=============================================================================== ffc098c8 <_API_extensions_Run_postdriver>: * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc098c8: 94 21 ff f0 stwu r1,-16(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc098cc: 3d 20 00 00 lis r9,0 * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc098d0: 7c 08 02 a6 mflr r0 ffc098d4: 93 c1 00 08 stw r30,8(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc098d8: 3b c9 2d c0 addi r30,r9,11712 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc098dc: 3b de 00 04 addi r30,r30,4 * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc098e0: 93 e1 00 0c stw r31,12(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc098e4: 83 e9 2d c0 lwz r31,11712(r9) * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc098e8: 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 ); ffc098ec: 7f 9f f0 00 cmpw cr7,r31,r30 ffc098f0: 41 9e 00 1c beq- cr7,ffc0990c <_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)(); ffc098f4: 80 1f 00 08 lwz r0,8(r31) ffc098f8: 7c 09 03 a6 mtctr r0 ffc098fc: 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 ) { ffc09900: 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 ); ffc09904: 7f 9f f0 00 cmpw cr7,r31,r30 ffc09908: 40 9e ff ec bne+ cr7,ffc098f4 <_API_extensions_Run_postdriver+0x2c> #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) if ( the_extension->postdriver_hook ) #endif (*the_extension->postdriver_hook)(); } } ffc0990c: 80 01 00 14 lwz r0,20(r1) ffc09910: 83 c1 00 08 lwz r30,8(r1) ffc09914: 7c 08 03 a6 mtlr r0 ffc09918: 83 e1 00 0c lwz r31,12(r1) ffc0991c: 38 21 00 10 addi r1,r1,16 ffc09920: 4e 80 00 20 blr =============================================================================== ffc09924 <_API_extensions_Run_postswitch>: * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc09924: 94 21 ff e8 stwu r1,-24(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc09928: 3d 20 00 00 lis r9,0 * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc0992c: 7c 08 02 a6 mflr r0 ffc09930: 93 c1 00 10 stw r30,16(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc09934: 3b c9 2d c0 addi r30,r9,11712 void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc09938: 3b de 00 04 addi r30,r30,4 * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc0993c: 93 e1 00 14 stw r31,20(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc09940: 83 e9 2d c0 lwz r31,11712(r9) * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc09944: 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 ); ffc09948: 7f 9f f0 00 cmpw cr7,r31,r30 * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc0994c: 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 ); ffc09950: 41 9e 00 28 beq- cr7,ffc09978 <_API_extensions_Run_postswitch+0x54><== NEVER TAKEN ffc09954: 3f a0 00 00 lis r29,0 ffc09958: 3b bd 31 04 addi r29,r29,12548 !_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 ); ffc0995c: 80 1f 00 0c lwz r0,12(r31) ffc09960: 80 7d 00 0c lwz r3,12(r29) ffc09964: 7c 09 03 a6 mtctr r0 ffc09968: 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 ) { ffc0996c: 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 ); ffc09970: 7f 9f f0 00 cmpw cr7,r31,r30 ffc09974: 40 9e ff e8 bne+ cr7,ffc0995c <_API_extensions_Run_postswitch+0x38> the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc09978: 80 01 00 1c lwz r0,28(r1) ffc0997c: 83 a1 00 0c lwz r29,12(r1) ffc09980: 7c 08 03 a6 mtlr r0 ffc09984: 83 c1 00 10 lwz r30,16(r1) ffc09988: 83 e1 00 14 lwz r31,20(r1) ffc0998c: 38 21 00 18 addi r1,r1,24 ffc09990: 4e 80 00 20 blr =============================================================================== ffc0cc34 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { ffc0cc34: 94 21 ff f0 stwu r1,-16(r1) ffc0cc38: 7c 08 02 a6 mflr r0 ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0cc3c: 3d 20 00 00 lis r9,0 */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { ffc0cc40: 90 01 00 14 stw r0,20(r1) ffc0cc44: 93 e1 00 0c stw r31,12(r1) ffc0cc48: 7c 7f 1b 78 mr r31,r3 ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0cc4c: 81 29 31 30 lwz r9,12592(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0cc50: 7d 60 00 a6 mfmsr r11 ffc0cc54: 7c 10 42 a6 mfsprg r0,0 ffc0cc58: 7d 60 00 78 andc r0,r11,r0 ffc0cc5c: 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){ ffc0cc60: 80 03 00 44 lwz r0,68(r3) ffc0cc64: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cc68: 41 9e 00 cc beq- cr7,ffc0cd34 <_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 ) { ffc0cc6c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0cc70: 41 9e 00 94 beq- cr7,ffc0cd04 <_CORE_RWLock_Release+0xd0> return CORE_RWLOCK_SUCCESSFUL; } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; ffc0cc74: 38 00 00 00 li r0,0 ffc0cc78: 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; ffc0cc7c: 90 1f 00 44 stw r0,68(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0cc80: 7d 60 01 24 mtmsr r11 _ISR_Enable( level ); next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); ffc0cc84: 7f e3 fb 78 mr r3,r31 ffc0cc88: 48 00 22 61 bl ffc0eee8 <_Thread_queue_Dequeue> if ( next ) { ffc0cc8c: 2c 03 00 00 cmpwi r3,0 ffc0cc90: 41 82 00 5c beq- ffc0ccec <_CORE_RWLock_Release+0xb8> if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { ffc0cc94: 80 03 00 30 lwz r0,48(r3) ffc0cc98: 2f 80 00 01 cmpwi cr7,r0,1 ffc0cc9c: 41 9e 00 bc beq- cr7,ffc0cd58 <_CORE_RWLock_Release+0x124> } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; ffc0cca0: 81 3f 00 48 lwz r9,72(r31) ffc0cca4: 38 09 00 01 addi r0,r9,1 ffc0cca8: 90 1f 00 48 stw r0,72(r31) the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; ffc0ccac: 38 00 00 01 li r0,1 ffc0ccb0: 90 1f 00 44 stw r0,68(r31) ffc0ccb4: 48 00 00 20 b ffc0ccd4 <_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 || ffc0ccb8: 80 09 00 30 lwz r0,48(r9) ffc0ccbc: 2f 80 00 01 cmpwi cr7,r0,1 ffc0ccc0: 41 9e 00 2c beq- cr7,ffc0ccec <_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; ffc0ccc4: 81 3f 00 48 lwz r9,72(r31) ffc0ccc8: 38 09 00 01 addi r0,r9,1 ffc0cccc: 90 1f 00 48 stw r0,72(r31) _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); ffc0ccd0: 48 00 26 c5 bl ffc0f394 <_Thread_queue_Extract> /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); ffc0ccd4: 7f e3 fb 78 mr r3,r31 ffc0ccd8: 48 00 28 59 bl ffc0f530 <_Thread_queue_First> if ( !next || ffc0ccdc: 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 ); ffc0cce0: 7f e3 fb 78 mr r3,r31 ffc0cce4: 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 || ffc0cce8: 40 82 ff d0 bne+ ffc0ccb8 <_CORE_RWLock_Release+0x84> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0ccec: 80 01 00 14 lwz r0,20(r1) ffc0ccf0: 38 60 00 00 li r3,0 ffc0ccf4: 83 e1 00 0c lwz r31,12(r1) ffc0ccf8: 38 21 00 10 addi r1,r1,16 ffc0ccfc: 7c 08 03 a6 mtlr r0 ffc0cd00: 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; ffc0cd04: 81 43 00 48 lwz r10,72(r3) ffc0cd08: 38 0a ff ff addi r0,r10,-1 if ( the_rwlock->number_of_readers != 0 ) { ffc0cd0c: 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; ffc0cd10: 90 03 00 48 stw r0,72(r3) if ( the_rwlock->number_of_readers != 0 ) { ffc0cd14: 41 9e ff 60 beq+ cr7,ffc0cc74 <_CORE_RWLock_Release+0x40> ffc0cd18: 7d 60 01 24 mtmsr r11 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0cd1c: 80 01 00 14 lwz r0,20(r1) ffc0cd20: 38 60 00 00 li r3,0 ffc0cd24: 83 e1 00 0c lwz r31,12(r1) ffc0cd28: 38 21 00 10 addi r1,r1,16 ffc0cd2c: 7c 08 03 a6 mtlr r0 ffc0cd30: 4e 80 00 20 blr ffc0cd34: 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; ffc0cd38: 38 00 00 02 li r0,2 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0cd3c: 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; ffc0cd40: 90 09 00 34 stw r0,52(r9) } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0cd44: 38 60 00 00 li r3,0 ffc0cd48: 80 01 00 14 lwz r0,20(r1) ffc0cd4c: 38 21 00 10 addi r1,r1,16 ffc0cd50: 7c 08 03 a6 mtlr r0 ffc0cd54: 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; ffc0cd58: 38 00 00 02 li r0,2 ffc0cd5c: 90 1f 00 44 stw r0,68(r31) return CORE_RWLOCK_SUCCESSFUL; ffc0cd60: 4b ff ff 8c b ffc0ccec <_CORE_RWLock_Release+0xb8> =============================================================================== ffc0cd64 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { ffc0cd64: 94 21 ff e8 stwu r1,-24(r1) ffc0cd68: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0cd6c: 38 81 00 08 addi r4,r1,8 void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { ffc0cd70: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0cd74: 48 00 1d 01 bl ffc0ea74 <_Thread_Get> switch ( location ) { ffc0cd78: 80 01 00 08 lwz r0,8(r1) ffc0cd7c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cd80: 40 9e 00 18 bne- cr7,ffc0cd98 <_CORE_RWLock_Timeout+0x34><== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); ffc0cd84: 48 00 29 01 bl ffc0f684 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc0cd88: 3d 20 00 00 lis r9,0 ffc0cd8c: 81 69 27 f4 lwz r11,10228(r9) ffc0cd90: 38 0b ff ff addi r0,r11,-1 ffc0cd94: 90 09 27 f4 stw r0,10228(r9) _Thread_Unnest_dispatch(); break; } } ffc0cd98: 80 01 00 1c lwz r0,28(r1) ffc0cd9c: 38 21 00 18 addi r1,r1,24 ffc0cda0: 7c 08 03 a6 mtlr r0 ffc0cda4: 4e 80 00 20 blr =============================================================================== ffc1c82c <_CORE_message_queue_Broadcast>: Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { ffc1c82c: 94 21 ff e0 stwu r1,-32(r1) ffc1c830: 7c 08 02 a6 mflr r0 ffc1c834: 90 01 00 24 stw r0,36(r1) Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { ffc1c838: 80 03 00 4c lwz r0,76(r3) Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { ffc1c83c: 93 41 00 08 stw r26,8(r1) ffc1c840: 7d 1a 43 78 mr r26,r8 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { ffc1c844: 7f 80 28 40 cmplw cr7,r0,r5 Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { ffc1c848: 93 a1 00 14 stw r29,20(r1) ffc1c84c: 7c 9d 23 78 mr r29,r4 ffc1c850: 93 c1 00 18 stw r30,24(r1) ffc1c854: 7c 7e 1b 78 mr r30,r3 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { return CORE_MESSAGE_QUEUE_STATUS_INVALID_SIZE; ffc1c858: 38 60 00 01 li r3,1 Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { ffc1c85c: 93 e1 00 1c stw r31,28(r1) ffc1c860: 7c bf 2b 78 mr r31,r5 ffc1c864: 93 61 00 0c stw r27,12(r1) ffc1c868: 93 81 00 10 stw r28,16(r1) Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { ffc1c86c: 41 9c 00 20 blt- cr7,ffc1c88c <_CORE_message_queue_Broadcast+0x60><== NEVER TAKEN * NOTE: This check is critical because threads can block on * send and receive and this ensures that we are broadcasting * the message to threads waiting to receive -- not to send. */ if ( the_message_queue->number_of_pending_messages != 0 ) { ffc1c870: 80 1e 00 48 lwz r0,72(r30) ffc1c874: 3b 60 00 00 li r27,0 ffc1c878: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c87c: 41 be 00 4c beq+ cr7,ffc1c8c8 <_CORE_message_queue_Broadcast+0x9c> *count = 0; ffc1c880: 38 00 00 00 li r0,0 ffc1c884: 90 08 00 00 stw r0,0(r8) return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; ffc1c888: 38 60 00 00 li r3,0 #endif } *count = number_broadcasted; return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } ffc1c88c: 80 01 00 24 lwz r0,36(r1) ffc1c890: 83 41 00 08 lwz r26,8(r1) ffc1c894: 7c 08 03 a6 mtlr r0 ffc1c898: 83 61 00 0c lwz r27,12(r1) ffc1c89c: 83 81 00 10 lwz r28,16(r1) ffc1c8a0: 83 a1 00 14 lwz r29,20(r1) ffc1c8a4: 83 c1 00 18 lwz r30,24(r1) ffc1c8a8: 83 e1 00 1c lwz r31,28(r1) ffc1c8ac: 38 21 00 20 addi r1,r1,32 ffc1c8b0: 4e 80 00 20 blr const void *source, void *destination, size_t size ) { memcpy(destination, source, size); ffc1c8b4: 80 7c 00 2c lwz r3,44(r28) */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; ffc1c8b8: 3b 7b 00 01 addi r27,r27,1 ffc1c8bc: 48 00 b8 29 bl ffc280e4 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; ffc1c8c0: 81 3c 00 28 lwz r9,40(r28) ffc1c8c4: 93 e9 00 00 stw r31,0(r9) /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = ffc1c8c8: 7f c3 f3 78 mr r3,r30 ffc1c8cc: 48 00 36 d9 bl ffc1ffa4 <_Thread_queue_Dequeue> ffc1c8d0: 7f a4 eb 78 mr r4,r29 ffc1c8d4: 7c 7c 1b 79 mr. r28,r3 ffc1c8d8: 7f e5 fb 78 mr r5,r31 ffc1c8dc: 40 82 ff d8 bne+ ffc1c8b4 <_CORE_message_queue_Broadcast+0x88> #endif } *count = number_broadcasted; return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } ffc1c8e0: 80 01 00 24 lwz r0,36(r1) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; ffc1c8e4: 93 7a 00 00 stw r27,0(r26) return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } ffc1c8e8: 7c 08 03 a6 mtlr r0 ffc1c8ec: 83 41 00 08 lwz r26,8(r1) ffc1c8f0: 83 61 00 0c lwz r27,12(r1) ffc1c8f4: 83 81 00 10 lwz r28,16(r1) ffc1c8f8: 83 a1 00 14 lwz r29,20(r1) ffc1c8fc: 83 c1 00 18 lwz r30,24(r1) ffc1c900: 83 e1 00 1c lwz r31,28(r1) ffc1c904: 38 21 00 20 addi r1,r1,32 ffc1c908: 4e 80 00 20 blr =============================================================================== ffc151d8 <_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 ) { ffc151d8: 94 21 ff e0 stwu r1,-32(r1) ffc151dc: 7c 08 02 a6 mflr r0 /* * 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)) { ffc151e0: 7c c9 33 78 mr r9,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 ) { ffc151e4: 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)) { ffc151e8: 70 c0 00 03 andi. r0,r6,3 { size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; the_message_queue->number_of_pending_messages = 0; ffc151ec: 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 ) { ffc151f0: 93 a1 00 14 stw r29,20(r1) ffc151f4: 7c 9d 23 78 mr r29,r4 ffc151f8: 93 e1 00 1c stw r31,28(r1) ffc151fc: 7c 7f 1b 78 mr r31,r3 ffc15200: 93 81 00 10 stw r28,16(r1) ffc15204: 93 c1 00 18 stw r30,24(r1) size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; ffc15208: 90 a3 00 44 stw r5,68(r3) the_message_queue->number_of_pending_messages = 0; ffc1520c: 90 03 00 48 stw r0,72(r3) the_message_queue->maximum_message_size = maximum_message_size; ffc15210: 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; ffc15214: 90 03 00 60 stw r0,96(r3) the_message_queue->notify_argument = the_argument; ffc15218: 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)) { ffc1521c: 41 82 00 3c beq- ffc15258 <_CORE_message_queue_Initialize+0x80> allocated_message_size += sizeof(uint32_t); ffc15220: 39 26 00 04 addi r9,r6,4 allocated_message_size &= ~(sizeof(uint32_t) - 1); ffc15224: 55 29 00 3a rlwinm r9,r9,0,0,29 } if (allocated_message_size < maximum_message_size) ffc15228: 7f 86 48 40 cmplw cr7,r6,r9 return false; ffc1522c: 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) ffc15230: 40 9d 00 28 ble- cr7,ffc15258 <_CORE_message_queue_Initialize+0x80><== ALWAYS TAKEN STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } ffc15234: 80 01 00 24 lwz r0,36(r1) ffc15238: 7f c3 f3 78 mr r3,r30 ffc1523c: 83 81 00 10 lwz r28,16(r1) ffc15240: 7c 08 03 a6 mtlr r0 ffc15244: 83 a1 00 14 lwz r29,20(r1) ffc15248: 83 c1 00 18 lwz r30,24(r1) ffc1524c: 83 e1 00 1c lwz r31,28(r1) ffc15250: 38 21 00 20 addi r1,r1,32 ffc15254: 4e 80 00 20 blr /* * Calculate how much total memory is required for message buffering and * check for overflow on the multiplication. */ message_buffering_required = (size_t) maximum_pending_messages * (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); ffc15258: 3b 89 00 14 addi r28,r9,20 /* * Calculate how much total memory is required for message buffering and * check for overflow on the multiplication. */ message_buffering_required = (size_t) maximum_pending_messages * ffc1525c: 7c 7c 29 d6 mullw r3,r28,r5 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) return false; ffc15260: 3b c0 00 00 li r30,0 * check for overflow on the multiplication. */ message_buffering_required = (size_t) maximum_pending_messages * (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) ffc15264: 7f 83 48 40 cmplw cr7,r3,r9 ffc15268: 41 9c ff cc blt+ cr7,ffc15234 <_CORE_message_queue_Initialize+0x5c><== NEVER TAKEN /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); ffc1526c: 90 a1 00 08 stw r5,8(r1) ffc15270: 48 00 3e 79 bl ffc190e8 <_Workspace_Allocate> if (the_message_queue->message_buffers == 0) ffc15274: 2f 83 00 00 cmpwi cr7,r3,0 /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); ffc15278: 7c 64 1b 78 mr r4,r3 return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) ffc1527c: 90 7f 00 5c stw r3,92(r31) _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) ffc15280: 80 a1 00 08 lwz r5,8(r1) ffc15284: 41 be ff b0 beq- cr7,ffc15234 <_CORE_message_queue_Initialize+0x5c> /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( ffc15288: 38 7f 00 68 addi r3,r31,104 ffc1528c: 7f 86 e3 78 mr r6,r28 ffc15290: 48 00 6d 59 bl ffc1bfe8 <_Chain_Initialize> */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); ffc15294: 38 1f 00 50 addi r0,r31,80 Chain_Node *tail = _Chain_Tail( the_chain ); ffc15298: 39 3f 00 54 addi r9,r31,84 head->next = tail; head->previous = NULL; ffc1529c: 93 df 00 54 stw r30,84(r31) allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( ffc152a0: 7f e3 fb 78 mr r3,r31 tail->previous = head; ffc152a4: 90 1f 00 58 stw r0,88(r31) ffc152a8: 38 a0 00 80 li r5,128 ffc152ac: 38 c0 00 06 li r6,6 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc152b0: 91 3f 00 50 stw r9,80(r31) THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; ffc152b4: 3b c0 00 01 li r30,1 allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( ffc152b8: 80 9d 00 00 lwz r4,0(r29) ffc152bc: 68 84 00 01 xori r4,r4,1 ffc152c0: 7c 84 00 34 cntlzw r4,r4 ffc152c4: 54 84 d9 7e rlwinm r4,r4,27,5,31 ffc152c8: 48 00 2e b5 bl ffc1817c <_Thread_queue_Initialize> STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } ffc152cc: 80 01 00 24 lwz r0,36(r1) ffc152d0: 7f c3 f3 78 mr r3,r30 ffc152d4: 83 81 00 10 lwz r28,16(r1) ffc152d8: 7c 08 03 a6 mtlr r0 ffc152dc: 83 a1 00 14 lwz r29,20(r1) ffc152e0: 83 c1 00 18 lwz r30,24(r1) ffc152e4: 83 e1 00 1c lwz r31,28(r1) ffc152e8: 38 21 00 20 addi r1,r1,32 ffc152ec: 4e 80 00 20 blr =============================================================================== ffc09d44 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { ffc09d44: 94 21 ff d8 stwu r1,-40(r1) ffc09d48: 7c 08 02 a6 mflr r0 ffc09d4c: 93 c1 00 20 stw r30,32(r1) _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09d50: 3f c0 00 00 lis r30,0 Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { ffc09d54: 90 01 00 2c stw r0,44(r1) _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09d58: 80 1e 27 a8 lwz r0,10152(r30) Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { ffc09d5c: 93 61 00 14 stw r27,20(r1) ffc09d60: 7c db 33 78 mr r27,r6 _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09d64: 2f 80 00 00 cmpwi cr7,r0,0 Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { ffc09d68: 93 81 00 18 stw r28,24(r1) ffc09d6c: 7c bc 2b 78 mr r28,r5 ffc09d70: 93 a1 00 1c stw r29,28(r1) ffc09d74: 7c 9d 23 78 mr r29,r4 ffc09d78: 93 e1 00 24 stw r31,36(r1) ffc09d7c: 7c 7f 1b 78 mr r31,r3 ffc09d80: 90 e1 00 08 stw r7,8(r1) _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09d84: 41 9e 00 0c beq- cr7,ffc09d90 <_CORE_mutex_Seize+0x4c> ffc09d88: 2f 85 00 00 cmpwi cr7,r5,0 ffc09d8c: 40 9e 00 5c bne- cr7,ffc09de8 <_CORE_mutex_Seize+0xa4> <== ALWAYS TAKEN ffc09d90: 7f e3 fb 78 mr r3,r31 ffc09d94: 38 81 00 08 addi r4,r1,8 ffc09d98: 48 00 66 f9 bl ffc10490 <_CORE_mutex_Seize_interrupt_trylock> ffc09d9c: 2f 83 00 00 cmpwi cr7,r3,0 ffc09da0: 41 9e 00 24 beq- cr7,ffc09dc4 <_CORE_mutex_Seize+0x80> ffc09da4: 2f 9c 00 00 cmpwi cr7,r28,0 ffc09da8: 40 9e 00 60 bne- cr7,ffc09e08 <_CORE_mutex_Seize+0xc4> ffc09dac: 80 01 00 08 lwz r0,8(r1) ffc09db0: 7c 00 01 24 mtmsr r0 ffc09db4: 3d 20 00 00 lis r9,0 ffc09db8: 81 29 31 10 lwz r9,12560(r9) ffc09dbc: 38 00 00 01 li r0,1 ffc09dc0: 90 09 00 34 stw r0,52(r9) } ffc09dc4: 80 01 00 2c lwz r0,44(r1) ffc09dc8: 83 61 00 14 lwz r27,20(r1) ffc09dcc: 7c 08 03 a6 mtlr r0 ffc09dd0: 83 81 00 18 lwz r28,24(r1) ffc09dd4: 83 a1 00 1c lwz r29,28(r1) ffc09dd8: 83 c1 00 20 lwz r30,32(r1) ffc09ddc: 83 e1 00 24 lwz r31,36(r1) ffc09de0: 38 21 00 28 addi r1,r1,40 ffc09de4: 4e 80 00 20 blr bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09de8: 3d 20 00 00 lis r9,0 ffc09dec: 80 09 27 ec lwz r0,10220(r9) ffc09df0: 2b 80 00 01 cmplwi cr7,r0,1 ffc09df4: 40 9d ff 9c ble+ cr7,ffc09d90 <_CORE_mutex_Seize+0x4c> ffc09df8: 38 60 00 00 li r3,0 ffc09dfc: 38 80 00 00 li r4,0 ffc09e00: 38 a0 00 12 li r5,18 ffc09e04: 48 00 08 95 bl ffc0a698 <_Internal_error_Occurred> ffc09e08: 3d 20 00 00 lis r9,0 ffc09e0c: 81 7e 27 a8 lwz r11,10152(r30) ffc09e10: 81 29 31 10 lwz r9,12560(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; ffc09e14: 38 00 00 01 li r0,1 ffc09e18: 90 1f 00 30 stw r0,48(r31) ffc09e1c: 38 0b 00 01 addi r0,r11,1 ffc09e20: 93 e9 00 44 stw r31,68(r9) ffc09e24: 93 a9 00 20 stw r29,32(r9) ffc09e28: 90 1e 27 a8 stw r0,10152(r30) ffc09e2c: 80 01 00 08 lwz r0,8(r1) ffc09e30: 7c 00 01 24 mtmsr r0 ffc09e34: 7f e3 fb 78 mr r3,r31 ffc09e38: 7f 64 db 78 mr r4,r27 ffc09e3c: 4b ff fe 45 bl ffc09c80 <_CORE_mutex_Seize_interrupt_blocking> } ffc09e40: 80 01 00 2c lwz r0,44(r1) ffc09e44: 83 61 00 14 lwz r27,20(r1) ffc09e48: 7c 08 03 a6 mtlr r0 ffc09e4c: 83 81 00 18 lwz r28,24(r1) ffc09e50: 83 a1 00 1c lwz r29,28(r1) ffc09e54: 83 c1 00 20 lwz r30,32(r1) ffc09e58: 83 e1 00 24 lwz r31,36(r1) ffc09e5c: 38 21 00 28 addi r1,r1,40 ffc09e60: 4e 80 00 20 blr =============================================================================== ffc0a024 <_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 ) { ffc0a024: 94 21 ff f0 stwu r1,-16(r1) ffc0a028: 7c 08 02 a6 mflr r0 ffc0a02c: 93 e1 00 0c stw r31,12(r1) ffc0a030: 7c 7f 1b 78 mr r31,r3 ffc0a034: 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)) ) { ffc0a038: 48 00 20 81 bl ffc0c0b8 <_Thread_queue_Dequeue> ffc0a03c: 2f 83 00 00 cmpwi cr7,r3,0 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; ffc0a040: 38 60 00 00 li r3,0 if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { ffc0a044: 41 9e 00 18 beq- cr7,ffc0a05c <_CORE_semaphore_Surrender+0x38> status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } ffc0a048: 80 01 00 14 lwz r0,20(r1) ffc0a04c: 83 e1 00 0c lwz r31,12(r1) ffc0a050: 38 21 00 10 addi r1,r1,16 ffc0a054: 7c 08 03 a6 mtlr r0 ffc0a058: 4e 80 00 20 blr static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0a05c: 7c 00 00 a6 mfmsr r0 ffc0a060: 7d 30 42 a6 mfsprg r9,0 ffc0a064: 7c 09 48 78 andc r9,r0,r9 ffc0a068: 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 ) ffc0a06c: 81 3f 00 48 lwz r9,72(r31) the_semaphore->count += 1; else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; ffc0a070: 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 ) ffc0a074: 81 7f 00 40 lwz r11,64(r31) ffc0a078: 7f 89 58 40 cmplw cr7,r9,r11 ffc0a07c: 40 9c 00 10 bge- cr7,ffc0a08c <_CORE_semaphore_Surrender+0x68><== NEVER TAKEN the_semaphore->count += 1; ffc0a080: 39 29 00 01 addi r9,r9,1 ffc0a084: 91 3f 00 48 stw r9,72(r31) { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; ffc0a088: 38 60 00 00 li r3,0 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0a08c: 7c 00 01 24 mtmsr r0 status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } ffc0a090: 80 01 00 14 lwz r0,20(r1) ffc0a094: 83 e1 00 0c lwz r31,12(r1) ffc0a098: 38 21 00 10 addi r1,r1,16 ffc0a09c: 7c 08 03 a6 mtlr r0 ffc0a0a0: 4e 80 00 20 blr =============================================================================== ffc10438 <_Chain_Initialize>: Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10438: 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; ffc1043c: 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 ); ffc10440: 39 43 00 04 addi r10,r3,4 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; ffc10444: 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; ffc10448: 7c 69 1b 78 mr r9,r3 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc1044c: 41 82 00 38 beq- ffc10484 <_Chain_Initialize+0x4c> <== NEVER TAKEN ffc10450: 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; ffc10454: 7c a9 03 a6 mtctr r5 Chain_Node *next = starting_address; ffc10458: 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; ffc1045c: 7c 6b 1b 78 mr r11,r3 ffc10460: 48 00 00 0c b ffc1046c <_Chain_Initialize+0x34> Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10464: 7d 2b 4b 78 mr r11,r9 current->next = next; next->previous = current; current = next; next = (Chain_Node *) ffc10468: 7c 09 03 78 mr r9,r0 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { current->next = next; ffc1046c: 91 2b 00 00 stw r9,0(r11) * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( ffc10470: 7c 09 32 14 add r0,r9,r6 head->previous = NULL; while ( count-- ) { current->next = next; next->previous = current; ffc10474: 91 69 00 04 stw r11,4(r9) Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10478: 42 00 ff ec bdnz+ ffc10464 <_Chain_Initialize+0x2c> * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( ffc1047c: 7c c6 41 d6 mullw r6,r6,r8 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10480: 7d 24 32 14 add r9,r4,r6 current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; ffc10484: 91 49 00 00 stw r10,0(r9) tail->previous = current; ffc10488: 91 23 00 08 stw r9,8(r3) } ffc1048c: 4e 80 00 20 blr =============================================================================== ffc0879c <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { ffc0879c: 94 21 ff f0 stwu r1,-16(r1) ffc087a0: 7c 08 02 a6 mflr r0 ffc087a4: 90 01 00 14 stw r0,20(r1) ffc087a8: 93 e1 00 0c stw r31,12(r1) ffc087ac: 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 ]; ffc087b0: 81 63 01 30 lwz r11,304(r3) option_set = (rtems_option) the_thread->Wait.option; ffc087b4: 80 c3 00 30 lwz r6,48(r3) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc087b8: 7d 40 00 a6 mfmsr r10 ffc087bc: 7c 10 42 a6 mfsprg r0,0 ffc087c0: 7d 40 00 78 andc r0,r10,r0 ffc087c4: 7c 00 01 24 mtmsr r0 _ISR_Disable( level ); pending_events = api->pending_events; ffc087c8: 81 2b 00 00 lwz r9,0(r11) event_condition = (rtems_event_set) the_thread->Wait.count; ffc087cc: 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 ) ) { ffc087d0: 7c 08 48 39 and. r8,r0,r9 ffc087d4: 41 82 00 b0 beq- ffc08884 <_Event_Surrender+0xe8> /* * 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() && ffc087d8: 3c e0 00 00 lis r7,0 ffc087dc: 38 e7 31 04 addi r7,r7,12548 ffc087e0: 80 a7 00 08 lwz r5,8(r7) ffc087e4: 2f 85 00 00 cmpwi cr7,r5,0 ffc087e8: 41 9e 00 10 beq- cr7,ffc087f8 <_Event_Surrender+0x5c> ffc087ec: 80 e7 00 0c lwz r7,12(r7) ffc087f0: 7f 83 38 00 cmpw cr7,r3,r7 ffc087f4: 41 9e 00 d0 beq- cr7,ffc088c4 <_Event_Surrender+0x128> */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); ffc087f8: 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 ) ) { ffc087fc: 70 e5 01 00 andi. r5,r7,256 ffc08800: 41 82 00 6c beq- ffc0886c <_Event_Surrender+0xd0> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { ffc08804: 7f 80 40 00 cmpw cr7,r0,r8 ffc08808: 41 9e 00 0c beq- cr7,ffc08814 <_Event_Surrender+0x78> ffc0880c: 70 c0 00 02 andi. r0,r6,2 ffc08810: 41 82 00 5c beq- ffc0886c <_Event_Surrender+0xd0> <== 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; ffc08814: 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) ); ffc08818: 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; ffc0881c: 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 ); ffc08820: 91 2b 00 00 stw r9,0(r11) the_thread->Wait.count = 0; ffc08824: 90 1f 00 24 stw r0,36(r31) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; ffc08828: 91 07 00 00 stw r8,0(r7) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; asm volatile ( ffc0882c: 7c 00 00 a6 mfmsr r0 ffc08830: 7d 40 01 24 mtmsr r10 ffc08834: 7c 00 01 24 mtmsr r0 _ISR_Flash( level ); if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { ffc08838: 80 1f 00 50 lwz r0,80(r31) ffc0883c: 2f 80 00 02 cmpwi cr7,r0,2 ffc08840: 41 9e 00 5c beq- cr7,ffc0889c <_Event_Surrender+0x100> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc08844: 7d 40 01 24 mtmsr r10 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc08848: 3c 80 10 03 lis r4,4099 ffc0884c: 7f e3 fb 78 mr r3,r31 ffc08850: 60 84 ff f8 ori r4,r4,65528 ffc08854: 48 00 2f 05 bl ffc0b758 <_Thread_Clear_state> } return; } } _ISR_Enable( level ); } ffc08858: 80 01 00 14 lwz r0,20(r1) ffc0885c: 83 e1 00 0c lwz r31,12(r1) ffc08860: 38 21 00 10 addi r1,r1,16 ffc08864: 7c 08 03 a6 mtlr r0 ffc08868: 4e 80 00 20 blr ffc0886c: 7d 40 01 24 mtmsr r10 ffc08870: 80 01 00 14 lwz r0,20(r1) ffc08874: 83 e1 00 0c lwz r31,12(r1) ffc08878: 38 21 00 10 addi r1,r1,16 ffc0887c: 7c 08 03 a6 mtlr r0 ffc08880: 4e 80 00 20 blr ffc08884: 7d 40 01 24 mtmsr r10 ffc08888: 80 01 00 14 lwz r0,20(r1) ffc0888c: 83 e1 00 0c lwz r31,12(r1) ffc08890: 38 21 00 10 addi r1,r1,16 ffc08894: 7c 08 03 a6 mtlr r0 ffc08898: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; ffc0889c: 38 00 00 03 li r0,3 ffc088a0: 90 1f 00 50 stw r0,80(r31) ffc088a4: 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 ); ffc088a8: 38 7f 00 48 addi r3,r31,72 ffc088ac: 48 00 4a 79 bl ffc0d324 <_Watchdog_Remove> ffc088b0: 3c 80 10 03 lis r4,4099 ffc088b4: 7f e3 fb 78 mr r3,r31 ffc088b8: 60 84 ff f8 ori r4,r4,65528 ffc088bc: 48 00 2e 9d bl ffc0b758 <_Thread_Clear_state> ffc088c0: 4b ff ff b0 b ffc08870 <_Event_Surrender+0xd4> * 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) || ffc088c4: 3c e0 00 00 lis r7,0 ffc088c8: 80 a7 27 f8 lwz r5,10232(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 ) && ffc088cc: 2f 85 00 02 cmpwi cr7,r5,2 ffc088d0: 41 9e 00 10 beq- cr7,ffc088e0 <_Event_Surrender+0x144> <== NEVER TAKEN ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { ffc088d4: 80 a7 27 f8 lwz r5,10232(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) || ffc088d8: 2f 85 00 01 cmpwi cr7,r5,1 ffc088dc: 40 9e ff 1c bne+ cr7,ffc087f8 <_Event_Surrender+0x5c> (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { ffc088e0: 7f 80 40 00 cmpw cr7,r0,r8 ffc088e4: 41 9e 00 0c beq- cr7,ffc088f0 <_Event_Surrender+0x154> ffc088e8: 70 c0 00 02 andi. r0,r6,2 ffc088ec: 41 82 00 24 beq- ffc08910 <_Event_Surrender+0x174> <== 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; ffc088f0: 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; ffc088f4: 38 00 00 00 li r0,0 ffc088f8: 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 ); ffc088fc: 91 2b 00 00 stw r9,0(r11) the_thread->Wait.count = 0; ffc08900: 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; ffc08904: 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; ffc08908: 91 06 00 00 stw r8,0(r6) _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; ffc0890c: 90 07 27 f8 stw r0,10232(r7) ffc08910: 7d 40 01 24 mtmsr r10 ffc08914: 4b ff ff 5c b ffc08870 <_Event_Surrender+0xd4> =============================================================================== ffc08918 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { ffc08918: 94 21 ff e8 stwu r1,-24(r1) ffc0891c: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); ffc08920: 38 81 00 08 addi r4,r1,8 void _Event_Timeout( Objects_Id id, void *ignored ) { ffc08924: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); ffc08928: 48 00 33 1d bl ffc0bc44 <_Thread_Get> switch ( location ) { ffc0892c: 80 01 00 08 lwz r0,8(r1) ffc08930: 2f 80 00 00 cmpwi cr7,r0,0 ffc08934: 40 9e 00 50 bne- cr7,ffc08984 <_Event_Timeout+0x6c> <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc08938: 7d 20 00 a6 mfmsr r9 ffc0893c: 7d 70 42 a6 mfsprg r11,0 ffc08940: 7d 2b 58 78 andc r11,r9,r11 ffc08944: 7d 60 01 24 mtmsr r11 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc08948: 3d 60 00 00 lis r11,0 _ISR_Enable( level ); return; } #endif the_thread->Wait.count = 0; ffc0894c: 90 03 00 24 stw r0,36(r3) if ( _Thread_Is_executing( the_thread ) ) { ffc08950: 81 6b 31 10 lwz r11,12560(r11) ffc08954: 7f 83 58 00 cmpw cr7,r3,r11 ffc08958: 41 9e 00 3c beq- cr7,ffc08994 <_Event_Timeout+0x7c> if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } the_thread->Wait.return_code = RTEMS_TIMEOUT; ffc0895c: 38 00 00 06 li r0,6 ffc08960: 90 03 00 34 stw r0,52(r3) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc08964: 7d 20 01 24 mtmsr r9 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc08968: 3c 80 10 03 lis r4,4099 ffc0896c: 60 84 ff f8 ori r4,r4,65528 ffc08970: 48 00 2d e9 bl ffc0b758 <_Thread_Clear_state> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc08974: 3d 20 00 00 lis r9,0 ffc08978: 81 69 27 a8 lwz r11,10152(r9) ffc0897c: 38 0b ff ff addi r0,r11,-1 ffc08980: 90 09 27 a8 stw r0,10152(r9) case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } ffc08984: 80 01 00 1c lwz r0,28(r1) ffc08988: 38 21 00 18 addi r1,r1,24 ffc0898c: 7c 08 03 a6 mtlr r0 ffc08990: 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 ) ffc08994: 3d 60 00 00 lis r11,0 ffc08998: 80 0b 27 f8 lwz r0,10232(r11) ffc0899c: 2f 80 00 01 cmpwi cr7,r0,1 ffc089a0: 40 9e ff bc bne+ cr7,ffc0895c <_Event_Timeout+0x44> _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; ffc089a4: 38 00 00 02 li r0,2 ffc089a8: 90 0b 27 f8 stw r0,10232(r11) ffc089ac: 4b ff ff b0 b ffc0895c <_Event_Timeout+0x44> =============================================================================== ffc1069c <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc1069c: 94 21 ff e0 stwu r1,-32(r1) ffc106a0: 7c 08 02 a6 mflr r0 ffc106a4: 7d 80 00 26 mfcr r12 ffc106a8: 7c 89 23 78 mr r9,r4 ffc106ac: 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 ffc106b0: 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 ) { ffc106b4: 7f 84 00 40 cmplw cr7,r4,r0 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc106b8: 93 a1 00 14 stw r29,20(r1) ffc106bc: 7c 7d 1b 78 mr r29,r3 ffc106c0: 91 81 00 08 stw r12,8(r1) ffc106c4: 93 61 00 0c stw r27,12(r1) 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; ffc106c8: 81 83 00 10 lwz r12,16(r3) uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { /* Integer overflow occured */ return NULL; ffc106cc: 38 60 00 00 li r3,0 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc106d0: 93 81 00 10 stw r28,16(r1) ffc106d4: 93 c1 00 18 stw r30,24(r1) ffc106d8: 93 e1 00 1c stw r31,28(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 ) { ffc106dc: 41 9d 01 60 bgt- cr7,ffc1083c <_Heap_Allocate_aligned_with_boundary+0x1a0> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { ffc106e0: 2e 06 00 00 cmpwi cr4,r6,0 ffc106e4: 40 92 01 8c bne- cr4,ffc10870 <_Heap_Allocate_aligned_with_boundary+0x1d4> if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } ffc106e8: 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 ) { ffc106ec: 38 60 00 00 li r3,0 ffc106f0: 7f 9d 20 00 cmpw cr7,r29,r4 ffc106f4: 41 9e 01 48 beq- cr7,ffc1083c <_Heap_Allocate_aligned_with_boundary+0x1a0> ffc106f8: 3b c0 00 01 li r30,1 * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { if ( alignment == 0 ) { ffc106fc: 2c 05 00 00 cmpwi r5,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 ffc10700: 3b 6c 00 07 addi r27,r12,7 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; ffc10704: 23 89 00 04 subfic r28,r9,4 ffc10708: 48 00 00 24 b ffc1072c <_Heap_Allocate_aligned_with_boundary+0x90> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc1070c: 3b e4 00 08 addi r31,r4,8 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { ffc10710: 2f 9f 00 00 cmpwi cr7,r31,0 ffc10714: 40 9e 00 ec bne- cr7,ffc10800 <_Heap_Allocate_aligned_with_boundary+0x164><== ALWAYS TAKEN break; } block = block->next; ffc10718: 80 84 00 08 lwz r4,8(r4) ffc1071c: 39 7e 00 01 addi r11,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 ) { ffc10720: 7f 9d 20 00 cmpw cr7,r29,r4 ffc10724: 41 9e 01 44 beq- cr7,ffc10868 <_Heap_Allocate_aligned_with_boundary+0x1cc> ffc10728: 7d 7e 5b 78 mr r30,r11 /* * 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 ) { ffc1072c: 81 64 00 04 lwz r11,4(r4) ffc10730: 7f 80 58 40 cmplw cr7,r0,r11 ffc10734: 40 bc ff e4 bge- cr7,ffc10718 <_Heap_Allocate_aligned_with_boundary+0x7c> if ( alignment == 0 ) { ffc10738: 41 a2 ff d4 beq- ffc1070c <_Heap_Allocate_aligned_with_boundary+0x70> - 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; ffc1073c: 55 6b 00 3c rlwinm r11,r11,0,0,30 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } ffc10740: 80 fd 00 14 lwz r7,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; ffc10744: 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; ffc10748: 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); ffc1074c: 7f ff 2b 96 divwu r31,r31,r5 ffc10750: 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; ffc10754: 7d 47 d8 50 subf r10,r7,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 ffc10758: 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 ) { ffc1075c: 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; ffc10760: 38 64 00 08 addi r3,r4,8 ffc10764: 40 9c 00 0c bge- cr7,ffc10770 <_Heap_Allocate_aligned_with_boundary+0xd4> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10768: 7d 6b 2b 96 divwu r11,r11,r5 ffc1076c: 7f eb 29 d6 mullw r31,r11,r5 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { ffc10770: 41 92 00 60 beq- cr4,ffc107d0 <_Heap_Allocate_aligned_with_boundary+0x134> /* 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; ffc10774: 7d 5f 4a 14 add r10,r31,r9 ffc10778: 7d 6a 33 96 divwu r11,r10,r6 ffc1077c: 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 ) { ffc10780: 7f 9f 58 40 cmplw cr7,r31,r11 ffc10784: 40 9c 00 4c bge- cr7,ffc107d0 <_Heap_Allocate_aligned_with_boundary+0x134> ffc10788: 7f 8a 58 40 cmplw cr7,r10,r11 ffc1078c: 40 9d 00 44 ble- cr7,ffc107d0 <_Heap_Allocate_aligned_with_boundary+0x134> alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; ffc10790: 7d 03 4a 14 add r8,r3,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 ) { ffc10794: 7f 88 58 40 cmplw cr7,r8,r11 ffc10798: 40 bd 00 10 ble+ cr7,ffc107a8 <_Heap_Allocate_aligned_with_boundary+0x10c> ffc1079c: 4b ff ff 7c b ffc10718 <_Heap_Allocate_aligned_with_boundary+0x7c> /* 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 ) { ffc107a0: 40 99 00 30 ble- cr6,ffc107d0 <_Heap_Allocate_aligned_with_boundary+0x134> if ( boundary_line < boundary_floor ) { ffc107a4: 41 a5 ff 74 bgt- cr1,ffc10718 <_Heap_Allocate_aligned_with_boundary+0x7c><== NEVER TAKEN return 0; } alloc_begin = boundary_line - alloc_size; ffc107a8: 7f e9 58 50 subf r31,r9,r11 ffc107ac: 7f ff 2b 96 divwu r31,r31,r5 ffc107b0: 7f ff 29 d6 mullw r31,r31,r5 alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; ffc107b4: 7d 5f 4a 14 add r10,r31,r9 ffc107b8: 7d 6a 33 96 divwu r11,r10,r6 ffc107bc: 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 ) { ffc107c0: 7f 9f 58 40 cmplw cr7,r31,r11 ffc107c4: 7f 0a 58 40 cmplw cr6,r10,r11 if ( boundary_line < boundary_floor ) { ffc107c8: 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 ) { ffc107cc: 41 9c ff d4 blt+ cr7,ffc107a0 <_Heap_Allocate_aligned_with_boundary+0x104> 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 ) { ffc107d0: 7f 83 f8 40 cmplw cr7,r3,r31 ffc107d4: 41 bd ff 44 bgt- cr7,ffc10718 <_Heap_Allocate_aligned_with_boundary+0x7c> ffc107d8: 7d 7f 63 96 divwu r11,r31,r12 ffc107dc: 7d 6b 61 d6 mullw r11,r11,r12 ffc107e0: 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; ffc107e4: 7d 6a 5a 14 add r11,r10,r11 if ( free_size >= min_block_size || free_size == 0 ) { ffc107e8: 7f 87 58 40 cmplw cr7,r7,r11 ffc107ec: 40 bd ff 24 ble- cr7,ffc10710 <_Heap_Allocate_aligned_with_boundary+0x74> ffc107f0: 2f 8b 00 00 cmpwi cr7,r11,0 ffc107f4: 40 be ff 24 bne- cr7,ffc10718 <_Heap_Allocate_aligned_with_boundary+0x7c> } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { ffc107f8: 2f 9f 00 00 cmpwi cr7,r31,0 ffc107fc: 41 9e ff 1c beq+ cr7,ffc10718 <_Heap_Allocate_aligned_with_boundary+0x7c><== NEVER TAKEN search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; ffc10800: 81 7d 00 48 lwz r11,72(r29) stats->searches += search_count; block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc10804: 7f a3 eb 78 mr r3,r29 } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; ffc10808: 80 1d 00 4c lwz r0,76(r29) block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc1080c: 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; ffc10810: 39 6b 00 01 addi r11,r11,1 stats->searches += search_count; ffc10814: 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; ffc10818: 91 7d 00 48 stw r11,72(r29) stats->searches += search_count; block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc1081c: 7d 26 4b 78 mr r6,r9 } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; ffc10820: 90 1d 00 4c stw r0,76(r29) block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc10824: 4b ff 9d 19 bl ffc0a53c <_Heap_Block_allocate> ffc10828: 7f e3 fb 78 mr r3,r31 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { ffc1082c: 80 1d 00 44 lwz r0,68(r29) ffc10830: 7f 80 f0 40 cmplw cr7,r0,r30 ffc10834: 40 9c 00 08 bge- cr7,ffc1083c <_Heap_Allocate_aligned_with_boundary+0x1a0> stats->max_search = search_count; ffc10838: 93 dd 00 44 stw r30,68(r29) } return (void *) alloc_begin; } ffc1083c: 80 01 00 24 lwz r0,36(r1) ffc10840: 81 81 00 08 lwz r12,8(r1) ffc10844: 7c 08 03 a6 mtlr r0 ffc10848: 83 61 00 0c lwz r27,12(r1) ffc1084c: 83 81 00 10 lwz r28,16(r1) ffc10850: 7d 80 81 20 mtcrf 8,r12 ffc10854: 83 a1 00 14 lwz r29,20(r1) ffc10858: 83 c1 00 18 lwz r30,24(r1) ffc1085c: 83 e1 00 1c lwz r31,28(r1) ffc10860: 38 21 00 20 addi r1,r1,32 ffc10864: 4e 80 00 20 blr do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { ffc10868: 38 60 00 00 li r3,0 ffc1086c: 4b ff ff c0 b ffc1082c <_Heap_Allocate_aligned_with_boundary+0x190> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { ffc10870: 7f 84 30 40 cmplw cr7,r4,r6 ffc10874: 41 bd ff c8 bgt- cr7,ffc1083c <_Heap_Allocate_aligned_with_boundary+0x1a0> return NULL; } if ( alignment == 0 ) { ffc10878: 2f 85 00 00 cmpwi cr7,r5,0 ffc1087c: 40 be fe 6c bne- cr7,ffc106e8 <_Heap_Allocate_aligned_with_boundary+0x4c> alignment = page_size; ffc10880: 7d 85 63 78 mr r5,r12 ffc10884: 4b ff fe 64 b ffc106e8 <_Heap_Allocate_aligned_with_boundary+0x4c> =============================================================================== ffc10d78 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc10d78: 94 21 ff c0 stwu r1,-64(r1) ffc10d7c: 7d 80 00 26 mfcr r12 ffc10d80: 7c 08 02 a6 mflr r0 ffc10d84: 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; ffc10d88: 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 ) { ffc10d8c: 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 ) { ffc10d90: 90 01 00 44 stw r0,68(r1) ffc10d94: 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; ffc10d98: 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 ) { ffc10d9c: 93 c1 00 38 stw r30,56(r1) ffc10da0: 7c 7e 1b 78 mr r30,r3 ffc10da4: 93 01 00 20 stw r24,32(r1) ffc10da8: 93 21 00 24 stw r25,36(r1) ffc10dac: 7c d9 33 78 mr r25,r6 ffc10db0: 93 61 00 2c stw r27,44(r1) ffc10db4: 93 81 00 30 stw r28,48(r1) ffc10db8: 93 e1 00 3c stw r31,60(r1) ffc10dbc: 7c 9f 23 78 mr r31,r4 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; ffc10dc0: 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; ffc10dc4: 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 ) { ffc10dc8: 92 e1 00 1c stw r23,28(r1) ffc10dcc: 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; ffc10dd0: 93 41 00 08 stw r26,8(r1) Heap_Block *extend_last_block = NULL; ffc10dd4: 93 41 00 0c stw r26,12(r1) uintptr_t const page_size = heap->page_size; ffc10dd8: 83 9e 00 10 lwz r28,16(r30) uintptr_t const min_block_size = heap->min_block_size; ffc10ddc: 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; ffc10de0: 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 ) { ffc10de4: 40 9d 00 40 ble- cr7,ffc10e24 <_Heap_Extend+0xac> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } ffc10de8: 80 01 00 44 lwz r0,68(r1) ffc10dec: 81 81 00 18 lwz r12,24(r1) ffc10df0: 7c 08 03 a6 mtlr r0 ffc10df4: 82 e1 00 1c lwz r23,28(r1) ffc10df8: 83 01 00 20 lwz r24,32(r1) ffc10dfc: 7d 81 81 20 mtcrf 24,r12 ffc10e00: 83 21 00 24 lwz r25,36(r1) ffc10e04: 83 41 00 28 lwz r26,40(r1) ffc10e08: 83 61 00 2c lwz r27,44(r1) ffc10e0c: 83 81 00 30 lwz r28,48(r1) ffc10e10: 83 a1 00 34 lwz r29,52(r1) ffc10e14: 83 c1 00 38 lwz r30,56(r1) ffc10e18: 83 e1 00 3c lwz r31,60(r1) ffc10e1c: 38 21 00 40 addi r1,r1,64 ffc10e20: 4e 80 00 20 blr if ( extend_area_end < extend_area_begin ) { return false; } extend_area_ok = _Heap_Get_first_and_last_block( ffc10e24: 7c 83 23 78 mr r3,r4 ffc10e28: 38 e1 00 08 addi r7,r1,8 ffc10e2c: 7c a4 2b 78 mr r4,r5 ffc10e30: 39 01 00 0c addi r8,r1,12 ffc10e34: 7f 85 e3 78 mr r5,r28 ffc10e38: 4b ff 99 3d bl ffc0a774 <_Heap_Get_first_and_last_block> page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { ffc10e3c: 2f 83 00 00 cmpwi cr7,r3,0 /* For simplicity we reject extend areas that are too small */ return false; ffc10e40: 7f 43 d3 78 mr r3,r26 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { ffc10e44: 41 be ff a4 beq- cr7,ffc10de8 <_Heap_Extend+0x70> ffc10e48: 7f 69 db 78 mr r9,r27 ffc10e4c: 3a e0 00 00 li r23,0 ffc10e50: 38 00 00 00 li r0,0 ffc10e54: 39 00 00 00 li r8,0 ffc10e58: 48 00 00 44 b ffc10e9c <_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 ) { ffc10e5c: 7f 9d 58 40 cmplw cr7,r29,r11 ffc10e60: 40 9c 00 08 bge- cr7,ffc10e68 <_Heap_Extend+0xf0> ffc10e64: 7d 20 4b 78 mr r0,r9 ffc10e68: 7d 4b e3 96 divwu r10,r11,r28 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { ffc10e6c: 7f 8b f8 00 cmpw cr7,r11,r31 ffc10e70: 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); ffc10e74: 39 4a ff f8 addi r10,r10,-8 ffc10e78: 41 9e 00 64 beq- cr7,ffc10edc <_Heap_Extend+0x164> start_block->prev_size = extend_area_end; merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { ffc10e7c: 7f 9f 58 40 cmplw cr7,r31,r11 ffc10e80: 40 9d 00 08 ble- cr7,ffc10e88 <_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 ) ffc10e84: 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; ffc10e88: 81 2a 00 04 lwz r9,4(r10) ffc10e8c: 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); ffc10e90: 7d 2a 4a 14 add r9,r10,r9 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); ffc10e94: 7f 9b 48 00 cmpw cr7,r27,r9 ffc10e98: 41 9e 00 60 beq- cr7,ffc10ef8 <_Heap_Extend+0x180> return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; ffc10e9c: 7f 89 d8 00 cmpw cr7,r9,r27 ffc10ea0: 7d 2a 4b 78 mr r10,r9 ffc10ea4: 41 9e 01 b8 beq- cr7,ffc1105c <_Heap_Extend+0x2e4> uintptr_t const sub_area_end = start_block->prev_size; ffc10ea8: 81 69 00 00 lwz r11,0(r9) Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( ffc10eac: 7f 9f 58 40 cmplw cr7,r31,r11 ffc10eb0: 40 9c 00 0c bge- cr7,ffc10ebc <_Heap_Extend+0x144> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ffc10eb4: 7f 8a e8 40 cmplw cr7,r10,r29 ffc10eb8: 41 9c 02 28 blt- cr7,ffc110e0 <_Heap_Extend+0x368> ) { return false; } if ( extend_area_end == sub_area_begin ) { ffc10ebc: 7f 8a e8 00 cmpw cr7,r10,r29 ffc10ec0: 40 9e ff 9c bne+ cr7,ffc10e5c <_Heap_Extend+0xe4> <== ALWAYS TAKEN RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10ec4: 7d 4b e3 96 divwu r10,r11,r28 <== NOT EXECUTED 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 ) { ffc10ec8: 7f 8b f8 00 cmpw cr7,r11,r31 <== NOT EXECUTED ffc10ecc: 7d 4a e1 d6 mullw r10,r10,r28 <== NOT EXECUTED sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { ffc10ed0: 7d 28 4b 78 mr r8,r9 <== NOT EXECUTED uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc10ed4: 39 4a ff f8 addi r10,r10,-8 <== NOT EXECUTED 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 ) { ffc10ed8: 40 9e ff a4 bne+ cr7,ffc10e7c <_Heap_Extend+0x104> <== NOT EXECUTED start_block->prev_size = extend_area_end; ffc10edc: 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 ) ffc10ee0: 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; ffc10ee4: 81 2a 00 04 lwz r9,4(r10) ffc10ee8: 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); ffc10eec: 7d 2a 4a 14 add r9,r10,r9 } 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 ); ffc10ef0: 7f 9b 48 00 cmpw cr7,r27,r9 ffc10ef4: 40 9e ff a8 bne+ cr7,ffc10e9c <_Heap_Extend+0x124> <== NEVER TAKEN if ( extend_area_begin < heap->area_begin ) { ffc10ef8: 81 3e 00 18 lwz r9,24(r30) ffc10efc: 7f 9f 48 40 cmplw cr7,r31,r9 ffc10f00: 41 9c 01 64 blt- cr7,ffc11064 <_Heap_Extend+0x2ec> heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { ffc10f04: 81 3e 00 1c lwz r9,28(r30) ffc10f08: 7f 9d 48 40 cmplw cr7,r29,r9 ffc10f0c: 40 9d 00 08 ble- cr7,ffc10f14 <_Heap_Extend+0x19c> heap->area_end = extend_area_end; ffc10f10: 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 ) { ffc10f14: 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; ffc10f18: 81 21 00 08 lwz r9,8(r1) ffc10f1c: 81 61 00 0c lwz r11,12(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 ) { ffc10f20: 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; ffc10f24: 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 = ffc10f28: 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; ffc10f2c: 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; ffc10f30: 91 4b 00 00 stw r10,0(r11) extend_last_block->size_and_flag = 0; ffc10f34: 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 = ffc10f38: 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; ffc10f3c: 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 ) { ffc10f40: 40 9d 01 58 ble- cr7,ffc11098 <_Heap_Extend+0x320> <== ALWAYS TAKEN heap->first_block = extend_first_block; ffc10f44: 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 ) { ffc10f48: 2e 08 00 00 cmpwi cr4,r8,0 ffc10f4c: 41 92 01 b0 beq- cr4,ffc110fc <_Heap_Extend+0x384> <== ALWAYS TAKEN Heap_Control *heap, uintptr_t extend_area_begin, Heap_Block *first_block ) { uintptr_t const page_size = heap->page_size; ffc10f50: 80 1e 00 10 lwz r0,16(r30) <== NOT EXECUTED uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); ffc10f54: 3b ff 00 08 addi r31,r31,8 <== NOT EXECUTED RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; ffc10f58: 7d 3f 03 96 divwu r9,r31,r0 <== NOT EXECUTED ffc10f5c: 7d 29 01 d6 mullw r9,r9,r0 <== NOT EXECUTED if ( remainder != 0 ) { ffc10f60: 7d 29 f8 51 subf. r9,r9,r31 <== NOT EXECUTED ffc10f64: 41 82 00 0c beq- ffc10f70 <_Heap_Extend+0x1f8> <== NOT EXECUTED return value - remainder + alignment; ffc10f68: 7f ff 02 14 add r31,r31,r0 <== NOT EXECUTED ffc10f6c: 7f e9 f8 50 subf r31,r9,r31 <== NOT EXECUTED uintptr_t const new_first_block_begin = ffc10f70: 38 9f ff f8 addi r4,r31,-8 <== NOT EXECUTED uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; ffc10f74: 81 28 00 00 lwz r9,0(r8) <== NOT EXECUTED uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = 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 = ffc10f78: 7c 04 40 50 subf r0,r4,r8 <== NOT EXECUTED 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; ffc10f7c: 60 00 00 01 ori r0,r0,1 <== NOT EXECUTED uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; ffc10f80: 91 3f ff f8 stw r9,-8(r31) <== NOT EXECUTED new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; _Heap_Free_block( heap, new_first_block ); ffc10f84: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED 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; ffc10f88: 90 04 00 04 stw r0,4(r4) <== NOT EXECUTED _Heap_Free_block( heap, new_first_block ); ffc10f8c: 4b ff fd b1 bl ffc10d3c <_Heap_Free_block> <== NOT EXECUTED link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { ffc10f90: 2d 9a 00 00 cmpwi cr3,r26,0 ffc10f94: 41 8e 01 18 beq- cr3,ffc110ac <_Heap_Extend+0x334> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10f98: 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, ffc10f9c: 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( ffc10fa0: 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) ffc10fa4: 81 7a 00 04 lwz r11,4(r26) ffc10fa8: 7c 00 4b 96 divwu r0,r0,r9 ffc10fac: 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 ); ffc10fb0: 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) ffc10fb4: 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 = ffc10fb8: 7d 20 d2 14 add r9,r0,r26 (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; ffc10fbc: 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 = ffc10fc0: 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 ); ffc10fc4: 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; ffc10fc8: 81 3a 00 04 lwz r9,4(r26) ffc10fcc: 55 29 07 fe clrlwi r9,r9,31 block->size_and_flag = size | flag; ffc10fd0: 7c 00 4b 78 or r0,r0,r9 ffc10fd4: 90 1a 00 04 stw r0,4(r26) ffc10fd8: 4b ff fd 65 bl ffc10d3c <_Heap_Free_block> extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { ffc10fdc: 41 92 01 0c beq- cr4,ffc110e8 <_Heap_Extend+0x370> <== ALWAYS TAKEN if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } ffc10fe0: 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 ) ffc10fe4: 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( ffc10fe8: 81 5e 00 20 lwz r10,32(r30) *extended_size_ptr = extended_size; return true; ffc10fec: 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; ffc10ff0: 81 69 00 04 lwz r11,4(r9) _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; ffc10ff4: 81 1e 00 30 lwz r8,48(r30) * 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( ffc10ff8: 7d 49 50 50 subf r10,r9,r10 /* Statistics */ stats->size += extended_size; ffc10ffc: 80 1e 00 2c lwz r0,44(r30) 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; ffc11000: 55 6b 07 fe clrlwi r11,r11,31 _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; ffc11004: 7f 18 40 50 subf r24,r24,r8 block->size_and_flag = size | flag; ffc11008: 7d 4b 5b 78 or r11,r10,r11 /* Statistics */ stats->size += extended_size; ffc1100c: 7c 00 c2 14 add r0,r0,r24 ffc11010: 91 69 00 04 stw r11,4(r9) ffc11014: 90 1e 00 2c stw r0,44(r30) if ( extended_size_ptr != NULL ) ffc11018: 41 be fd d0 beq- cr7,ffc10de8 <_Heap_Extend+0x70> <== NEVER TAKEN *extended_size_ptr = extended_size; return true; } ffc1101c: 80 01 00 44 lwz r0,68(r1) ffc11020: 81 81 00 18 lwz r12,24(r1) ffc11024: 7c 08 03 a6 mtlr r0 /* Statistics */ stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; ffc11028: 93 19 00 00 stw r24,0(r25) return true; } ffc1102c: 7d 81 81 20 mtcrf 24,r12 ffc11030: 82 e1 00 1c lwz r23,28(r1) ffc11034: 83 01 00 20 lwz r24,32(r1) ffc11038: 83 21 00 24 lwz r25,36(r1) ffc1103c: 83 41 00 28 lwz r26,40(r1) ffc11040: 83 61 00 2c lwz r27,44(r1) ffc11044: 83 81 00 30 lwz r28,48(r1) ffc11048: 83 a1 00 34 lwz r29,52(r1) ffc1104c: 83 c1 00 38 lwz r30,56(r1) ffc11050: 83 e1 00 3c lwz r31,60(r1) ffc11054: 38 21 00 40 addi r1,r1,64 ffc11058: 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; ffc1105c: 81 5e 00 18 lwz r10,24(r30) ffc11060: 4b ff fe 48 b ffc10ea8 <_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 ) { ffc11064: 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; ffc11068: 81 21 00 08 lwz r9,8(r1) ffc1106c: 81 61 00 0c lwz r11,12(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 ) { ffc11070: 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; ffc11074: 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 = ffc11078: 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; ffc1107c: 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; ffc11080: 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; ffc11084: 91 4b 00 00 stw r10,0(r11) extend_last_block->size_and_flag = 0; ffc11088: 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 = ffc1108c: 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; ffc11090: 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 ) { ffc11094: 41 bd fe b0 bgt- cr7,ffc10f44 <_Heap_Extend+0x1cc> <== ALWAYS TAKEN heap->first_block = extend_first_block; } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { ffc11098: 81 3e 00 24 lwz r9,36(r30) ffc1109c: 7f 89 58 40 cmplw cr7,r9,r11 ffc110a0: 40 bc fe a8 bge- cr7,ffc10f48 <_Heap_Extend+0x1d0> heap->last_block = extend_last_block; ffc110a4: 91 7e 00 24 stw r11,36(r30) ffc110a8: 4b ff fe a0 b ffc10f48 <_Heap_Extend+0x1d0> ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { ffc110ac: 2f 97 00 00 cmpwi cr7,r23,0 ffc110b0: 41 be ff 2c beq- cr7,ffc10fdc <_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; ffc110b4: 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 ); ffc110b8: 80 01 00 08 lwz r0,8(r1) ffc110bc: 55 29 07 fe clrlwi r9,r9,31 ffc110c0: 7c 17 00 50 subf r0,r23,r0 block->size_and_flag = size | flag; ffc110c4: 7c 00 4b 78 or r0,r0,r9 } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { _Heap_Link_above( ffc110c8: 81 21 00 0c lwz r9,12(r1) ffc110cc: 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; ffc110d0: 80 09 00 04 lwz r0,4(r9) ffc110d4: 60 00 00 01 ori r0,r0,1 ffc110d8: 90 09 00 04 stw r0,4(r9) ffc110dc: 4b ff ff 00 b ffc10fdc <_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; ffc110e0: 38 60 00 00 li r3,0 ffc110e4: 4b ff fd 04 b ffc10de8 <_Heap_Extend+0x70> extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { ffc110e8: 40 8e fe f8 bne+ cr3,ffc10fe0 <_Heap_Extend+0x268> _Heap_Free_block( heap, extend_first_block ); ffc110ec: 80 81 00 08 lwz r4,8(r1) ffc110f0: 7f c3 f3 78 mr r3,r30 ffc110f4: 4b ff fc 49 bl ffc10d3c <_Heap_Free_block> ffc110f8: 4b ff fe e8 b ffc10fe0 <_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 ) { ffc110fc: 2f 80 00 00 cmpwi cr7,r0,0 ffc11100: 41 be fe 90 beq- cr7,ffc10f90 <_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; ffc11104: 7c 0b 00 50 subf r0,r11,r0 ffc11108: 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 = ffc1110c: 90 0b 00 04 stw r0,4(r11) ffc11110: 4b ff fe 80 b ffc10f90 <_Heap_Extend+0x218> =============================================================================== ffc10888 <_Heap_Free>: ffc10888: 80 03 00 10 lwz r0,16(r3) return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { ffc1088c: 7c 69 1b 78 mr r9,r3 RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in_heap( const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block ffc10890: 81 63 00 20 lwz r11,32(r3) bool next_is_free = false; _Heap_Protection_block_check( heap, block ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { return false; ffc10894: 38 60 00 00 li r3,0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10898: 7d 44 03 96 divwu r10,r4,r0 return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { ffc1089c: 94 21 ff f0 stwu r1,-16(r1) ffc108a0: 93 e1 00 0c stw r31,12(r1) ffc108a4: 7d 4a 01 d6 mullw r10,r10,r0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc108a8: 39 4a ff f8 addi r10,r10,-8 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; ffc108ac: 7f 8a 58 40 cmplw cr7,r10,r11 ffc108b0: 41 9c 01 24 blt- cr7,ffc109d4 <_Heap_Free+0x14c> ffc108b4: 80 09 00 24 lwz r0,36(r9) ffc108b8: 7f 8a 00 40 cmplw cr7,r10,r0 ffc108bc: 41 9d 01 18 bgt- cr7,ffc109d4 <_Heap_Free+0x14c> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc108c0: 80 ea 00 04 lwz r7,4(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; ffc108c4: 54 e6 00 3c rlwinm r6,r7,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); ffc108c8: 7d 0a 32 14 add r8,r10,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; ffc108cc: 7f 8b 40 40 cmplw cr7,r11,r8 ffc108d0: 41 9d 01 04 bgt- cr7,ffc109d4 <_Heap_Free+0x14c> <== NEVER TAKEN ffc108d4: 7f 80 40 40 cmplw cr7,r0,r8 ffc108d8: 41 9c 00 fc blt- cr7,ffc109d4 <_Heap_Free+0x14c> <== NEVER TAKEN ffc108dc: 80 a8 00 04 lwz r5,4(r8) if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { ffc108e0: 70 a4 00 01 andi. r4,r5,1 ffc108e4: 41 82 00 f0 beq- ffc109d4 <_Heap_Free+0x14c> 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 )); ffc108e8: 7f 80 40 00 cmpw cr7,r0,r8 - 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; ffc108ec: 54 a4 00 3c rlwinm r4,r5,0,0,30 ffc108f0: 38 a0 00 00 li r5,0 ffc108f4: 41 9e 00 18 beq- cr7,ffc1090c <_Heap_Free+0x84> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc108f8: 7c a8 22 14 add r5,r8,r4 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; ffc108fc: 80 a5 00 04 lwz r5,4(r5) return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) ffc10900: 70 a3 00 01 andi. r3,r5,1 ffc10904: 7c a0 00 26 mfcr r5 ffc10908: 54 a5 1f fe rlwinm r5,r5,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 ) ) { ffc1090c: 70 e7 00 01 andi. r7,r7,1 ffc10910: 40 82 00 6c bne- ffc1097c <_Heap_Free+0xf4> uintptr_t const prev_size = block->prev_size; ffc10914: 83 ea 00 00 lwz r31,0(r10) Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { _HAssert( false ); return( false ); ffc10918: 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); ffc1091c: 7d 9f 50 50 subf r12,r31,r10 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; ffc10920: 7f 8b 60 40 cmplw cr7,r11,r12 ffc10924: 41 9d 00 b0 bgt- cr7,ffc109d4 <_Heap_Free+0x14c> <== NEVER TAKEN ffc10928: 7f 80 60 40 cmplw cr7,r0,r12 ffc1092c: 7c e3 3b 78 mr r3,r7 ffc10930: 41 9c 00 a4 blt- cr7,ffc109d4 <_Heap_Free+0x14c> <== 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; ffc10934: 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) ) { ffc10938: 70 0b 00 01 andi. r11,r0,1 ffc1093c: 41 82 00 98 beq- ffc109d4 <_Heap_Free+0x14c> <== NEVER TAKEN _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ ffc10940: 2f 85 00 00 cmpwi cr7,r5,0 ffc10944: 41 9e 00 e8 beq- cr7,ffc10a2c <_Heap_Free+0x1a4> uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ffc10948: 80 e9 00 38 lwz r7,56(r9) _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; ffc1094c: 7c 86 22 14 add r4,r6,r4 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc10950: 81 68 00 08 lwz r11,8(r8) _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; ffc10954: 7f e4 fa 14 add r31,r4,r31 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc10958: 81 48 00 0c lwz r10,12(r8) if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc1095c: 63 e0 00 01 ori r0,r31,1 } 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; ffc10960: 39 07 ff ff addi r8,r7,-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; ffc10964: 91 6a 00 08 stw r11,8(r10) next->prev = prev; ffc10968: 91 4b 00 0c stw r10,12(r11) ffc1096c: 91 09 00 38 stw r8,56(r9) prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc10970: 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; ffc10974: 7f ec f9 2e stwx r31,r12,r31 ffc10978: 48 00 00 34 b ffc109ac <_Heap_Free+0x124> 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 */ ffc1097c: 2f 85 00 00 cmpwi cr7,r5,0 ffc10980: 41 9e 00 60 beq- cr7,ffc109e0 <_Heap_Free+0x158> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc10984: 81 68 00 08 lwz r11,8(r8) 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; ffc10988: 7c 84 32 14 add r4,r4,r6 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc1098c: 81 08 00 0c lwz r8,12(r8) 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; ffc10990: 60 80 00 01 ori r0,r4,1 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; ffc10994: 91 6a 00 08 stw r11,8(r10) new_block->prev = prev; ffc10998: 91 0a 00 0c stw r8,12(r10) next->prev = new_block; prev->next = new_block; ffc1099c: 91 48 00 08 stw r10,8(r8) Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; ffc109a0: 91 4b 00 0c stw r10,12(r11) ffc109a4: 90 0a 00 04 stw r0,4(r10) next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; ffc109a8: 7c 8a 21 2e stwx r4,r10,r4 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc109ac: 81 69 00 40 lwz r11,64(r9) ++stats->frees; stats->free_size += block_size; return( true ); ffc109b0: 38 60 00 01 li r3,1 } } /* Statistics */ --stats->used_blocks; ++stats->frees; ffc109b4: 81 09 00 50 lwz r8,80(r9) stats->free_size += block_size; ffc109b8: 81 49 00 30 lwz r10,48(r9) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc109bc: 39 6b ff ff addi r11,r11,-1 ++stats->frees; ffc109c0: 38 08 00 01 addi r0,r8,1 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc109c4: 91 69 00 40 stw r11,64(r9) ++stats->frees; stats->free_size += block_size; ffc109c8: 7c ca 32 14 add r6,r10,r6 } } /* Statistics */ --stats->used_blocks; ++stats->frees; ffc109cc: 90 09 00 50 stw r0,80(r9) stats->free_size += block_size; ffc109d0: 90 c9 00 30 stw r6,48(r9) return( true ); } ffc109d4: 83 e1 00 0c lwz r31,12(r1) ffc109d8: 38 21 00 10 addi r1,r1,16 ffc109dc: 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; ffc109e0: 80 e9 00 38 lwz r7,56(r9) if ( stats->max_free_blocks < stats->free_blocks ) { ffc109e4: 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; ffc109e8: 38 07 00 01 addi r0,r7,1 ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; ffc109ec: 91 2a 00 0c stw r9,12(r10) 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; ffc109f0: 60 c7 00 01 ori r7,r6,1 ffc109f4: 90 ea 00 04 stw r7,4(r10) 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 ) { ffc109f8: 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; ffc109fc: 80 e8 00 04 lwz r7,4(r8) RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; ffc10a00: 81 69 00 08 lwz r11,8(r9) ffc10a04: 54 e7 00 3c rlwinm r7,r7,0,0,30 next_block->prev_size = block_size; ffc10a08: 7c ca 31 2e stwx r6,r10,r6 new_block->next = next; ffc10a0c: 91 6a 00 08 stw r11,8(r10) } 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; ffc10a10: 90 e8 00 04 stw r7,4(r8) new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; ffc10a14: 91 4b 00 0c stw r10,12(r11) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; ffc10a18: 91 49 00 08 stw r10,8(r9) next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; ffc10a1c: 90 09 00 38 stw r0,56(r9) if ( stats->max_free_blocks < stats->free_blocks ) { ffc10a20: 40 bd ff 8c ble- cr7,ffc109ac <_Heap_Free+0x124> stats->max_free_blocks = stats->free_blocks; ffc10a24: 90 09 00 3c stw r0,60(r9) ffc10a28: 4b ff ff 84 b ffc109ac <_Heap_Free+0x124> 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; ffc10a2c: 7f e6 fa 14 add r31,r6,r31 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc10a30: 63 e0 00 01 ori r0,r31,1 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; ffc10a34: 7f ea 31 2e stwx r31,r10,r6 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; ffc10a38: 90 0c 00 04 stw r0,4(r12) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; ffc10a3c: 80 08 00 04 lwz r0,4(r8) ffc10a40: 54 00 00 3c rlwinm r0,r0,0,0,30 ffc10a44: 90 08 00 04 stw r0,4(r8) ffc10a48: 4b ff ff 64 b ffc109ac <_Heap_Free+0x124> =============================================================================== ffc0b380 <_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; ffc0b380: 2f 85 00 00 cmpwi cr7,r5,0 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { ffc0b384: 94 21 ff 98 stwu r1,-104(r1) ffc0b388: 7c 08 02 a6 mflr r0 ffc0b38c: 92 e1 00 44 stw r23,68(r1) ffc0b390: 90 01 00 6c stw r0,108(r1) ffc0b394: 93 01 00 48 stw r24,72(r1) ffc0b398: 93 21 00 4c stw r25,76(r1) ffc0b39c: 7c 99 23 78 mr r25,r4 ffc0b3a0: 93 41 00 50 stw r26,80(r1) ffc0b3a4: 93 61 00 54 stw r27,84(r1) ffc0b3a8: 93 e1 00 64 stw r31,100(r1) ffc0b3ac: 7c 7f 1b 78 mr r31,r3 ffc0b3b0: 91 c1 00 20 stw r14,32(r1) ffc0b3b4: 91 e1 00 24 stw r15,36(r1) ffc0b3b8: 92 01 00 28 stw r16,40(r1) ffc0b3bc: 92 21 00 2c stw r17,44(r1) ffc0b3c0: 92 41 00 30 stw r18,48(r1) ffc0b3c4: 92 61 00 34 stw r19,52(r1) ffc0b3c8: 92 81 00 38 stw r20,56(r1) ffc0b3cc: 92 a1 00 3c stw r21,60(r1) ffc0b3d0: 92 c1 00 40 stw r22,64(r1) ffc0b3d4: 93 81 00 58 stw r28,88(r1) ffc0b3d8: 93 a1 00 5c stw r29,92(r1) ffc0b3dc: 93 c1 00 60 stw r30,96(r1) uintptr_t const page_size = heap->page_size; ffc0b3e0: 83 63 00 10 lwz r27,16(r3) uintptr_t const min_block_size = heap->min_block_size; ffc0b3e4: 83 03 00 14 lwz r24,20(r3) Heap_Block *const first_block = heap->first_block; ffc0b3e8: 83 43 00 20 lwz r26,32(r3) Heap_Block *const last_block = heap->last_block; ffc0b3ec: 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; ffc0b3f0: 41 9e 00 7c beq- cr7,ffc0b46c <_Heap_Walk+0xec> ffc0b3f4: 3d 20 ff c1 lis r9,-63 ffc0b3f8: 39 29 b2 80 addi r9,r9,-19840 ffc0b3fc: 91 21 00 18 stw r9,24(r1) if ( !_System_state_Is_up( _System_state_Get() ) ) { ffc0b400: 3d 20 00 00 lis r9,0 return true; ffc0b404: 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() ) ) { ffc0b408: 80 09 27 ec lwz r0,10220(r9) ffc0b40c: 2f 80 00 03 cmpwi cr7,r0,3 ffc0b410: 41 9e 00 7c beq- cr7,ffc0b48c <_Heap_Walk+0x10c> <== ALWAYS TAKEN block = next_block; } while ( block != first_block ); return true; } ffc0b414: 80 01 00 6c lwz r0,108(r1) ffc0b418: 81 c1 00 20 lwz r14,32(r1) ffc0b41c: 7c 08 03 a6 mtlr r0 ffc0b420: 81 e1 00 24 lwz r15,36(r1) ffc0b424: 82 01 00 28 lwz r16,40(r1) ffc0b428: 82 21 00 2c lwz r17,44(r1) ffc0b42c: 82 41 00 30 lwz r18,48(r1) ffc0b430: 82 61 00 34 lwz r19,52(r1) ffc0b434: 82 81 00 38 lwz r20,56(r1) ffc0b438: 82 a1 00 3c lwz r21,60(r1) ffc0b43c: 82 c1 00 40 lwz r22,64(r1) ffc0b440: 82 e1 00 44 lwz r23,68(r1) ffc0b444: 83 01 00 48 lwz r24,72(r1) ffc0b448: 83 21 00 4c lwz r25,76(r1) ffc0b44c: 83 41 00 50 lwz r26,80(r1) ffc0b450: 83 61 00 54 lwz r27,84(r1) ffc0b454: 83 81 00 58 lwz r28,88(r1) ffc0b458: 83 a1 00 5c lwz r29,92(r1) ffc0b45c: 83 c1 00 60 lwz r30,96(r1) ffc0b460: 83 e1 00 64 lwz r31,100(r1) ffc0b464: 38 21 00 68 addi r1,r1,104 ffc0b468: 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; ffc0b46c: 3d 20 ff c1 lis r9,-63 ffc0b470: 39 29 b2 7c addi r9,r9,-19844 ffc0b474: 91 21 00 18 stw r9,24(r1) if ( !_System_state_Is_up( _System_state_Get() ) ) { ffc0b478: 3d 20 00 00 lis r9,0 return true; ffc0b47c: 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() ) ) { ffc0b480: 80 09 27 ec lwz r0,10220(r9) ffc0b484: 2f 80 00 03 cmpwi cr7,r0,3 ffc0b488: 40 9e ff 8c bne+ cr7,ffc0b414 <_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)( ffc0b48c: 80 1f 00 0c lwz r0,12(r31) ffc0b490: 3c a0 ff c2 lis r5,-62 ffc0b494: 81 1f 00 18 lwz r8,24(r31) ffc0b498: 7f 23 cb 78 mr r3,r25 ffc0b49c: 81 3f 00 1c lwz r9,28(r31) ffc0b4a0: 38 80 00 00 li r4,0 ffc0b4a4: 81 7f 00 08 lwz r11,8(r31) ffc0b4a8: 38 a5 b7 a0 addi r5,r5,-18528 ffc0b4ac: 90 01 00 10 stw r0,16(r1) ffc0b4b0: 7f 66 db 78 mr r6,r27 ffc0b4b4: 7f 07 c3 78 mr r7,r24 ffc0b4b8: 80 01 00 18 lwz r0,24(r1) ffc0b4bc: 7f 4a d3 78 mr r10,r26 ffc0b4c0: 92 e1 00 08 stw r23,8(r1) ffc0b4c4: 7c 09 03 a6 mtctr r0 ffc0b4c8: 91 61 00 0c stw r11,12(r1) ffc0b4cc: 4c c6 31 82 crclr 4*cr1+eq ffc0b4d0: 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 ) { ffc0b4d4: 2f 9b 00 00 cmpwi cr7,r27,0 ffc0b4d8: 41 9e 00 ac beq- cr7,ffc0b584 <_Heap_Walk+0x204> (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { ffc0b4dc: 73 67 00 07 andi. r7,r27,7 ffc0b4e0: 40 82 00 cc bne- ffc0b5ac <_Heap_Walk+0x22c> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b4e4: 7c 18 db 96 divwu r0,r24,r27 ffc0b4e8: 7c 00 d9 d6 mullw r0,r0,r27 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { ffc0b4ec: 7f 98 00 00 cmpw cr7,r24,r0 ffc0b4f0: 40 9e 00 e8 bne- cr7,ffc0b5d8 <_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; ffc0b4f4: 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; ffc0b4f8: 7d 20 db 96 divwu r9,r0,r27 ffc0b4fc: 7d 29 d9 d6 mullw r9,r9,r27 ); return false; } if ( ffc0b500: 7f 80 48 00 cmpw cr7,r0,r9 ffc0b504: 40 9e 01 00 bne- cr7,ffc0b604 <_Heap_Walk+0x284> block = next_block; } while ( block != first_block ); return true; } ffc0b508: 82 da 00 04 lwz r22,4(r26) ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { ffc0b50c: 72 c7 00 01 andi. r7,r22,1 ffc0b510: 41 82 01 68 beq- ffc0b678 <_Heap_Walk+0x2f8> - 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; ffc0b514: 81 37 00 04 lwz r9,4(r23) ffc0b518: 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); ffc0b51c: 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; ffc0b520: 80 09 00 04 lwz r0,4(r9) ); return false; } if ( _Heap_Is_free( last_block ) ) { ffc0b524: 70 07 00 01 andi. r7,r0,1 ffc0b528: 41 82 00 34 beq- ffc0b55c <_Heap_Walk+0x1dc> ); return false; } if ( ffc0b52c: 7f 9a 48 00 cmpw cr7,r26,r9 ffc0b530: 41 9e 01 00 beq- cr7,ffc0b630 <_Heap_Walk+0x2b0> <== ALWAYS TAKEN _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( ffc0b534: 80 01 00 18 lwz r0,24(r1) <== NOT EXECUTED ffc0b538: 3c a0 ff c2 lis r5,-62 <== NOT EXECUTED ffc0b53c: 7f 23 cb 78 mr r3,r25 <== NOT EXECUTED ffc0b540: 38 80 00 01 li r4,1 <== NOT EXECUTED ffc0b544: 7c 09 03 a6 mtctr r0 <== NOT EXECUTED ffc0b548: 38 a5 b9 08 addi r5,r5,-18168 <== NOT EXECUTED ffc0b54c: 4c c6 31 82 crclr 4*cr1+eq <== NOT EXECUTED ffc0b550: 4e 80 04 21 bctrl <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; ffc0b554: 38 60 00 00 li r3,0 <== NOT EXECUTED ffc0b558: 4b ff fe bc b ffc0b414 <_Heap_Walk+0x94> <== NOT EXECUTED return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( ffc0b55c: 80 01 00 18 lwz r0,24(r1) ffc0b560: 3c a0 ff c2 lis r5,-62 ffc0b564: 7f 23 cb 78 mr r3,r25 ffc0b568: 38 80 00 01 li r4,1 ffc0b56c: 7c 09 03 a6 mtctr r0 ffc0b570: 38 a5 b8 f0 addi r5,r5,-18192 ffc0b574: 4c c6 31 82 crclr 4*cr1+eq ffc0b578: 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; ffc0b57c: 38 60 00 00 li r3,0 ffc0b580: 4b ff fe 94 b ffc0b414 <_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" ); ffc0b584: 80 01 00 18 lwz r0,24(r1) ffc0b588: 3c a0 ff c2 lis r5,-62 ffc0b58c: 7f 23 cb 78 mr r3,r25 ffc0b590: 38 80 00 01 li r4,1 ffc0b594: 7c 09 03 a6 mtctr r0 ffc0b598: 38 a5 b8 34 addi r5,r5,-18380 ffc0b59c: 4c c6 31 82 crclr 4*cr1+eq ffc0b5a0: 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; ffc0b5a4: 38 60 00 00 li r3,0 ffc0b5a8: 4b ff fe 6c b ffc0b414 <_Heap_Walk+0x94> return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( ffc0b5ac: 80 01 00 18 lwz r0,24(r1) ffc0b5b0: 3c a0 ff c2 lis r5,-62 ffc0b5b4: 7f 23 cb 78 mr r3,r25 ffc0b5b8: 38 80 00 01 li r4,1 ffc0b5bc: 7c 09 03 a6 mtctr r0 ffc0b5c0: 38 a5 b8 48 addi r5,r5,-18360 ffc0b5c4: 7f 66 db 78 mr r6,r27 ffc0b5c8: 4c c6 31 82 crclr 4*cr1+eq ffc0b5cc: 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; ffc0b5d0: 38 60 00 00 li r3,0 ffc0b5d4: 4b ff fe 40 b ffc0b414 <_Heap_Walk+0x94> return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( ffc0b5d8: 80 01 00 18 lwz r0,24(r1) ffc0b5dc: 3c a0 ff c2 lis r5,-62 ffc0b5e0: 7f 23 cb 78 mr r3,r25 ffc0b5e4: 38 80 00 01 li r4,1 ffc0b5e8: 7c 09 03 a6 mtctr r0 ffc0b5ec: 38 a5 b8 68 addi r5,r5,-18328 ffc0b5f0: 7f 06 c3 78 mr r6,r24 ffc0b5f4: 4c c6 31 82 crclr 4*cr1+eq ffc0b5f8: 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; ffc0b5fc: 38 60 00 00 li r3,0 ffc0b600: 4b ff fe 14 b ffc0b414 <_Heap_Walk+0x94> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( ffc0b604: 80 01 00 18 lwz r0,24(r1) ffc0b608: 3c a0 ff c2 lis r5,-62 ffc0b60c: 7f 23 cb 78 mr r3,r25 ffc0b610: 38 80 00 01 li r4,1 ffc0b614: 7c 09 03 a6 mtctr r0 ffc0b618: 38 a5 b8 8c addi r5,r5,-18292 ffc0b61c: 7f 46 d3 78 mr r6,r26 ffc0b620: 4c c6 31 82 crclr 4*cr1+eq ffc0b624: 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; ffc0b628: 38 60 00 00 li r3,0 ffc0b62c: 4b ff fd e8 b ffc0b414 <_Heap_Walk+0x94> block = next_block; } while ( block != first_block ); return true; } ffc0b630: 81 3f 00 08 lwz r9,8(r31) int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; ffc0b634: 80 bf 00 10 lwz r5,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 ) { ffc0b638: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0b63c: 41 9e 01 2c beq- cr7,ffc0b768 <_Heap_Walk+0x3e8> block = next_block; } while ( block != first_block ); return true; } ffc0b640: 80 1f 00 20 lwz r0,32(r31) 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; ffc0b644: 7d 26 4b 78 mr r6,r9 ffc0b648: 7f 80 48 40 cmplw cr7,r0,r9 ffc0b64c: 40 9d 00 54 ble- cr7,ffc0b6a0 <_Heap_Walk+0x320> <== ALWAYS TAKEN const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( ffc0b650: 80 01 00 18 lwz r0,24(r1) ffc0b654: 3c a0 ff c2 lis r5,-62 ffc0b658: 7f 23 cb 78 mr r3,r25 ffc0b65c: 38 80 00 01 li r4,1 ffc0b660: 7c 09 03 a6 mtctr r0 ffc0b664: 38 a5 b9 38 addi r5,r5,-18120 ffc0b668: 4c c6 31 82 crclr 4*cr1+eq ffc0b66c: 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; ffc0b670: 38 60 00 00 li r3,0 ffc0b674: 4b ff fd a0 b ffc0b414 <_Heap_Walk+0x94> return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( ffc0b678: 80 01 00 18 lwz r0,24(r1) ffc0b67c: 3c a0 ff c2 lis r5,-62 ffc0b680: 7f 23 cb 78 mr r3,r25 ffc0b684: 38 80 00 01 li r4,1 ffc0b688: 7c 09 03 a6 mtctr r0 ffc0b68c: 38 a5 b8 c0 addi r5,r5,-18240 ffc0b690: 4c c6 31 82 crclr 4*cr1+eq ffc0b694: 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; ffc0b698: 38 60 00 00 li r3,0 ffc0b69c: 4b ff fd 78 b ffc0b414 <_Heap_Walk+0x94> ffc0b6a0: 81 1f 00 24 lwz r8,36(r31) ffc0b6a4: 7f 88 48 40 cmplw cr7,r8,r9 ffc0b6a8: 41 bc ff a8 blt- cr7,ffc0b650 <_Heap_Walk+0x2d0> <== NEVER TAKEN RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc0b6ac: 39 69 00 08 addi r11,r9,8 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b6b0: 7d 4b 2b 96 divwu r10,r11,r5 ffc0b6b4: 7d 4a 29 d6 mullw r10,r10,r5 ); return false; } if ( ffc0b6b8: 7f 8b 50 00 cmpw cr7,r11,r10 ffc0b6bc: 40 9e 03 a8 bne- cr7,ffc0ba64 <_Heap_Walk+0x6e4> <== 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; ffc0b6c0: 81 69 00 04 lwz r11,4(r9) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b6c4: 7f ea fb 78 mr r10,r31 ffc0b6c8: 55 6b 00 3c rlwinm r11,r11,0,0,30 block = next_block; } while ( block != first_block ); return true; } ffc0b6cc: 7d 69 5a 14 add r11,r9,r11 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; ffc0b6d0: 81 6b 00 04 lwz r11,4(r11) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b6d4: 71 67 00 01 andi. r7,r11,1 ffc0b6d8: 41 a2 00 58 beq+ ffc0b730 <_Heap_Walk+0x3b0> <== ALWAYS TAKEN ffc0b6dc: 48 00 03 b0 b ffc0ba8c <_Heap_Walk+0x70c> <== NOT EXECUTED return false; } prev_block = free_block; free_block = free_block->next; ffc0b6e0: 80 c9 00 08 lwz r6,8(r9) 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 ) { ffc0b6e4: 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; ffc0b6e8: 7f 00 30 40 cmplw cr6,r0,r6 ffc0b6ec: 7c 86 40 40 cmplw cr1,r6,r8 ffc0b6f0: 41 9e 00 7c beq- cr7,ffc0b76c <_Heap_Walk+0x3ec> ffc0b6f4: 41 b9 ff 5c bgt- cr6,ffc0b650 <_Heap_Walk+0x2d0> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc0b6f8: 39 66 00 08 addi r11,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; ffc0b6fc: 41 a5 ff 54 bgt- cr1,ffc0b650 <_Heap_Walk+0x2d0> <== NEVER TAKEN RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b700: 7c eb 2b 96 divwu r7,r11,r5 ffc0b704: 7c e7 29 d6 mullw r7,r7,r5 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b708: 7d 2a 4b 78 mr r10,r9 ); return false; } if ( ffc0b70c: 7f 8b 38 00 cmpw cr7,r11,r7 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b710: 7c c9 33 78 mr r9,r6 ); return false; } if ( ffc0b714: 40 9e 03 50 bne- cr7,ffc0ba64 <_Heap_Walk+0x6e4> - 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; ffc0b718: 81 66 00 04 lwz r11,4(r6) ffc0b71c: 55 6b 00 3c rlwinm r11,r11,0,0,30 block = next_block; } while ( block != first_block ); return true; } ffc0b720: 7d 6b 32 14 add r11,r11,r6 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; ffc0b724: 81 6b 00 04 lwz r11,4(r11) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b728: 71 67 00 01 andi. r7,r11,1 ffc0b72c: 40 82 03 60 bne- ffc0ba8c <_Heap_Walk+0x70c> ); return false; } if ( free_block->prev != prev_block ) { ffc0b730: 80 e9 00 0c lwz r7,12(r9) ffc0b734: 7f 87 50 00 cmpw cr7,r7,r10 ffc0b738: 41 9e ff a8 beq+ cr7,ffc0b6e0 <_Heap_Walk+0x360> (*printer)( ffc0b73c: 80 01 00 18 lwz r0,24(r1) ffc0b740: 3c a0 ff c2 lis r5,-62 ffc0b744: 7f 23 cb 78 mr r3,r25 ffc0b748: 38 80 00 01 li r4,1 ffc0b74c: 7c 09 03 a6 mtctr r0 ffc0b750: 38 a5 b9 a4 addi r5,r5,-18012 ffc0b754: 7d 26 4b 78 mr r6,r9 ffc0b758: 4c c6 31 82 crclr 4*cr1+eq ffc0b75c: 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; ffc0b760: 38 60 00 00 li r3,0 ffc0b764: 4b ff fc b0 b ffc0b414 <_Heap_Walk+0x94> 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 ) { ffc0b768: 80 1f 00 20 lwz r0,32(r31) "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b76c: 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)( ffc0b770: 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)( ffc0b774: 3e 40 ff c2 lis r18,-62 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b778: 7f 5d d3 78 mr r29,r26 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b77c: 3a 73 bb 54 addi r19,r19,-17580 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( ffc0b780: 3a 94 bb 3c addi r20,r20,-17604 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)( ffc0b784: 3a 52 ba 98 addi r18,r18,-17768 ffc0b788: 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)" : "") ffc0b78c: 3e a0 ff c2 lis r21,-62 ffc0b790: 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)( ffc0b794: 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)" : ""), ffc0b798: 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; ffc0b79c: 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); ffc0b7a0: 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; ffc0b7a4: 7f 80 f0 40 cmplw cr7,r0,r30 ffc0b7a8: 40 9d 00 34 ble- cr7,ffc0b7dc <_Heap_Walk+0x45c> <== 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)( ffc0b7ac: 3c a0 ff c2 lis r5,-62 ffc0b7b0: 7f 23 cb 78 mr r3,r25 ffc0b7b4: 38 80 00 01 li r4,1 ffc0b7b8: 38 a5 b9 d8 addi r5,r5,-17960 return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( ffc0b7bc: 80 01 00 18 lwz r0,24(r1) ffc0b7c0: 7f a6 eb 78 mr r6,r29 ffc0b7c4: 7f c7 f3 78 mr r7,r30 ffc0b7c8: 7c 09 03 a6 mtctr r0 ffc0b7cc: 4c c6 31 82 crclr 4*cr1+eq ffc0b7d0: 4e 80 04 21 bctrl "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; ffc0b7d4: 38 60 00 00 li r3,0 ffc0b7d8: 4b ff fc 3c b ffc0b414 <_Heap_Walk+0x94> ffc0b7dc: 80 1f 00 24 lwz r0,36(r31) ffc0b7e0: 7f 80 f0 40 cmplw cr7,r0,r30 ffc0b7e4: 41 bc ff c8 blt- cr7,ffc0b7ac <_Heap_Walk+0x42c> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b7e8: 7d 3c db 96 divwu r9,r28,r27 ffc0b7ec: 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; ffc0b7f0: 7f a0 ba 78 xor r0,r29,r23 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { ffc0b7f4: 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; ffc0b7f8: 7c 00 00 34 cntlzw r0,r0 ffc0b7fc: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0b800: 68 00 00 01 xori r0,r0,1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { ffc0b804: 41 9e 00 0c beq- cr7,ffc0b810 <_Heap_Walk+0x490> ffc0b808: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b80c: 40 9e 01 e0 bne- cr7,ffc0b9ec <_Heap_Walk+0x66c> ); return false; } if ( block_size < min_block_size && is_not_last_block ) { ffc0b810: 7f 98 e0 40 cmplw cr7,r24,r28 ffc0b814: 40 9d 00 0c ble- cr7,ffc0b820 <_Heap_Walk+0x4a0> ffc0b818: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b81c: 40 9e 02 00 bne- cr7,ffc0ba1c <_Heap_Walk+0x69c> <== ALWAYS TAKEN ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { ffc0b820: 7f 9d f0 40 cmplw cr7,r29,r30 ffc0b824: 41 9c 00 0c blt- cr7,ffc0b830 <_Heap_Walk+0x4b0> ffc0b828: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b82c: 40 9e 02 24 bne- cr7,ffc0ba50 <_Heap_Walk+0x6d0> 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; ffc0b830: 80 1e 00 04 lwz r0,4(r30) ffc0b834: 56 d6 07 fe clrlwi r22,r22,31 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { ffc0b838: 70 07 00 01 andi. r7,r0,1 ffc0b83c: 41 82 00 74 beq- ffc0b8b0 <_Heap_Walk+0x530> if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { ffc0b840: 2f 96 00 00 cmpwi cr7,r22,0 ffc0b844: 41 9e 00 40 beq- cr7,ffc0b884 <_Heap_Walk+0x504> (*printer)( ffc0b848: 80 01 00 18 lwz r0,24(r1) ffc0b84c: 7f 23 cb 78 mr r3,r25 ffc0b850: 38 80 00 00 li r4,0 ffc0b854: 7e 85 a3 78 mr r5,r20 ffc0b858: 7c 09 03 a6 mtctr r0 ffc0b85c: 7f a6 eb 78 mr r6,r29 ffc0b860: 7f 87 e3 78 mr r7,r28 ffc0b864: 4c c6 31 82 crclr 4*cr1+eq ffc0b868: 4e 80 04 21 bctrl block->prev_size ); } block = next_block; } while ( block != first_block ); ffc0b86c: 7f 9a f0 00 cmpw cr7,r26,r30 ffc0b870: 41 9e 01 0c beq- cr7,ffc0b97c <_Heap_Walk+0x5fc> ffc0b874: 82 de 00 04 lwz r22,4(r30) ffc0b878: 7f dd f3 78 mr r29,r30 ffc0b87c: 80 1f 00 20 lwz r0,32(r31) ffc0b880: 4b ff ff 1c b ffc0b79c <_Heap_Walk+0x41c> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b884: 80 01 00 18 lwz r0,24(r1) ffc0b888: 7f a6 eb 78 mr r6,r29 ffc0b88c: 7f 23 cb 78 mr r3,r25 ffc0b890: 81 1d 00 00 lwz r8,0(r29) ffc0b894: 38 80 00 00 li r4,0 ffc0b898: 7c 09 03 a6 mtctr r0 ffc0b89c: 7e 65 9b 78 mr r5,r19 ffc0b8a0: 7f 87 e3 78 mr r7,r28 ffc0b8a4: 4c c6 31 82 crclr 4*cr1+eq ffc0b8a8: 4e 80 04 21 bctrl ffc0b8ac: 4b ff ff c0 b ffc0b86c <_Heap_Walk+0x4ec> 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 ? ffc0b8b0: 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)( ffc0b8b4: 81 3f 00 08 lwz r9,8(r31) block = next_block; } while ( block != first_block ); return true; } ffc0b8b8: 80 1f 00 0c lwz r0,12(r31) 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)( ffc0b8bc: 7f 89 40 00 cmpw cr7,r9,r8 ffc0b8c0: 41 9e 01 00 beq- cr7,ffc0b9c0 <_Heap_Walk+0x640> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc0b8c4: 7f 9f 40 00 cmpw cr7,r31,r8 ffc0b8c8: 41 9e 01 08 beq- cr7,ffc0b9d0 <_Heap_Walk+0x650> ffc0b8cc: 39 35 bb 08 addi r9,r21,-17656 block->next, block->next == last_free_block ? ffc0b8d0: 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)( ffc0b8d4: 7f 80 50 00 cmpw cr7,r0,r10 ffc0b8d8: 41 9e 00 e0 beq- cr7,ffc0b9b8 <_Heap_Walk+0x638> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ffc0b8dc: 7f 9f 50 00 cmpw cr7,r31,r10 ffc0b8e0: 41 9e 00 e8 beq- cr7,ffc0b9c8 <_Heap_Walk+0x648> ffc0b8e4: 38 15 bb 08 addi r0,r21,-17656 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)( ffc0b8e8: 90 01 00 08 stw r0,8(r1) ffc0b8ec: 7f 23 cb 78 mr r3,r25 ffc0b8f0: 38 80 00 00 li r4,0 ffc0b8f4: 80 01 00 18 lwz r0,24(r1) ffc0b8f8: 7e 45 93 78 mr r5,r18 ffc0b8fc: 7f a6 eb 78 mr r6,r29 ffc0b900: 7f 87 e3 78 mr r7,r28 ffc0b904: 7c 09 03 a6 mtctr r0 ffc0b908: 4c c6 31 82 crclr 4*cr1+eq ffc0b90c: 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 ) { ffc0b910: 81 1e 00 00 lwz r8,0(r30) ffc0b914: 7f 9c 40 00 cmpw cr7,r28,r8 ffc0b918: 40 9e 00 6c bne- cr7,ffc0b984 <_Heap_Walk+0x604> ); return false; } if ( !prev_used ) { ffc0b91c: 2f 96 00 00 cmpwi cr7,r22,0 ffc0b920: 41 9e 00 b8 beq- cr7,ffc0b9d8 <_Heap_Walk+0x658> block = next_block; } while ( block != first_block ); return true; } ffc0b924: 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 ) { ffc0b928: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0b92c: 41 9e 00 24 beq- cr7,ffc0b950 <_Heap_Walk+0x5d0> <== NEVER TAKEN if ( free_block == block ) { ffc0b930: 7f 9d 48 00 cmpw cr7,r29,r9 ffc0b934: 40 be 00 0c bne+ cr7,ffc0b940 <_Heap_Walk+0x5c0> ffc0b938: 4b ff ff 34 b ffc0b86c <_Heap_Walk+0x4ec> ffc0b93c: 41 ba ff 30 beq- cr6,ffc0b86c <_Heap_Walk+0x4ec> return true; } free_block = free_block->next; ffc0b940: 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 ) { ffc0b944: 7f 9f 48 00 cmpw cr7,r31,r9 if ( free_block == block ) { ffc0b948: 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 ) { ffc0b94c: 40 9e ff f0 bne+ cr7,ffc0b93c <_Heap_Walk+0x5bc> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( ffc0b950: 3c a0 ff c2 lis r5,-62 ffc0b954: 7f 23 cb 78 mr r3,r25 ffc0b958: 38 80 00 01 li r4,1 ffc0b95c: 38 a5 bb 7c addi r5,r5,-17540 ffc0b960: 80 01 00 18 lwz r0,24(r1) ffc0b964: 7f a6 eb 78 mr r6,r29 ffc0b968: 7c 09 03 a6 mtctr r0 ffc0b96c: 4c c6 31 82 crclr 4*cr1+eq ffc0b970: 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; ffc0b974: 38 60 00 00 li r3,0 ffc0b978: 4b ff fa 9c b ffc0b414 <_Heap_Walk+0x94> } block = next_block; } while ( block != first_block ); return true; ffc0b97c: 38 60 00 01 li r3,1 ffc0b980: 4b ff fa 94 b ffc0b414 <_Heap_Walk+0x94> " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( ffc0b984: 80 01 00 18 lwz r0,24(r1) ffc0b988: 3c a0 ff c2 lis r5,-62 ffc0b98c: 7f 23 cb 78 mr r3,r25 ffc0b990: 38 80 00 01 li r4,1 ffc0b994: 7c 09 03 a6 mtctr r0 ffc0b998: 38 a5 ba d0 addi r5,r5,-17712 ffc0b99c: 7f a6 eb 78 mr r6,r29 ffc0b9a0: 7f 87 e3 78 mr r7,r28 ffc0b9a4: 7f c9 f3 78 mr r9,r30 ffc0b9a8: 4c c6 31 82 crclr 4*cr1+eq ffc0b9ac: 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; ffc0b9b0: 38 60 00 00 li r3,0 ffc0b9b4: 4b ff fa 60 b ffc0b414 <_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)( ffc0b9b8: 38 11 b7 84 addi r0,r17,-18556 ffc0b9bc: 4b ff ff 2c b ffc0b8e8 <_Heap_Walk+0x568> ffc0b9c0: 39 30 b7 68 addi r9,r16,-18584 ffc0b9c4: 4b ff ff 0c b ffc0b8d0 <_Heap_Walk+0x550> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ffc0b9c8: 38 0f b7 94 addi r0,r15,-18540 ffc0b9cc: 4b ff ff 1c b ffc0b8e8 <_Heap_Walk+0x568> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc0b9d0: 39 2e b7 78 addi r9,r14,-18568 ffc0b9d4: 4b ff fe fc b ffc0b8d0 <_Heap_Walk+0x550> return false; } if ( !prev_used ) { (*printer)( ffc0b9d8: 3c a0 ff c2 lis r5,-62 ffc0b9dc: 7f 23 cb 78 mr r3,r25 ffc0b9e0: 38 80 00 01 li r4,1 ffc0b9e4: 38 a5 bb 0c addi r5,r5,-17652 ffc0b9e8: 4b ff ff 78 b ffc0b960 <_Heap_Walk+0x5e0> return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*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 ba 08 addi r5,r5,-17912 ffc0ba04: 7f a6 eb 78 mr r6,r29 ffc0ba08: 7f 87 e3 78 mr r7,r28 ffc0ba0c: 4c c6 31 82 crclr 4*cr1+eq ffc0ba10: 4e 80 04 21 bctrl "block 0x%08x: block size %u not page aligned\n", block, block_size ); return false; ffc0ba14: 38 60 00 00 li r3,0 ffc0ba18: 4b ff f9 fc b ffc0b414 <_Heap_Walk+0x94> } if ( block_size < min_block_size && is_not_last_block ) { (*printer)( ffc0ba1c: 80 01 00 18 lwz r0,24(r1) ffc0ba20: 3c a0 ff c2 lis r5,-62 ffc0ba24: 7f 23 cb 78 mr r3,r25 ffc0ba28: 38 80 00 01 li r4,1 ffc0ba2c: 7c 09 03 a6 mtctr r0 ffc0ba30: 38 a5 ba 38 addi r5,r5,-17864 ffc0ba34: 7f a6 eb 78 mr r6,r29 ffc0ba38: 7f 87 e3 78 mr r7,r28 ffc0ba3c: 7f 08 c3 78 mr r8,r24 ffc0ba40: 4c c6 31 82 crclr 4*cr1+eq ffc0ba44: 4e 80 04 21 bctrl block, block_size, min_block_size ); return false; ffc0ba48: 38 60 00 00 li r3,0 ffc0ba4c: 4b ff f9 c8 b ffc0b414 <_Heap_Walk+0x94> } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( ffc0ba50: 3c a0 ff c2 lis r5,-62 ffc0ba54: 7f 23 cb 78 mr r3,r25 ffc0ba58: 38 80 00 01 li r4,1 ffc0ba5c: 38 a5 ba 64 addi r5,r5,-17820 ffc0ba60: 4b ff fd 5c b ffc0b7bc <_Heap_Walk+0x43c> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( ffc0ba64: 80 01 00 18 lwz r0,24(r1) ffc0ba68: 3c a0 ff c2 lis r5,-62 ffc0ba6c: 7f 23 cb 78 mr r3,r25 ffc0ba70: 38 80 00 01 li r4,1 ffc0ba74: 7c 09 03 a6 mtctr r0 ffc0ba78: 38 a5 b9 58 addi r5,r5,-18088 ffc0ba7c: 4c c6 31 82 crclr 4*cr1+eq ffc0ba80: 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; ffc0ba84: 38 60 00 00 li r3,0 ffc0ba88: 4b ff f9 8c b ffc0b414 <_Heap_Walk+0x94> return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( ffc0ba8c: 80 01 00 18 lwz r0,24(r1) ffc0ba90: 3c a0 ff c2 lis r5,-62 ffc0ba94: 7f 23 cb 78 mr r3,r25 ffc0ba98: 38 80 00 01 li r4,1 ffc0ba9c: 7c 09 03 a6 mtctr r0 ffc0baa0: 38 a5 b9 88 addi r5,r5,-18040 ffc0baa4: 4c c6 31 82 crclr 4*cr1+eq ffc0baa8: 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; ffc0baac: 38 60 00 00 li r3,0 ffc0bab0: 4b ff f9 64 b ffc0b414 <_Heap_Walk+0x94> =============================================================================== ffc0b280 <_Heap_Walk_print>: static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { ffc0b280: 94 21 ff 88 stwu r1,-120(r1) ffc0b284: 7c 08 02 a6 mflr r0 ffc0b288: 93 e1 00 74 stw r31,116(r1) ffc0b28c: 90 01 00 7c stw r0,124(r1) ffc0b290: 7c 60 1b 78 mr r0,r3 ffc0b294: 90 c1 00 1c stw r6,28(r1) ffc0b298: 90 e1 00 20 stw r7,32(r1) ffc0b29c: 91 01 00 24 stw r8,36(r1) ffc0b2a0: 91 21 00 28 stw r9,40(r1) ffc0b2a4: 91 41 00 2c stw r10,44(r1) ffc0b2a8: 40 86 00 24 bne- cr1,ffc0b2cc <_Heap_Walk_print+0x4c> <== ALWAYS TAKEN ffc0b2ac: d8 21 00 30 stfd f1,48(r1) <== NOT EXECUTED ffc0b2b0: d8 41 00 38 stfd f2,56(r1) <== NOT EXECUTED ffc0b2b4: d8 61 00 40 stfd f3,64(r1) <== NOT EXECUTED ffc0b2b8: d8 81 00 48 stfd f4,72(r1) <== NOT EXECUTED ffc0b2bc: d8 a1 00 50 stfd f5,80(r1) <== NOT EXECUTED ffc0b2c0: d8 c1 00 58 stfd f6,88(r1) <== NOT EXECUTED ffc0b2c4: d8 e1 00 60 stfd f7,96(r1) <== NOT EXECUTED ffc0b2c8: d9 01 00 68 stfd f8,104(r1) <== NOT EXECUTED va_list ap; if ( error ) { ffc0b2cc: 2f 84 00 00 cmpwi cr7,r4,0 { /* Do nothing */ } static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { ffc0b2d0: 7c bf 2b 78 mr r31,r5 va_list ap; if ( error ) { ffc0b2d4: 40 9e 00 58 bne- cr7,ffc0b32c <_Heap_Walk_print+0xac> printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); ffc0b2d8: 3c 60 ff c2 lis r3,-62 ffc0b2dc: 7c 04 03 78 mr r4,r0 ffc0b2e0: 38 63 b7 5c addi r3,r3,-18596 ffc0b2e4: 4c c6 31 82 crclr 4*cr1+eq ffc0b2e8: 4b ff b1 39 bl ffc06420 } va_start( ap, fmt ); ffc0b2ec: 38 00 00 03 li r0,3 ffc0b2f0: 98 01 00 08 stb r0,8(r1) ffc0b2f4: 38 00 00 00 li r0,0 vprintk( fmt, ap ); ffc0b2f8: 7f e3 fb 78 mr r3,r31 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b2fc: 98 01 00 09 stb r0,9(r1) ffc0b300: 38 01 00 80 addi r0,r1,128 vprintk( fmt, ap ); ffc0b304: 38 81 00 08 addi r4,r1,8 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b308: 90 01 00 0c stw r0,12(r1) ffc0b30c: 38 01 00 10 addi r0,r1,16 ffc0b310: 90 01 00 10 stw r0,16(r1) vprintk( fmt, ap ); ffc0b314: 4b ff d5 05 bl ffc08818 va_end( ap ); } ffc0b318: 80 01 00 7c lwz r0,124(r1) ffc0b31c: 83 e1 00 74 lwz r31,116(r1) ffc0b320: 38 21 00 78 addi r1,r1,120 ffc0b324: 7c 08 03 a6 mtlr r0 ffc0b328: 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 ); ffc0b32c: 3c 60 ff c2 lis r3,-62 ffc0b330: 7c 04 03 78 mr r4,r0 ffc0b334: 38 63 b7 50 addi r3,r3,-18608 ffc0b338: 4c c6 31 82 crclr 4*cr1+eq ffc0b33c: 4b ff b0 e5 bl ffc06420 } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b340: 38 00 00 03 li r0,3 ffc0b344: 98 01 00 08 stb r0,8(r1) ffc0b348: 38 00 00 00 li r0,0 vprintk( fmt, ap ); ffc0b34c: 7f e3 fb 78 mr r3,r31 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b350: 98 01 00 09 stb r0,9(r1) ffc0b354: 38 01 00 80 addi r0,r1,128 vprintk( fmt, ap ); ffc0b358: 38 81 00 08 addi r4,r1,8 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b35c: 90 01 00 0c stw r0,12(r1) ffc0b360: 38 01 00 10 addi r0,r1,16 ffc0b364: 90 01 00 10 stw r0,16(r1) vprintk( fmt, ap ); ffc0b368: 4b ff d4 b1 bl ffc08818 va_end( ap ); } ffc0b36c: 80 01 00 7c lwz r0,124(r1) ffc0b370: 83 e1 00 74 lwz r31,116(r1) ffc0b374: 38 21 00 78 addi r1,r1,120 ffc0b378: 7c 08 03 a6 mtlr r0 ffc0b37c: 4e 80 00 20 blr =============================================================================== ffc09768 <_IO_Initialize_all_drivers>: * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc09768: 94 21 ff f0 stwu r1,-16(r1) ffc0976c: 7c 08 02 a6 mflr r0 ffc09770: 93 c1 00 08 stw r30,8(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc09774: 3f c0 00 00 lis r30,0 * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc09778: 90 01 00 14 stw r0,20(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc0977c: 80 1e 27 fc lwz r0,10236(r30) * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc09780: 93 e1 00 0c stw r31,12(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc09784: 2f 80 00 00 cmpwi cr7,r0,0 ffc09788: 41 9e 00 2c beq- cr7,ffc097b4 <_IO_Initialize_all_drivers+0x4c><== NEVER TAKEN ffc0978c: 3b e0 00 00 li r31,0 ffc09790: 3b de 27 fc addi r30,r30,10236 (void) rtems_io_initialize( major, 0, NULL ); ffc09794: 7f e3 fb 78 mr r3,r31 ffc09798: 38 80 00 00 li r4,0 ffc0979c: 38 a0 00 00 li r5,0 ffc097a0: 48 00 6c 3d bl ffc103dc void _IO_Initialize_all_drivers( void ) { rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc097a4: 80 1e 00 00 lwz r0,0(r30) ffc097a8: 3b ff 00 01 addi r31,r31,1 ffc097ac: 7f 80 f8 40 cmplw cr7,r0,r31 ffc097b0: 41 9d ff e4 bgt+ cr7,ffc09794 <_IO_Initialize_all_drivers+0x2c> (void) rtems_io_initialize( major, 0, NULL ); } ffc097b4: 80 01 00 14 lwz r0,20(r1) ffc097b8: 83 c1 00 08 lwz r30,8(r1) ffc097bc: 7c 08 03 a6 mtlr r0 ffc097c0: 83 e1 00 0c lwz r31,12(r1) ffc097c4: 38 21 00 10 addi r1,r1,16 ffc097c8: 4e 80 00 20 blr =============================================================================== ffc09658 <_IO_Manager_initialization>: * workspace. * */ void _IO_Manager_initialization(void) { ffc09658: 94 21 ff e0 stwu r1,-32(r1) ffc0965c: 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; ffc09660: 3d 20 00 00 lis r9,0 * workspace. * */ void _IO_Manager_initialization(void) { ffc09664: 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; ffc09668: 39 29 20 a0 addi r9,r9,8352 * workspace. * */ void _IO_Manager_initialization(void) { ffc0966c: 93 a1 00 14 stw r29,20(r1) ffc09670: 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; ffc09674: 83 a9 00 30 lwz r29,48(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; ffc09678: 83 c9 00 34 lwz r30,52(r9) * workspace. * */ void _IO_Manager_initialization(void) { ffc0967c: 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 ) ffc09680: 7f 9e e8 40 cmplw cr7,r30,r29 * workspace. * */ void _IO_Manager_initialization(void) { ffc09684: 93 61 00 0c stw r27,12(r1) ffc09688: 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; ffc0968c: 83 e9 00 38 lwz r31,56(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 ) ffc09690: 40 9c 00 a4 bge- cr7,ffc09734 <_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 ) ffc09694: 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( ffc09698: 7f 63 db 78 mr r3,r27 ffc0969c: 48 00 3f 25 bl ffc0d5c0 <_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 *) ffc096a0: 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; ffc096a4: 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 *) ffc096a8: 90 7c 28 00 stw r3,10240(r28) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( ffc096ac: 38 80 00 00 li r4,0 ffc096b0: 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; ffc096b4: 93 a9 27 fc stw r29,10236(r9) memset( ffc096b8: 48 00 aa bd bl ffc14174 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) ffc096bc: 2f 9e 00 00 cmpwi cr7,r30,0 ffc096c0: 41 9e 00 50 beq- cr7,ffc09710 <_IO_Manager_initialization+0xb8><== NEVER TAKEN ffc096c4: 7f c9 03 a6 mtctr r30 ffc096c8: 81 1c 28 00 lwz r8,10240(r28) ffc096cc: 39 40 00 00 li r10,0 _IO_Driver_address_table[index] = driver_table[index]; ffc096d0: 7f e9 fb 78 mr r9,r31 ffc096d4: 7c a9 50 6e lwzux r5,r9,r10 ffc096d8: 7d 68 52 14 add r11,r8,r10 ffc096dc: 80 e9 00 08 lwz r7,8(r9) ffc096e0: 80 09 00 0c lwz r0,12(r9) ffc096e4: 80 c9 00 04 lwz r6,4(r9) ffc096e8: 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++ ) ffc096ec: 39 4a 00 18 addi r10,r10,24 _IO_Driver_address_table[index] = driver_table[index]; ffc096f0: 90 cb 00 04 stw r6,4(r11) ffc096f4: 90 eb 00 08 stw r7,8(r11) ffc096f8: 90 0b 00 0c stw r0,12(r11) ffc096fc: 80 e9 00 10 lwz r7,16(r9) ffc09700: 80 09 00 14 lwz r0,20(r9) ffc09704: 90 eb 00 10 stw r7,16(r11) ffc09708: 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++ ) ffc0970c: 42 00 ff c4 bdnz+ ffc096d0 <_IO_Manager_initialization+0x78> _IO_Driver_address_table[index] = driver_table[index]; } ffc09710: 80 01 00 24 lwz r0,36(r1) ffc09714: 83 61 00 0c lwz r27,12(r1) ffc09718: 7c 08 03 a6 mtlr r0 ffc0971c: 83 81 00 10 lwz r28,16(r1) ffc09720: 83 a1 00 14 lwz r29,20(r1) ffc09724: 83 c1 00 18 lwz r30,24(r1) ffc09728: 83 e1 00 1c lwz r31,28(r1) ffc0972c: 38 21 00 20 addi r1,r1,32 ffc09730: 4e 80 00 20 blr ffc09734: 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; ffc09738: 3d 20 00 00 lis r9,0 ffc0973c: 93 e9 28 00 stw r31,10240(r9) _IO_Number_of_drivers = number_of_drivers; ffc09740: 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]; } ffc09744: 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; ffc09748: 93 c9 27 fc stw r30,10236(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]; } ffc0974c: 83 61 00 0c lwz r27,12(r1) ffc09750: 83 81 00 10 lwz r28,16(r1) ffc09754: 83 a1 00 14 lwz r29,20(r1) ffc09758: 83 c1 00 18 lwz r30,24(r1) ffc0975c: 83 e1 00 1c lwz r31,28(r1) ffc09760: 38 21 00 20 addi r1,r1,32 ffc09764: 4e 80 00 20 blr =============================================================================== ffc0a698 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0a698: 94 21 ff f0 stwu r1,-16(r1) ffc0a69c: 7c 08 02 a6 mflr r0 _Internal_errors_What_happened.the_source = the_source; ffc0a6a0: 3d 60 00 00 lis r11,0 ffc0a6a4: 39 2b 2d 10 addi r9,r11,11536 void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0a6a8: 90 01 00 14 stw r0,20(r1) ffc0a6ac: 93 e1 00 0c stw r31,12(r1) ffc0a6b0: 7c bf 2b 78 mr r31,r5 _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; ffc0a6b4: 98 89 00 04 stb r4,4(r9) _Internal_errors_What_happened.the_error = the_error; ffc0a6b8: 90 a9 00 08 stw r5,8(r9) bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; ffc0a6bc: 90 6b 2d 10 stw r3,11536(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 ); ffc0a6c0: 48 00 27 c1 bl ffc0ce80 <_User_extensions_Fatal> RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; ffc0a6c4: 38 00 00 05 li r0,5 ffc0a6c8: 3d 20 00 00 lis r9,0 _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); ffc0a6cc: 7f e3 fb 78 mr r3,r31 ffc0a6d0: 90 09 27 ec stw r0,10220(r9) ffc0a6d4: 4b ff 92 a5 bl ffc03978 <_BSP_Fatal_error> ffc0a6d8: 48 00 00 00 b ffc0a6d8 <_Internal_error_Occurred+0x40><== NOT EXECUTED =============================================================================== ffc0a6f0 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0a6f0: 94 21 ff f0 stwu r1,-16(r1) ffc0a6f4: 7c 08 02 a6 mflr r0 ffc0a6f8: 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 ) ffc0a6fc: 80 03 00 18 lwz r0,24(r3) */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0a700: 93 e1 00 0c stw r31,12(r1) ffc0a704: 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 ) ffc0a708: 2f 80 00 00 cmpwi cr7,r0,0 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0a70c: 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; ffc0a710: 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 ) ffc0a714: 40 9e 00 1c bne- cr7,ffc0a730 <_Objects_Allocate+0x40> <== ALWAYS TAKEN ); } #endif return the_object; } ffc0a718: 80 01 00 14 lwz r0,20(r1) ffc0a71c: 83 c1 00 08 lwz r30,8(r1) ffc0a720: 7c 08 03 a6 mtlr r0 ffc0a724: 83 e1 00 0c lwz r31,12(r1) ffc0a728: 38 21 00 10 addi r1,r1,16 ffc0a72c: 4e 80 00 20 blr /* * 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 ); ffc0a730: 3b df 00 20 addi r30,r31,32 ffc0a734: 7f c3 f3 78 mr r3,r30 ffc0a738: 4b ff f4 15 bl ffc09b4c <_Chain_Get> if ( information->auto_extend ) { ffc0a73c: 88 1f 00 12 lbz r0,18(r31) ffc0a740: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a744: 41 be ff d4 beq- cr7,ffc0a718 <_Objects_Allocate+0x28> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { ffc0a748: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a74c: 41 9e 00 50 beq- cr7,ffc0a79c <_Objects_Allocate+0xac> } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - ffc0a750: a1 63 00 0a lhz r11,10(r3) ffc0a754: a0 1f 00 0a lhz r0,10(r31) _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; ffc0a758: a1 3f 00 14 lhz r9,20(r31) } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - ffc0a75c: 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--; ffc0a760: 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; ffc0a764: 7c 00 4b 96 divwu r0,r0,r9 information->inactive_per_block[ block ]--; ffc0a768: 81 3f 00 30 lwz r9,48(r31) ); } #endif return the_object; } ffc0a76c: 83 c1 00 08 lwz r30,8(r1) block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; ffc0a770: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0a774: 7d 49 00 2e lwzx r10,r9,r0 information->inactive--; ffc0a778: 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 ]--; ffc0a77c: 39 4a ff ff addi r10,r10,-1 ffc0a780: 7d 49 01 2e stwx r10,r9,r0 ); } #endif return the_object; } ffc0a784: 80 01 00 14 lwz r0,20(r1) block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; information->inactive--; ffc0a788: b1 7f 00 2c sth r11,44(r31) ); } #endif return the_object; } ffc0a78c: 7c 08 03 a6 mtlr r0 ffc0a790: 83 e1 00 0c lwz r31,12(r1) ffc0a794: 38 21 00 10 addi r1,r1,16 ffc0a798: 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 ); ffc0a79c: 7f e3 fb 78 mr r3,r31 ffc0a7a0: 48 00 00 4d bl ffc0a7ec <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); ffc0a7a4: 7f c3 f3 78 mr r3,r30 ffc0a7a8: 4b ff f3 a5 bl ffc09b4c <_Chain_Get> } if ( the_object ) { ffc0a7ac: 2c 03 00 00 cmpwi r3,0 ffc0a7b0: 41 82 ff 68 beq+ ffc0a718 <_Objects_Allocate+0x28> ffc0a7b4: 4b ff ff 9c b ffc0a750 <_Objects_Allocate+0x60> =============================================================================== ffc0a7ec <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { ffc0a7ec: 94 21 ff c0 stwu r1,-64(r1) ffc0a7f0: 7c 08 02 a6 mflr r0 ffc0a7f4: 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 ) ffc0a7f8: 81 23 00 34 lwz r9,52(r3) */ void _Objects_Extend_information( Objects_Information *information ) { ffc0a7fc: 93 a1 00 34 stw r29,52(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 ) ffc0a800: 2f 89 00 00 cmpwi cr7,r9,0 */ void _Objects_Extend_information( Objects_Information *information ) { ffc0a804: 93 e1 00 3c stw r31,60(r1) ffc0a808: 7c 7f 1b 78 mr r31,r3 ffc0a80c: 92 c1 00 18 stw r22,24(r1) ffc0a810: 92 e1 00 1c stw r23,28(r1) ffc0a814: 93 01 00 20 stw r24,32(r1) ffc0a818: 93 21 00 24 stw r25,36(r1) ffc0a81c: 93 41 00 28 stw r26,40(r1) ffc0a820: 93 61 00 2c stw r27,44(r1) ffc0a824: 93 81 00 30 stw r28,48(r1) ffc0a828: 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 ); ffc0a82c: a3 a3 00 0a lhz r29,10(r3) index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc0a830: 41 9e 02 8c beq- cr7,ffc0aabc <_Objects_Extend_information+0x2d0> block_count = 0; else { block_count = information->maximum / information->allocation_size; ffc0a834: a3 43 00 10 lhz r26,16(r3) ffc0a838: a1 63 00 14 lhz r11,20(r3) ffc0a83c: 7e da 5b 96 divwu r22,r26,r11 for ( ; block < block_count; block++ ) { ffc0a840: 2f 96 00 00 cmpwi cr7,r22,0 ffc0a844: 41 9e 02 94 beq- cr7,ffc0aad8 <_Objects_Extend_information+0x2ec><== NEVER TAKEN if ( information->object_blocks[ block ] == NULL ) { ffc0a848: 80 09 00 00 lwz r0,0(r9) ffc0a84c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a850: 41 9e 02 9c beq- cr7,ffc0aaec <_Objects_Extend_information+0x300><== NEVER TAKEN ffc0a854: 7d 6a 5b 78 mr r10,r11 * 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; ffc0a858: 7e c9 03 a6 mtctr r22 /* * 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 ); ffc0a85c: 7f be eb 78 mr r30,r29 index_base = minimum_index; block = 0; ffc0a860: 3b 60 00 00 li r27,0 ffc0a864: 48 00 00 10 b ffc0a874 <_Objects_Extend_information+0x88> block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { ffc0a868: 84 09 00 04 lwzu r0,4(r9) ffc0a86c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a870: 41 9e 01 fc beq- cr7,ffc0aa6c <_Objects_Extend_information+0x280> do_extend = false; break; } else index_base += information->allocation_size; ffc0a874: 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++ ) { ffc0a878: 3b 7b 00 01 addi r27,r27,1 ffc0a87c: 42 00 ff ec bdnz+ ffc0a868 <_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; ffc0a880: 3b 20 00 01 li r25,1 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; ffc0a884: 7f 5a 52 14 add r26,r26,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 ) { ffc0a888: 2b 9a ff ff cmplwi cr7,r26,65535 ffc0a88c: 41 9d 01 a8 bgt- cr7,ffc0aa34 <_Objects_Extend_information+0x248> /* * 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 ) { ffc0a890: 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; ffc0a894: 80 7f 00 18 lwz r3,24(r31) if ( information->auto_extend ) { ffc0a898: 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; ffc0a89c: 7c 6a 19 d6 mullw r3,r10,r3 if ( information->auto_extend ) { ffc0a8a0: 41 9e 01 d4 beq- cr7,ffc0aa74 <_Objects_Extend_information+0x288> new_object_block = _Workspace_Allocate( block_size ); ffc0a8a4: 48 00 2c bd bl ffc0d560 <_Workspace_Allocate> if ( !new_object_block ) ffc0a8a8: 7c 7c 1b 79 mr. r28,r3 ffc0a8ac: 41 82 01 88 beq- ffc0aa34 <_Objects_Extend_information+0x248> } /* * Do we need to grow the tables? */ if ( do_extend ) { ffc0a8b0: 2f 99 00 00 cmpwi cr7,r25,0 ffc0a8b4: 41 9e 00 fc beq- cr7,ffc0a9b0 <_Objects_Extend_information+0x1c4> */ /* * Up the block count and maximum */ block_count++; ffc0a8b8: 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 *)) + ffc0a8bc: 1c 77 00 03 mulli r3,r23,3 ((maximum + minimum_index) * sizeof(Objects_Control *)); ffc0a8c0: 7c 7a 1a 14 add r3,r26,r3 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ffc0a8c4: 7c 63 ea 14 add r3,r3,r29 ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); ffc0a8c8: 54 63 10 3a rlwinm r3,r3,2,0,29 ffc0a8cc: 48 00 2c 95 bl ffc0d560 <_Workspace_Allocate> if ( !object_blocks ) { ffc0a8d0: 7c 78 1b 79 mr. r24,r3 ffc0a8d4: 41 82 02 2c beq- ffc0ab00 <_Objects_Extend_information+0x314> * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { ffc0a8d8: a0 1f 00 10 lhz r0,16(r31) } /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( ffc0a8dc: 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); ffc0a8e0: 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 ) { ffc0a8e4: 7f 9d 00 40 cmplw cr7,r29,r0 ffc0a8e8: 7e f9 ba 14 add r23,r25,r23 ffc0a8ec: 41 9c 01 94 blt- cr7,ffc0aa80 <_Objects_Extend_information+0x294> } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { ffc0a8f0: 2f 9d 00 00 cmpwi cr7,r29,0 local_table[ index ] = NULL; ffc0a8f4: 7f a9 03 a6 mtctr r29 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, ffc0a8f8: 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; ffc0a8fc: 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++ ) { ffc0a900: 41 9e 00 0c beq- cr7,ffc0a90c <_Objects_Extend_information+0x120><== NEVER TAKEN local_table[ index ] = NULL; ffc0a904: 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++ ) { ffc0a908: 42 00 ff fc bdnz+ ffc0a904 <_Objects_Extend_information+0x118> ffc0a90c: 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 ); ffc0a910: a1 7f 00 14 lhz r11,20(r31) } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; ffc0a914: 38 00 00 00 li r0,0 ffc0a918: 7c 18 b1 2e stwx r0,r24,r22 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); ffc0a91c: 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 ; ffc0a920: 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; ffc0a924: 7c 19 b1 2e stwx r0,r25,r22 for ( index=index_base ; ffc0a928: 40 9c 00 30 bge- cr7,ffc0a958 <_Objects_Extend_information+0x16c><== NEVER TAKEN ffc0a92c: 38 1e 00 01 addi r0,r30,1 ffc0a930: 7f 80 58 40 cmplw cr7,r0,r11 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( ffc0a934: 57 c9 10 3a rlwinm r9,r30,2,0,29 ffc0a938: 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; ffc0a93c: 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 ; ffc0a940: 7d 29 ba 14 add r9,r9,r23 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; ffc0a944: 7d 69 03 a6 mtctr r11 ffc0a948: 38 00 00 00 li r0,0 ffc0a94c: 41 9d 01 c0 bgt- cr7,ffc0ab0c <_Objects_Extend_information+0x320><== NEVER TAKEN ffc0a950: 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 ; ffc0a954: 42 00 ff fc bdnz+ ffc0a950 <_Objects_Extend_information+0x164> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0a958: 7c 00 00 a6 mfmsr r0 ffc0a95c: 7d 30 42 a6 mfsprg r9,0 ffc0a960: 7c 09 48 78 andc r9,r0,r9 ffc0a964: 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) | ffc0a968: 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; ffc0a96c: 57 5a 04 3e clrlwi r26,r26,16 information->maximum_id = _Objects_Build_id( ffc0a970: a1 3f 00 04 lhz r9,4(r31) ffc0a974: 55 6b c0 0e rlwinm r11,r11,24,0,7 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; ffc0a978: 80 7f 00 34 lwz r3,52(r31) ffc0a97c: 65 6b 00 01 oris r11,r11,1 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; ffc0a980: 93 3f 00 30 stw r25,48(r31) (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc0a984: 55 29 d8 08 rlwinm r9,r9,27,0,4 ffc0a988: 7d 69 4b 78 or r9,r11,r9 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; ffc0a98c: 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) | ffc0a990: 7d 29 d3 78 or r9,r9,r26 information->inactive_per_block = inactive_per_block; information->local_table = local_table; ffc0a994: 92 ff 00 1c stw r23,28(r31) information->maximum = (Objects_Maximum) maximum; ffc0a998: b3 5f 00 10 sth r26,16(r31) information->maximum_id = _Objects_Build_id( ffc0a99c: 91 3f 00 0c stw r9,12(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0a9a0: 7c 00 01 24 mtmsr r0 information->maximum ); _ISR_Enable( level ); if ( old_tables ) ffc0a9a4: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a9a8: 41 9e 00 08 beq- cr7,ffc0a9b0 <_Objects_Extend_information+0x1c4> _Workspace_Free( old_tables ); ffc0a9ac: 48 00 2b e9 bl ffc0d594 <_Workspace_Free> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; ffc0a9b0: 81 3f 00 34 lwz r9,52(r31) ffc0a9b4: 57 7b 10 3a rlwinm r27,r27,2,0,29 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc0a9b8: 3b a1 00 08 addi r29,r1,8 ffc0a9bc: a0 bf 00 14 lhz r5,20(r31) } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; ffc0a9c0: 7f 89 d9 2e stwx r28,r9,r27 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc0a9c4: 7f 84 e3 78 mr r4,r28 ffc0a9c8: 7f a3 eb 78 mr r3,r29 ffc0a9cc: 80 df 00 18 lwz r6,24(r31) information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0a9d0: 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( ffc0a9d4: 48 00 5a 65 bl ffc10438 <_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 ) { ffc0a9d8: 48 00 00 2c b ffc0aa04 <_Objects_Extend_information+0x218> ffc0a9dc: 81 7f 00 00 lwz r11,0(r31) the_object->id = _Objects_Build_id( ffc0a9e0: a0 1f 00 04 lhz r0,4(r31) ffc0a9e4: 55 6b c0 0e rlwinm r11,r11,24,0,7 ffc0a9e8: 65 6b 00 01 oris r11,r11,1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc0a9ec: 54 00 d8 08 rlwinm r0,r0,27,0,4 ffc0a9f0: 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) | ffc0a9f4: 7c 00 f3 78 or r0,r0,r30 ffc0a9f8: 90 09 00 08 stw r0,8(r9) index ); _Chain_Append( &information->Inactive, &the_object->Node ); index++; ffc0a9fc: 3b de 00 01 addi r30,r30,1 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0aa00: 4b ff f0 f5 bl ffc09af4 <_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 ) { ffc0aa04: 7f a3 eb 78 mr r3,r29 ffc0aa08: 4b ff f1 45 bl ffc09b4c <_Chain_Get> ffc0aa0c: 7c 69 1b 79 mr. r9,r3 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0aa10: 7f 83 e3 78 mr r3,r28 ffc0aa14: 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 ) { ffc0aa18: 40 82 ff c4 bne+ ffc0a9dc <_Objects_Extend_information+0x1f0> index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); ffc0aa1c: a1 3f 00 2c lhz r9,44(r31) _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; ffc0aa20: a0 1f 00 14 lhz r0,20(r31) ffc0aa24: 81 7f 00 30 lwz r11,48(r31) information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); ffc0aa28: 7d 20 4a 14 add r9,r0,r9 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; ffc0aa2c: 7c 0b d9 2e stwx r0,r11,r27 information->inactive = ffc0aa30: b1 3f 00 2c sth r9,44(r31) (Objects_Maximum)(information->inactive + information->allocation_size); } ffc0aa34: 80 01 00 44 lwz r0,68(r1) ffc0aa38: 82 c1 00 18 lwz r22,24(r1) ffc0aa3c: 7c 08 03 a6 mtlr r0 ffc0aa40: 82 e1 00 1c lwz r23,28(r1) ffc0aa44: 83 01 00 20 lwz r24,32(r1) ffc0aa48: 83 21 00 24 lwz r25,36(r1) ffc0aa4c: 83 41 00 28 lwz r26,40(r1) ffc0aa50: 83 61 00 2c lwz r27,44(r1) ffc0aa54: 83 81 00 30 lwz r28,48(r1) ffc0aa58: 83 a1 00 34 lwz r29,52(r1) ffc0aa5c: 83 c1 00 38 lwz r30,56(r1) ffc0aa60: 83 e1 00 3c lwz r31,60(r1) ffc0aa64: 38 21 00 40 addi r1,r1,64 ffc0aa68: 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; ffc0aa6c: 3b 20 00 00 li r25,0 ffc0aa70: 4b ff fe 14 b ffc0a884 <_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 ); ffc0aa74: 48 00 2b 4d bl ffc0d5c0 <_Workspace_Allocate_or_fatal_error> ffc0aa78: 7c 7c 1b 78 mr r28,r3 ffc0aa7c: 4b ff fe 34 b ffc0a8b0 <_Objects_Extend_information+0xc4> * separate parts as size of each block has changed. */ memcpy( object_blocks, information->object_blocks, block_count * sizeof(void*) ); ffc0aa80: 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, ffc0aa84: 80 9f 00 34 lwz r4,52(r31) ffc0aa88: 7e c5 b3 78 mr r5,r22 ffc0aa8c: 48 00 96 09 bl ffc14094 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, ffc0aa90: 80 9f 00 30 lwz r4,48(r31) ffc0aa94: 7e c5 b3 78 mr r5,r22 ffc0aa98: 7f 23 cb 78 mr r3,r25 ffc0aa9c: 48 00 95 f9 bl ffc14094 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); ffc0aaa0: 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, ffc0aaa4: 80 9f 00 1c lwz r4,28(r31) ffc0aaa8: 7e e3 bb 78 mr r3,r23 information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); ffc0aaac: 7c bd 2a 14 add r5,r29,r5 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, ffc0aab0: 54 a5 10 3a rlwinm r5,r5,2,0,29 ffc0aab4: 48 00 95 e1 bl ffc14094 ffc0aab8: 4b ff fe 58 b ffc0a910 <_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 ) ffc0aabc: a3 43 00 10 lhz r26,16(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 ); ffc0aac0: 7f be eb 78 mr r30,r29 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc0aac4: 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; ffc0aac8: 3b 20 00 01 li r25,1 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc0aacc: 3b 60 00 00 li r27,0 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; ffc0aad0: 3a c0 00 00 li r22,0 ffc0aad4: 4b ff fd b0 b ffc0a884 <_Objects_Extend_information+0x98> else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { ffc0aad8: 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 ); ffc0aadc: 7f be eb 78 mr r30,r29 <== 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; ffc0aae0: 3b 20 00 01 li r25,1 <== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc0aae4: 3b 60 00 00 li r27,0 <== NOT EXECUTED ffc0aae8: 4b ff fd 9c b ffc0a884 <_Objects_Extend_information+0x98><== NOT EXECUTED block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { ffc0aaec: 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 ); ffc0aaf0: 7f be eb 78 mr r30,r29 <== NOT EXECUTED else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { do_extend = false; ffc0aaf4: 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; ffc0aaf8: 3b 60 00 00 li r27,0 <== NOT EXECUTED ffc0aafc: 4b ff fd 88 b ffc0a884 <_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 ); ffc0ab00: 7f 83 e3 78 mr r3,r28 ffc0ab04: 48 00 2a 91 bl ffc0d594 <_Workspace_Free> return; ffc0ab08: 4b ff ff 2c b ffc0aa34 <_Objects_Extend_information+0x248> ffc0ab0c: 39 60 00 01 li r11,1 <== NOT EXECUTED ffc0ab10: 7d 69 03 a6 mtctr r11 <== NOT EXECUTED ffc0ab14: 4b ff fe 3c b ffc0a950 <_Objects_Extend_information+0x164><== NOT EXECUTED =============================================================================== ffc0ac04 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0ac04: 94 21 ff e8 stwu r1,-24(r1) ffc0ac08: 7c 08 02 a6 mflr r0 ffc0ac0c: 93 c1 00 10 stw r30,16(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) ffc0ac10: 7c 9e 23 79 mr. r30,r4 Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0ac14: 93 a1 00 0c stw r29,12(r1) ffc0ac18: 7c 7d 1b 78 mr r29,r3 ffc0ac1c: 93 e1 00 14 stw r31,20(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) return NULL; ffc0ac20: 3b e0 00 00 li r31,0 Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0ac24: 90 01 00 1c stw r0,28(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) ffc0ac28: 40 82 00 24 bne- ffc0ac4c <_Objects_Get_information+0x48> if ( info->maximum == 0 ) return NULL; #endif return info; } ffc0ac2c: 80 01 00 1c lwz r0,28(r1) ffc0ac30: 7f e3 fb 78 mr r3,r31 ffc0ac34: 83 a1 00 0c lwz r29,12(r1) ffc0ac38: 7c 08 03 a6 mtlr r0 ffc0ac3c: 83 c1 00 10 lwz r30,16(r1) ffc0ac40: 83 e1 00 14 lwz r31,20(r1) ffc0ac44: 38 21 00 18 addi r1,r1,24 ffc0ac48: 4e 80 00 20 blr /* * 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 ); ffc0ac4c: 48 00 5e 01 bl ffc10a4c <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) ffc0ac50: 2c 03 00 00 cmpwi r3,0 ffc0ac54: 41 82 ff d8 beq+ ffc0ac2c <_Objects_Get_information+0x28> return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) ffc0ac58: 7f 83 f0 40 cmplw cr7,r3,r30 ffc0ac5c: 41 9c ff d0 blt+ cr7,ffc0ac2c <_Objects_Get_information+0x28> return NULL; if ( !_Objects_Information_table[ the_api ] ) ffc0ac60: 3d 20 00 00 lis r9,0 ffc0ac64: 57 bd 10 3a rlwinm r29,r29,2,0,29 ffc0ac68: 39 29 2c 00 addi r9,r9,11264 ffc0ac6c: 7d 29 e8 2e lwzx r9,r9,r29 ffc0ac70: 2f 89 00 00 cmpwi cr7,r9,0 ffc0ac74: 41 9e ff b8 beq+ cr7,ffc0ac2c <_Objects_Get_information+0x28><== NEVER TAKEN return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; ffc0ac78: 57 de 10 3a rlwinm r30,r30,2,0,29 ffc0ac7c: 7f e9 f0 2e lwzx r31,r9,r30 if ( !info ) ffc0ac80: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0ac84: 41 9e ff a8 beq+ cr7,ffc0ac2c <_Objects_Get_information+0x28><== 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 ) ffc0ac88: a0 1f 00 10 lhz r0,16(r31) ffc0ac8c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ac90: 40 9e ff 9c bne+ cr7,ffc0ac2c <_Objects_Get_information+0x28> return NULL; ffc0ac94: 3b e0 00 00 li r31,0 ffc0ac98: 4b ff ff 94 b ffc0ac2c <_Objects_Get_information+0x28> =============================================================================== ffc0cedc <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { ffc0cedc: 94 21 ff d8 stwu r1,-40(r1) ffc0cee0: 7c 08 02 a6 mflr r0 ffc0cee4: 93 c1 00 20 stw r30,32(r1) char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) ffc0cee8: 7c 9e 23 79 mr. r30,r4 char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { ffc0ceec: 93 e1 00 24 stw r31,36(r1) ffc0cef0: 7c bf 2b 78 mr r31,r5 ffc0cef4: 90 01 00 2c stw r0,44(r1) ffc0cef8: 93 81 00 18 stw r28,24(r1) ffc0cefc: 93 a1 00 1c stw r29,28(r1) char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) ffc0cf00: 40 82 00 2c bne- ffc0cf2c <_Objects_Get_name_as_string+0x50> #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* not supported */ #endif case OBJECTS_ERROR: return NULL; ffc0cf04: 3b e0 00 00 li r31,0 _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } ffc0cf08: 80 01 00 2c lwz r0,44(r1) ffc0cf0c: 7f e3 fb 78 mr r3,r31 ffc0cf10: 83 81 00 18 lwz r28,24(r1) ffc0cf14: 7c 08 03 a6 mtlr r0 ffc0cf18: 83 a1 00 1c lwz r29,28(r1) ffc0cf1c: 83 c1 00 20 lwz r30,32(r1) ffc0cf20: 83 e1 00 24 lwz r31,36(r1) ffc0cf24: 38 21 00 28 addi r1,r1,40 ffc0cf28: 4e 80 00 20 blr Objects_Id tmpId; if ( length == 0 ) return NULL; if ( name == NULL ) ffc0cf2c: 2f 85 00 00 cmpwi cr7,r5,0 ffc0cf30: 41 9e ff d8 beq+ cr7,ffc0cf08 <_Objects_Get_name_as_string+0x2c> return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; ffc0cf34: 2f 83 00 00 cmpwi cr7,r3,0 ffc0cf38: 7c 7c 1b 78 mr r28,r3 ffc0cf3c: 40 9e 00 10 bne- cr7,ffc0cf4c <_Objects_Get_name_as_string+0x70> ffc0cf40: 3d 20 00 01 lis r9,1 ffc0cf44: 81 29 af 90 lwz r9,-20592(r9) ffc0cf48: 83 89 00 08 lwz r28,8(r9) information = _Objects_Get_information_id( tmpId ); ffc0cf4c: 7f 83 e3 78 mr r3,r28 ffc0cf50: 4b ff fe 59 bl ffc0cda8 <_Objects_Get_information_id> if ( !information ) ffc0cf54: 7c 7d 1b 79 mr. r29,r3 ffc0cf58: 41 82 ff ac beq+ ffc0cf04 <_Objects_Get_name_as_string+0x28> return NULL; the_object = _Objects_Get( information, tmpId, &location ); ffc0cf5c: 7f 84 e3 78 mr r4,r28 ffc0cf60: 38 a1 00 08 addi r5,r1,8 ffc0cf64: 48 00 00 cd bl ffc0d030 <_Objects_Get> switch ( location ) { ffc0cf68: 80 01 00 08 lwz r0,8(r1) ffc0cf6c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cf70: 40 be ff 94 bne- cr7,ffc0cf04 <_Objects_Get_name_as_string+0x28> return NULL; case OBJECTS_LOCAL: #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { ffc0cf74: 89 3d 00 38 lbz r9,56(r29) ffc0cf78: 2f 89 00 00 cmpwi cr7,r9,0 ffc0cf7c: 41 9e 00 88 beq- cr7,ffc0d004 <_Objects_Get_name_as_string+0x128> s = the_object->name.name_p; ffc0cf80: 80 e3 00 0c lwz r7,12(r3) lname[ 4 ] = '\0'; s = lname; } d = name; if ( s ) { ffc0cf84: 7f e9 fb 78 mr r9,r31 ffc0cf88: 2f 87 00 00 cmpwi cr7,r7,0 ffc0cf8c: 41 9e 00 68 beq- cr7,ffc0cff4 <_Objects_Get_name_as_string+0x118> for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { ffc0cf90: 34 1e ff ff addic. r0,r30,-1 ffc0cf94: 7f e9 fb 78 mr r9,r31 ffc0cf98: 7c 09 03 a6 mtctr r0 ffc0cf9c: 41 82 00 58 beq- ffc0cff4 <_Objects_Get_name_as_string+0x118><== NEVER TAKEN ffc0cfa0: 88 07 00 00 lbz r0,0(r7) ffc0cfa4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cfa8: 41 9e 00 4c beq- cr7,ffc0cff4 <_Objects_Get_name_as_string+0x118> ffc0cfac: 3c c0 00 00 lis r6,0 ffc0cfb0: 39 60 00 00 li r11,0 ffc0cfb4: 38 c6 27 d4 addi r6,r6,10196 ffc0cfb8: 48 00 00 10 b ffc0cfc8 <_Objects_Get_name_as_string+0xec> ffc0cfbc: 7c 07 58 ae lbzx r0,r7,r11 ffc0cfc0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cfc4: 41 9e 00 30 beq- cr7,ffc0cff4 <_Objects_Get_name_as_string+0x118> *d = (isprint((unsigned char)*s)) ? *s : '*'; ffc0cfc8: 81 06 00 00 lwz r8,0(r6) ffc0cfcc: 7c 0a 03 78 mr r10,r0 s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { ffc0cfd0: 39 6b 00 01 addi r11,r11,1 *d = (isprint((unsigned char)*s)) ? *s : '*'; ffc0cfd4: 7d 08 02 14 add r8,r8,r0 ffc0cfd8: 88 08 00 01 lbz r0,1(r8) ffc0cfdc: 70 08 00 97 andi. r8,r0,151 ffc0cfe0: 40 82 00 08 bne- ffc0cfe8 <_Objects_Get_name_as_string+0x10c> ffc0cfe4: 39 40 00 2a li r10,42 ffc0cfe8: 99 49 00 00 stb r10,0(r9) s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { ffc0cfec: 39 29 00 01 addi r9,r9,1 ffc0cff0: 42 00 ff cc bdnz+ ffc0cfbc <_Objects_Get_name_as_string+0xe0> *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; ffc0cff4: 38 00 00 00 li r0,0 ffc0cff8: 98 09 00 00 stb r0,0(r9) _Thread_Enable_dispatch(); ffc0cffc: 48 00 0f 4d bl ffc0df48 <_Thread_Enable_dispatch> return name; ffc0d000: 4b ff ff 08 b ffc0cf08 <_Objects_Get_name_as_string+0x2c> if ( information->is_string ) { s = the_object->name.name_p; } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; ffc0d004: 80 03 00 0c lwz r0,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'; s = lname; ffc0d008: 38 e1 00 0c addi r7,r1,12 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'; ffc0d00c: 99 21 00 10 stb r9,16(r1) } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; ffc0d010: 54 0a 46 3e rlwinm r10,r0,8,24,31 lname[ 1 ] = (u32_name >> 16) & 0xff; ffc0d014: 54 0b 84 3e rlwinm r11,r0,16,16,31 } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; ffc0d018: 99 41 00 0c stb r10,12(r1) lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; ffc0d01c: 54 09 c2 3e rlwinm r9,r0,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; ffc0d020: 99 61 00 0d stb r11,13(r1) lname[ 2 ] = (u32_name >> 8) & 0xff; ffc0d024: 99 21 00 0e stb r9,14(r1) lname[ 3 ] = (u32_name >> 0) & 0xff; ffc0d028: 98 01 00 0f stb r0,15(r1) ffc0d02c: 4b ff ff 64 b ffc0cf90 <_Objects_Get_name_as_string+0xb4> =============================================================================== ffc1ebb0 <_Objects_Get_no_protection>: /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; ffc1ebb0: 81 23 00 08 lwz r9,8(r3) if ( information->maximum >= index ) { ffc1ebb4: a0 03 00 10 lhz r0,16(r3) /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; ffc1ebb8: 21 29 00 01 subfic r9,r9,1 ffc1ebbc: 7d 29 22 14 add r9,r9,r4 if ( information->maximum >= index ) { ffc1ebc0: 7f 89 00 40 cmplw cr7,r9,r0 ffc1ebc4: 41 9d 00 24 bgt- cr7,ffc1ebe8 <_Objects_Get_no_protection+0x38> if ( (the_object = information->local_table[ index ]) != NULL ) { ffc1ebc8: 81 63 00 1c lwz r11,28(r3) ffc1ebcc: 55 29 10 3a rlwinm r9,r9,2,0,29 ffc1ebd0: 7c 6b 48 2e lwzx r3,r11,r9 ffc1ebd4: 2f 83 00 00 cmpwi cr7,r3,0 ffc1ebd8: 41 9e 00 10 beq- cr7,ffc1ebe8 <_Objects_Get_no_protection+0x38><== NEVER TAKEN *location = OBJECTS_LOCAL; ffc1ebdc: 38 00 00 00 li r0,0 ffc1ebe0: 90 05 00 00 stw r0,0(r5) return the_object; ffc1ebe4: 4e 80 00 20 blr /* * This isn't supported or required yet for Global objects so * if it isn't local, we don't find it. */ *location = OBJECTS_ERROR; ffc1ebe8: 38 00 00 01 li r0,1 ffc1ebec: 90 05 00 00 stw r0,0(r5) return NULL; ffc1ebf0: 38 60 00 00 li r3,0 } ffc1ebf4: 4e 80 00 20 blr =============================================================================== ffc0c8bc <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { ffc0c8bc: 94 21 ff e0 stwu r1,-32(r1) ffc0c8c0: 7c 08 02 a6 mflr r0 ffc0c8c4: 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; ffc0c8c8: 7c 60 1b 79 mr. r0,r3 */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { ffc0c8cc: 93 c1 00 18 stw r30,24(r1) ffc0c8d0: 7c 9e 23 78 mr r30,r4 ffc0c8d4: 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; ffc0c8d8: 40 82 00 10 bne- ffc0c8e8 <_Objects_Id_to_name+0x2c> ffc0c8dc: 3d 20 00 00 lis r9,0 ffc0c8e0: 81 29 31 90 lwz r9,12688(r9) ffc0c8e4: 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); ffc0c8e8: 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 ) ffc0c8ec: 39 69 ff ff addi r11,r9,-1 ffc0c8f0: 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; ffc0c8f4: 3b e0 00 03 li r31,3 ffc0c8f8: 41 9d 00 38 bgt- cr7,ffc0c930 <_Objects_Id_to_name+0x74> if ( !_Objects_Information_table[ the_api ] ) ffc0c8fc: 3d 60 00 00 lis r11,0 ffc0c900: 55 29 10 3a rlwinm r9,r9,2,0,29 ffc0c904: 39 6b 2c 80 addi r11,r11,11392 ffc0c908: 7d 2b 48 2e lwzx r9,r11,r9 ffc0c90c: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c910: 41 9e 00 20 beq- cr7,ffc0c930 <_Objects_Id_to_name+0x74> return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; ffc0c914: 54 0b 3e 7a rlwinm r11,r0,7,25,29 ffc0c918: 7c 69 58 2e lwzx r3,r9,r11 if ( !information ) ffc0c91c: 2f 83 00 00 cmpwi cr7,r3,0 ffc0c920: 41 9e 00 10 beq- cr7,ffc0c930 <_Objects_Id_to_name+0x74><== NEVER TAKEN return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) ffc0c924: 89 23 00 38 lbz r9,56(r3) ffc0c928: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c92c: 41 9e 00 20 beq- cr7,ffc0c94c <_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; } ffc0c930: 80 01 00 24 lwz r0,36(r1) ffc0c934: 7f e3 fb 78 mr r3,r31 ffc0c938: 83 c1 00 18 lwz r30,24(r1) ffc0c93c: 7c 08 03 a6 mtlr r0 ffc0c940: 83 e1 00 1c lwz r31,28(r1) ffc0c944: 38 21 00 20 addi r1,r1,32 ffc0c948: 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 ); ffc0c94c: 7c 04 03 78 mr r4,r0 ffc0c950: 38 a1 00 08 addi r5,r1,8 ffc0c954: 4b ff fe cd bl ffc0c820 <_Objects_Get> if ( !the_object ) ffc0c958: 2c 03 00 00 cmpwi r3,0 ffc0c95c: 41 a2 ff d4 beq- ffc0c930 <_Objects_Id_to_name+0x74> return OBJECTS_INVALID_ID; *name = the_object->name; ffc0c960: 80 03 00 0c lwz r0,12(r3) _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; ffc0c964: 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; ffc0c968: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc0c96c: 48 00 0e 9d bl ffc0d808 <_Thread_Enable_dispatch> return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } ffc0c970: 80 01 00 24 lwz r0,36(r1) ffc0c974: 7f e3 fb 78 mr r3,r31 ffc0c978: 83 c1 00 18 lwz r30,24(r1) ffc0c97c: 7c 08 03 a6 mtlr r0 ffc0c980: 83 e1 00 1c lwz r31,28(r1) ffc0c984: 38 21 00 20 addi r1,r1,32 ffc0c988: 4e 80 00 20 blr =============================================================================== ffc0af70 <_Objects_Shrink_information>: */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0af70: 94 21 ff e8 stwu r1,-24(r1) ffc0af74: 7c 08 02 a6 mflr r0 ffc0af78: 90 01 00 1c stw r0,28(r1) ffc0af7c: 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) / ffc0af80: 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 ); ffc0af84: a3 e3 00 0a lhz r31,10(r3) block_count = (information->maximum - index_base) / ffc0af88: a0 03 00 14 lhz r0,20(r3) ffc0af8c: 7d 5f 50 50 subf r10,r31,r10 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0af90: 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) / ffc0af94: 7d 4a 03 96 divwu r10,r10,r0 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0af98: 93 a1 00 0c stw r29,12(r1) ffc0af9c: 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++ ) { ffc0afa0: 2f 8a 00 00 cmpwi cr7,r10,0 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0afa4: 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++ ) { ffc0afa8: 41 9e 00 3c beq- cr7,ffc0afe4 <_Objects_Shrink_information+0x74><== NEVER TAKEN if ( information->inactive_per_block[ block ] == ffc0afac: 81 63 00 30 lwz r11,48(r3) ffc0afb0: 81 2b 00 00 lwz r9,0(r11) ffc0afb4: 7f 80 48 00 cmpw cr7,r0,r9 ffc0afb8: 41 9e 00 4c beq- cr7,ffc0b004 <_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++ ) { ffc0afbc: 39 20 00 00 li r9,0 ffc0afc0: 7d 49 03 a6 mtctr r10 ffc0afc4: 48 00 00 18 b ffc0afdc <_Objects_Shrink_information+0x6c> if ( information->inactive_per_block[ block ] == ffc0afc8: 85 4b 00 04 lwzu r10,4(r11) information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; ffc0afcc: 7f ff 02 14 add r31,r31,r0 ffc0afd0: 55 3d 10 3a rlwinm r29,r9,2,0,29 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 ] == ffc0afd4: 7f 80 50 00 cmpw cr7,r0,r10 ffc0afd8: 41 9e 00 30 beq- cr7,ffc0b008 <_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++ ) { ffc0afdc: 39 29 00 01 addi r9,r9,1 ffc0afe0: 42 00 ff e8 bdnz+ ffc0afc8 <_Objects_Shrink_information+0x58> return; } index_base += information->allocation_size; } } ffc0afe4: 80 01 00 1c lwz r0,28(r1) ffc0afe8: 83 81 00 08 lwz r28,8(r1) ffc0afec: 7c 08 03 a6 mtlr r0 ffc0aff0: 83 a1 00 0c lwz r29,12(r1) ffc0aff4: 83 c1 00 10 lwz r30,16(r1) ffc0aff8: 83 e1 00 14 lwz r31,20(r1) ffc0affc: 38 21 00 18 addi r1,r1,24 ffc0b000: 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 ] == ffc0b004: 3b a0 00 00 li r29,0 <== NOT EXECUTED information->allocation_size ) { /* * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); ffc0b008: 80 7c 00 20 lwz r3,32(r28) ffc0b00c: 48 00 00 10 b ffc0b01c <_Objects_Shrink_information+0xac> if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); ffc0b010: 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; ffc0b014: 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 ); ffc0b018: 41 9e 00 34 beq- cr7,ffc0b04c <_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 ); ffc0b01c: 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; ffc0b020: 83 c3 00 00 lwz r30,0(r3) if ((index >= index_base) && ffc0b024: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0b028: 41 bc ff e8 blt- cr7,ffc0b010 <_Objects_Shrink_information+0xa0> (index < (index_base + information->allocation_size))) { ffc0b02c: a1 3c 00 14 lhz r9,20(r28) ffc0b030: 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) && ffc0b034: 7f 80 48 40 cmplw cr7,r0,r9 ffc0b038: 40 9c ff d8 bge+ cr7,ffc0b010 <_Objects_Shrink_information+0xa0> (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); ffc0b03c: 4b ff ea e9 bl ffc09b24 <_Chain_Extract> } } while ( the_object ); ffc0b040: 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; ffc0b044: 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 ); ffc0b048: 40 9e ff d4 bne+ cr7,ffc0b01c <_Objects_Shrink_information+0xac><== ALWAYS TAKEN /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); ffc0b04c: 81 3c 00 34 lwz r9,52(r28) ffc0b050: 7c 69 e8 2e lwzx r3,r9,r29 ffc0b054: 48 00 25 41 bl ffc0d594 <_Workspace_Free> information->object_blocks[ block ] = NULL; information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; ffc0b058: a1 5c 00 2c lhz r10,44(r28) ffc0b05c: 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; ffc0b060: 81 7c 00 34 lwz r11,52(r28) information->inactive_per_block[ block ] = 0; ffc0b064: 81 3c 00 30 lwz r9,48(r28) information->inactive -= information->allocation_size; ffc0b068: 7c 00 50 50 subf r0,r0,r10 /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; ffc0b06c: 7f cb e9 2e stwx r30,r11,r29 information->inactive_per_block[ block ] = 0; ffc0b070: 7f c9 e9 2e stwx r30,r9,r29 information->inactive -= information->allocation_size; ffc0b074: b0 1c 00 2c sth r0,44(r28) return; } index_base += information->allocation_size; } } ffc0b078: 80 01 00 1c lwz r0,28(r1) ffc0b07c: 83 81 00 08 lwz r28,8(r1) ffc0b080: 7c 08 03 a6 mtlr r0 ffc0b084: 83 a1 00 0c lwz r29,12(r1) ffc0b088: 83 c1 00 10 lwz r30,16(r1) ffc0b08c: 83 e1 00 14 lwz r31,20(r1) ffc0b090: 38 21 00 18 addi r1,r1,24 ffc0b094: 4e 80 00 20 blr =============================================================================== ffc0b6e0 <_POSIX_Absolute_timeout_to_ticks>: */ POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks( const struct timespec *abstime, Watchdog_Interval *ticks_out ) { ffc0b6e0: 94 21 ff d8 stwu r1,-40(r1) ffc0b6e4: 7c 08 02 a6 mflr r0 ffc0b6e8: 90 01 00 2c stw r0,44(r1) /* * Make sure there is always a value returned. */ *ticks_out = 0; ffc0b6ec: 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 ) { ffc0b6f0: 93 81 00 18 stw r28,24(r1) ffc0b6f4: 7c 7c 1b 78 mr r28,r3 ffc0b6f8: 93 e1 00 24 stw r31,36(r1) ffc0b6fc: 7c 9f 23 78 mr r31,r4 ffc0b700: 93 a1 00 1c stw r29,28(r1) ffc0b704: 93 c1 00 20 stw r30,32(r1) /* * Make sure there is always a value returned. */ *ticks_out = 0; ffc0b708: 90 04 00 00 stw r0,0(r4) /* * Is the absolute time even valid? */ if ( !_Timespec_Is_valid(abstime) ) ffc0b70c: 48 00 54 61 bl ffc10b6c <_Timespec_Is_valid> ffc0b710: 2f 83 00 00 cmpwi cr7,r3,0 return POSIX_ABSOLUTE_TIMEOUT_INVALID; ffc0b714: 38 60 00 00 li r3,0 *ticks_out = 0; /* * Is the absolute time even valid? */ if ( !_Timespec_Is_valid(abstime) ) ffc0b718: 40 9e 00 24 bne- cr7,ffc0b73c <_POSIX_Absolute_timeout_to_ticks+0x5c> /* * This is the case we were expecting and it took this long to * get here. */ return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE; } ffc0b71c: 80 01 00 2c lwz r0,44(r1) ffc0b720: 83 81 00 18 lwz r28,24(r1) ffc0b724: 7c 08 03 a6 mtlr r0 ffc0b728: 83 a1 00 1c lwz r29,28(r1) ffc0b72c: 83 c1 00 20 lwz r30,32(r1) ffc0b730: 83 e1 00 24 lwz r31,36(r1) ffc0b734: 38 21 00 28 addi r1,r1,40 ffc0b738: 4e 80 00 20 blr return POSIX_ABSOLUTE_TIMEOUT_INVALID; /* * Is the absolute time in the past? */ _TOD_Get( ¤t_time ); ffc0b73c: 3b c1 00 08 addi r30,r1,8 ffc0b740: 7f c3 f3 78 mr r3,r30 ffc0b744: 48 00 27 b9 bl ffc0defc <_TOD_Get> if ( _Timespec_Less_than( abstime, ¤t_time ) ) ffc0b748: 7f 83 e3 78 mr r3,r28 ffc0b74c: 7f c4 f3 78 mr r4,r30 ffc0b750: 48 00 54 59 bl ffc10ba8 <_Timespec_Less_than> ffc0b754: 2f 83 00 00 cmpwi cr7,r3,0 return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST; ffc0b758: 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 ) ) ffc0b75c: 40 be ff c0 bne- cr7,ffc0b71c <_POSIX_Absolute_timeout_to_ticks+0x3c> return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST; /* * How long until the requested absolute time? */ _Timespec_Subtract( ¤t_time, abstime, &difference ); ffc0b760: 3b a1 00 10 addi r29,r1,16 ffc0b764: 7f 84 e3 78 mr r4,r28 ffc0b768: 7f a5 eb 78 mr r5,r29 ffc0b76c: 7f c3 f3 78 mr r3,r30 ffc0b770: 48 00 54 75 bl ffc10be4 <_Timespec_Subtract> /* * Internally the SuperCore uses ticks, so convert to them. */ *ticks_out = _Timespec_To_ticks( &difference ); ffc0b774: 7f a3 eb 78 mr r3,r29 ffc0b778: 48 00 54 c1 bl ffc10c38 <_Timespec_To_ticks> /* * If the difference was 0, then the future is now. It is so bright * we better wear shades. */ if ( !*ticks_out ) ffc0b77c: 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 ); ffc0b780: 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; ffc0b784: 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 ) ffc0b788: 40 9e ff 94 bne+ cr7,ffc0b71c <_POSIX_Absolute_timeout_to_ticks+0x3c><== ALWAYS TAKEN return POSIX_ABSOLUTE_TIMEOUT_IS_NOW; ffc0b78c: 38 60 00 02 li r3,2 <== NOT EXECUTED ffc0b790: 4b ff ff 8c b ffc0b71c <_POSIX_Absolute_timeout_to_ticks+0x3c><== NOT EXECUTED =============================================================================== ffc0eaf8 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { ffc0eaf8: 94 21 ff d0 stwu r1,-48(r1) ffc0eafc: 7c 08 02 a6 mflr r0 ffc0eb00: 93 e1 00 2c stw r31,44(r1) ffc0eb04: 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( ffc0eb08: 3c 60 00 00 lis r3,0 ffc0eb0c: 93 81 00 20 stw r28,32(r1) ffc0eb10: 38 63 36 18 addi r3,r3,13848 ffc0eb14: 7c 9c 23 78 mr r28,r4 ffc0eb18: 93 c1 00 28 stw r30,40(r1) ffc0eb1c: 7f e4 fb 78 mr r4,r31 ffc0eb20: 7c be 2b 78 mr r30,r5 ffc0eb24: 38 a1 00 08 addi r5,r1,8 ffc0eb28: 90 01 00 34 stw r0,52(r1) ffc0eb2c: 93 41 00 18 stw r26,24(r1) ffc0eb30: 7c fa 3b 78 mr r26,r7 ffc0eb34: 93 61 00 1c stw r27,28(r1) ffc0eb38: 7d 1b 43 78 mr r27,r8 ffc0eb3c: 93 a1 00 24 stw r29,36(r1) ffc0eb40: 7c dd 33 78 mr r29,r6 ffc0eb44: 48 00 41 e1 bl ffc12d24 <_Objects_Get> Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { ffc0eb48: 80 01 00 08 lwz r0,8(r1) ffc0eb4c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0eb50: 41 9e 00 3c beq- cr7,ffc0eb8c <_POSIX_Message_queue_Receive_support+0x94> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); ffc0eb54: 48 00 d4 25 bl ffc1bf78 <__errno> ffc0eb58: 38 00 00 09 li r0,9 ffc0eb5c: 90 03 00 00 stw r0,0(r3) ffc0eb60: 38 60 ff ff li r3,-1 } ffc0eb64: 80 01 00 34 lwz r0,52(r1) ffc0eb68: 83 41 00 18 lwz r26,24(r1) ffc0eb6c: 7c 08 03 a6 mtlr r0 ffc0eb70: 83 61 00 1c lwz r27,28(r1) ffc0eb74: 83 81 00 20 lwz r28,32(r1) ffc0eb78: 83 a1 00 24 lwz r29,36(r1) ffc0eb7c: 83 c1 00 28 lwz r30,40(r1) ffc0eb80: 83 e1 00 2c lwz r31,44(r1) ffc0eb84: 38 21 00 30 addi r1,r1,48 ffc0eb88: 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 ) { ffc0eb8c: 80 03 00 14 lwz r0,20(r3) ffc0eb90: 54 09 07 be clrlwi r9,r0,30 ffc0eb94: 2f 89 00 01 cmpwi cr7,r9,1 ffc0eb98: 41 9e 00 e4 beq- cr7,ffc0ec7c <_POSIX_Message_queue_Receive_support+0x184> _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; ffc0eb9c: 80 63 00 10 lwz r3,16(r3) if ( msg_len < the_mq->Message_queue.maximum_message_size ) { ffc0eba0: 81 23 00 68 lwz r9,104(r3) ffc0eba4: 7f 89 f0 40 cmplw cr7,r9,r30 ffc0eba8: 41 9d 00 9c bgt- cr7,ffc0ec44 <_POSIX_Message_queue_Receive_support+0x14c> length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0ebac: 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; ffc0ebb0: 39 20 ff ff li r9,-1 ffc0ebb4: 91 21 00 0c stw r9,12(r1) /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0ebb8: 38 e0 00 00 li r7,0 ffc0ebbc: 40 9e 00 78 bne- cr7,ffc0ec34 <_POSIX_Message_queue_Receive_support+0x13c><== ALWAYS TAKEN do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0ebc0: 7f e4 fb 78 mr r4,r31 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0ebc4: 3f e0 00 00 lis r31,0 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0ebc8: 38 63 00 1c addi r3,r3,28 ffc0ebcc: 7f 85 e3 78 mr r5,r28 ffc0ebd0: 38 c1 00 0c addi r6,r1,12 ffc0ebd4: 7f 68 db 78 mr r8,r27 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0ebd8: 3b ff 36 84 addi r31,r31,13956 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0ebdc: 48 00 2c 39 bl ffc11814 <_CORE_message_queue_Seize> &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); ffc0ebe0: 48 00 51 1d bl ffc13cfc <_Thread_Enable_dispatch> *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0ebe4: 81 3f 00 0c lwz r9,12(r31) if ( !_Thread_Executing->Wait.return_code ) ffc0ebe8: 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); ffc0ebec: 80 09 00 24 lwz r0,36(r9) ffc0ebf0: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0ebf4: 7c 09 fe 70 srawi r9,r0,31 ffc0ebf8: 7d 20 02 78 xor r0,r9,r0 ffc0ebfc: 7c 09 00 50 subf r0,r9,r0 do_wait, timeout ); _Thread_Enable_dispatch(); *msg_prio = ffc0ec00: 90 1d 00 00 stw r0,0(r29) _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) ffc0ec04: 40 9e 00 58 bne- cr7,ffc0ec5c <_POSIX_Message_queue_Receive_support+0x164> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0ec08: 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; ffc0ec0c: 80 61 00 0c lwz r3,12(r1) case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0ec10: 7c 08 03 a6 mtlr r0 ffc0ec14: 83 41 00 18 lwz r26,24(r1) ffc0ec18: 83 61 00 1c lwz r27,28(r1) ffc0ec1c: 83 81 00 20 lwz r28,32(r1) ffc0ec20: 83 a1 00 24 lwz r29,36(r1) ffc0ec24: 83 c1 00 28 lwz r30,40(r1) ffc0ec28: 83 e1 00 2c lwz r31,44(r1) ffc0ec2c: 38 21 00 30 addi r1,r1,48 ffc0ec30: 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; ffc0ec34: 70 09 40 00 andi. r9,r0,16384 ffc0ec38: 7c e0 00 26 mfcr r7 ffc0ec3c: 54 e7 1f fe rlwinm r7,r7,3,31,31 ffc0ec40: 4b ff ff 80 b ffc0ebc0 <_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(); ffc0ec44: 48 00 50 b9 bl ffc13cfc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EMSGSIZE ); ffc0ec48: 48 00 d3 31 bl ffc1bf78 <__errno> ffc0ec4c: 38 00 00 7a li r0,122 ffc0ec50: 90 03 00 00 stw r0,0(r3) ffc0ec54: 38 60 ff ff li r3,-1 ffc0ec58: 4b ff ff 0c b ffc0eb64 <_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( ffc0ec5c: 48 00 d3 1d bl ffc1bf78 <__errno> ffc0ec60: 81 3f 00 0c lwz r9,12(r31) ffc0ec64: 7c 7e 1b 78 mr r30,r3 ffc0ec68: 80 69 00 34 lwz r3,52(r9) ffc0ec6c: 48 00 03 71 bl ffc0efdc <_POSIX_Message_queue_Translate_core_message_queue_return_code> ffc0ec70: 90 7e 00 00 stw r3,0(r30) ffc0ec74: 38 60 ff ff li r3,-1 ffc0ec78: 4b ff fe ec b ffc0eb64 <_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(); ffc0ec7c: 48 00 50 81 bl ffc13cfc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EBADF ); ffc0ec80: 48 00 d2 f9 bl ffc1bf78 <__errno> ffc0ec84: 38 00 00 09 li r0,9 ffc0ec88: 90 03 00 00 stw r0,0(r3) ffc0ec8c: 38 60 ff ff li r3,-1 ffc0ec90: 4b ff fe d4 b ffc0eb64 <_POSIX_Message_queue_Receive_support+0x6c> =============================================================================== ffc0ecbc <_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 ) ffc0ecbc: 2b 86 00 20 cmplwi cr7,r6,32 size_t msg_len, uint32_t msg_prio, bool wait, Watchdog_Interval timeout ) { ffc0ecc0: 94 21 ff d0 stwu r1,-48(r1) ffc0ecc4: 7c 08 02 a6 mflr r0 ffc0ecc8: 93 41 00 18 stw r26,24(r1) ffc0eccc: 7c fa 3b 78 mr r26,r7 ffc0ecd0: 93 61 00 1c stw r27,28(r1) ffc0ecd4: 7c 9b 23 78 mr r27,r4 ffc0ecd8: 93 81 00 20 stw r28,32(r1) ffc0ecdc: 7c bc 2b 78 mr r28,r5 ffc0ece0: 93 a1 00 24 stw r29,36(r1) ffc0ece4: 7c 7d 1b 78 mr r29,r3 ffc0ece8: 93 c1 00 28 stw r30,40(r1) ffc0ecec: 7c de 33 78 mr r30,r6 ffc0ecf0: 93 e1 00 2c stw r31,44(r1) ffc0ecf4: 7d 1f 43 78 mr r31,r8 ffc0ecf8: 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 ) ffc0ecfc: 41 9d 01 04 bgt- cr7,ffc0ee00 <_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( ffc0ed00: 3c 60 00 00 lis r3,0 ffc0ed04: 38 63 36 18 addi r3,r3,13848 ffc0ed08: 7f a4 eb 78 mr r4,r29 ffc0ed0c: 38 a1 00 08 addi r5,r1,8 ffc0ed10: 48 00 40 15 bl ffc12d24 <_Objects_Get> rtems_set_errno_and_return_minus_one( EINVAL ); the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { ffc0ed14: 80 01 00 08 lwz r0,8(r1) ffc0ed18: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ed1c: 40 9e 00 d0 bne- cr7,ffc0edec <_POSIX_Message_queue_Send_support+0x130> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { ffc0ed20: 80 03 00 14 lwz r0,20(r3) ffc0ed24: 70 09 00 03 andi. r9,r0,3 ffc0ed28: 41 82 00 ec beq- ffc0ee14 <_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 ) ffc0ed2c: 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; ffc0ed30: 81 63 00 10 lwz r11,16(r3) /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0ed34: 39 20 00 00 li r9,0 ffc0ed38: 40 9e 00 68 bne- cr7,ffc0eda0 <_POSIX_Message_queue_Send_support+0xe4> do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( ffc0ed3c: 7f ea fb 78 mr r10,r31 ffc0ed40: 7f 64 db 78 mr r4,r27 ffc0ed44: 7f 85 e3 78 mr r5,r28 ffc0ed48: 7f a6 eb 78 mr r6,r29 ffc0ed4c: 38 e0 00 00 li r7,0 ffc0ed50: 7d 1e 00 d0 neg r8,r30 ffc0ed54: 38 6b 00 1c addi r3,r11,28 ffc0ed58: 48 00 2c 51 bl ffc119a8 <_CORE_message_queue_Submit> ffc0ed5c: 7c 7f 1b 78 mr r31,r3 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); ffc0ed60: 48 00 4f 9d bl ffc13cfc <_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 ) ffc0ed64: 2f 9f 00 07 cmpwi cr7,r31,7 ffc0ed68: 41 9e 00 74 beq- cr7,ffc0eddc <_POSIX_Message_queue_Send_support+0x120><== NEVER TAKEN msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) ffc0ed6c: 2f 9f 00 00 cmpwi cr7,r31,0 return msg_status; ffc0ed70: 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 ) ffc0ed74: 40 9e 00 b8 bne- cr7,ffc0ee2c <_POSIX_Message_queue_Send_support+0x170> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0ed78: 80 01 00 34 lwz r0,52(r1) ffc0ed7c: 83 41 00 18 lwz r26,24(r1) ffc0ed80: 7c 08 03 a6 mtlr r0 ffc0ed84: 83 61 00 1c lwz r27,28(r1) ffc0ed88: 83 81 00 20 lwz r28,32(r1) ffc0ed8c: 83 a1 00 24 lwz r29,36(r1) ffc0ed90: 83 c1 00 28 lwz r30,40(r1) ffc0ed94: 83 e1 00 2c lwz r31,44(r1) ffc0ed98: 38 21 00 30 addi r1,r1,48 ffc0ed9c: 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; ffc0eda0: 70 09 40 00 andi. r9,r0,16384 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( ffc0eda4: 7f ea fb 78 mr r10,r31 ffc0eda8: 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; ffc0edac: 7d 20 00 26 mfcr r9 ffc0edb0: 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( ffc0edb4: 7f 85 e3 78 mr r5,r28 ffc0edb8: 7f a6 eb 78 mr r6,r29 ffc0edbc: 38 e0 00 00 li r7,0 ffc0edc0: 7d 1e 00 d0 neg r8,r30 ffc0edc4: 38 6b 00 1c addi r3,r11,28 ffc0edc8: 48 00 2b e1 bl ffc119a8 <_CORE_message_queue_Submit> ffc0edcc: 7c 7f 1b 78 mr r31,r3 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); ffc0edd0: 48 00 4f 2d bl ffc13cfc <_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 ) ffc0edd4: 2f 9f 00 07 cmpwi cr7,r31,7 ffc0edd8: 40 9e ff 94 bne+ cr7,ffc0ed6c <_POSIX_Message_queue_Send_support+0xb0> msg_status = _Thread_Executing->Wait.return_code; ffc0eddc: 3d 20 00 00 lis r9,0 ffc0ede0: 81 29 36 90 lwz r9,13968(r9) ffc0ede4: 83 e9 00 34 lwz r31,52(r9) ffc0ede8: 4b ff ff 84 b ffc0ed6c <_POSIX_Message_queue_Send_support+0xb0> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); ffc0edec: 48 00 d1 8d bl ffc1bf78 <__errno> ffc0edf0: 38 00 00 09 li r0,9 ffc0edf4: 90 03 00 00 stw r0,0(r3) ffc0edf8: 38 60 ff ff li r3,-1 ffc0edfc: 4b ff ff 7c b ffc0ed78 <_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 ); ffc0ee00: 48 00 d1 79 bl ffc1bf78 <__errno> ffc0ee04: 38 00 00 16 li r0,22 ffc0ee08: 90 03 00 00 stw r0,0(r3) ffc0ee0c: 38 60 ff ff li r3,-1 ffc0ee10: 4b ff ff 68 b ffc0ed78 <_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(); ffc0ee14: 48 00 4e e9 bl ffc13cfc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EBADF ); ffc0ee18: 48 00 d1 61 bl ffc1bf78 <__errno> ffc0ee1c: 38 00 00 09 li r0,9 ffc0ee20: 90 03 00 00 stw r0,0(r3) ffc0ee24: 38 60 ff ff li r3,-1 ffc0ee28: 4b ff ff 50 b ffc0ed78 <_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( ffc0ee2c: 48 00 d1 4d bl ffc1bf78 <__errno> ffc0ee30: 7c 7e 1b 78 mr r30,r3 ffc0ee34: 7f e3 fb 78 mr r3,r31 ffc0ee38: 48 00 01 a5 bl ffc0efdc <_POSIX_Message_queue_Translate_core_message_queue_return_code> ffc0ee3c: 90 7e 00 00 stw r3,0(r30) ffc0ee40: 38 60 ff ff li r3,-1 ffc0ee44: 4b ff ff 34 b ffc0ed78 <_POSIX_Message_queue_Send_support+0xbc> =============================================================================== ffc0f94c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>: #include void _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( Thread_Control *the_thread ) { ffc0f94c: 7c 08 02 a6 mflr r0 ffc0f950: 94 21 ff f8 stwu r1,-8(r1) ffc0f954: 90 01 00 0c stw r0,12(r1) POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0f958: 81 23 01 34 lwz r9,308(r3) if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc0f95c: 80 09 00 d8 lwz r0,216(r9) ffc0f960: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f964: 40 9e 00 10 bne- cr7,ffc0f974 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x28><== NEVER TAKEN ffc0f968: 80 09 00 dc lwz r0,220(r9) ffc0f96c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0f970: 41 9e 00 18 beq- cr7,ffc0f988 <_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(); ffc0f974: 4b ff c8 a1 bl ffc0c214 <_Thread_Enable_dispatch> } ffc0f978: 80 01 00 0c lwz r0,12(r1) ffc0f97c: 38 21 00 08 addi r1,r1,8 ffc0f980: 7c 08 03 a6 mtlr r0 ffc0f984: 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 && ffc0f988: 80 09 00 e0 lwz r0,224(r9) ffc0f98c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f990: 41 9e ff e4 beq+ cr7,ffc0f974 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x28> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc0f994: 3d 20 00 00 lis r9,0 ffc0f998: 81 69 27 f4 lwz r11,10228(r9) thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); ffc0f99c: 38 80 ff ff li r4,-1 ffc0f9a0: 38 0b ff ff addi r0,r11,-1 ffc0f9a4: 90 09 27 f4 stw r0,10228(r9) ffc0f9a8: 48 00 09 69 bl ffc10310 <_POSIX_Thread_Exit> ffc0f9ac: 4b ff ff cc b ffc0f978 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x2c> =============================================================================== ffc112cc <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { ffc112cc: 94 21 ff e0 stwu r1,-32(r1) ffc112d0: 7c 08 02 a6 mflr r0 ffc112d4: 93 e1 00 1c stw r31,28(r1) ffc112d8: 7c 7f 1b 78 mr r31,r3 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) ffc112dc: 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 ) { ffc112e0: 93 61 00 0c stw r27,12(r1) ffc112e4: 7c db 33 78 mr r27,r6 ffc112e8: 93 81 00 10 stw r28,16(r1) if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) return EINVAL; ffc112ec: 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 ) { ffc112f0: 93 a1 00 14 stw r29,20(r1) ffc112f4: 7c bd 2b 78 mr r29,r5 ffc112f8: 93 c1 00 18 stw r30,24(r1) ffc112fc: 7c 9e 23 78 mr r30,r4 ffc11300: 90 01 00 24 stw r0,36(r1) if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) ffc11304: 4b ff ff a5 bl ffc112a8 <_POSIX_Priority_Is_valid> ffc11308: 2f 83 00 00 cmpwi cr7,r3,0 ffc1130c: 41 9e 00 38 beq- cr7,ffc11344 <_POSIX_Thread_Translate_sched_param+0x78><== NEVER TAKEN return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { ffc11310: 2f 9f 00 00 cmpwi cr7,r31,0 ) { if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; ffc11314: 38 00 00 00 li r0,0 ffc11318: 90 1d 00 00 stw r0,0(r29) *budget_callout = NULL; ffc1131c: 90 1b 00 00 stw r0,0(r27) if ( policy == SCHED_OTHER ) { ffc11320: 41 9e 00 4c beq- cr7,ffc1136c <_POSIX_Thread_Translate_sched_param+0xa0> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; return 0; } if ( policy == SCHED_FIFO ) { ffc11324: 2f 9f 00 01 cmpwi cr7,r31,1 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; ffc11328: 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 ) { ffc1132c: 41 9e 00 18 beq- cr7,ffc11344 <_POSIX_Thread_Translate_sched_param+0x78> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { ffc11330: 2f 9f 00 02 cmpwi cr7,r31,2 ffc11334: 41 9e 00 ec beq- cr7,ffc11420 <_POSIX_Thread_Translate_sched_param+0x154> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { ffc11338: 2f 9f 00 04 cmpwi cr7,r31,4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; ffc1133c: 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 ) { ffc11340: 41 9e 00 60 beq- cr7,ffc113a0 <_POSIX_Thread_Translate_sched_param+0xd4> *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc11344: 80 01 00 24 lwz r0,36(r1) ffc11348: 7f 83 e3 78 mr r3,r28 ffc1134c: 83 61 00 0c lwz r27,12(r1) ffc11350: 7c 08 03 a6 mtlr r0 ffc11354: 83 81 00 10 lwz r28,16(r1) ffc11358: 83 a1 00 14 lwz r29,20(r1) ffc1135c: 83 c1 00 18 lwz r30,24(r1) ffc11360: 83 e1 00 1c lwz r31,28(r1) ffc11364: 38 21 00 20 addi r1,r1,32 ffc11368: 4e 80 00 20 blr *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; ffc1136c: 38 00 00 01 li r0,1 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc11370: 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; ffc11374: 90 1d 00 00 stw r0,0(r29) return 0; ffc11378: 3b 80 00 00 li r28,0 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc1137c: 7f 83 e3 78 mr r3,r28 ffc11380: 80 01 00 24 lwz r0,36(r1) ffc11384: 83 81 00 10 lwz r28,16(r1) ffc11388: 7c 08 03 a6 mtlr r0 ffc1138c: 83 a1 00 14 lwz r29,20(r1) ffc11390: 83 c1 00 18 lwz r30,24(r1) ffc11394: 83 e1 00 1c lwz r31,28(r1) ffc11398: 38 21 00 20 addi r1,r1,32 ffc1139c: 4e 80 00 20 blr *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { if ( (param->sched_ss_repl_period.tv_sec == 0) && ffc113a0: 80 1e 00 08 lwz r0,8(r30) ffc113a4: 2f 80 00 00 cmpwi cr7,r0,0 ffc113a8: 40 9e 00 10 bne- cr7,ffc113b8 <_POSIX_Thread_Translate_sched_param+0xec> ffc113ac: 80 1e 00 0c lwz r0,12(r30) ffc113b0: 2f 80 00 00 cmpwi cr7,r0,0 ffc113b4: 41 be ff 90 beq- cr7,ffc11344 <_POSIX_Thread_Translate_sched_param+0x78> (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && ffc113b8: 80 1e 00 10 lwz r0,16(r30) ffc113bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc113c0: 40 9e 00 14 bne- cr7,ffc113d4 <_POSIX_Thread_Translate_sched_param+0x108> ffc113c4: 80 1e 00 14 lwz r0,20(r30) (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; ffc113c8: 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) && ffc113cc: 2f 80 00 00 cmpwi cr7,r0,0 ffc113d0: 41 be ff 74 beq- cr7,ffc11344 <_POSIX_Thread_Translate_sched_param+0x78> (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < ffc113d4: 38 7e 00 08 addi r3,r30,8 ffc113d8: 4b ff d0 09 bl ffc0e3e0 <_Timespec_To_ticks> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; ffc113dc: 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 ) < ffc113e0: 7c 7f 1b 78 mr r31,r3 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) ffc113e4: 38 7e 00 10 addi r3,r30,16 ffc113e8: 4b ff cf f9 bl ffc0e3e0 <_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 ) < ffc113ec: 7f 9f 18 40 cmplw cr7,r31,r3 ffc113f0: 41 bc ff 54 blt- cr7,ffc11344 <_POSIX_Thread_Translate_sched_param+0x78> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) ffc113f4: 80 7e 00 04 lwz r3,4(r30) ffc113f8: 4b ff fe b1 bl ffc112a8 <_POSIX_Priority_Is_valid> ffc113fc: 2f 83 00 00 cmpwi cr7,r3,0 ffc11400: 41 be ff 44 beq- cr7,ffc11344 <_POSIX_Thread_Translate_sched_param+0x78> return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; ffc11404: 38 00 00 03 li r0,3 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc11408: 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; ffc1140c: 90 1d 00 00 stw r0,0(r29) *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc11410: 38 09 96 f8 addi r0,r9,-26888 return 0; ffc11414: 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; ffc11418: 90 1b 00 00 stw r0,0(r27) return 0; ffc1141c: 4b ff ff 28 b ffc11344 <_POSIX_Thread_Translate_sched_param+0x78> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; ffc11420: 93 fd 00 00 stw r31,0(r29) return 0; ffc11424: 4b ff ff 20 b ffc11344 <_POSIX_Thread_Translate_sched_param+0x78> =============================================================================== ffc0f92c <_POSIX_Threads_Exitted_extension>: * This method is invoked each time a thread exits. */ void _POSIX_Threads_Exitted_extension( Thread_Control *executing ) { ffc0f92c: 7c 08 02 a6 mflr r0 ffc0f930: 94 21 ff f8 stwu r1,-8(r1) ffc0f934: 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); ffc0f938: 88 03 00 08 lbz r0,8(r3) ffc0f93c: 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 ) ffc0f940: 2f 80 00 03 cmpwi cr7,r0,3 ffc0f944: 41 9e 00 14 beq- cr7,ffc0f958 <_POSIX_Threads_Exitted_extension+0x2c> pthread_exit( executing->Wait.return_argument ); } ffc0f948: 80 01 00 0c lwz r0,12(r1) ffc0f94c: 38 21 00 08 addi r1,r1,8 ffc0f950: 7c 08 03 a6 mtlr r0 ffc0f954: 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 ); ffc0f958: 80 63 00 28 lwz r3,40(r3) ffc0f95c: 48 00 34 51 bl ffc12dac } ffc0f960: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc0f964: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc0f968: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0f96c: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc092c4 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc092c4: 94 21 ff 90 stwu r1,-112(r1) ffc092c8: 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; ffc092cc: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc092d0: 90 01 00 74 stw r0,116(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; ffc092d4: 39 29 20 84 addi r9,r9,8324 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc092d8: 93 c1 00 68 stw r30,104(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; ffc092dc: 83 c9 00 34 lwz r30,52(r9) * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc092e0: 93 81 00 60 stw r28,96(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 ) ffc092e4: 2f 9e 00 00 cmpwi cr7,r30,0 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc092e8: 93 61 00 5c stw r27,92(r1) ffc092ec: 93 a1 00 64 stw r29,100(r1) ffc092f0: 93 e1 00 6c stw r31,108(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; ffc092f4: 83 89 00 30 lwz r28,48(r9) if ( !user_threads || maximum == 0 ) ffc092f8: 41 9e 00 64 beq- cr7,ffc0935c <_POSIX_Threads_Initialize_user_threads_body+0x98><== NEVER TAKEN ffc092fc: 2f 9c 00 00 cmpwi cr7,r28,0 ffc09300: 41 9e 00 5c beq- cr7,ffc0935c <_POSIX_Threads_Initialize_user_threads_body+0x98><== NEVER TAKEN ffc09304: 3b a0 00 00 li r29,0 ffc09308: 3b e1 00 0c addi r31,r1,12 ffc0930c: 3b 61 00 08 addi r27,r1,8 for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); ffc09310: 7f e3 fb 78 mr r3,r31 ffc09314: 48 00 81 15 bl ffc11428 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); ffc09318: 38 80 00 02 li r4,2 ffc0931c: 7f e3 fb 78 mr r3,r31 ffc09320: 48 00 81 49 bl ffc11468 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); ffc09324: 80 9e 00 04 lwz r4,4(r30) ffc09328: 7f e3 fb 78 mr r3,r31 ffc0932c: 48 00 81 71 bl ffc1149c status = pthread_create( ffc09330: 80 be 00 00 lwz r5,0(r30) ffc09334: 7f 63 db 78 mr r3,r27 ffc09338: 7f e4 fb 78 mr r4,r31 ffc0933c: 38 c0 00 00 li r6,0 ffc09340: 4b ff fb c1 bl ffc08f00 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) ffc09344: 7c 65 1b 79 mr. r5,r3 ffc09348: 40 82 00 38 bne- ffc09380 <_POSIX_Threads_Initialize_user_threads_body+0xbc> * * Setting the attributes explicitly is critical, since we don't want * to inherit the idle tasks attributes. */ for ( index=0 ; index < maximum ; index++ ) { ffc0934c: 3b bd 00 01 addi r29,r29,1 ffc09350: 7f 9c e8 40 cmplw cr7,r28,r29 ffc09354: 3b de 00 08 addi r30,r30,8 ffc09358: 41 9d ff b8 bgt+ cr7,ffc09310 <_POSIX_Threads_Initialize_user_threads_body+0x4c><== NEVER TAKEN NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); } } ffc0935c: 80 01 00 74 lwz r0,116(r1) ffc09360: 83 61 00 5c lwz r27,92(r1) ffc09364: 7c 08 03 a6 mtlr r0 ffc09368: 83 81 00 60 lwz r28,96(r1) ffc0936c: 83 a1 00 64 lwz r29,100(r1) ffc09370: 83 c1 00 68 lwz r30,104(r1) ffc09374: 83 e1 00 6c lwz r31,108(r1) ffc09378: 38 21 00 70 addi r1,r1,112 ffc0937c: 4e 80 00 20 blr &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); ffc09380: 38 60 00 02 li r3,2 ffc09384: 38 80 00 01 li r4,1 ffc09388: 48 00 2a 19 bl ffc0bda0 <_Internal_error_Occurred> =============================================================================== ffc0fb9c <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { ffc0fb9c: 94 21 ff f0 stwu r1,-16(r1) ffc0fba0: 7c 08 02 a6 mflr r0 ffc0fba4: 90 01 00 14 stw r0,20(r1) ffc0fba8: 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 ]; ffc0fbac: 83 e4 01 34 lwz r31,308(r4) */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { ffc0fbb0: 93 c1 00 08 stw r30,8(r1) ffc0fbb4: 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 ); ffc0fbb8: 38 7f 00 98 addi r3,r31,152 ffc0fbbc: 48 00 13 81 bl ffc10f3c <_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 ) { ffc0fbc0: 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); ffc0fbc4: 3d 20 00 00 lis r9,0 ffc0fbc8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0fbcc: 88 89 26 ec lbz r4,9964(r9) ffc0fbd0: 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; ffc0fbd4: 90 7e 00 78 stw r3,120(r30) ffc0fbd8: 7c 80 20 50 subf r4,r0,r4 new_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); the_thread->real_priority = new_priority; ffc0fbdc: 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 ) { ffc0fbe0: 40 9e 00 10 bne- cr7,ffc0fbf0 <_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 ) { ffc0fbe4: 80 1e 00 14 lwz r0,20(r30) ffc0fbe8: 7f 80 20 40 cmplw cr7,r0,r4 ffc0fbec: 41 9d 00 38 bgt- cr7,ffc0fc24 <_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 ); ffc0fbf0: 38 7f 00 90 addi r3,r31,144 ffc0fbf4: 48 00 13 49 bl ffc10f3c <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0fbf8: 38 9f 00 a8 addi r4,r31,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0fbfc: 90 7f 00 b4 stw r3,180(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0fc00: 3c 60 00 00 lis r3,0 ffc0fc04: 38 63 2d 28 addi r3,r3,11560 ffc0fc08: 4b ff d5 4d bl ffc0d154 <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } ffc0fc0c: 80 01 00 14 lwz r0,20(r1) ffc0fc10: 83 c1 00 08 lwz r30,8(r1) ffc0fc14: 7c 08 03 a6 mtlr r0 ffc0fc18: 83 e1 00 0c lwz r31,12(r1) ffc0fc1c: 38 21 00 10 addi r1,r1,16 ffc0fc20: 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 ); ffc0fc24: 7f c3 f3 78 mr r3,r30 ffc0fc28: 38 a0 00 01 li r5,1 ffc0fc2c: 4b ff b9 29 bl ffc0b554 <_Thread_Change_priority> #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); ffc0fc30: 38 7f 00 90 addi r3,r31,144 ffc0fc34: 48 00 13 09 bl ffc10f3c <_Timespec_To_ticks> ffc0fc38: 38 9f 00 a8 addi r4,r31,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0fc3c: 90 7f 00 b4 stw r3,180(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0fc40: 3c 60 00 00 lis r3,0 ffc0fc44: 38 63 2d 28 addi r3,r3,11560 ffc0fc48: 4b ff d5 0d bl ffc0d154 <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } ffc0fc4c: 80 01 00 14 lwz r0,20(r1) ffc0fc50: 83 c1 00 08 lwz r30,8(r1) ffc0fc54: 7c 08 03 a6 mtlr r0 ffc0fc58: 83 e1 00 0c lwz r31,12(r1) ffc0fc5c: 38 21 00 10 addi r1,r1,16 ffc0fc60: 4e 80 00 20 blr =============================================================================== ffc0fc64 <_POSIX_Threads_Sporadic_budget_callout>: * _POSIX_Threads_Sporadic_budget_callout */ void _POSIX_Threads_Sporadic_budget_callout( Thread_Control *the_thread ) { ffc0fc64: 7c 08 02 a6 mflr r0 ffc0fc68: 94 21 ff f8 stwu r1,-8(r1) ffc0fc6c: 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 ) { ffc0fc70: 80 03 00 1c lwz r0,28(r3) ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0fc74: 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 ) { ffc0fc78: 2f 80 00 00 cmpwi cr7,r0,0 ffc0fc7c: 80 0b 00 8c lwz r0,140(r11) ffc0fc80: 3d 60 00 00 lis r11,0 ffc0fc84: 88 8b 26 ec lbz r4,9964(r11) ffc0fc88: 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 */ ffc0fc8c: 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; ffc0fc90: 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 */ ffc0fc94: 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 ) { ffc0fc98: 40 9e 00 10 bne- cr7,ffc0fca8 <_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 ) { ffc0fc9c: 80 03 00 14 lwz r0,20(r3) ffc0fca0: 7f 80 20 40 cmplw cr7,r0,r4 ffc0fca4: 41 9c 00 14 blt- cr7,ffc0fcb8 <_POSIX_Threads_Sporadic_budget_callout+0x54><== ALWAYS TAKEN #if 0 printk( "lower priority\n" ); #endif } } } ffc0fca8: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc0fcac: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc0fcb0: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0fcb4: 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 ); ffc0fcb8: 38 a0 00 01 li r5,1 ffc0fcbc: 4b ff b8 99 bl ffc0b554 <_Thread_Change_priority> #if 0 printk( "lower priority\n" ); #endif } } } ffc0fcc0: 80 01 00 0c lwz r0,12(r1) ffc0fcc4: 38 21 00 08 addi r1,r1,8 ffc0fcc8: 7c 08 03 a6 mtlr r0 ffc0fccc: 4e 80 00 20 blr =============================================================================== ffc12900 <_POSIX_Threads_cancel_run>: #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { ffc12900: 94 21 ff e8 stwu r1,-24(r1) ffc12904: 7c 08 02 a6 mflr r0 ffc12908: 90 01 00 1c stw r0,28(r1) ffc1290c: 93 a1 00 0c stw r29,12(r1) ffc12910: 93 c1 00 10 stw r30,16(r1) ffc12914: 93 e1 00 14 stw r31,20(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 ]; ffc12918: 83 c3 01 34 lwz r30,308(r3) handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { ffc1291c: 80 1e 00 e4 lwz r0,228(r30) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc12920: 3b be 00 e8 addi r29,r30,232 ffc12924: 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; ffc12928: 38 00 00 01 li r0,1 ffc1292c: 90 1e 00 d8 stw r0,216(r30) while ( !_Chain_Is_empty( handler_stack ) ) { ffc12930: 41 9e 00 50 beq- cr7,ffc12980 <_POSIX_Threads_cancel_run+0x80> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc12934: 7c 00 00 a6 mfmsr r0 ffc12938: 7d 30 42 a6 mfsprg r9,0 ffc1293c: 7c 09 48 78 andc r9,r0,r9 ffc12940: 7d 20 01 24 mtmsr r9 _ISR_Disable( level ); handler = (POSIX_Cancel_Handler_control *) ffc12944: 83 fe 00 ec lwz r31,236(r30) ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc12948: 81 7f 00 00 lwz r11,0(r31) previous = the_node->previous; ffc1294c: 81 3f 00 04 lwz r9,4(r31) next->previous = previous; ffc12950: 91 2b 00 04 stw r9,4(r11) previous->next = next; ffc12954: 91 69 00 00 stw r11,0(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc12958: 7c 00 01 24 mtmsr r0 _Chain_Tail( handler_stack )->previous; _Chain_Extract_unprotected( &handler->Node ); _ISR_Enable( level ); (*handler->routine)( handler->arg ); ffc1295c: 80 1f 00 08 lwz r0,8(r31) ffc12960: 80 7f 00 0c lwz r3,12(r31) ffc12964: 7c 09 03 a6 mtctr r0 ffc12968: 4e 80 04 21 bctrl _Workspace_Free( handler ); ffc1296c: 7f e3 fb 78 mr r3,r31 ffc12970: 4b ff ac 25 bl ffc0d594 <_Workspace_Free> handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { ffc12974: 80 1e 00 e4 lwz r0,228(r30) ffc12978: 7f 80 e8 00 cmpw cr7,r0,r29 ffc1297c: 40 9e ff b8 bne+ cr7,ffc12934 <_POSIX_Threads_cancel_run+0x34><== NEVER TAKEN (*handler->routine)( handler->arg ); _Workspace_Free( handler ); } } ffc12980: 80 01 00 1c lwz r0,28(r1) ffc12984: 83 a1 00 0c lwz r29,12(r1) ffc12988: 7c 08 03 a6 mtlr r0 ffc1298c: 83 c1 00 10 lwz r30,16(r1) ffc12990: 83 e1 00 14 lwz r31,20(r1) ffc12994: 38 21 00 18 addi r1,r1,24 ffc12998: 4e 80 00 20 blr =============================================================================== ffc09050 <_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) { ffc09050: 94 21 ff f0 stwu r1,-16(r1) ffc09054: 7c 08 02 a6 mflr r0 ffc09058: 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 ) || ffc0905c: 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; ffc09060: 81 24 00 68 lwz r9,104(r4) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ffc09064: 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) { ffc09068: 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; ffc0906c: 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) { ffc09070: 7c 9f 23 78 mr r31,r4 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; ffc09074: 90 04 00 68 stw r0,104(r4) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ffc09078: 40 9e 00 40 bne- cr7,ffc090b8 <_POSIX_Timer_TSR+0x68> ffc0907c: 80 04 00 58 lwz r0,88(r4) ffc09080: 2f 80 00 00 cmpwi cr7,r0,0 ffc09084: 40 9e 00 34 bne- cr7,ffc090b8 <_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; ffc09088: 38 00 00 04 li r0,4 <== NOT EXECUTED ffc0908c: 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 ) ) { ffc09090: 80 7f 00 38 lwz r3,56(r31) ffc09094: 80 9f 00 44 lwz r4,68(r31) ffc09098: 48 00 79 45 bl ffc109dc } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; ffc0909c: 38 00 00 00 li r0,0 ffc090a0: 90 1f 00 68 stw r0,104(r31) } ffc090a4: 80 01 00 14 lwz r0,20(r1) ffc090a8: 83 e1 00 0c lwz r31,12(r1) ffc090ac: 38 21 00 10 addi r1,r1,16 ffc090b0: 7c 08 03 a6 mtlr r0 ffc090b4: 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( ffc090b8: 80 9f 00 64 lwz r4,100(r31) ffc090bc: 3c c0 ff c1 lis r6,-63 ffc090c0: 80 bf 00 08 lwz r5,8(r31) ffc090c4: 38 7f 00 10 addi r3,r31,16 ffc090c8: 38 c6 90 50 addi r6,r6,-28592 ffc090cc: 7f e7 fb 78 mr r7,r31 ffc090d0: 48 00 7f 21 bl ffc10ff0 <_POSIX_Timer_Insert_helper> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) ffc090d4: 2f 83 00 00 cmpwi cr7,r3,0 ffc090d8: 41 9e ff cc beq+ cr7,ffc090a4 <_POSIX_Timer_TSR+0x54> <== NEVER TAKEN return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); ffc090dc: 38 7f 00 6c addi r3,r31,108 ffc090e0: 48 00 1e 79 bl ffc0af58 <_TOD_Get> /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc090e4: 38 00 00 03 li r0,3 ffc090e8: 98 1f 00 3c stb r0,60(r31) ffc090ec: 4b ff ff a4 b ffc09090 <_POSIX_Timer_TSR+0x40> =============================================================================== ffc12a78 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc12a78: 94 21 ff 90 stwu r1,-112(r1) ffc12a7c: 7c 08 02 a6 mflr r0 ffc12a80: 7c a6 2b 78 mr r6,r5 ffc12a84: 93 c1 00 68 stw r30,104(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, ffc12a88: 3b c1 00 08 addi r30,r1,8 ffc12a8c: 7f c5 f3 78 mr r5,r30 ffc12a90: 38 e0 00 01 li r7,1 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc12a94: 93 a1 00 64 stw r29,100(r1) ffc12a98: 7c 9d 23 78 mr r29,r4 ffc12a9c: 93 e1 00 6c stw r31,108(r1) ffc12aa0: 7c 7f 1b 78 mr r31,r3 ffc12aa4: 90 01 00 74 stw r0,116(r1) ffc12aa8: 92 e1 00 4c stw r23,76(r1) ffc12aac: 93 01 00 50 stw r24,80(r1) ffc12ab0: 93 21 00 54 stw r25,84(r1) ffc12ab4: 93 41 00 58 stw r26,88(r1) ffc12ab8: 93 61 00 5c stw r27,92(r1) ffc12abc: 93 81 00 60 stw r28,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, ffc12ac0: 48 00 00 e1 bl ffc12ba0 <_POSIX_signals_Clear_signals> ffc12ac4: 2f 83 00 00 cmpwi cr7,r3,0 is_global, true ) ) return false; ffc12ac8: 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, ffc12acc: 41 9e 00 88 beq- cr7,ffc12b54 <_POSIX_signals_Check_signal+0xdc> #endif /* * Just to prevent sending a signal which is currently being ignored. */ if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN ) ffc12ad0: 1f 7d 00 0c mulli r27,r29,12 ffc12ad4: 3f 40 00 00 lis r26,0 ffc12ad8: 3b 5a 31 60 addi r26,r26,12640 ffc12adc: 7d 3a da 14 add r9,r26,r27 ffc12ae0: 83 89 00 08 lwz r28,8(r9) ffc12ae4: 2f 9c 00 01 cmpwi cr7,r28,1 ffc12ae8: 41 9e 00 6c beq- cr7,ffc12b54 <_POSIX_signals_Check_signal+0xdc><== NEVER TAKEN return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; ffc12aec: 83 3f 00 d0 lwz r25,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, ffc12af0: 3e e0 00 00 lis r23,0 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; ffc12af4: 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, ffc12af8: 3a f7 31 04 addi r23,r23,12548 ffc12afc: 80 97 00 0c lwz r4,12(r23) ffc12b00: 3b 01 00 14 addi r24,r1,20 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; ffc12b04: 7c 00 cb 78 or r0,r0,r25 ffc12b08: 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, ffc12b0c: 7f 03 c3 78 mr r3,r24 ffc12b10: 38 84 00 20 addi r4,r4,32 ffc12b14: 38 a0 00 28 li r5,40 ffc12b18: 48 00 15 7d bl ffc14094 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { ffc12b1c: 7c 1a d8 2e lwzx r0,r26,r27 ffc12b20: 2f 80 00 02 cmpwi cr7,r0,2 ffc12b24: 41 9e 00 64 beq- cr7,ffc12b88 <_POSIX_signals_Check_signal+0x110> &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); ffc12b28: 7f a3 eb 78 mr r3,r29 ffc12b2c: 7f 89 03 a6 mtctr r28 ffc12b30: 4c c6 31 82 crclr 4*cr1+eq ffc12b34: 4e 80 04 21 bctrl } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, ffc12b38: 80 77 00 0c lwz r3,12(r23) ffc12b3c: 7f 04 c3 78 mr r4,r24 ffc12b40: 38 a0 00 28 li r5,40 ffc12b44: 38 63 00 20 addi r3,r3,32 ffc12b48: 48 00 15 4d bl ffc14094 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; ffc12b4c: 93 3f 00 d0 stw r25,208(r31) return true; ffc12b50: 38 60 00 01 li r3,1 } ffc12b54: 80 01 00 74 lwz r0,116(r1) ffc12b58: 82 e1 00 4c lwz r23,76(r1) ffc12b5c: 7c 08 03 a6 mtlr r0 ffc12b60: 83 01 00 50 lwz r24,80(r1) ffc12b64: 83 21 00 54 lwz r25,84(r1) ffc12b68: 83 41 00 58 lwz r26,88(r1) ffc12b6c: 83 61 00 5c lwz r27,92(r1) ffc12b70: 83 81 00 60 lwz r28,96(r1) ffc12b74: 83 a1 00 64 lwz r29,100(r1) ffc12b78: 83 c1 00 68 lwz r30,104(r1) ffc12b7c: 83 e1 00 6c lwz r31,108(r1) ffc12b80: 38 21 00 70 addi r1,r1,112 ffc12b84: 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)( ffc12b88: 7f a3 eb 78 mr r3,r29 ffc12b8c: 7f 89 03 a6 mtctr r28 ffc12b90: 7f c4 f3 78 mr r4,r30 ffc12b94: 38 a0 00 00 li r5,0 ffc12b98: 4e 80 04 21 bctrl signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; ffc12b9c: 4b ff ff 9c b ffc12b38 <_POSIX_signals_Check_signal+0xc0> =============================================================================== ffc133c4 <_POSIX_signals_Clear_process_signals>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc133c4: 7d 60 00 a6 mfmsr r11 ffc133c8: 7c 10 42 a6 mfsprg r0,0 ffc133cc: 7d 60 00 78 andc r0,r11,r0 ffc133d0: 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 ) { ffc133d4: 3d 20 00 00 lis r9,0 ffc133d8: 1c 03 00 0c mulli r0,r3,12 ffc133dc: 39 29 31 60 addi r9,r9,12640 ffc133e0: 7d 29 00 2e lwzx r9,r9,r0 ffc133e4: 2f 89 00 02 cmpwi cr7,r9,2 ffc133e8: 41 9e 00 28 beq- cr7,ffc13410 <_POSIX_signals_Clear_process_signals+0x4c> if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; ffc133ec: 3d 20 00 00 lis r9,0 ffc133f0: 80 09 27 f4 lwz r0,10228(r9) ffc133f4: 39 40 ff fe li r10,-2 ffc133f8: 38 63 ff ff addi r3,r3,-1 ffc133fc: 5d 43 18 3e rotlw r3,r10,r3 ffc13400: 7c 63 00 38 and r3,r3,r0 ffc13404: 90 69 27 f4 stw r3,10228(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc13408: 7d 60 01 24 mtmsr r11 } _ISR_Enable( level ); } ffc1340c: 4e 80 00 20 blr ffc13410: 3d 20 00 00 lis r9,0 ffc13414: 39 29 33 54 addi r9,r9,13140 ffc13418: 7d 49 02 14 add r10,r9,r0 ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) ffc1341c: 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 ); ffc13420: 38 0a 00 04 addi r0,r10,4 ffc13424: 7f 89 00 00 cmpw cr7,r9,r0 ffc13428: 41 be ff c4 beq- cr7,ffc133ec <_POSIX_signals_Clear_process_signals+0x28><== ALWAYS TAKEN ffc1342c: 7d 60 01 24 mtmsr r11 <== NOT EXECUTED } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } ffc13430: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc09cf8 <_POSIX_signals_Get_lowest>: ffc09cf8: 38 00 00 05 li r0,5 ffc09cfc: 7c 09 03 a6 mtctr r0 sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc09d00: 39 20 00 1b li r9,27 ffc09d04: 39 60 00 01 li r11,1 #include #include #include #include int _POSIX_signals_Get_lowest( ffc09d08: 38 09 ff ff addi r0,r9,-1 ffc09d0c: 7d 60 00 30 slw r0,r11,r0 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { ffc09d10: 7c 0a 18 39 and. r10,r0,r3 ffc09d14: 40 82 00 38 bne- ffc09d4c <_POSIX_signals_Get_lowest+0x54><== NEVER TAKEN sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc09d18: 39 29 00 01 addi r9,r9,1 ffc09d1c: 42 00 ff ec bdnz+ ffc09d08 <_POSIX_signals_Get_lowest+0x10> ffc09d20: 38 00 00 1a li r0,26 ffc09d24: 39 20 00 01 li r9,1 ffc09d28: 7c 09 03 a6 mtctr r0 ffc09d2c: 39 60 00 01 li r11,1 ffc09d30: 48 00 00 0c b ffc09d3c <_POSIX_signals_Get_lowest+0x44> */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { ffc09d34: 39 29 00 01 addi r9,r9,1 ffc09d38: 42 40 00 14 bdz- ffc09d4c <_POSIX_signals_Get_lowest+0x54> #include #include #include #include int _POSIX_signals_Get_lowest( ffc09d3c: 38 09 ff ff addi r0,r9,-1 ffc09d40: 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 ) ) { ffc09d44: 7c 0a 18 39 and. r10,r0,r3 ffc09d48: 41 82 ff ec beq+ ffc09d34 <_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; } ffc09d4c: 7d 23 4b 78 mr r3,r9 ffc09d50: 4e 80 00 20 blr =============================================================================== ffc0f578 <_POSIX_signals_Post_switch_extension>: */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0f578: 94 21 ff e8 stwu r1,-24(r1) ffc0f57c: 7c 08 02 a6 mflr r0 ffc0f580: 90 01 00 1c stw r0,28(r1) ffc0f584: 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 ]; ffc0f588: 83 c3 01 34 lwz r30,308(r3) */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0f58c: 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 ) ffc0f590: 2f 9e 00 00 cmpwi cr7,r30,0 */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0f594: 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 ) ffc0f598: 41 9e 00 c4 beq- cr7,ffc0f65c <_POSIX_signals_Post_switch_extension+0xe4> ffc0f59c: 3f a0 00 00 lis r29,0 ffc0f5a0: 3b bd 27 f4 addi r29,r29,10228 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0f5a4: 7c 00 00 a6 mfmsr r0 ffc0f5a8: 7d 30 42 a6 mfsprg r9,0 ffc0f5ac: 7c 09 48 78 andc r9,r0,r9 ffc0f5b0: 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)) ) { ffc0f5b4: 81 5d 00 00 lwz r10,0(r29) ffc0f5b8: 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 & ffc0f5bc: 81 7e 00 d0 lwz r11,208(r30) (api->signals_pending | _POSIX_signals_Pending)) ) { ffc0f5c0: 7d 49 4b 78 or r9,r10,r9 * 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 & ffc0f5c4: 7d 2a 58 79 andc. r10,r9,r11 ffc0f5c8: 41 82 00 90 beq- ffc0f658 <_POSIX_signals_Post_switch_extension+0xe0> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0f5cc: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc0f5d0: 3b e0 00 1b li r31,27 _POSIX_signals_Check_signal( api, signo, false ); ffc0f5d4: 7f e4 fb 78 mr r4,r31 ffc0f5d8: 38 a0 00 00 li r5,0 ffc0f5dc: 7f c3 f3 78 mr r3,r30 ffc0f5e0: 48 00 34 99 bl ffc12a78 <_POSIX_signals_Check_signal> _POSIX_signals_Check_signal( api, signo, true ); ffc0f5e4: 7f e4 fb 78 mr r4,r31 ffc0f5e8: 7f c3 f3 78 mr r3,r30 ffc0f5ec: 38 a0 00 01 li r5,1 ffc0f5f0: 48 00 34 89 bl ffc12a78 <_POSIX_signals_Check_signal> _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc0f5f4: 2f 9f 00 1f cmpwi cr7,r31,31 ffc0f5f8: 3b ff 00 01 addi r31,r31,1 ffc0f5fc: 40 9e ff d8 bne+ cr7,ffc0f5d4 <_POSIX_signals_Post_switch_extension+0x5c> ffc0f600: 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 ); ffc0f604: 7f e4 fb 78 mr r4,r31 ffc0f608: 38 a0 00 00 li r5,0 ffc0f60c: 7f c3 f3 78 mr r3,r30 ffc0f610: 48 00 34 69 bl ffc12a78 <_POSIX_signals_Check_signal> _POSIX_signals_Check_signal( api, signo, true ); ffc0f614: 7f e4 fb 78 mr r4,r31 ffc0f618: 7f c3 f3 78 mr r3,r30 ffc0f61c: 38 a0 00 01 li r5,1 ffc0f620: 48 00 34 59 bl ffc12a78 <_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++ ) { ffc0f624: 2f 9f 00 1a cmpwi cr7,r31,26 ffc0f628: 3b ff 00 01 addi r31,r31,1 ffc0f62c: 40 9e ff d8 bne+ cr7,ffc0f604 <_POSIX_signals_Post_switch_extension+0x8c> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0f630: 7c 00 00 a6 mfmsr r0 ffc0f634: 7d 30 42 a6 mfsprg r9,0 ffc0f638: 7c 09 48 78 andc r9,r0,r9 ffc0f63c: 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)) ) { ffc0f640: 81 5d 00 00 lwz r10,0(r29) ffc0f644: 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 & ffc0f648: 81 7e 00 d0 lwz r11,208(r30) (api->signals_pending | _POSIX_signals_Pending)) ) { ffc0f64c: 7d 49 4b 78 or r9,r10,r9 * 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 & ffc0f650: 7d 2a 58 79 andc. r10,r9,r11 ffc0f654: 40 82 ff 78 bne+ ffc0f5cc <_POSIX_signals_Post_switch_extension+0x54><== NEVER TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0f658: 7c 00 01 24 mtmsr r0 for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { _POSIX_signals_Check_signal( api, signo, false ); _POSIX_signals_Check_signal( api, signo, true ); } } } ffc0f65c: 80 01 00 1c lwz r0,28(r1) ffc0f660: 83 a1 00 0c lwz r29,12(r1) ffc0f664: 7c 08 03 a6 mtlr r0 ffc0f668: 83 c1 00 10 lwz r30,16(r1) ffc0f66c: 83 e1 00 14 lwz r31,20(r1) ffc0f670: 38 21 00 18 addi r1,r1,24 ffc0f674: 4e 80 00 20 blr =============================================================================== ffc2a2f0 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc2a2f0: 94 21 ff f0 stwu r1,-16(r1) ffc2a2f4: 7c 08 02 a6 mflr r0 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc2a2f8: 3d 20 10 00 lis r9,4096 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc2a2fc: 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 ) ) { ffc2a300: 61 29 80 00 ori r9,r9,32768 ffc2a304: 80 03 00 10 lwz r0,16(r3) bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc2a308: 93 e1 00 0c stw r31,12(r1) ffc2a30c: 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 ) ) { ffc2a310: 7c 0b 48 38 and r11,r0,r9 ffc2a314: 7f 8b 48 00 cmpw cr7,r11,r9 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc2a318: 93 c1 00 08 stw r30,8(r1) ffc2a31c: 39 64 ff ff addi r11,r4,-1 ffc2a320: 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 ]; ffc2a324: 81 43 01 34 lwz r10,308(r3) ffc2a328: 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 ) ) { ffc2a32c: 41 9e 00 70 beq- cr7,ffc2a39c <_POSIX_signals_Unblock_thread+0xac> } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { ffc2a330: 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; ffc2a334: 3b c0 00 00 li r30,0 } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { ffc2a338: 7d 68 50 79 andc. r8,r11,r10 ffc2a33c: 41 82 00 44 beq- ffc2a380 <_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 ) ) { ffc2a340: 74 0b 10 00 andis. r11,r0,4096 ffc2a344: 41 82 00 b8 beq- ffc2a3fc <_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); ffc2a348: 3d 20 00 03 lis r9,3 ffc2a34c: 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) ) ffc2a350: 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; ffc2a354: 39 20 00 04 li r9,4 ffc2a358: 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) ) ffc2a35c: 40 82 00 e4 bne- ffc2a440 <_POSIX_signals_Unblock_thread+0x150> _Thread_queue_Extract_with_proxy( the_thread ); else if ( _States_Is_delaying(the_thread->current_state) ) { ffc2a360: 70 09 00 08 andi. r9,r0,8 ffc2a364: 41 a2 00 1c beq+ ffc2a380 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN (void) _Watchdog_Remove( &the_thread->Timer ); ffc2a368: 38 63 00 48 addi r3,r3,72 ffc2a36c: 4b fe a1 05 bl ffc14470 <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc2a370: 3c 80 10 03 lis r4,4099 ffc2a374: 7f e3 fb 78 mr r3,r31 ffc2a378: 60 84 ff f8 ori r4,r4,65528 ffc2a37c: 4b fe 85 29 bl ffc128a4 <_Thread_Clear_state> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc2a380: 80 01 00 14 lwz r0,20(r1) ffc2a384: 7f c3 f3 78 mr r3,r30 ffc2a388: 83 e1 00 0c lwz r31,12(r1) ffc2a38c: 7c 08 03 a6 mtlr r0 ffc2a390: 83 c1 00 08 lwz r30,8(r1) ffc2a394: 38 21 00 10 addi r1,r1,16 ffc2a398: 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) ) { ffc2a39c: 80 03 00 30 lwz r0,48(r3) ffc2a3a0: 7d 68 00 39 and. r8,r11,r0 ffc2a3a4: 41 82 00 88 beq- ffc2a42c <_POSIX_signals_Unblock_thread+0x13c> the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { ffc2a3a8: 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; ffc2a3ac: 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; ffc2a3b0: 38 00 00 04 li r0,4 ffc2a3b4: 90 1f 00 34 stw r0,52(r31) the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { ffc2a3b8: 41 9e 00 90 beq- cr7,ffc2a448 <_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; ffc2a3bc: 81 45 00 00 lwz r10,0(r5) ffc2a3c0: 81 65 00 04 lwz r11,4(r5) ffc2a3c4: 80 05 00 08 lwz r0,8(r5) ffc2a3c8: 91 49 00 00 stw r10,0(r9) ffc2a3cc: 91 69 00 04 stw r11,4(r9) ffc2a3d0: 90 09 00 08 stw r0,8(r9) } _Thread_queue_Extract_with_proxy( the_thread ); ffc2a3d4: 7f e3 fb 78 mr r3,r31 ffc2a3d8: 4b fe 92 d9 bl ffc136b0 <_Thread_queue_Extract_with_proxy> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc2a3dc: 80 01 00 14 lwz r0,20(r1) } else { *the_info = *info; } _Thread_queue_Extract_with_proxy( the_thread ); return true; ffc2a3e0: 3b c0 00 01 li r30,1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc2a3e4: 83 e1 00 0c lwz r31,12(r1) ffc2a3e8: 7c 08 03 a6 mtlr r0 ffc2a3ec: 7f c3 f3 78 mr r3,r30 ffc2a3f0: 83 c1 00 08 lwz r30,8(r1) ffc2a3f4: 38 21 00 10 addi r1,r1,16 ffc2a3f8: 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 ) { ffc2a3fc: 2f 80 00 00 cmpwi cr7,r0,0 ffc2a400: 40 be ff 80 bne- cr7,ffc2a380 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc2a404: 3d 60 00 00 lis r11,0 ffc2a408: 39 6b 32 84 addi r11,r11,12932 ffc2a40c: 80 0b 00 08 lwz r0,8(r11) ffc2a410: 2f 80 00 00 cmpwi cr7,r0,0 ffc2a414: 41 be ff 6c beq- cr7,ffc2a380 <_POSIX_signals_Unblock_thread+0x90> ffc2a418: 80 0b 00 0c lwz r0,12(r11) ffc2a41c: 7f 83 00 00 cmpw cr7,r3,r0 ffc2a420: 40 9e ff 60 bne+ cr7,ffc2a380 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc2a424: 99 2b 00 18 stb r9,24(r11) ffc2a428: 4b ff ff 58 b ffc2a380 <_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) ) { ffc2a42c: 80 0a 00 d0 lwz r0,208(r10) /* * This should only be reached via pthread_kill(). */ return false; ffc2a430: 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) ) { ffc2a434: 7d 69 00 79 andc. r9,r11,r0 ffc2a438: 40 82 ff 70 bne+ ffc2a3a8 <_POSIX_signals_Unblock_thread+0xb8> ffc2a43c: 4b ff ff 44 b ffc2a380 <_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 ); ffc2a440: 4b fe 92 71 bl ffc136b0 <_Thread_queue_Extract_with_proxy> ffc2a444: 4b ff ff 3c b ffc2a380 <_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; ffc2a448: 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; ffc2a44c: 90 89 00 00 stw r4,0(r9) the_info->si_code = SI_USER; ffc2a450: 90 09 00 04 stw r0,4(r9) the_info->si_value.sival_int = 0; ffc2a454: 90 a9 00 08 stw r5,8(r9) ffc2a458: 4b ff ff 7c b ffc2a3d4 <_POSIX_signals_Unblock_thread+0xe4> =============================================================================== ffc09218 <_RTEMS_tasks_Initialize_user_tasks_body>: * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc09218: 94 21 ff d8 stwu r1,-40(r1) ffc0921c: 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; ffc09220: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc09224: 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; ffc09228: 39 29 20 70 addi r9,r9,8304 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc0922c: 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; ffc09230: 83 e9 00 2c lwz r31,44(r9) * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc09234: 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 ) ffc09238: 2f 9f 00 00 cmpwi cr7,r31,0 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc0923c: 93 81 00 18 stw r28,24(r1) ffc09240: 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; ffc09244: 83 a9 00 28 lwz r29,40(r9) /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) ffc09248: 41 9e 00 60 beq- cr7,ffc092a8 <_RTEMS_tasks_Initialize_user_tasks_body+0x90> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { ffc0924c: 2f 9d 00 00 cmpwi cr7,r29,0 ffc09250: 41 9e 00 58 beq- cr7,ffc092a8 <_RTEMS_tasks_Initialize_user_tasks_body+0x90><== NEVER TAKEN ffc09254: 3b c0 00 00 li r30,0 ffc09258: 3b 81 00 08 addi r28,r1,8 return_value = rtems_task_create( ffc0925c: 80 bf 00 04 lwz r5,4(r31) ffc09260: 7f 88 e3 78 mr r8,r28 ffc09264: 80 7f 00 00 lwz r3,0(r31) ffc09268: 80 9f 00 08 lwz r4,8(r31) ffc0926c: 80 df 00 14 lwz r6,20(r31) ffc09270: 80 ff 00 0c lwz r7,12(r31) ffc09274: 4b ff fc b1 bl ffc08f24 user_tasks[ index ].stack_size, user_tasks[ index ].mode_set, user_tasks[ index ].attribute_set, &id ); if ( !rtems_is_status_successful( return_value ) ) ffc09278: 7c 65 1b 79 mr. r5,r3 ffc0927c: 40 82 00 4c bne- ffc092c8 <_RTEMS_tasks_Initialize_user_tasks_body+0xb0> _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); return_value = rtems_task_start( ffc09280: 80 bf 00 18 lwz r5,24(r31) ffc09284: 80 61 00 08 lwz r3,8(r1) ffc09288: 80 9f 00 10 lwz r4,16(r31) ffc0928c: 48 00 00 49 bl ffc092d4 id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) ffc09290: 7c 65 1b 79 mr. r5,r3 ffc09294: 40 82 00 34 bne- ffc092c8 <_RTEMS_tasks_Initialize_user_tasks_body+0xb0> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { ffc09298: 3b de 00 01 addi r30,r30,1 ffc0929c: 7f 9d f0 40 cmplw cr7,r29,r30 ffc092a0: 3b ff 00 1c addi r31,r31,28 ffc092a4: 41 9d ff b8 bgt+ cr7,ffc0925c <_RTEMS_tasks_Initialize_user_tasks_body+0x44><== NEVER TAKEN user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); } } ffc092a8: 80 01 00 2c lwz r0,44(r1) ffc092ac: 83 81 00 18 lwz r28,24(r1) ffc092b0: 7c 08 03 a6 mtlr r0 ffc092b4: 83 a1 00 1c lwz r29,28(r1) ffc092b8: 83 c1 00 20 lwz r30,32(r1) ffc092bc: 83 e1 00 24 lwz r31,36(r1) ffc092c0: 38 21 00 28 addi r1,r1,40 ffc092c4: 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 ); ffc092c8: 38 60 00 01 li r3,1 ffc092cc: 38 80 00 01 li r4,1 ffc092d0: 48 00 13 c9 bl ffc0a698 <_Internal_error_Occurred> =============================================================================== ffc10050 <_RTEMS_tasks_Switch_extension>: /* * Per Task Variables */ tvp = executing->task_variables; ffc10050: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc10054: 2f 89 00 00 cmpwi cr7,r9,0 ffc10058: 41 9e 00 24 beq- cr7,ffc1007c <_RTEMS_tasks_Switch_extension+0x2c> tvp->tval = *tvp->ptr; ffc1005c: 81 69 00 04 lwz r11,4(r9) *tvp->ptr = tvp->gval; ffc10060: 80 09 00 08 lwz r0,8(r9) * Per Task Variables */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; ffc10064: 81 4b 00 00 lwz r10,0(r11) ffc10068: 91 49 00 0c stw r10,12(r9) *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; ffc1006c: 81 29 00 00 lwz r9,0(r9) */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; ffc10070: 90 0b 00 00 stw r0,0(r11) /* * Per Task Variables */ tvp = executing->task_variables; while (tvp) { ffc10074: 2f 89 00 00 cmpwi cr7,r9,0 ffc10078: 40 9e ff e4 bne+ cr7,ffc1005c <_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; ffc1007c: 81 24 01 3c lwz r9,316(r4) while (tvp) { ffc10080: 2f 89 00 00 cmpwi cr7,r9,0 ffc10084: 4d 9e 00 20 beqlr cr7 tvp->gval = *tvp->ptr; ffc10088: 81 69 00 04 lwz r11,4(r9) *tvp->ptr = tvp->tval; ffc1008c: 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; ffc10090: 81 4b 00 00 lwz r10,0(r11) ffc10094: 91 49 00 08 stw r10,8(r9) *tvp->ptr = tvp->tval; tvp = (rtems_task_variable_t *)tvp->next; ffc10098: 81 29 00 00 lwz r9,0(r9) } tvp = heir->task_variables; while (tvp) { tvp->gval = *tvp->ptr; *tvp->ptr = tvp->tval; ffc1009c: 90 0b 00 00 stw r0,0(r11) *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { ffc100a0: 2f 89 00 00 cmpwi cr7,r9,0 ffc100a4: 40 9e ff e4 bne+ cr7,ffc10088 <_RTEMS_tasks_Switch_extension+0x38><== NEVER TAKEN ffc100a8: 4e 80 00 20 blr =============================================================================== ffc0a7ec <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { ffc0a7ec: 94 21 ff e0 stwu r1,-32(r1) ffc0a7f0: 7c 08 02 a6 mflr r0 ffc0a7f4: 7c 64 1b 78 mr r4,r3 ffc0a7f8: 3c 60 00 00 lis r3,0 ffc0a7fc: 90 01 00 24 stw r0,36(r1) ffc0a800: 38 63 2c 58 addi r3,r3,11352 ffc0a804: 38 a1 00 08 addi r5,r1,8 ffc0a808: 93 e1 00 1c stw r31,28(r1) ffc0a80c: 48 00 28 5d bl ffc0d068 <_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 ) { ffc0a810: 80 01 00 08 lwz r0,8(r1) ffc0a814: 7c 7f 1b 78 mr r31,r3 ffc0a818: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a81c: 40 9e 00 48 bne- cr7,ffc0a864 <_Rate_monotonic_Timeout+0x78><== NEVER TAKEN case OBJECTS_LOCAL: the_thread = the_period->owner; ffc0a820: 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); ffc0a824: 80 03 00 10 lwz r0,16(r3) if ( _States_Is_waiting_for_period( the_thread->current_state ) && ffc0a828: 70 09 40 00 andi. r9,r0,16384 ffc0a82c: 41 82 00 14 beq- ffc0a840 <_Rate_monotonic_Timeout+0x54> ffc0a830: 81 23 00 20 lwz r9,32(r3) ffc0a834: 80 1f 00 08 lwz r0,8(r31) ffc0a838: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a83c: 41 9e 00 68 beq- cr7,ffc0a8a4 <_Rate_monotonic_Timeout+0xb8> _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 ) { ffc0a840: 80 1f 00 38 lwz r0,56(r31) ffc0a844: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a848: 41 9e 00 30 beq- cr7,ffc0a878 <_Rate_monotonic_Timeout+0x8c> _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; ffc0a84c: 38 00 00 04 li r0,4 ffc0a850: 90 1f 00 38 stw r0,56(r31) */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc0a854: 3d 20 00 00 lis r9,0 ffc0a858: 81 69 28 2c lwz r11,10284(r9) ffc0a85c: 38 0b ff ff addi r0,r11,-1 ffc0a860: 90 09 28 2c stw r0,10284(r9) case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } ffc0a864: 80 01 00 24 lwz r0,36(r1) ffc0a868: 83 e1 00 1c lwz r31,28(r1) ffc0a86c: 38 21 00 20 addi r1,r1,32 ffc0a870: 7c 08 03 a6 mtlr r0 ffc0a874: 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; ffc0a878: 38 00 00 03 li r0,3 ffc0a87c: 90 1f 00 38 stw r0,56(r31) _Rate_monotonic_Initiate_statistics( the_period ); ffc0a880: 7f e3 fb 78 mr r3,r31 ffc0a884: 4b ff f7 55 bl ffc09fd8 <_Rate_monotonic_Initiate_statistics> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a888: 80 1f 00 3c lwz r0,60(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a88c: 3c 60 00 00 lis r3,0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a890: 90 1f 00 1c stw r0,28(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a894: 38 63 2e 48 addi r3,r3,11848 ffc0a898: 38 9f 00 10 addi r4,r31,16 ffc0a89c: 48 00 4d 39 bl ffc0f5d4 <_Watchdog_Insert> ffc0a8a0: 4b ff ff b4 b ffc0a854 <_Rate_monotonic_Timeout+0x68> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc0a8a4: 3c 80 10 03 lis r4,4099 ffc0a8a8: 60 84 ff f8 ori r4,r4,65528 ffc0a8ac: 48 00 32 09 bl ffc0dab4 <_Thread_Clear_state> ffc0a8b0: 4b ff ff d0 b ffc0a880 <_Rate_monotonic_Timeout+0x94> =============================================================================== ffc10a70 <_Scheduler_priority_Block>: RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_extract( Thread_Control *the_thread ) { Chain_Control *ready = the_thread->scheduler.priority->ready_chain; ffc10a70: 81 24 00 8c lwz r9,140(r4) ffc10a74: 81 29 00 00 lwz r9,0(r9) if ( _Chain_Has_only_one_node( ready ) ) { ffc10a78: 81 69 00 00 lwz r11,0(r9) ffc10a7c: 80 09 00 08 lwz r0,8(r9) ffc10a80: 7f 8b 00 00 cmpw cr7,r11,r0 ffc10a84: 41 9e 00 a8 beq- cr7,ffc10b2c <_Scheduler_priority_Block+0xbc> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc10a88: 81 64 00 00 lwz r11,0(r4) previous = the_node->previous; ffc10a8c: 81 24 00 04 lwz r9,4(r4) next->previous = previous; ffc10a90: 91 2b 00 04 stw r9,4(r11) previous->next = next; ffc10a94: 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 ); ffc10a98: 3d 20 00 00 lis r9,0 ffc10a9c: 39 29 31 04 addi r9,r9,12548 { _Scheduler_priority_Ready_queue_extract(the_thread); /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) ffc10aa0: 80 09 00 10 lwz r0,16(r9) ffc10aa4: 7f 84 00 00 cmpw cr7,r4,r0 ffc10aa8: 41 9e 00 1c beq- cr7,ffc10ac4 <_Scheduler_priority_Block+0x54> _Scheduler_priority_Schedule_body(the_scheduler); if ( _Thread_Is_executing( the_thread ) ) ffc10aac: 80 09 00 0c lwz r0,12(r9) ffc10ab0: 7f 84 00 00 cmpw cr7,r4,r0 ffc10ab4: 4c be 00 20 bnelr+ cr7 _Thread_Dispatch_necessary = true; ffc10ab8: 38 00 00 01 li r0,1 ffc10abc: 98 09 00 18 stb r0,24(r9) ffc10ac0: 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 ); ffc10ac4: 3c a0 00 00 lis r5,0 Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { _Scheduler_priority_Block_body(the_scheduler, the_thread); } ffc10ac8: 81 43 00 00 lwz r10,0(r3) ffc10acc: 81 65 27 f0 lwz r11,10224(r5) ffc10ad0: 7d 66 00 34 cntlzw r6,r11 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc10ad4: 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 ); ffc10ad8: 91 65 27 f0 stw r11,10224(r5) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc10adc: 38 e7 31 20 addi r7,r7,12576 ffc10ae0: 54 c8 10 3a rlwinm r8,r6,2,0,29 ffc10ae4: 7c 07 40 2e lwzx r0,r7,r8 ffc10ae8: 7c 0b 00 34 cntlzw r11,r0 return (_Priority_Bits_index( major ) << 4) + ffc10aec: 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 ); ffc10af0: 7c 07 41 2e stwx r0,r7,r8 return (_Priority_Bits_index( major ) << 4) + ffc10af4: 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 ] ) ) ffc10af8: 1d 6b 00 0c mulli r11,r11,12 ffc10afc: 7d 0a 5a 14 add r8,r10,r11 ffc10b00: 7d 6a 58 2e lwzx r11,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 ); ffc10b04: 38 08 00 04 addi r0,r8,4 ffc10b08: 7f 8b 00 00 cmpw cr7,r11,r0 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; ffc10b0c: 38 00 00 00 li r0,0 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) ffc10b10: 41 9e 00 08 beq- cr7,ffc10b18 <_Scheduler_priority_Block+0xa8><== NEVER TAKEN return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); ffc10b14: 7d 60 5b 78 mr r0,r11 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc10b18: 90 09 00 10 stw r0,16(r9) /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(the_scheduler); if ( _Thread_Is_executing( the_thread ) ) ffc10b1c: 80 09 00 0c lwz r0,12(r9) ffc10b20: 7f 84 00 00 cmpw cr7,r4,r0 ffc10b24: 4c be 00 20 bnelr+ cr7 ffc10b28: 4b ff ff 90 b ffc10ab8 <_Scheduler_priority_Block+0x48> 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 ); ffc10b2c: 38 09 00 04 addi r0,r9,4 head->next = tail; head->previous = NULL; tail->previous = head; ffc10b30: 91 29 00 08 stw r9,8(r9) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc10b34: 90 09 00 00 stw r0,0(r9) head->previous = NULL; ffc10b38: 38 00 00 00 li r0,0 ffc10b3c: 90 09 00 04 stw r0,4(r9) { Chain_Control *ready = the_thread->scheduler.priority->ready_chain; if ( _Chain_Has_only_one_node( ready ) ) { _Chain_Initialize_empty( ready ); _Priority_bit_map_Remove( &the_thread->scheduler.priority->Priority_map ); ffc10b40: 81 24 00 8c lwz r9,140(r4) RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; ffc10b44: 81 69 00 04 lwz r11,4(r9) ffc10b48: 80 09 00 14 lwz r0,20(r9) ffc10b4c: 81 4b 00 00 lwz r10,0(r11) ffc10b50: 7d 40 00 38 and r0,r10,r0 if ( *the_priority_map->minor == 0 ) ffc10b54: 2f 80 00 00 cmpwi cr7,r0,0 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; ffc10b58: 90 0b 00 00 stw r0,0(r11) if ( *the_priority_map->minor == 0 ) ffc10b5c: 40 be ff 3c bne- cr7,ffc10a98 <_Scheduler_priority_Block+0x28> _Priority_Major_bit_map &= the_priority_map->block_major; ffc10b60: 3d 60 00 00 lis r11,0 ffc10b64: 80 09 00 10 lwz r0,16(r9) ffc10b68: 81 4b 27 f0 lwz r10,10224(r11) ffc10b6c: 7d 40 00 38 and r0,r10,r0 ffc10b70: 90 0b 27 f0 stw r0,10224(r11) ffc10b74: 4b ff ff 24 b ffc10a98 <_Scheduler_priority_Block+0x28> =============================================================================== ffc0b29c <_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 ); ffc0b29c: 3d 20 00 00 lis r9,0 void _Scheduler_priority_Schedule( Scheduler_Control *the_scheduler ) { _Scheduler_priority_Schedule_body( the_scheduler ); } ffc0b2a0: 81 63 00 00 lwz r11,0(r3) ffc0b2a4: 80 09 27 f0 lwz r0,10224(r9) ffc0b2a8: 7c 07 00 34 cntlzw r7,r0 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b2ac: 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 ); ffc0b2b0: 90 09 27 f0 stw r0,10224(r9) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b2b4: 39 08 31 20 addi r8,r8,12576 ffc0b2b8: 54 ea 10 3a rlwinm r10,r7,2,0,29 ffc0b2bc: 7c c8 50 2e lwzx r6,r8,r10 ffc0b2c0: 7c c0 33 78 mr r0,r6 ffc0b2c4: 7c 06 00 34 cntlzw r6,r0 return (_Priority_Bits_index( major ) << 4) + ffc0b2c8: 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 ); ffc0b2cc: 7c 08 51 2e stwx r0,r8,r10 return (_Priority_Bits_index( major ) << 4) + ffc0b2d0: 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 ] ) ) ffc0b2d4: 1d 29 00 0c mulli r9,r9,12 ffc0b2d8: 7d 4b 4a 14 add r10,r11,r9 ffc0b2dc: 7d 2b 48 2e lwzx r9,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 ); ffc0b2e0: 38 0a 00 04 addi r0,r10,4 ffc0b2e4: 7f 89 00 00 cmpw cr7,r9,r0 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; ffc0b2e8: 38 00 00 00 li r0,0 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) ffc0b2ec: 41 9e 00 08 beq- cr7,ffc0b2f4 <_Scheduler_priority_Schedule+0x58><== NEVER TAKEN return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); ffc0b2f0: 7d 20 4b 78 mr r0,r9 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0b2f4: 3d 20 00 00 lis r9,0 ffc0b2f8: 90 09 31 14 stw r0,12564(r9) ffc0b2fc: 4e 80 00 20 blr =============================================================================== ffc0b450 <_Scheduler_priority_Yield>: { ISR_Level level; Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; ffc0b450: 3d 40 00 00 lis r10,0 ffc0b454: 39 4a 31 04 addi r10,r10,12548 ffc0b458: 81 2a 00 0c lwz r9,12(r10) ready = executing->scheduler.priority->ready_chain; ffc0b45c: 81 69 00 8c lwz r11,140(r9) ffc0b460: 81 6b 00 00 lwz r11,0(r11) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0b464: 7c 00 00 a6 mfmsr r0 ffc0b468: 7d 10 42 a6 mfsprg r8,0 ffc0b46c: 7c 08 40 78 andc r8,r0,r8 ffc0b470: 7d 00 01 24 mtmsr r8 _ISR_Disable( level ); if ( !_Chain_Has_only_one_node( ready ) ) { ffc0b474: 80 eb 00 00 lwz r7,0(r11) ffc0b478: 81 0b 00 08 lwz r8,8(r11) ffc0b47c: 7f 87 40 00 cmpw cr7,r7,r8 ffc0b480: 41 9e 00 60 beq- cr7,ffc0b4e0 <_Scheduler_priority_Yield+0x90> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc0b484: 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 ); ffc0b488: 38 ab 00 04 addi r5,r11,4 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; ffc0b48c: 80 e9 00 04 lwz r7,4(r9) next->previous = previous; ffc0b490: 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; ffc0b494: 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; ffc0b498: 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; ffc0b49c: 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; ffc0b4a0: 90 a9 00 00 stw r5,0(r9) tail->previous = the_node; old_last->next = the_node; the_node->previous = old_last; ffc0b4a4: 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; ffc0b4a8: 91 28 00 00 stw r9,0(r8) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; asm volatile ( ffc0b4ac: 7d 00 00 a6 mfmsr r8 ffc0b4b0: 7c 00 01 24 mtmsr r0 ffc0b4b4: 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 ) ) ffc0b4b8: 81 0a 00 10 lwz r8,16(r10) ffc0b4bc: 7f 89 40 00 cmpw cr7,r9,r8 ffc0b4c0: 41 9e 00 14 beq- cr7,ffc0b4d4 <_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; ffc0b4c4: 39 20 00 01 li r9,1 ffc0b4c8: 99 2a 00 18 stb r9,24(r10) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0b4cc: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); } ffc0b4d0: 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 ); ffc0b4d4: 81 2b 00 00 lwz r9,0(r11) ffc0b4d8: 91 2a 00 10 stw r9,16(r10) ffc0b4dc: 4b ff ff e8 b ffc0b4c4 <_Scheduler_priority_Yield+0x74> _Thread_Dispatch_necessary = true; } else if ( !_Thread_Is_heir( executing ) ) ffc0b4e0: 81 6a 00 10 lwz r11,16(r10) ffc0b4e4: 7f 89 58 00 cmpw cr7,r9,r11 ffc0b4e8: 40 9e ff dc bne+ cr7,ffc0b4c4 <_Scheduler_priority_Yield+0x74> ffc0b4ec: 4b ff ff e0 b ffc0b4cc <_Scheduler_priority_Yield+0x7c> =============================================================================== ffc0b554 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { ffc0b554: 94 21 ff e8 stwu r1,-24(r1) ffc0b558: 7c 08 02 a6 mflr r0 ffc0b55c: 90 01 00 1c stw r0,28(r1) ffc0b560: 93 e1 00 14 stw r31,20(r1) ffc0b564: 7c 7f 1b 78 mr r31,r3 ffc0b568: 93 81 00 08 stw r28,8(r1) ffc0b56c: 7c bc 2b 78 mr r28,r5 ffc0b570: 93 a1 00 0c stw r29,12(r1) ffc0b574: 93 c1 00 10 stw r30,16(r1) ffc0b578: 7c 9e 23 78 mr r30,r4 */ /* * Save original state */ original_state = the_thread->current_state; ffc0b57c: 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 ); ffc0b580: 48 00 12 a1 bl ffc0c820 <_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 ) ffc0b584: 80 1f 00 14 lwz r0,20(r31) ffc0b588: 7f 80 f0 00 cmpw cr7,r0,r30 ffc0b58c: 41 9e 00 10 beq- cr7,ffc0b59c <_Thread_Change_priority+0x48> _Thread_Set_priority( the_thread, new_priority ); ffc0b590: 7f e3 fb 78 mr r3,r31 ffc0b594: 7f c4 f3 78 mr r4,r30 ffc0b598: 48 00 11 c1 bl ffc0c758 <_Thread_Set_priority> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0b59c: 7f c0 00 a6 mfmsr r30 ffc0b5a0: 7c 10 42 a6 mfsprg r0,0 ffc0b5a4: 7f c0 00 78 andc r0,r30,r0 ffc0b5a8: 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; ffc0b5ac: 80 1f 00 10 lwz r0,16(r31) if ( state != STATES_TRANSIENT ) { ffc0b5b0: 2f 80 00 04 cmpwi cr7,r0,4 ffc0b5b4: 41 9e 00 88 beq- cr7,ffc0b63c <_Thread_Change_priority+0xe8> /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) ffc0b5b8: 73 a9 00 04 andi. r9,r29,4 ffc0b5bc: 41 82 00 38 beq- ffc0b5f4 <_Thread_Change_priority+0xa0><== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0b5c0: 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); ffc0b5c4: 3d 20 00 03 lis r9,3 <== NOT EXECUTED ffc0b5c8: 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 ) ) { ffc0b5cc: 7c 0b 48 39 and. r11,r0,r9 <== NOT EXECUTED ffc0b5d0: 40 82 00 40 bne- ffc0b610 <_Thread_Change_priority+0xbc><== NOT EXECUTED if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; _ISR_Enable( level ); } ffc0b5d4: 80 01 00 1c lwz r0,28(r1) ffc0b5d8: 83 81 00 08 lwz r28,8(r1) ffc0b5dc: 7c 08 03 a6 mtlr r0 ffc0b5e0: 83 a1 00 0c lwz r29,12(r1) ffc0b5e4: 83 c1 00 10 lwz r30,16(r1) ffc0b5e8: 83 e1 00 14 lwz r31,20(r1) ffc0b5ec: 38 21 00 18 addi r1,r1,24 ffc0b5f0: 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); ffc0b5f4: 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 ); ffc0b5f8: 91 3f 00 10 stw r9,16(r31) ffc0b5fc: 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); ffc0b600: 3d 20 00 03 lis r9,3 ffc0b604: 61 29 be e0 ori r9,r9,48864 _ISR_Enable( level ); if ( _States_Is_waiting_on_thread_queue( state ) ) { ffc0b608: 7c 0b 48 39 and. r11,r0,r9 ffc0b60c: 41 82 ff c8 beq+ ffc0b5d4 <_Thread_Change_priority+0x80> _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); ffc0b610: 80 7f 00 44 lwz r3,68(r31) ffc0b614: 7f e4 fb 78 mr r4,r31 ffc0b618: 48 00 10 49 bl ffc0c660 <_Thread_queue_Requeue> if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; _ISR_Enable( level ); } 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 } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { ffc0b63c: 73 bd 00 04 andi. r29,r29,4 ffc0b640: 40 82 00 58 bne- ffc0b698 <_Thread_Change_priority+0x144><== NEVER TAKEN * FIXME: hard-coded for priority scheduling. Might be ok since this * function is specific to priority scheduling? */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); if ( prepend_it ) ffc0b644: 2f 9c 00 00 cmpwi cr7,r28,0 * Ready Queue with interrupts off. * * FIXME: hard-coded for priority scheduling. Might be ok since this * function is specific to priority scheduling? */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); ffc0b648: 93 bf 00 10 stw r29,16(r31) if ( prepend_it ) ffc0b64c: 41 9e 00 bc beq- cr7,ffc0b708 <_Thread_Change_priority+0x1b4> RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_enqueue_first( Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); ffc0b650: 81 3f 00 8c lwz r9,140(r31) ffc0b654: 3d 40 00 00 lis r10,0 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; ffc0b658: 81 69 00 04 lwz r11,4(r9) ffc0b65c: 80 09 00 0c lwz r0,12(r9) ffc0b660: 81 0b 00 00 lwz r8,0(r11) ffc0b664: 7d 00 03 78 or r0,r8,r0 ffc0b668: 90 0b 00 00 stw r0,0(r11) _Chain_Prepend_unprotected( the_thread->scheduler.priority->ready_chain, ffc0b66c: 81 7f 00 8c lwz r11,140(r31) _Priority_Major_bit_map |= the_priority_map->ready_major; ffc0b670: 80 09 00 08 lwz r0,8(r9) ffc0b674: 81 2b 00 00 lwz r9,0(r11) ffc0b678: 81 0a 27 f0 lwz r8,10224(r10) ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0b67c: 81 69 00 00 lwz r11,0(r9) ffc0b680: 7d 00 03 78 or r0,r8,r0 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0b684: 91 3f 00 04 stw r9,4(r31) ffc0b688: 90 0a 27 f0 stw r0,10224(r10) before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; before_node->previous = the_node; ffc0b68c: 93 eb 00 04 stw r31,4(r11) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; ffc0b690: 93 e9 00 00 stw r31,0(r9) the_node->next = before_node; ffc0b694: 91 7f 00 00 stw r11,0(r31) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; asm volatile ( ffc0b698: 7c 00 00 a6 mfmsr r0 ffc0b69c: 7f c0 01 24 mtmsr r30 ffc0b6a0: 7c 00 01 24 mtmsr r0 */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( Scheduler_Control *the_scheduler ) { the_scheduler->Operations.schedule( the_scheduler ); ffc0b6a4: 3c 60 00 00 lis r3,0 ffc0b6a8: 38 63 2c e0 addi r3,r3,11488 ffc0b6ac: 80 03 00 04 lwz r0,4(r3) ffc0b6b0: 7c 09 03 a6 mtctr r0 ffc0b6b4: 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 ); ffc0b6b8: 3d 20 00 00 lis r9,0 ffc0b6bc: 39 29 31 04 addi r9,r9,12548 ffc0b6c0: 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(&_Scheduler); if ( !_Thread_Is_executing_also_the_heir() && ffc0b6c4: 80 09 00 10 lwz r0,16(r9) ffc0b6c8: 7f 8b 00 00 cmpw cr7,r11,r0 ffc0b6cc: 41 9e 00 18 beq- cr7,ffc0b6e4 <_Thread_Change_priority+0x190> ffc0b6d0: 88 0b 00 74 lbz r0,116(r11) ffc0b6d4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b6d8: 41 9e 00 0c beq- cr7,ffc0b6e4 <_Thread_Change_priority+0x190> _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; ffc0b6dc: 38 00 00 01 li r0,1 ffc0b6e0: 98 09 00 18 stb r0,24(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0b6e4: 7f c0 01 24 mtmsr r30 _ISR_Enable( level ); } ffc0b6e8: 80 01 00 1c lwz r0,28(r1) ffc0b6ec: 83 81 00 08 lwz r28,8(r1) ffc0b6f0: 7c 08 03 a6 mtlr r0 ffc0b6f4: 83 a1 00 0c lwz r29,12(r1) ffc0b6f8: 83 c1 00 10 lwz r30,16(r1) ffc0b6fc: 83 e1 00 14 lwz r31,20(r1) ffc0b700: 38 21 00 18 addi r1,r1,24 ffc0b704: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_enqueue( Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); ffc0b708: 81 3f 00 8c lwz r9,140(r31) ffc0b70c: 3d 40 00 00 lis r10,0 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; ffc0b710: 81 69 00 04 lwz r11,4(r9) ffc0b714: 80 09 00 0c lwz r0,12(r9) ffc0b718: 81 0b 00 00 lwz r8,0(r11) ffc0b71c: 7d 00 03 78 or r0,r8,r0 ffc0b720: 90 0b 00 00 stw r0,0(r11) _Chain_Append_unprotected( the_thread->scheduler.priority->ready_chain, ffc0b724: 81 7f 00 8c lwz r11,140(r31) _Priority_Major_bit_map |= the_priority_map->ready_major; ffc0b728: 80 09 00 08 lwz r0,8(r9) ffc0b72c: 81 2b 00 00 lwz r9,0(r11) ffc0b730: 81 0a 27 f0 lwz r8,10224(r10) Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; ffc0b734: 81 69 00 08 lwz r11,8(r9) ffc0b738: 7d 08 03 78 or r8,r8,r0 the_node->next = tail; tail->previous = the_node; ffc0b73c: 93 e9 00 08 stw r31,8(r9) RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); ffc0b740: 38 09 00 04 addi r0,r9,4 ffc0b744: 91 0a 27 f0 stw r8,10224(r10) Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; old_last->next = the_node; the_node->previous = old_last; ffc0b748: 91 7f 00 04 stw r11,4(r31) ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; ffc0b74c: 90 1f 00 00 stw r0,0(r31) tail->previous = the_node; old_last->next = the_node; ffc0b750: 93 eb 00 00 stw r31,0(r11) ffc0b754: 4b ff ff 44 b ffc0b698 <_Thread_Change_priority+0x144> =============================================================================== ffc0b7e0 <_Thread_Close>: void _Thread_Close( Objects_Information *information, Thread_Control *the_thread ) { ffc0b7e0: 94 21 ff e8 stwu r1,-24(r1) ffc0b7e4: 7c 08 02 a6 mflr r0 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0b7e8: 39 60 00 00 li r11,0 ffc0b7ec: 90 01 00 1c stw r0,28(r1) RTEMS_INLINE_ROUTINE void _Objects_Invalidate_Id( Objects_Information *information, Objects_Control *the_object ) { _Objects_Set_local_object( ffc0b7f0: a0 04 00 0a lhz r0,10(r4) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0b7f4: 81 23 00 1c lwz r9,28(r3) ffc0b7f8: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0b7fc: 93 c1 00 10 stw r30,16(r1) ffc0b800: 7c 7e 1b 78 mr r30,r3 ffc0b804: 93 e1 00 14 stw r31,20(r1) ffc0b808: 7c 9f 23 78 mr r31,r4 ffc0b80c: 93 a1 00 0c stw r29,12(r1) ffc0b810: 7d 69 01 2e stwx r11,r9,r0 */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc0b814: 3f a0 00 00 lis r29,0 ffc0b818: 81 3d 27 a8 lwz r9,10152(r29) * disappear and set a transient state on it. So we temporarily * unnest dispatching. */ _Thread_Unnest_dispatch(); _User_extensions_Thread_delete( the_thread ); ffc0b81c: 7c 83 23 78 mr r3,r4 ffc0b820: 38 09 ff ff addi r0,r9,-1 ffc0b824: 90 1d 27 a8 stw r0,10152(r29) ffc0b828: 48 00 17 a5 bl ffc0cfcc <_User_extensions_Thread_delete> rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0b82c: 81 3d 27 a8 lwz r9,10152(r29) ffc0b830: 38 09 00 01 addi r0,r9,1 ffc0b834: 90 1d 27 a8 stw r0,10152(r29) /* * Now we are in a dispatching critical section again and we * can take the thread OUT of the published set. It is invalid * to use this thread's Id OR name after this call. */ _Objects_Close( information, &the_thread->Object ); ffc0b838: 7f e4 fb 78 mr r4,r31 ffc0b83c: 7f c3 f3 78 mr r3,r30 ffc0b840: 4b ff ef 79 bl ffc0a7b8 <_Objects_Close> /* * By setting the dormant state, the thread will not be considered * for scheduling when we remove any blocking states. */ _Thread_Set_state( the_thread, STATES_DORMANT ); ffc0b844: 7f e3 fb 78 mr r3,r31 ffc0b848: 38 80 00 01 li r4,1 ffc0b84c: 48 00 0f 4d bl ffc0c798 <_Thread_Set_state> if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { ffc0b850: 7f e3 fb 78 mr r3,r31 ffc0b854: 48 00 0d 11 bl ffc0c564 <_Thread_queue_Extract_with_proxy> ffc0b858: 2f 83 00 00 cmpwi cr7,r3,0 ffc0b85c: 40 9e 00 10 bne- cr7,ffc0b86c <_Thread_Close+0x8c> if ( _Watchdog_Is_active( &the_thread->Timer ) ) ffc0b860: 80 1f 00 50 lwz r0,80(r31) ffc0b864: 2f 80 00 02 cmpwi cr7,r0,2 ffc0b868: 41 9e 00 78 beq- cr7,ffc0b8e0 <_Thread_Close+0x100> RTEMS_INLINE_ROUTINE void _Scheduler_Thread_scheduler_free( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return the_scheduler->Operations.scheduler_free( the_scheduler, the_thread ); ffc0b86c: 3c 60 00 00 lis r3,0 ffc0b870: 38 63 2c e0 addi r3,r3,11488 ffc0b874: 80 03 00 18 lwz r0,24(r3) ffc0b878: 7f e4 fb 78 mr r4,r31 ffc0b87c: 7c 09 03 a6 mtctr r0 ffc0b880: 4e 80 04 21 bctrl if ( _Thread_Is_allocated_fp( the_thread ) ) _Thread_Deallocate_fp(); #endif the_thread->fp_context = NULL; if ( the_thread->Start.fp_context ) ffc0b884: 80 7f 00 c0 lwz r3,192(r31) #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( _Thread_Is_allocated_fp( the_thread ) ) _Thread_Deallocate_fp(); #endif the_thread->fp_context = NULL; ffc0b888: 38 00 00 00 li r0,0 if ( the_thread->Start.fp_context ) ffc0b88c: 2f 83 00 00 cmpwi cr7,r3,0 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( _Thread_Is_allocated_fp( the_thread ) ) _Thread_Deallocate_fp(); #endif the_thread->fp_context = NULL; ffc0b890: 90 1f 01 28 stw r0,296(r31) if ( the_thread->Start.fp_context ) ffc0b894: 41 9e 00 08 beq- cr7,ffc0b89c <_Thread_Close+0xbc> <== NEVER TAKEN (void) _Workspace_Free( the_thread->Start.fp_context ); ffc0b898: 48 00 1c fd bl ffc0d594 <_Workspace_Free> /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); ffc0b89c: 7f e3 fb 78 mr r3,r31 ffc0b8a0: 48 00 10 c5 bl ffc0c964 <_Thread_Stack_Free> the_thread->Start.stack = NULL; if ( the_thread->extensions ) ffc0b8a4: 80 7f 01 38 lwz r3,312(r31) /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); the_thread->Start.stack = NULL; ffc0b8a8: 38 00 00 00 li r0,0 if ( the_thread->extensions ) ffc0b8ac: 2f 83 00 00 cmpwi cr7,r3,0 /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); the_thread->Start.stack = NULL; ffc0b8b0: 90 1f 00 c4 stw r0,196(r31) if ( the_thread->extensions ) ffc0b8b4: 41 9e 00 08 beq- cr7,ffc0b8bc <_Thread_Close+0xdc> (void) _Workspace_Free( the_thread->extensions ); ffc0b8b8: 48 00 1c dd bl ffc0d594 <_Workspace_Free> the_thread->extensions = NULL; ffc0b8bc: 38 00 00 00 li r0,0 } ffc0b8c0: 83 a1 00 0c lwz r29,12(r1) _Thread_Stack_Free( the_thread ); the_thread->Start.stack = NULL; if ( the_thread->extensions ) (void) _Workspace_Free( the_thread->extensions ); the_thread->extensions = NULL; ffc0b8c4: 90 1f 01 38 stw r0,312(r31) } ffc0b8c8: 80 01 00 1c lwz r0,28(r1) ffc0b8cc: 83 c1 00 10 lwz r30,16(r1) ffc0b8d0: 7c 08 03 a6 mtlr r0 ffc0b8d4: 83 e1 00 14 lwz r31,20(r1) ffc0b8d8: 38 21 00 18 addi r1,r1,24 ffc0b8dc: 4e 80 00 20 blr */ _Thread_Set_state( the_thread, STATES_DORMANT ); if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { if ( _Watchdog_Is_active( &the_thread->Timer ) ) (void) _Watchdog_Remove( &the_thread->Timer ); ffc0b8e0: 38 7f 00 48 addi r3,r31,72 ffc0b8e4: 48 00 1a 41 bl ffc0d324 <_Watchdog_Remove> ffc0b8e8: 4b ff ff 84 b ffc0b86c <_Thread_Close+0x8c> =============================================================================== ffc0b9e8 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0b9e8: 94 21 ff e8 stwu r1,-24(r1) ffc0b9ec: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0b9f0: 38 81 00 08 addi r4,r1,8 void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0b9f4: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0b9f8: 48 00 02 4d bl ffc0bc44 <_Thread_Get> switch ( location ) { ffc0b9fc: 80 01 00 08 lwz r0,8(r1) ffc0ba00: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ba04: 40 9e 00 20 bne- cr7,ffc0ba24 <_Thread_Delay_ended+0x3c><== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( ffc0ba08: 3c 80 10 00 lis r4,4096 ffc0ba0c: 60 84 00 18 ori r4,r4,24 ffc0ba10: 4b ff fd 49 bl ffc0b758 <_Thread_Clear_state> ffc0ba14: 3d 20 00 00 lis r9,0 ffc0ba18: 81 69 27 a8 lwz r11,10152(r9) ffc0ba1c: 38 0b ff ff addi r0,r11,-1 ffc0ba20: 90 09 27 a8 stw r0,10152(r9) | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Thread_Unnest_dispatch(); break; } } ffc0ba24: 80 01 00 1c lwz r0,28(r1) ffc0ba28: 38 21 00 18 addi r1,r1,24 ffc0ba2c: 7c 08 03 a6 mtlr r0 ffc0ba30: 4e 80 00 20 blr =============================================================================== ffc0ba34 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { ffc0ba34: 94 21 ff b8 stwu r1,-72(r1) ffc0ba38: 7c 08 02 a6 mflr r0 ffc0ba3c: 93 a1 00 3c stw r29,60(r1) Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; ffc0ba40: 3f a0 00 00 lis r29,0 ffc0ba44: 3b bd 31 04 addi r29,r29,12548 * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { ffc0ba48: 93 e1 00 44 stw r31,68(r1) ffc0ba4c: 90 01 00 4c stw r0,76(r1) ffc0ba50: 92 a1 00 1c stw r21,28(r1) ffc0ba54: 92 c1 00 20 stw r22,32(r1) ffc0ba58: 92 e1 00 24 stw r23,36(r1) ffc0ba5c: 93 01 00 28 stw r24,40(r1) ffc0ba60: 93 21 00 2c stw r25,44(r1) ffc0ba64: 93 41 00 30 stw r26,48(r1) ffc0ba68: 93 61 00 34 stw r27,52(r1) ffc0ba6c: 93 81 00 38 stw r28,56(r1) ffc0ba70: 93 c1 00 40 stw r30,64(r1) Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; ffc0ba74: 83 fd 00 0c lwz r31,12(r29) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0ba78: 7d 20 00 a6 mfmsr r9 ffc0ba7c: 7c 10 42 a6 mfsprg r0,0 ffc0ba80: 7d 20 00 78 andc r0,r9,r0 ffc0ba84: 7c 00 01 24 mtmsr r0 _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { ffc0ba88: 88 1d 00 18 lbz r0,24(r29) ffc0ba8c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ba90: 41 9e 01 88 beq- cr7,ffc0bc18 <_Thread_Dispatch+0x1e4> heir = _Thread_Heir; ffc0ba94: 83 dd 00 10 lwz r30,16(r29) _Thread_Dispatch_disable_level = 1; ffc0ba98: 38 00 00 01 li r0,1 ffc0ba9c: 3f 20 00 00 lis r25,0 /* * 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 ) ffc0baa0: 7f 9f f0 00 cmpw cr7,r31,r30 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; ffc0baa4: 90 19 27 a8 stw r0,10152(r25) _Thread_Dispatch_necessary = false; ffc0baa8: 39 60 00 00 li r11,0 Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); ffc0baac: 7d 20 4b 78 mr r0,r9 while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; ffc0bab0: 99 7d 00 18 stb r11,24(r29) _Thread_Executing = heir; ffc0bab4: 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 ) ffc0bab8: 41 9e 01 14 beq- cr7,ffc0bbcc <_Thread_Dispatch+0x198> ffc0babc: 3f 60 00 00 lis r27,0 ffc0bac0: 3f 00 00 00 lis r24,0 ffc0bac4: 3b 41 00 08 addi r26,r1,8 ffc0bac8: 3b 7b 27 d8 addi r27,r27,10200 ffc0bacc: 3b 81 00 10 addi r28,r1,16 ffc0bad0: 3b 18 27 bc addi r24,r24,10172 #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; ffc0bad4: 3e a0 00 00 lis r21,0 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; ffc0bad8: 3a c0 00 01 li r22,1 _Thread_Dispatch_necessary = false; ffc0badc: 3a e0 00 00 li r23,0 ffc0bae0: 48 00 00 d0 b ffc0bbb0 <_Thread_Dispatch+0x17c> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0bae4: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); ffc0bae8: 7f 43 d3 78 mr r3,r26 ffc0baec: 48 00 4b 19 bl ffc10604 <_TOD_Get_uptime> _Timestamp_Subtract( ffc0baf0: 7f 63 db 78 mr r3,r27 ffc0baf4: 7f 44 d3 78 mr r4,r26 ffc0baf8: 7f 85 e3 78 mr r5,r28 ffc0bafc: 48 00 11 3d bl ffc0cc38 <_Timespec_Subtract> &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); ffc0bb00: 38 7f 00 84 addi r3,r31,132 ffc0bb04: 7f 84 e3 78 mr r4,r28 ffc0bb08: 48 00 10 d5 bl ffc0cbdc <_Timespec_Add_to> #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0bb0c: 81 78 00 00 lwz r11,0(r24) &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; ffc0bb10: 81 21 00 08 lwz r9,8(r1) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0bb14: 2f 8b 00 00 cmpwi cr7,r11,0 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; ffc0bb18: 81 41 00 0c lwz r10,12(r1) ffc0bb1c: 91 3b 00 00 stw r9,0(r27) ffc0bb20: 91 5b 00 04 stw r10,4(r27) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0bb24: 41 9e 00 14 beq- cr7,ffc0bb38 <_Thread_Dispatch+0x104> <== NEVER TAKEN executing->libc_reent = *_Thread_libc_reent; ffc0bb28: 80 0b 00 00 lwz r0,0(r11) ffc0bb2c: 90 1f 01 2c stw r0,300(r31) *_Thread_libc_reent = heir->libc_reent; ffc0bb30: 80 1e 01 2c lwz r0,300(r30) ffc0bb34: 90 0b 00 00 stw r0,0(r11) } _User_extensions_Thread_switch( executing, heir ); ffc0bb38: 7f e3 fb 78 mr r3,r31 ffc0bb3c: 7f c4 f3 78 mr r4,r30 ffc0bb40: 48 00 15 99 bl ffc0d0d8 <_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 ) ffc0bb44: 80 1f 01 28 lwz r0,296(r31) ffc0bb48: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bb4c: 41 9e 00 0c beq- cr7,ffc0bb58 <_Thread_Dispatch+0x124> _Context_Save_fp( &executing->fp_context ); ffc0bb50: 38 7f 01 28 addi r3,r31,296 ffc0bb54: 48 00 c9 0d bl ffc18460 <_CPU_Context_save_fp> #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); ffc0bb58: 38 7f 00 c8 addi r3,r31,200 ffc0bb5c: 38 9e 00 c8 addi r4,r30,200 ffc0bb60: 48 00 ca 81 bl ffc185e0 <_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 ) ffc0bb64: 80 1f 01 28 lwz r0,296(r31) ffc0bb68: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bb6c: 41 9e 00 0c beq- cr7,ffc0bb78 <_Thread_Dispatch+0x144> _Context_Restore_fp( &executing->fp_context ); ffc0bb70: 38 7f 01 28 addi r3,r31,296 ffc0bb74: 48 00 c9 ad bl ffc18520 <_CPU_Context_restore_fp> #endif #endif executing = _Thread_Executing; ffc0bb78: 83 fd 00 0c lwz r31,12(r29) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0bb7c: 7d 20 00 a6 mfmsr r9 ffc0bb80: 7c 10 42 a6 mfsprg r0,0 ffc0bb84: 7d 20 00 78 andc r0,r9,r0 ffc0bb88: 7c 00 01 24 mtmsr r0 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { ffc0bb8c: 88 1d 00 18 lbz r0,24(r29) ffc0bb90: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bb94: 41 9e 00 34 beq- cr7,ffc0bbc8 <_Thread_Dispatch+0x194> heir = _Thread_Heir; ffc0bb98: 83 dd 00 10 lwz r30,16(r29) _Thread_Dispatch_disable_level = 1; ffc0bb9c: 92 d9 27 a8 stw r22,10152(r25) /* * 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 ) ffc0bba0: 7f 9e f8 00 cmpw cr7,r30,r31 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; ffc0bba4: 9a fd 00 18 stb r23,24(r29) _Thread_Executing = heir; ffc0bba8: 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 ) ffc0bbac: 41 9e 00 1c beq- cr7,ffc0bbc8 <_Thread_Dispatch+0x194> <== 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 ) ffc0bbb0: 80 1e 00 7c lwz r0,124(r30) ffc0bbb4: 2f 80 00 01 cmpwi cr7,r0,1 ffc0bbb8: 40 9e ff 2c bne+ cr7,ffc0bae4 <_Thread_Dispatch+0xb0> heir->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0bbbc: 80 15 27 a4 lwz r0,10148(r21) ffc0bbc0: 90 1e 00 78 stw r0,120(r30) ffc0bbc4: 4b ff ff 20 b ffc0bae4 <_Thread_Dispatch+0xb0> ffc0bbc8: 7d 20 4b 78 mr r0,r9 _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; ffc0bbcc: 39 20 00 00 li r9,0 ffc0bbd0: 91 39 27 a8 stw r9,10152(r25) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0bbd4: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); _API_extensions_Run_postswitch(); ffc0bbd8: 4b ff dd 4d bl ffc09924 <_API_extensions_Run_postswitch> } ffc0bbdc: 80 01 00 4c lwz r0,76(r1) ffc0bbe0: 82 a1 00 1c lwz r21,28(r1) ffc0bbe4: 7c 08 03 a6 mtlr r0 ffc0bbe8: 82 c1 00 20 lwz r22,32(r1) ffc0bbec: 82 e1 00 24 lwz r23,36(r1) ffc0bbf0: 83 01 00 28 lwz r24,40(r1) ffc0bbf4: 83 21 00 2c lwz r25,44(r1) ffc0bbf8: 83 41 00 30 lwz r26,48(r1) ffc0bbfc: 83 61 00 34 lwz r27,52(r1) ffc0bc00: 83 81 00 38 lwz r28,56(r1) ffc0bc04: 83 a1 00 3c lwz r29,60(r1) ffc0bc08: 83 c1 00 40 lwz r30,64(r1) ffc0bc0c: 83 e1 00 44 lwz r31,68(r1) ffc0bc10: 38 21 00 48 addi r1,r1,72 ffc0bc14: 4e 80 00 20 blr Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); ffc0bc18: 7d 20 4b 78 mr r0,r9 ffc0bc1c: 3f 20 00 00 lis r25,0 ffc0bc20: 4b ff ff ac b ffc0bbcc <_Thread_Dispatch+0x198> =============================================================================== ffc131c0 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc131c0: 94 21 ff f0 stwu r1,-16(r1) ffc131c4: 7c 08 02 a6 mflr r0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; ffc131c8: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc131cc: 90 01 00 14 stw r0,20(r1) ffc131d0: 93 e1 00 0c stw r31,12(r1) #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; ffc131d4: 83 e9 31 10 lwz r31,12560(r9) * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc131d8: 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; ffc131dc: 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); ffc131e0: 38 00 00 00 li r0,0 ffc131e4: 7c 00 00 a6 mfmsr r0 if (!(level & CPU_MODES_INTERRUPT_MASK)) { ffc131e8: 71 2b 00 01 andi. r11,r9,1 ffc131ec: 40 82 00 60 bne- ffc1324c <_Thread_Handler+0x8c> static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; asm volatile ( ffc131f0: 7d 30 42 a6 mfsprg r9,0 msr |= ppc_interrupt_get_disable_mask(); ffc131f4: 7d 20 03 78 or r0,r9,r0 } else { msr &= ~ppc_interrupt_get_disable_mask(); } _CPU_MSR_SET(msr); ffc131f8: 7c 00 01 24 mtmsr r0 _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; ffc131fc: 3d 20 00 00 lis r9,0 ffc13200: 8b c9 29 98 lbz r30,10648(r9) doneConstructors = 1; ffc13204: 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 ); ffc13208: 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; ffc1320c: 98 09 29 98 stb r0,10648(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 ); ffc13210: 4b ff 9b 8d bl ffc0cd9c <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); ffc13214: 4b ff 8a 11 bl ffc0bc24 <_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) */ { ffc13218: 2f 9e 00 00 cmpwi cr7,r30,0 ffc1321c: 41 9e 00 60 beq- cr7,ffc1327c <_Thread_Handler+0xbc> INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { ffc13220: 80 1f 00 94 lwz r0,148(r31) ffc13224: 2f 80 00 00 cmpwi cr7,r0,0 ffc13228: 41 9e 00 64 beq- cr7,ffc1328c <_Thread_Handler+0xcc> (*(Thread_Entry_numeric) executing->Start.entry_point)( executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { ffc1322c: 2f 80 00 01 cmpwi cr7,r0,1 ffc13230: 41 9e 00 74 beq- cr7,ffc132a4 <_Thread_Handler+0xe4> <== 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 ); ffc13234: 7f e3 fb 78 mr r3,r31 ffc13238: 4b ff 9b d9 bl ffc0ce10 <_User_extensions_Thread_exitted> _Internal_error_Occurred( ffc1323c: 38 60 00 00 li r3,0 ffc13240: 38 80 00 01 li r4,1 ffc13244: 38 a0 00 05 li r5,5 ffc13248: 4b ff 74 51 bl ffc0a698 <_Internal_error_Occurred> ffc1324c: 7d 30 42 a6 mfsprg r9,0 _CPU_MSR_GET(msr); if (!(level & CPU_MODES_INTERRUPT_MASK)) { msr |= ppc_interrupt_get_disable_mask(); } else { msr &= ~ppc_interrupt_get_disable_mask(); ffc13250: 7c 00 48 78 andc r0,r0,r9 } _CPU_MSR_SET(msr); ffc13254: 7c 00 01 24 mtmsr r0 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; ffc13258: 3d 20 00 00 lis r9,0 ffc1325c: 8b c9 29 98 lbz r30,10648(r9) doneConstructors = 1; ffc13260: 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 ); ffc13264: 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; ffc13268: 98 09 29 98 stb r0,10648(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 ); ffc1326c: 4b ff 9b 31 bl ffc0cd9c <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); ffc13270: 4b ff 89 b5 bl ffc0bc24 <_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) */ { ffc13274: 2f 9e 00 00 cmpwi cr7,r30,0 ffc13278: 40 9e ff a8 bne+ cr7,ffc13220 <_Thread_Handler+0x60> <== ALWAYS TAKEN INIT_NAME (); ffc1327c: 48 00 62 a1 bl ffc1951c <_init> } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { ffc13280: 80 1f 00 94 lwz r0,148(r31) ffc13284: 2f 80 00 00 cmpwi cr7,r0,0 ffc13288: 40 9e ff a4 bne+ cr7,ffc1322c <_Thread_Handler+0x6c> executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( ffc1328c: 80 1f 00 90 lwz r0,144(r31) ffc13290: 80 7f 00 9c lwz r3,156(r31) ffc13294: 7c 09 03 a6 mtctr r0 ffc13298: 4e 80 04 21 bctrl INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = ffc1329c: 90 7f 00 28 stw r3,40(r31) ffc132a0: 4b ff ff 94 b ffc13234 <_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)( ffc132a4: 80 1f 00 90 lwz r0,144(r31) ffc132a8: 80 7f 00 98 lwz r3,152(r31) ffc132ac: 7c 09 03 a6 mtctr r0 ffc132b0: 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 = ffc132b4: 90 7f 00 28 stw r3,40(r31) ffc132b8: 4b ff ff 7c b ffc13234 <_Thread_Handler+0x74> =============================================================================== ffc0bcfc <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { ffc0bcfc: 94 21 ff c8 stwu r1,-56(r1) ffc0bd00: 7d 80 00 26 mfcr r12 ffc0bd04: 7c 08 02 a6 mflr r0 ffc0bd08: 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 ) { ffc0bd0c: 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 ) { ffc0bd10: 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; ffc0bd14: 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 ) { ffc0bd18: 93 61 00 24 stw r27,36(r1) ffc0bd1c: 7d 3b 4b 78 mr r27,r9 ffc0bd20: 81 21 00 48 lwz r9,72(r1) ffc0bd24: 93 01 00 18 stw r24,24(r1) ffc0bd28: 93 41 00 20 stw r26,32(r1) ffc0bd2c: 7d 5a 53 78 mr r26,r10 ffc0bd30: 93 81 00 28 stw r28,40(r1) ffc0bd34: 7d 1c 43 78 mr r28,r8 ffc0bd38: 93 a1 00 2c stw r29,44(r1) ffc0bd3c: 7c 7d 1b 78 mr r29,r3 ffc0bd40: 93 e1 00 34 stw r31,52(r1) ffc0bd44: 7c 9f 23 78 mr r31,r4 ffc0bd48: 92 e1 00 14 stw r23,20(r1) ffc0bd4c: 93 21 00 1c stw r25,28(r1) ffc0bd50: 91 81 00 10 stw r12,16(r1) ffc0bd54: 83 09 00 00 lwz r24,0(r9) /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; ffc0bd58: 90 04 01 30 stw r0,304(r4) ffc0bd5c: 90 04 01 34 stw r0,308(r4) extensions_area = NULL; the_thread->libc_reent = NULL; ffc0bd60: 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 ) { ffc0bd64: 41 82 02 34 beq- ffc0bf98 <_Thread_Initialize+0x29c> 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; ffc0bd68: 98 04 00 b4 stb r0,180(r4) ffc0bd6c: 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 ) { ffc0bd70: 2f 87 00 00 cmpwi cr7,r7,0 Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; ffc0bd74: 93 df 00 bc stw r30,188(r31) ffc0bd78: 39 20 00 00 li r9,0 the_stack->size = size; ffc0bd7c: 90 1f 00 b8 stw r0,184(r31) extensions_area = NULL; the_thread->libc_reent = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) fp_area = NULL; ffc0bd80: 3b 20 00 00 li r25,0 /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { ffc0bd84: 40 9e 01 88 bne- cr7,ffc0bf0c <_Thread_Initialize+0x210> #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bd88: 3e e0 00 00 lis r23,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; ffc0bd8c: 91 3f 01 28 stw r9,296(r31) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0bd90: 38 00 00 00 li r0,0 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bd94: 81 77 27 c8 lwz r11,10184(r23) 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; ffc0bd98: 91 3f 00 c0 stw r9,192(r31) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bd9c: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0bda0: 90 1f 00 50 stw r0,80(r31) the_watchdog->routine = routine; ffc0bda4: 90 1f 00 64 stw r0,100(r31) the_watchdog->id = id; ffc0bda8: 90 1f 00 68 stw r0,104(r31) the_watchdog->user_data = user_data; ffc0bdac: 90 1f 00 6c stw r0,108(r31) ffc0bdb0: 40 9e 01 a0 bne- cr7,ffc0bf50 <_Thread_Initialize+0x254> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; ffc0bdb4: 91 7f 01 38 stw r11,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; ffc0bdb8: 3b c0 00 00 li r30,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 ) { ffc0bdbc: 2f 9a 00 02 cmpwi cr7,r26,2 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; ffc0bdc0: 80 01 00 40 lwz r0,64(r1) /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; ffc0bdc4: 9b 7f 00 a0 stb r27,160(r31) the_thread->Start.budget_algorithm = budget_algorithm; ffc0bdc8: 93 5f 00 a4 stw r26,164(r31) the_thread->Start.budget_callout = budget_callout; ffc0bdcc: 90 1f 00 a8 stw r0,168(r31) switch ( budget_algorithm ) { ffc0bdd0: 40 be 00 10 bne+ cr7,ffc0bde0 <_Thread_Initialize+0xe4> 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; ffc0bdd4: 3d 20 00 00 lis r9,0 ffc0bdd8: 80 09 27 a4 lwz r0,10148(r9) ffc0bddc: 90 1f 00 78 stw r0,120(r31) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; ffc0bde0: 80 01 00 44 lwz r0,68(r1) Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return the_scheduler->Operations.scheduler_allocate( the_scheduler, the_thread ); ffc0bde4: 3d 20 00 00 lis r9,0 ffc0bde8: 39 29 2c e0 addi r9,r9,11488 the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; the_thread->resource_count = 0; the_thread->real_priority = priority; ffc0bdec: 93 9f 00 18 stw r28,24(r31) } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; ffc0bdf0: 3b 60 00 00 li r27,0 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; ffc0bdf4: 90 1f 00 ac stw r0,172(r31) the_thread->current_state = STATES_DORMANT; ffc0bdf8: 38 00 00 01 li r0,1 RTEMS_INLINE_ROUTINE void* _Scheduler_Thread_scheduler_allocate( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return ffc0bdfc: 7d 23 4b 78 mr r3,r9 ffc0be00: 90 1f 00 10 stw r0,16(r31) ffc0be04: 7f e4 fb 78 mr r4,r31 ffc0be08: 80 09 00 14 lwz r0,20(r9) the_thread->Wait.queue = NULL; ffc0be0c: 93 7f 00 44 stw r27,68(r31) ffc0be10: 7c 09 03 a6 mtctr r0 the_thread->resource_count = 0; ffc0be14: 93 7f 00 1c stw r27,28(r31) the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; ffc0be18: 93 9f 00 b0 stw r28,176(r31) ffc0be1c: 4e 80 04 21 bctrl sched =_Scheduler_Thread_scheduler_allocate( &_Scheduler, the_thread ); if ( !sched ) ffc0be20: 2e 03 00 00 cmpwi cr4,r3,0 ffc0be24: 7c 7a 1b 78 mr r26,r3 ffc0be28: 41 92 00 40 beq- cr4,ffc0be68 <_Thread_Initialize+0x16c> goto failed; _Thread_Set_priority( the_thread, priority ); ffc0be2c: 7f e3 fb 78 mr r3,r31 ffc0be30: 7f 84 e3 78 mr r4,r28 ffc0be34: 48 00 09 25 bl ffc0c758 <_Thread_Set_priority> Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( ffc0be38: a0 1f 00 0a lhz r0,10(r31) _Thread_Stack_Free( the_thread ); return false; } ffc0be3c: 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 ); ffc0be40: 7f e3 fb 78 mr r3,r31 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0be44: 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 ); ffc0be48: 93 7f 00 84 stw r27,132(r31) ffc0be4c: 93 7f 00 88 stw r27,136(r31) ffc0be50: 7f e9 01 2e stwx r31,r9,r0 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc0be54: 93 1f 00 0c stw r24,12(r31) * enabled when we get here. We want to be able to run the * user extensions with dispatching enabled. The Allocator * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); ffc0be58: 48 00 10 b9 bl ffc0cf10 <_User_extensions_Thread_create> if ( extension_status ) ffc0be5c: 2f 83 00 00 cmpwi cr7,r3,0 return true; ffc0be60: 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 ) ffc0be64: 40 9e 00 6c bne- cr7,ffc0bed0 <_Thread_Initialize+0x1d4> ffc0be68: 2d 99 00 00 cmpwi cr3,r25,0 ffc0be6c: 2d 1e 00 00 cmpwi cr2,r30,0 return true; failed: if ( the_thread->libc_reent ) ffc0be70: 80 7f 01 2c lwz r3,300(r31) ffc0be74: 2f 83 00 00 cmpwi cr7,r3,0 ffc0be78: 41 9e 00 08 beq- cr7,ffc0be80 <_Thread_Initialize+0x184> _Workspace_Free( the_thread->libc_reent ); ffc0be7c: 48 00 17 19 bl ffc0d594 <_Workspace_Free> for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) ffc0be80: 80 7f 01 30 lwz r3,304(r31) ffc0be84: 2f 83 00 00 cmpwi cr7,r3,0 ffc0be88: 41 9e 00 08 beq- cr7,ffc0be90 <_Thread_Initialize+0x194> _Workspace_Free( the_thread->API_Extensions[i] ); ffc0be8c: 48 00 17 09 bl ffc0d594 <_Workspace_Free> failed: if ( the_thread->libc_reent ) _Workspace_Free( the_thread->libc_reent ); for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) ffc0be90: 80 7f 01 34 lwz r3,308(r31) ffc0be94: 2f 83 00 00 cmpwi cr7,r3,0 ffc0be98: 41 9e 00 08 beq- cr7,ffc0bea0 <_Thread_Initialize+0x1a4> _Workspace_Free( the_thread->API_Extensions[i] ); ffc0be9c: 48 00 16 f9 bl ffc0d594 <_Workspace_Free> if ( extensions_area ) ffc0bea0: 41 8a 00 0c beq- cr2,ffc0beac <_Thread_Initialize+0x1b0> (void) _Workspace_Free( extensions_area ); ffc0bea4: 7f c3 f3 78 mr r3,r30 ffc0bea8: 48 00 16 ed bl ffc0d594 <_Workspace_Free> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( fp_area ) ffc0beac: 41 8e 00 0c beq- cr3,ffc0beb8 <_Thread_Initialize+0x1bc> (void) _Workspace_Free( fp_area ); ffc0beb0: 7f 23 cb 78 mr r3,r25 ffc0beb4: 48 00 16 e1 bl ffc0d594 <_Workspace_Free> #endif if ( sched ) ffc0beb8: 41 92 00 0c beq- cr4,ffc0bec4 <_Thread_Initialize+0x1c8> (void) _Workspace_Free( sched ); ffc0bebc: 7f 43 d3 78 mr r3,r26 ffc0bec0: 48 00 16 d5 bl ffc0d594 <_Workspace_Free> _Thread_Stack_Free( the_thread ); ffc0bec4: 7f e3 fb 78 mr r3,r31 ffc0bec8: 48 00 0a 9d bl ffc0c964 <_Thread_Stack_Free> return false; ffc0becc: 38 60 00 00 li r3,0 } ffc0bed0: 80 01 00 3c lwz r0,60(r1) ffc0bed4: 81 81 00 10 lwz r12,16(r1) ffc0bed8: 7c 08 03 a6 mtlr r0 ffc0bedc: 82 e1 00 14 lwz r23,20(r1) ffc0bee0: 83 01 00 18 lwz r24,24(r1) ffc0bee4: 7d 83 81 20 mtcrf 56,r12 ffc0bee8: 83 21 00 1c lwz r25,28(r1) ffc0beec: 83 41 00 20 lwz r26,32(r1) ffc0bef0: 83 61 00 24 lwz r27,36(r1) ffc0bef4: 83 81 00 28 lwz r28,40(r1) ffc0bef8: 83 a1 00 2c lwz r29,44(r1) ffc0befc: 83 c1 00 30 lwz r30,48(r1) ffc0bf00: 83 e1 00 34 lwz r31,52(r1) ffc0bf04: 38 21 00 38 addi r1,r1,56 ffc0bf08: 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 ); ffc0bf0c: 38 60 01 08 li r3,264 ffc0bf10: 48 00 16 51 bl ffc0d560 <_Workspace_Allocate> if ( !fp_area ) ffc0bf14: 2d 83 00 00 cmpwi cr3,r3,0 ffc0bf18: 7c 79 1b 78 mr r25,r3 ffc0bf1c: 41 8e 00 c0 beq- cr3,ffc0bfdc <_Thread_Initialize+0x2e0> #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bf20: 3e e0 00 00 lis r23,0 ffc0bf24: 81 77 27 c8 lwz r11,10184(r23) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0bf28: 38 00 00 00 li r0,0 * 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 ); if ( !fp_area ) ffc0bf2c: 7c 69 1b 78 mr r9,r3 ffc0bf30: 90 1f 00 50 stw r0,80(r31) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bf34: 2f 8b 00 00 cmpwi cr7,r11,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; ffc0bf38: 91 3f 01 28 stw r9,296(r31) the_thread->Start.fp_context = fp_area; ffc0bf3c: 91 3f 00 c0 stw r9,192(r31) the_watchdog->routine = routine; ffc0bf40: 90 1f 00 64 stw r0,100(r31) the_watchdog->id = id; ffc0bf44: 90 1f 00 68 stw r0,104(r31) the_watchdog->user_data = user_data; ffc0bf48: 90 1f 00 6c stw r0,108(r31) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bf4c: 41 9e fe 68 beq+ cr7,ffc0bdb4 <_Thread_Initialize+0xb8> extensions_area = _Workspace_Allocate( ffc0bf50: 39 6b 00 01 addi r11,r11,1 ffc0bf54: 55 63 10 3a rlwinm r3,r11,2,0,29 ffc0bf58: 48 00 16 09 bl ffc0d560 <_Workspace_Allocate> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) ffc0bf5c: 2d 03 00 00 cmpwi cr2,r3,0 ffc0bf60: 7c 7e 1b 78 mr r30,r3 ffc0bf64: 41 8a 00 8c beq- cr2,ffc0bff0 <_Thread_Initialize+0x2f4> goto failed; } the_thread->extensions = (void **) extensions_area; ffc0bf68: 90 7f 01 38 stw r3,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++ ) ffc0bf6c: 38 00 00 00 li r0,0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; ffc0bf70: 39 20 00 00 li r9,0 ffc0bf74: 81 57 27 c8 lwz r10,10184(r23) * 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; ffc0bf78: 39 60 00 00 li r11,0 * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) ffc0bf7c: 39 29 00 01 addi r9,r9,1 ffc0bf80: 7f 8a 48 40 cmplw cr7,r10,r9 the_thread->extensions[i] = NULL; ffc0bf84: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0bf88: 7d 7e 01 2e stwx r11,r30,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++ ) ffc0bf8c: 7d 20 4b 78 mr r0,r9 ffc0bf90: 40 9c ff ec bge+ cr7,ffc0bf7c <_Thread_Initialize+0x280> ffc0bf94: 4b ff fe 28 b ffc0bdbc <_Thread_Initialize+0xc0> return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); ffc0bf98: 7c 83 23 78 mr r3,r4 ffc0bf9c: 90 c1 00 08 stw r6,8(r1) ffc0bfa0: 7c c4 33 78 mr r4,r6 ffc0bfa4: 90 e1 00 0c stw r7,12(r1) ffc0bfa8: 48 00 09 15 bl ffc0c8bc <_Thread_Stack_Allocate> if ( !actual_stack_size || actual_stack_size < stack_size ) ffc0bfac: 7c 60 1b 79 mr. r0,r3 ffc0bfb0: 80 c1 00 08 lwz r6,8(r1) return false; /* stack allocation failed */ ffc0bfb4: 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 ) ffc0bfb8: 80 e1 00 0c lwz r7,12(r1) ffc0bfbc: 41 a2 ff 14 beq- ffc0bed0 <_Thread_Initialize+0x1d4> ffc0bfc0: 7f 86 00 40 cmplw cr7,r6,r0 return false; /* stack allocation failed */ ffc0bfc4: 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 ) ffc0bfc8: 41 bd ff 08 bgt- cr7,ffc0bed0 <_Thread_Initialize+0x1d4><== NEVER TAKEN return false; /* stack allocation failed */ stack = the_thread->Start.stack; the_thread->Start.core_allocated_stack = true; ffc0bfcc: 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; ffc0bfd0: 83 df 00 c4 lwz r30,196(r31) the_thread->Start.core_allocated_stack = true; ffc0bfd4: 99 3f 00 b4 stb r9,180(r31) ffc0bfd8: 4b ff fd 98 b ffc0bd70 <_Thread_Initialize+0x74> * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; ffc0bfdc: 3b c0 00 00 li r30,0 ffc0bfe0: 4d 0c 00 00 mcrf cr2,cr3 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; ffc0bfe4: 3b 40 00 00 li r26,0 ffc0bfe8: 4e 0c 00 00 mcrf cr4,cr3 ffc0bfec: 4b ff fe 84 b ffc0be70 <_Thread_Initialize+0x174> ffc0bff0: 2d 99 00 00 cmpwi cr3,r25,0 ffc0bff4: 4e 08 00 00 mcrf cr4,cr2 ffc0bff8: 3b 40 00 00 li r26,0 ffc0bffc: 4b ff fe 74 b ffc0be70 <_Thread_Initialize+0x174> =============================================================================== ffc0d80c <_Thread_Restart>: bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { ffc0d80c: 94 21 ff e8 stwu r1,-24(r1) ffc0d810: 7c 08 02 a6 mflr r0 ffc0d814: 90 01 00 1c stw r0,28(r1) */ RTEMS_INLINE_ROUTINE bool _States_Is_dormant ( States_Control the_states ) { return (the_states & STATES_DORMANT); ffc0d818: 80 03 00 10 lwz r0,16(r3) ffc0d81c: 93 e1 00 14 stw r31,20(r1) ffc0d820: 7c 7f 1b 78 mr r31,r3 if ( !_States_Is_dormant( the_thread->current_state ) ) { ffc0d824: 70 09 00 01 andi. r9,r0,1 bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { ffc0d828: 93 c1 00 10 stw r30,16(r1) _Thread_Restart_self(); return true; } return false; ffc0d82c: 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 ) ) { ffc0d830: 41 82 00 20 beq- ffc0d850 <_Thread_Restart+0x44> return true; } return false; } ffc0d834: 7c 03 03 78 mr r3,r0 ffc0d838: 80 01 00 1c lwz r0,28(r1) ffc0d83c: 83 c1 00 10 lwz r30,16(r1) ffc0d840: 7c 08 03 a6 mtlr r0 ffc0d844: 83 e1 00 14 lwz r31,20(r1) ffc0d848: 38 21 00 18 addi r1,r1,24 ffc0d84c: 4e 80 00 20 blr Thread_Entry_numeric_type numeric_argument ) { if ( !_States_Is_dormant( the_thread->current_state ) ) { _Thread_Set_transient( the_thread ); ffc0d850: 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 ); ffc0d854: 3f c0 00 00 lis r30,0 ffc0d858: 3b de 31 84 addi r30,r30,12676 ffc0d85c: 90 a1 00 0c stw r5,12(r1) ffc0d860: 48 00 01 25 bl ffc0d984 <_Thread_Set_transient> _Thread_Reset( the_thread, pointer_argument, numeric_argument ); ffc0d864: 7f e3 fb 78 mr r3,r31 ffc0d868: 80 81 00 08 lwz r4,8(r1) ffc0d86c: 80 a1 00 0c lwz r5,12(r1) ffc0d870: 48 00 49 e5 bl ffc12254 <_Thread_Reset> _Thread_Load_environment( the_thread ); ffc0d874: 7f e3 fb 78 mr r3,r31 ffc0d878: 48 00 46 19 bl ffc11e90 <_Thread_Load_environment> _Thread_Ready( the_thread ); ffc0d87c: 7f e3 fb 78 mr r3,r31 ffc0d880: 48 00 49 79 bl ffc121f8 <_Thread_Ready> _User_extensions_Thread_restart( the_thread ); ffc0d884: 7f e3 fb 78 mr r3,r31 ffc0d888: 48 00 09 2d bl ffc0e1b4 <_User_extensions_Thread_restart> if ( _Thread_Is_executing ( the_thread ) ) ffc0d88c: 81 3e 00 0c lwz r9,12(r30) _Thread_Restart_self(); return true; ffc0d890: 38 00 00 01 li r0,1 _Thread_Ready( the_thread ); _User_extensions_Thread_restart( the_thread ); if ( _Thread_Is_executing ( the_thread ) ) ffc0d894: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0d898: 40 9e ff 9c bne+ cr7,ffc0d834 <_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 ) ffc0d89c: 80 1f 01 28 lwz r0,296(r31) ffc0d8a0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d8a4: 41 9e 00 0c beq- cr7,ffc0d8b0 <_Thread_Restart+0xa4> <== NEVER TAKEN _Context_Restore_fp( &_Thread_Executing->fp_context ); ffc0d8a8: 38 7f 01 28 addi r3,r31,296 ffc0d8ac: 48 01 19 f5 bl ffc1f2a0 <_CPU_Context_restore_fp> #endif _CPU_Context_Restart_self( &_Thread_Executing->Registers ); ffc0d8b0: 80 7e 00 0c lwz r3,12(r30) ffc0d8b4: 38 63 00 c8 addi r3,r3,200 ffc0d8b8: 48 01 1b a9 bl ffc1f460 <_CPU_Context_restore> =============================================================================== ffc10908 <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { ffc10908: 94 21 ff f0 stwu r1,-16(r1) ffc1090c: 7c 08 02 a6 mflr r0 ffc10910: 7c 64 1b 78 mr r4,r3 ffc10914: 90 01 00 14 stw r0,20(r1) ffc10918: 93 e1 00 0c stw r31,12(r1) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc1091c: 7f e0 00 a6 mfmsr r31 ffc10920: 7c 10 42 a6 mfsprg r0,0 ffc10924: 7f e0 00 78 andc r0,r31,r0 ffc10928: 7c 00 01 24 mtmsr r0 ISR_Level level; States_Control current_state; _ISR_Disable( level ); current_state = the_thread->current_state; ffc1092c: 80 03 00 10 lwz r0,16(r3) if ( current_state & STATES_SUSPENDED ) { ffc10930: 70 09 00 02 andi. r9,r0,2 ffc10934: 41 82 00 14 beq- ffc10948 <_Thread_Resume+0x40> <== NEVER TAKEN RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); ffc10938: 54 00 07 fa rlwinm r0,r0,0,31,29 current_state = the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); if ( _States_Is_ready( current_state ) ) { ffc1093c: 2f 80 00 00 cmpwi cr7,r0,0 _ISR_Disable( level ); current_state = the_thread->current_state; if ( current_state & STATES_SUSPENDED ) { current_state = the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); ffc10940: 90 03 00 10 stw r0,16(r3) if ( _States_Is_ready( current_state ) ) { ffc10944: 41 9e 00 1c beq- cr7,ffc10960 <_Thread_Resume+0x58> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc10948: 7f e0 01 24 mtmsr r31 _Scheduler_Unblock( &_Scheduler, the_thread ); } } _ISR_Enable( level ); } ffc1094c: 80 01 00 14 lwz r0,20(r1) ffc10950: 83 e1 00 0c lwz r31,12(r1) ffc10954: 38 21 00 10 addi r1,r1,16 ffc10958: 7c 08 03 a6 mtlr r0 ffc1095c: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { the_scheduler->Operations.unblock( the_scheduler, the_thread ); ffc10960: 3c 60 00 00 lis r3,0 ffc10964: 38 63 2d c0 addi r3,r3,11712 ffc10968: 80 03 00 10 lwz r0,16(r3) ffc1096c: 7c 09 03 a6 mtctr r0 ffc10970: 4e 80 04 21 bctrl ffc10974: 7f e0 01 24 mtmsr r31 ffc10978: 80 01 00 14 lwz r0,20(r1) ffc1097c: 83 e1 00 0c lwz r31,12(r1) ffc10980: 38 21 00 10 addi r1,r1,16 ffc10984: 7c 08 03 a6 mtlr r0 ffc10988: 4e 80 00 20 blr =============================================================================== ffc0cb1c <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { ffc0cb1c: 94 21 ff f0 stwu r1,-16(r1) ffc0cb20: 7c 08 02 a6 mflr r0 Thread_Control *executing; executing = _Thread_Executing; ffc0cb24: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { ffc0cb28: 90 01 00 14 stw r0,20(r1) ffc0cb2c: 93 e1 00 0c stw r31,12(r1) Thread_Control *executing; executing = _Thread_Executing; ffc0cb30: 83 e9 31 10 lwz r31,12560(r9) /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) ffc0cb34: 88 1f 00 74 lbz r0,116(r31) ffc0cb38: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cb3c: 41 9e 00 2c beq- cr7,ffc0cb68 <_Thread_Tickle_timeslice+0x4c> return; if ( !_States_Is_ready( executing->current_state ) ) ffc0cb40: 80 1f 00 10 lwz r0,16(r31) ffc0cb44: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cb48: 40 9e 00 20 bne- cr7,ffc0cb68 <_Thread_Tickle_timeslice+0x4c> /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { ffc0cb4c: 80 1f 00 7c lwz r0,124(r31) ffc0cb50: 2b 80 00 01 cmplwi cr7,r0,1 ffc0cb54: 41 9c 00 14 blt- cr7,ffc0cb68 <_Thread_Tickle_timeslice+0x4c> ffc0cb58: 2b 80 00 02 cmplwi cr7,r0,2 ffc0cb5c: 40 9d 00 48 ble- cr7,ffc0cba4 <_Thread_Tickle_timeslice+0x88> ffc0cb60: 2f 80 00 03 cmpwi cr7,r0,3 ffc0cb64: 41 9e 00 18 beq- cr7,ffc0cb7c <_Thread_Tickle_timeslice+0x60><== ALWAYS TAKEN if ( --executing->cpu_time_budget == 0 ) (*executing->budget_callout)( executing ); break; #endif } } ffc0cb68: 80 01 00 14 lwz r0,20(r1) ffc0cb6c: 83 e1 00 0c lwz r31,12(r1) ffc0cb70: 38 21 00 10 addi r1,r1,16 ffc0cb74: 7c 08 03 a6 mtlr r0 ffc0cb78: 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 ) ffc0cb7c: 81 3f 00 78 lwz r9,120(r31) ffc0cb80: 38 09 ff ff addi r0,r9,-1 ffc0cb84: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cb88: 90 1f 00 78 stw r0,120(r31) ffc0cb8c: 40 9e ff dc bne+ cr7,ffc0cb68 <_Thread_Tickle_timeslice+0x4c> (*executing->budget_callout)( executing ); ffc0cb90: 80 1f 00 80 lwz r0,128(r31) ffc0cb94: 7f e3 fb 78 mr r3,r31 ffc0cb98: 7c 09 03 a6 mtctr r0 ffc0cb9c: 4e 80 04 21 bctrl ffc0cba0: 4b ff ff c8 b ffc0cb68 <_Thread_Tickle_timeslice+0x4c> 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 ) { ffc0cba4: 81 3f 00 78 lwz r9,120(r31) ffc0cba8: 38 09 ff ff addi r0,r9,-1 ffc0cbac: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cbb0: 90 1f 00 78 stw r0,120(r31) ffc0cbb4: 41 9d ff b4 bgt+ cr7,ffc0cb68 <_Thread_Tickle_timeslice+0x4c> * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield( &_Scheduler ); ffc0cbb8: 3c 60 00 00 lis r3,0 ffc0cbbc: 38 63 2c e0 addi r3,r3,11488 ffc0cbc0: 80 03 00 08 lwz r0,8(r3) ffc0cbc4: 7c 09 03 a6 mtctr r0 ffc0cbc8: 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; ffc0cbcc: 3d 20 00 00 lis r9,0 ffc0cbd0: 80 09 27 a4 lwz r0,10148(r9) ffc0cbd4: 90 1f 00 78 stw r0,120(r31) ffc0cbd8: 4b ff ff 90 b ffc0cb68 <_Thread_Tickle_timeslice+0x4c> =============================================================================== ffc0c660 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { ffc0c660: 94 21 ff d8 stwu r1,-40(r1) ffc0c664: 7c 08 02 a6 mflr r0 ffc0c668: 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 ) ffc0c66c: 7c 7f 1b 79 mr. r31,r3 void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { ffc0c670: 93 c1 00 20 stw r30,32(r1) ffc0c674: 7c 9e 23 78 mr r30,r4 ffc0c678: 90 01 00 2c stw r0,44(r1) ffc0c67c: 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 ) ffc0c680: 41 82 00 10 beq- ffc0c690 <_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 ) { ffc0c684: 80 1f 00 34 lwz r0,52(r31) ffc0c688: 2f 80 00 01 cmpwi cr7,r0,1 ffc0c68c: 41 9e 00 20 beq- cr7,ffc0c6ac <_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 ); } } ffc0c690: 80 01 00 2c lwz r0,44(r1) <== NOT EXECUTED ffc0c694: 83 a1 00 1c lwz r29,28(r1) <== NOT EXECUTED ffc0c698: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0c69c: 83 c1 00 20 lwz r30,32(r1) <== NOT EXECUTED ffc0c6a0: 83 e1 00 24 lwz r31,36(r1) <== NOT EXECUTED ffc0c6a4: 38 21 00 28 addi r1,r1,40 <== NOT EXECUTED ffc0c6a8: 4e 80 00 20 blr <== NOT EXECUTED static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0c6ac: 7f a0 00 a6 mfmsr r29 ffc0c6b0: 7d 30 42 a6 mfsprg r9,0 ffc0c6b4: 7f a9 48 78 andc r9,r29,r9 ffc0c6b8: 7d 20 01 24 mtmsr r9 ffc0c6bc: 3d 60 00 03 lis r11,3 ffc0c6c0: 81 24 00 10 lwz r9,16(r4) ffc0c6c4: 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 ) ) { ffc0c6c8: 7d 6a 48 39 and. r10,r11,r9 ffc0c6cc: 40 82 00 24 bne- ffc0c6f0 <_Thread_queue_Requeue+0x90> <== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0c6d0: 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 ); } } ffc0c6d4: 80 01 00 2c lwz r0,44(r1) ffc0c6d8: 83 a1 00 1c lwz r29,28(r1) ffc0c6dc: 7c 08 03 a6 mtlr r0 ffc0c6e0: 83 c1 00 20 lwz r30,32(r1) ffc0c6e4: 83 e1 00 24 lwz r31,36(r1) ffc0c6e8: 38 21 00 28 addi r1,r1,40 ffc0c6ec: 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; ffc0c6f0: 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 ); ffc0c6f4: 38 a0 00 01 li r5,1 ffc0c6f8: 48 00 46 6d bl ffc10d64 <_Thread_queue_Extract_priority_helper> (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); ffc0c6fc: 7f e3 fb 78 mr r3,r31 ffc0c700: 7f c4 f3 78 mr r4,r30 ffc0c704: 38 a1 00 08 addi r5,r1,8 ffc0c708: 4b ff fc 81 bl ffc0c388 <_Thread_queue_Enqueue_priority> ffc0c70c: 7f a0 01 24 mtmsr r29 ffc0c710: 4b ff ff c4 b ffc0c6d4 <_Thread_queue_Requeue+0x74> =============================================================================== ffc0c714 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0c714: 94 21 ff e8 stwu r1,-24(r1) ffc0c718: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0c71c: 38 81 00 08 addi r4,r1,8 void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0c720: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0c724: 4b ff f5 21 bl ffc0bc44 <_Thread_Get> switch ( location ) { ffc0c728: 80 01 00 08 lwz r0,8(r1) ffc0c72c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c730: 40 9e 00 18 bne- cr7,ffc0c748 <_Thread_queue_Timeout+0x34><== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); ffc0c734: 48 00 47 45 bl ffc10e78 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc0c738: 3d 20 00 00 lis r9,0 ffc0c73c: 81 69 27 a8 lwz r11,10152(r9) ffc0c740: 38 0b ff ff addi r0,r11,-1 ffc0c744: 90 09 27 a8 stw r0,10152(r9) _Thread_Unnest_dispatch(); break; } } ffc0c748: 80 01 00 1c lwz r0,28(r1) ffc0c74c: 38 21 00 18 addi r1,r1,24 ffc0c750: 7c 08 03 a6 mtlr r0 ffc0c754: 4e 80 00 20 blr =============================================================================== ffc1b8f0 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { ffc1b8f0: 94 21 ff 98 stwu r1,-104(r1) ffc1b8f4: 7c 08 02 a6 mflr r0 ffc1b8f8: 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; head->previous = NULL; tail->previous = head; ffc1b8fc: 3a a1 00 08 addi r21,r1,8 ffc1b900: 90 01 00 6c stw r0,108(r1) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; ffc1b904: 38 00 00 00 li r0,0 ffc1b908: 93 21 00 4c stw r25,76(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc1b90c: 3b 21 00 0c addi r25,r1,12 ffc1b910: 93 41 00 50 stw r26,80(r1) ffc1b914: 3b 41 00 18 addi r26,r1,24 ffc1b918: 93 81 00 58 stw r28,88(r1) ffc1b91c: 3b 81 00 14 addi r28,r1,20 ffc1b920: 92 81 00 38 stw r20,56(r1) ffc1b924: 3e 80 00 00 lis r20,0 ffc1b928: 3a 94 28 a0 addi r20,r20,10400 ffc1b92c: 92 e1 00 44 stw r23,68(r1) ffc1b930: 3e e0 00 00 lis r23,0 ffc1b934: 3a f7 28 dc addi r23,r23,10460 ffc1b938: 93 01 00 48 stw r24,72(r1) ffc1b93c: 3f 00 00 00 lis r24,0 ffc1b940: 3b 18 28 b8 addi r24,r24,10424 ffc1b944: 93 c1 00 60 stw r30,96(r1) ffc1b948: 93 21 00 08 stw r25,8(r1) head->previous = NULL; ffc1b94c: 90 01 00 0c stw r0,12(r1) tail->previous = head; ffc1b950: 92 a1 00 10 stw r21,16(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc1b954: 93 41 00 14 stw r26,20(r1) head->previous = NULL; ffc1b958: 90 01 00 18 stw r0,24(r1) tail->previous = head; ffc1b95c: 93 81 00 1c stw r28,28(r1) ffc1b960: 92 21 00 2c stw r17,44(r1) ffc1b964: 3a 23 00 08 addi r17,r3,8 ffc1b968: 92 41 00 30 stw r18,48(r1) ffc1b96c: 3a 43 00 40 addi r18,r3,64 ffc1b970: 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; ffc1b974: 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 ) { ffc1b978: 92 c1 00 40 stw r22,64(r1) _ISR_Disable( level ); tmp = ts->insert_chain; if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; do_loop = false; ffc1b97c: 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 ) { ffc1b980: 93 61 00 54 stw r27,84(r1) ffc1b984: 3b 63 00 68 addi r27,r3,104 ffc1b988: 93 a1 00 5c stw r29,92(r1) ffc1b98c: 3b a3 00 30 addi r29,r3,48 ffc1b990: 93 e1 00 64 stw r31,100(r1) ffc1b994: 7c 7f 1b 78 mr r31,r3 Chain_Control *tmp; /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; ffc1b998: 92 bf 00 78 stw r21,120(r31) static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; ffc1b99c: 80 17 00 00 lwz r0,0(r23) */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1b9a0: 7f 85 e3 78 mr r5,r28 Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; ffc1b9a4: 80 9f 00 3c lwz r4,60(r31) watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1b9a8: 7f a3 eb 78 mr r3,r29 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; ffc1b9ac: 90 1f 00 3c stw r0,60(r31) _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1b9b0: 7c 84 00 50 subf r4,r4,r0 ffc1b9b4: 48 00 59 ed bl ffc213a0 <_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(); ffc1b9b8: 83 d8 00 00 lwz r30,0(r24) Watchdog_Interval last_snapshot = watchdogs->last_snapshot; ffc1b9bc: 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 ) { ffc1b9c0: 7f 9e 28 40 cmplw cr7,r30,r5 ffc1b9c4: 41 9d 00 fc bgt- cr7,ffc1bac0 <_Timer_server_Body+0x1d0> * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { ffc1b9c8: 41 9c 00 d4 blt- cr7,ffc1ba9c <_Timer_server_Body+0x1ac> */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; ffc1b9cc: 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 ); ffc1b9d0: 80 7f 00 78 lwz r3,120(r31) ffc1b9d4: 48 00 0d bd bl ffc1c790 <_Chain_Get> if ( timer == NULL ) { ffc1b9d8: 7c 64 1b 79 mr. r4,r3 ffc1b9dc: 41 82 00 34 beq- ffc1ba10 <_Timer_server_Body+0x120> <== ALWAYS TAKEN static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1b9e0: 80 04 00 38 lwz r0,56(r4) <== NOT EXECUTED ffc1b9e4: 2f 80 00 01 cmpwi cr7,r0,1 <== NOT EXECUTED _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc1b9e8: 2f 00 00 03 cmpwi cr6,r0,3 <== NOT EXECUTED static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1b9ec: 41 9e 00 c4 beq- cr7,ffc1bab0 <_Timer_server_Body+0x1c0><== NOT EXECUTED _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc1b9f0: 40 9a ff e0 bne+ cr6,ffc1b9d0 <_Timer_server_Body+0xe0> <== NOT EXECUTED _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); ffc1b9f4: 38 84 00 10 addi r4,r4,16 <== NOT EXECUTED ffc1b9f8: 7f 63 db 78 mr r3,r27 <== NOT EXECUTED ffc1b9fc: 48 00 5a 5d bl ffc21458 <_Watchdog_Insert> <== NOT EXECUTED } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); ffc1ba00: 80 7f 00 78 lwz r3,120(r31) <== NOT EXECUTED ffc1ba04: 48 00 0d 8d bl ffc1c790 <_Chain_Get> <== NOT EXECUTED if ( timer == NULL ) { ffc1ba08: 7c 64 1b 79 mr. r4,r3 <== NOT EXECUTED ffc1ba0c: 40 82 ff d4 bne+ ffc1b9e0 <_Timer_server_Body+0xf0> <== NOT EXECUTED static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc1ba10: 7d 20 00 a6 mfmsr r9 ffc1ba14: 7c 10 42 a6 mfsprg r0,0 ffc1ba18: 7d 20 00 78 andc r0,r9,r0 ffc1ba1c: 7c 00 01 24 mtmsr r0 * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); tmp = ts->insert_chain; ffc1ba20: 80 1f 00 78 lwz r0,120(r31) if ( _Chain_Is_empty( insert_chain ) ) { ffc1ba24: 80 01 00 08 lwz r0,8(r1) ffc1ba28: 7f 80 c8 00 cmpw cr7,r0,r25 ffc1ba2c: 38 00 00 01 li r0,1 ffc1ba30: 41 9e 00 a4 beq- cr7,ffc1bad4 <_Timer_server_Body+0x1e4><== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc1ba34: 7d 20 01 24 mtmsr r9 * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; while ( do_loop ) { ffc1ba38: 2f 80 00 00 cmpwi cr7,r0,0 ffc1ba3c: 40 9e ff 60 bne+ cr7,ffc1b99c <_Timer_server_Body+0xac> <== NEVER TAKEN _Chain_Initialize_empty( &fire_chain ); while ( true ) { _Timer_server_Get_watchdogs_that_fire_now( ts, &insert_chain, &fire_chain ); if ( !_Chain_Is_empty( &fire_chain ) ) { ffc1ba40: 81 21 00 14 lwz r9,20(r1) ffc1ba44: 7f 89 d0 00 cmpw cr7,r9,r26 ffc1ba48: 40 be 00 30 bne+ cr7,ffc1ba78 <_Timer_server_Body+0x188> ffc1ba4c: 48 00 00 94 b ffc1bae0 <_Timer_server_Body+0x1f0> Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; ffc1ba50: 81 69 00 00 lwz r11,0(r9) head->next = new_first; new_first->previous = head; ffc1ba54: 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; ffc1ba58: 91 61 00 14 stw r11,20(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; ffc1ba5c: 92 c9 00 08 stw r22,8(r9) ffc1ba60: 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 ); ffc1ba64: 80 09 00 1c lwz r0,28(r9) ffc1ba68: 80 69 00 20 lwz r3,32(r9) ffc1ba6c: 80 89 00 24 lwz r4,36(r9) ffc1ba70: 7c 09 03 a6 mtctr r0 ffc1ba74: 4e 80 04 21 bctrl static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc1ba78: 7c 00 00 a6 mfmsr r0 ffc1ba7c: 7d 30 42 a6 mfsprg r9,0 ffc1ba80: 7c 09 48 78 andc r9,r0,r9 ffc1ba84: 7d 20 01 24 mtmsr r9 initialized = false; } #endif return status; } ffc1ba88: 81 21 00 14 lwz r9,20(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) ffc1ba8c: 7f 89 d0 00 cmpw cr7,r9,r26 ffc1ba90: 40 9e ff c0 bne+ cr7,ffc1ba50 <_Timer_server_Body+0x160> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc1ba94: 7c 00 01 24 mtmsr r0 ffc1ba98: 4b ff ff 00 b ffc1b998 <_Timer_server_Body+0xa8> /* * 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 ); ffc1ba9c: 7f 63 db 78 mr r3,r27 ffc1baa0: 38 80 00 01 li r4,1 ffc1baa4: 7c be 28 50 subf r5,r30,r5 ffc1baa8: 48 00 57 cd bl ffc21274 <_Watchdog_Adjust> ffc1baac: 4b ff ff 20 b ffc1b9cc <_Timer_server_Body+0xdc> Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); ffc1bab0: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc1bab4: 38 84 00 10 addi r4,r4,16 <== NOT EXECUTED ffc1bab8: 48 00 59 a1 bl ffc21458 <_Watchdog_Insert> <== NOT EXECUTED ffc1babc: 4b ff ff 14 b ffc1b9d0 <_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 ); ffc1bac0: 7c 85 f0 50 subf r4,r5,r30 ffc1bac4: 7f 63 db 78 mr r3,r27 ffc1bac8: 7f 85 e3 78 mr r5,r28 ffc1bacc: 48 00 58 d5 bl ffc213a0 <_Watchdog_Adjust_to_chain> ffc1bad0: 4b ff fe fc b ffc1b9cc <_Timer_server_Body+0xdc> _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); tmp = ts->insert_chain; if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; ffc1bad4: 90 9f 00 78 stw r4,120(r31) do_loop = false; ffc1bad8: 38 00 00 00 li r0,0 ffc1badc: 4b ff ff 58 b ffc1ba34 <_Timer_server_Body+0x144> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; ffc1bae0: 98 1f 00 7c stb r0,124(r31) ffc1bae4: 80 14 00 00 lwz r0,0(r20) ffc1bae8: 30 00 00 01 addic r0,r0,1 ffc1baec: 90 14 00 00 stw r0,0(r20) /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); ffc1baf0: 80 7f 00 00 lwz r3,0(r31) ffc1baf4: 38 80 00 08 li r4,8 ffc1baf8: 48 00 4c c1 bl ffc207b8 <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); ffc1bafc: 7f e3 fb 78 mr r3,r31 ffc1bb00: 4b ff fc c9 bl ffc1b7c8 <_Timer_server_Reset_interval_system_watchdog> _Timer_server_Reset_tod_system_watchdog( ts ); ffc1bb04: 7f e3 fb 78 mr r3,r31 ffc1bb08: 4b ff fd 55 bl ffc1b85c <_Timer_server_Reset_tod_system_watchdog> _Thread_Enable_dispatch(); ffc1bb0c: 48 00 40 05 bl ffc1fb10 <_Thread_Enable_dispatch> ts->active = true; ffc1bb10: 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 ); ffc1bb14: 7e 23 8b 78 mr r3,r17 ffc1bb18: 48 00 5b 11 bl ffc21628 <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); ffc1bb1c: 7e 43 93 78 mr r3,r18 ffc1bb20: 48 00 5b 09 bl ffc21628 <_Watchdog_Remove> ffc1bb24: 4b ff fe 74 b ffc1b998 <_Timer_server_Body+0xa8> =============================================================================== ffc1bb28 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc1bb28: 94 21 ff f0 stwu r1,-16(r1) ffc1bb2c: 7c 08 02 a6 mflr r0 ffc1bb30: 7c 89 23 78 mr r9,r4 ffc1bb34: 90 01 00 14 stw r0,20(r1) if ( ts->insert_chain == NULL ) { ffc1bb38: 80 03 00 78 lwz r0,120(r3) static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc1bb3c: 93 e1 00 0c stw r31,12(r1) ffc1bb40: 7c 7f 1b 78 mr r31,r3 if ( ts->insert_chain == NULL ) { ffc1bb44: 2f 80 00 00 cmpwi cr7,r0,0 ffc1bb48: 41 9e 00 20 beq- cr7,ffc1bb68 <_Timer_server_Schedule_operation_method+0x40><== ALWAYS TAKEN * 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 ); ffc1bb4c: 80 63 00 78 lwz r3,120(r3) <== NOT EXECUTED ffc1bb50: 48 00 0b e9 bl ffc1c738 <_Chain_Append> <== NOT EXECUTED } } ffc1bb54: 80 01 00 14 lwz r0,20(r1) <== NOT EXECUTED ffc1bb58: 83 e1 00 0c lwz r31,12(r1) <== NOT EXECUTED ffc1bb5c: 38 21 00 10 addi r1,r1,16 <== NOT EXECUTED ffc1bb60: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc1bb64: 4e 80 00 20 blr <== NOT EXECUTED ffc1bb68: 3d 60 00 00 lis r11,0 ffc1bb6c: 81 4b 28 a0 lwz r10,10400(r11) ffc1bb70: 38 0a 00 01 addi r0,r10,1 ffc1bb74: 90 0b 28 a0 stw r0,10400(r11) * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1bb78: 80 04 00 38 lwz r0,56(r4) ffc1bb7c: 2f 80 00 01 cmpwi cr7,r0,1 ffc1bb80: 41 9e 00 ac beq- cr7,ffc1bc2c <_Timer_server_Schedule_operation_method+0x104> _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 ) { ffc1bb84: 2f 80 00 03 cmpwi cr7,r0,3 ffc1bb88: 41 9e 00 1c beq- cr7,ffc1bba4 <_Timer_server_Schedule_operation_method+0x7c> if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); ffc1bb8c: 48 00 3f 85 bl ffc1fb10 <_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 ); } } ffc1bb90: 80 01 00 14 lwz r0,20(r1) ffc1bb94: 83 e1 00 0c lwz r31,12(r1) ffc1bb98: 38 21 00 10 addi r1,r1,16 ffc1bb9c: 7c 08 03 a6 mtlr r0 ffc1bba0: 4e 80 00 20 blr static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc1bba4: 7c c0 00 a6 mfmsr r6 ffc1bba8: 7c 10 42 a6 mfsprg r0,0 ffc1bbac: 7c c0 00 78 andc r0,r6,r0 ffc1bbb0: 7c 00 01 24 mtmsr r0 initialized = false; } #endif return status; } ffc1bbb4: 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 ); ffc1bbb8: 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(); ffc1bbbc: 3d 40 00 00 lis r10,0 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { ffc1bbc0: 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(); ffc1bbc4: 80 0a 28 b8 lwz r0,10424(r10) last_snapshot = ts->TOD_watchdogs.last_snapshot; ffc1bbc8: 81 43 00 74 lwz r10,116(r3) if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { ffc1bbcc: 41 9e 00 30 beq- cr7,ffc1bbfc <_Timer_server_Schedule_operation_method+0xd4> first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { ffc1bbd0: 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; ffc1bbd4: 80 eb 00 10 lwz r7,16(r11) } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; ffc1bbd8: 7d 07 52 14 add r8,r7,r10 delta_interval += delta; ffc1bbdc: 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 ) { ffc1bbe0: 40 9d 00 18 ble- cr7,ffc1bbf8 <_Timer_server_Schedule_operation_method+0xd0> /* * We advanced in time. */ delta = snapshot - last_snapshot; ffc1bbe4: 7d 4a 00 50 subf r10,r10,r0 if (delta_interval > delta) { ffc1bbe8: 7f 87 50 40 cmplw cr7,r7,r10 delta_interval -= delta; } else { delta_interval = 0; ffc1bbec: 39 00 00 00 li r8,0 if ( snapshot > last_snapshot ) { /* * We advanced in time. */ delta = snapshot - last_snapshot; if (delta_interval > delta) { ffc1bbf0: 40 9d 00 08 ble- cr7,ffc1bbf8 <_Timer_server_Schedule_operation_method+0xd0><== NEVER TAKEN delta_interval -= delta; ffc1bbf4: 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; ffc1bbf8: 91 0b 00 10 stw r8,16(r11) } ts->TOD_watchdogs.last_snapshot = snapshot; ffc1bbfc: 90 1f 00 74 stw r0,116(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc1bc00: 7c c0 01 24 mtmsr r6 _ISR_Enable( level ); _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); ffc1bc04: 38 7f 00 68 addi r3,r31,104 ffc1bc08: 38 89 00 10 addi r4,r9,16 ffc1bc0c: 48 00 58 4d bl ffc21458 <_Watchdog_Insert> if ( !ts->active ) { ffc1bc10: 88 1f 00 7c lbz r0,124(r31) ffc1bc14: 2f 80 00 00 cmpwi cr7,r0,0 ffc1bc18: 40 9e ff 74 bne+ cr7,ffc1bb8c <_Timer_server_Schedule_operation_method+0x64> _Timer_server_Reset_tod_system_watchdog( ts ); ffc1bc1c: 7f e3 fb 78 mr r3,r31 ffc1bc20: 4b ff fc 3d bl ffc1b85c <_Timer_server_Reset_tod_system_watchdog> } } _Thread_Enable_dispatch(); ffc1bc24: 48 00 3e ed bl ffc1fb10 <_Thread_Enable_dispatch> ffc1bc28: 4b ff ff 68 b ffc1bb90 <_Timer_server_Schedule_operation_method+0x68> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc1bc2c: 7c c0 00 a6 mfmsr r6 ffc1bc30: 7c 10 42 a6 mfsprg r0,0 ffc1bc34: 7c c0 00 78 andc r0,r6,r0 ffc1bc38: 7c 00 01 24 mtmsr r0 initialized = false; } #endif return status; } ffc1bc3c: 81 63 00 30 lwz r11,48(r3) ffc1bc40: 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; ffc1bc44: 3d 40 00 00 lis r10,0 last_snapshot = ts->Interval_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { ffc1bc48: 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; ffc1bc4c: 80 0a 28 dc lwz r0,10460(r10) last_snapshot = ts->Interval_watchdogs.last_snapshot; ffc1bc50: 81 03 00 3c lwz r8,60(r3) if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { ffc1bc54: 41 9e 00 20 beq- cr7,ffc1bc74 <_Timer_server_Schedule_operation_method+0x14c> /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; ffc1bc58: 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; ffc1bc5c: 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; ffc1bc60: 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) { ffc1bc64: 7f 88 38 40 cmplw cr7,r8,r7 ffc1bc68: 40 9c 00 08 bge- cr7,ffc1bc70 <_Timer_server_Schedule_operation_method+0x148> delta_interval -= delta; ffc1bc6c: 7d 48 38 50 subf r10,r8,r7 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; ffc1bc70: 91 4b 00 10 stw r10,16(r11) } ts->Interval_watchdogs.last_snapshot = snapshot; ffc1bc74: 90 1f 00 3c stw r0,60(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc1bc78: 7c c0 01 24 mtmsr r6 _ISR_Enable( level ); _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); ffc1bc7c: 38 7f 00 30 addi r3,r31,48 ffc1bc80: 38 89 00 10 addi r4,r9,16 ffc1bc84: 48 00 57 d5 bl ffc21458 <_Watchdog_Insert> if ( !ts->active ) { ffc1bc88: 88 1f 00 7c lbz r0,124(r31) ffc1bc8c: 2f 80 00 00 cmpwi cr7,r0,0 ffc1bc90: 40 9e fe fc bne+ cr7,ffc1bb8c <_Timer_server_Schedule_operation_method+0x64> _Timer_server_Reset_interval_system_watchdog( ts ); ffc1bc94: 7f e3 fb 78 mr r3,r31 ffc1bc98: 4b ff fb 31 bl ffc1b7c8 <_Timer_server_Reset_interval_system_watchdog> if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); ffc1bc9c: 48 00 3e 75 bl ffc1fb10 <_Thread_Enable_dispatch> ffc1bca0: 4b ff fe f0 b ffc1bb90 <_Timer_server_Schedule_operation_method+0x68> =============================================================================== ffc0ce80 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0ce80: 94 21 ff e0 stwu r1,-32(r1) ffc0ce84: 7c 08 02 a6 mflr r0 ffc0ce88: 93 c1 00 18 stw r30,24(r1) the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } ffc0ce8c: 3f c0 00 00 lis r30,0 ffc0ce90: 3b de 2d b4 addi r30,r30,11700 void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0ce94: 93 e1 00 1c stw r31,28(r1) the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } ffc0ce98: 83 fe 00 08 lwz r31,8(r30) void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0ce9c: 93 61 00 0c stw r27,12(r1) ffc0cea0: 7c 7b 1b 78 mr r27,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0cea4: 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 ) { ffc0cea8: 93 81 00 10 stw r28,16(r1) ffc0ceac: 7c 9c 23 78 mr r28,r4 ffc0ceb0: 93 a1 00 14 stw r29,20(r1) ffc0ceb4: 7c bd 2b 78 mr r29,r5 ffc0ceb8: 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 ); ffc0cebc: 41 9e 00 30 beq- cr7,ffc0ceec <_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 ) ffc0cec0: 80 1f 00 30 lwz r0,48(r31) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0cec4: 7f 63 db 78 mr r3,r27 ffc0cec8: 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 ) ffc0cecc: 2f 80 00 00 cmpwi cr7,r0,0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0ced0: 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 ) ffc0ced4: 41 9e 00 0c beq- cr7,ffc0cee0 <_User_extensions_Fatal+0x60> (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0ced8: 7c 09 03 a6 mtctr r0 ffc0cedc: 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 ) { ffc0cee0: 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 ); ffc0cee4: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0cee8: 40 9e ff d8 bne+ cr7,ffc0cec0 <_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 ); } } ffc0ceec: 80 01 00 24 lwz r0,36(r1) ffc0cef0: 83 61 00 0c lwz r27,12(r1) ffc0cef4: 7c 08 03 a6 mtlr r0 ffc0cef8: 83 81 00 10 lwz r28,16(r1) ffc0cefc: 83 a1 00 14 lwz r29,20(r1) ffc0cf00: 83 c1 00 18 lwz r30,24(r1) ffc0cf04: 83 e1 00 1c lwz r31,28(r1) ffc0cf08: 38 21 00 20 addi r1,r1,32 ffc0cf0c: 4e 80 00 20 blr =============================================================================== ffc0cc8c <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { ffc0cc8c: 94 21 ff e8 stwu r1,-24(r1) ffc0cc90: 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; ffc0cc94: 3c e0 00 00 lis r7,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0cc98: 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; ffc0cc9c: 38 e7 20 a0 addi r7,r7,8352 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0cca0: 3d 00 00 00 lis r8,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0cca4: 93 a1 00 0c stw r29,12(r1) ffc0cca8: 3d 40 00 00 lis r10,0 ffc0ccac: 39 68 2d b4 addi r11,r8,11700 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; ffc0ccb0: 83 a7 00 40 lwz r29,64(r7) ffc0ccb4: 39 2a 2c 70 addi r9,r10,11376 head->previous = NULL; ffc0ccb8: 38 00 00 00 li r0,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0ccbc: 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 ) { ffc0ccc0: 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; ffc0ccc4: 38 ab 00 04 addi r5,r11,4 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0ccc8: 93 81 00 08 stw r28,8(r1) ffc0cccc: 38 c9 00 04 addi r6,r9,4 ffc0ccd0: 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; ffc0ccd4: 83 c7 00 3c lwz r30,60(r7) ffc0ccd8: 90 a8 2d b4 stw r5,11700(r8) head->previous = NULL; ffc0ccdc: 90 0b 00 04 stw r0,4(r11) tail->previous = head; ffc0cce0: 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; ffc0cce4: 90 ca 2c 70 stw r6,11376(r10) head->previous = NULL; ffc0cce8: 90 09 00 04 stw r0,4(r9) tail->previous = head; ffc0ccec: 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 ) { ffc0ccf0: 41 9e 00 8c beq- cr7,ffc0cd7c <_User_extensions_Handler_initialization+0xf0><== NEVER TAKEN extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ffc0ccf4: 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 *) _Workspace_Allocate_or_fatal_error( ffc0ccf8: 7f 83 e3 78 mr r3,r28 ffc0ccfc: 48 00 08 c5 bl ffc0d5c0 <_Workspace_Allocate_or_fatal_error> number_of_extensions * sizeof( User_extensions_Control ) ); memset ( ffc0cd00: 38 80 00 00 li r4,0 ffc0cd04: 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 *) _Workspace_Allocate_or_fatal_error( ffc0cd08: 7c 7f 1b 78 mr r31,r3 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( ffc0cd0c: 48 00 74 69 bl ffc14174 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0cd10: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0cd14: 41 9e 00 68 beq- cr7,ffc0cd7c <_User_extensions_Handler_initialization+0xf0><== NEVER TAKEN ffc0cd18: 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; ffc0cd1c: 7f a9 eb 78 mr r9,r29 #include #include #include #include void _User_extensions_Handler_initialization(void) ffc0cd20: 57 80 28 34 rlwinm r0,r28,5,0,26 ffc0cd24: 7d 09 00 6e lwzux r8,r9,r0 _User_extensions_Add_set( extension ); ffc0cd28: 7f e3 fb 78 mr r3,r31 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0cd2c: 3b 9c 00 01 addi r28,r28,1 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; ffc0cd30: 81 49 00 04 lwz r10,4(r9) ffc0cd34: 81 69 00 08 lwz r11,8(r9) ffc0cd38: 80 09 00 0c lwz r0,12(r9) ffc0cd3c: 91 1f 00 14 stw r8,20(r31) ffc0cd40: 91 5f 00 18 stw r10,24(r31) ffc0cd44: 91 7f 00 1c stw r11,28(r31) ffc0cd48: 90 1f 00 20 stw r0,32(r31) ffc0cd4c: 81 09 00 10 lwz r8,16(r9) ffc0cd50: 81 49 00 14 lwz r10,20(r9) ffc0cd54: 81 69 00 18 lwz r11,24(r9) ffc0cd58: 80 09 00 1c lwz r0,28(r9) ffc0cd5c: 91 1f 00 24 stw r8,36(r31) ffc0cd60: 91 5f 00 28 stw r10,40(r31) ffc0cd64: 91 7f 00 2c stw r11,44(r31) ffc0cd68: 90 1f 00 30 stw r0,48(r31) _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; ffc0cd6c: 3b ff 00 34 addi r31,r31,52 _User_extensions_Add_set( extension ); ffc0cd70: 48 00 42 59 bl ffc10fc8 <_User_extensions_Add_set> extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0cd74: 7f 9e e0 40 cmplw cr7,r30,r28 ffc0cd78: 41 9d ff a4 bgt+ cr7,ffc0cd1c <_User_extensions_Handler_initialization+0x90> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; } } } ffc0cd7c: 80 01 00 1c lwz r0,28(r1) ffc0cd80: 83 81 00 08 lwz r28,8(r1) ffc0cd84: 7c 08 03 a6 mtlr r0 ffc0cd88: 83 a1 00 0c lwz r29,12(r1) ffc0cd8c: 83 c1 00 10 lwz r30,16(r1) ffc0cd90: 83 e1 00 14 lwz r31,20(r1) ffc0cd94: 38 21 00 18 addi r1,r1,24 ffc0cd98: 4e 80 00 20 blr =============================================================================== ffc0cd9c <_User_extensions_Thread_begin>: #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cd9c: 94 21 ff e8 stwu r1,-24(r1) the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } ffc0cda0: 3d 20 00 00 lis r9,0 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cda4: 7c 08 02 a6 mflr r0 ffc0cda8: 93 c1 00 10 stw r30,16(r1) the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } ffc0cdac: 3b c9 2d b4 addi r30,r9,11700 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0cdb0: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cdb4: 93 e1 00 14 stw r31,20(r1) the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } ffc0cdb8: 83 e9 2d b4 lwz r31,11700(r9) #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cdbc: 93 a1 00 0c stw r29,12(r1) ffc0cdc0: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0cdc4: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cdc8: 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 ); ffc0cdcc: 41 9e 00 28 beq- cr7,ffc0cdf4 <_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 ) ffc0cdd0: 80 1f 00 28 lwz r0,40(r31) (*the_extension->Callouts.thread_begin)( executing ); ffc0cdd4: 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 ) ffc0cdd8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cddc: 41 9e 00 0c beq- cr7,ffc0cde8 <_User_extensions_Thread_begin+0x4c> (*the_extension->Callouts.thread_begin)( executing ); ffc0cde0: 7c 09 03 a6 mtctr r0 ffc0cde4: 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 ) { ffc0cde8: 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 ); ffc0cdec: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0cdf0: 40 9e ff e0 bne+ cr7,ffc0cdd0 <_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 ); } } ffc0cdf4: 80 01 00 1c lwz r0,28(r1) ffc0cdf8: 83 a1 00 0c lwz r29,12(r1) ffc0cdfc: 7c 08 03 a6 mtlr r0 ffc0ce00: 83 c1 00 10 lwz r30,16(r1) ffc0ce04: 83 e1 00 14 lwz r31,20(r1) ffc0ce08: 38 21 00 18 addi r1,r1,24 ffc0ce0c: 4e 80 00 20 blr =============================================================================== ffc0cf10 <_User_extensions_Thread_create>: #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf10: 94 21 ff e8 stwu r1,-24(r1) return false; } } return true; } ffc0cf14: 3d 20 00 00 lis r9,0 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf18: 7c 08 02 a6 mflr r0 ffc0cf1c: 93 c1 00 10 stw r30,16(r1) return false; } } return true; } ffc0cf20: 3b c9 2d b4 addi r30,r9,11700 { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0cf24: 3b de 00 04 addi r30,r30,4 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf28: 93 e1 00 14 stw r31,20(r1) return false; } } return true; } ffc0cf2c: 83 e9 2d b4 lwz r31,11700(r9) #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf30: 93 a1 00 0c stw r29,12(r1) ffc0cf34: 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 ); ffc0cf38: 7f 9f f0 00 cmpw cr7,r31,r30 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf3c: 90 01 00 1c stw r0,28(r1) if ( !status ) return false; } } return true; ffc0cf40: 38 60 00 01 li r3,1 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf44: 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 ); ffc0cf48: 41 9e 00 40 beq- cr7,ffc0cf88 <_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)( ffc0cf4c: 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 ) { ffc0cf50: 80 1f 00 14 lwz r0,20(r31) status = (*the_extension->Callouts.thread_create)( ffc0cf54: 39 3c 31 04 addi r9,r28,12548 ffc0cf58: 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 ) { ffc0cf5c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cf60: 41 9e 00 18 beq- cr7,ffc0cf78 <_User_extensions_Thread_create+0x68> status = (*the_extension->Callouts.thread_create)( ffc0cf64: 80 69 00 0c lwz r3,12(r9) ffc0cf68: 7c 09 03 a6 mtctr r0 ffc0cf6c: 4e 80 04 21 bctrl _Thread_Executing, the_thread ); if ( !status ) ffc0cf70: 2f 83 00 00 cmpwi cr7,r3,0 ffc0cf74: 41 9e 00 34 beq- cr7,ffc0cfa8 <_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 ) { ffc0cf78: 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 ); ffc0cf7c: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0cf80: 40 9e ff d0 bne+ cr7,ffc0cf50 <_User_extensions_Thread_create+0x40> if ( !status ) return false; } } return true; ffc0cf84: 38 60 00 01 li r3,1 } ffc0cf88: 80 01 00 1c lwz r0,28(r1) ffc0cf8c: 83 81 00 08 lwz r28,8(r1) ffc0cf90: 7c 08 03 a6 mtlr r0 ffc0cf94: 83 a1 00 0c lwz r29,12(r1) ffc0cf98: 83 c1 00 10 lwz r30,16(r1) ffc0cf9c: 83 e1 00 14 lwz r31,20(r1) ffc0cfa0: 38 21 00 18 addi r1,r1,24 ffc0cfa4: 4e 80 00 20 blr ffc0cfa8: 80 01 00 1c lwz r0,28(r1) status = (*the_extension->Callouts.thread_create)( _Thread_Executing, the_thread ); if ( !status ) return false; ffc0cfac: 38 60 00 00 li r3,0 } } return true; } ffc0cfb0: 83 81 00 08 lwz r28,8(r1) ffc0cfb4: 7c 08 03 a6 mtlr r0 ffc0cfb8: 83 a1 00 0c lwz r29,12(r1) ffc0cfbc: 83 c1 00 10 lwz r30,16(r1) ffc0cfc0: 83 e1 00 14 lwz r31,20(r1) ffc0cfc4: 38 21 00 18 addi r1,r1,24 ffc0cfc8: 4e 80 00 20 blr =============================================================================== ffc0cfcc <_User_extensions_Thread_delete>: #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0cfcc: 94 21 ff e8 stwu r1,-24(r1) ffc0cfd0: 7c 08 02 a6 mflr r0 ffc0cfd4: 93 c1 00 10 stw r30,16(r1) (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } ffc0cfd8: 3f c0 00 00 lis r30,0 ffc0cfdc: 3b de 2d b4 addi r30,r30,11700 #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0cfe0: 93 e1 00 14 stw r31,20(r1) (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } ffc0cfe4: 83 fe 00 08 lwz r31,8(r30) #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0cfe8: 93 a1 00 0c stw r29,12(r1) ffc0cfec: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0cff0: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0cff4: 90 01 00 1c stw r0,28(r1) ffc0cff8: 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 ); ffc0cffc: 41 9e 00 34 beq- cr7,ffc0d030 <_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)( ffc0d000: 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 ) ffc0d004: 80 1f 00 20 lwz r0,32(r31) (*the_extension->Callouts.thread_delete)( ffc0d008: 39 3c 31 04 addi r9,r28,12548 ffc0d00c: 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 ) ffc0d010: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d014: 41 9e 00 10 beq- cr7,ffc0d024 <_User_extensions_Thread_delete+0x58> (*the_extension->Callouts.thread_delete)( ffc0d018: 80 69 00 0c lwz r3,12(r9) ffc0d01c: 7c 09 03 a6 mtctr r0 ffc0d020: 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 ) { ffc0d024: 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 ); ffc0d028: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d02c: 40 9e ff d8 bne+ cr7,ffc0d004 <_User_extensions_Thread_delete+0x38> (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } ffc0d030: 80 01 00 1c lwz r0,28(r1) ffc0d034: 83 81 00 08 lwz r28,8(r1) ffc0d038: 7c 08 03 a6 mtlr r0 ffc0d03c: 83 a1 00 0c lwz r29,12(r1) ffc0d040: 83 c1 00 10 lwz r30,16(r1) ffc0d044: 83 e1 00 14 lwz r31,20(r1) ffc0d048: 38 21 00 18 addi r1,r1,24 ffc0d04c: 4e 80 00 20 blr =============================================================================== ffc0ce10 <_User_extensions_Thread_exitted>: void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0ce10: 94 21 ff e8 stwu r1,-24(r1) ffc0ce14: 7c 08 02 a6 mflr r0 ffc0ce18: 93 c1 00 10 stw r30,16(r1) the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } ffc0ce1c: 3f c0 00 00 lis r30,0 ffc0ce20: 3b de 2d b4 addi r30,r30,11700 } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0ce24: 93 e1 00 14 stw r31,20(r1) the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } ffc0ce28: 83 fe 00 08 lwz r31,8(r30) } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0ce2c: 93 a1 00 0c stw r29,12(r1) ffc0ce30: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0ce34: 7f 9f f0 00 cmpw cr7,r31,r30 } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0ce38: 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 ); ffc0ce3c: 41 9e 00 28 beq- cr7,ffc0ce64 <_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 ) ffc0ce40: 80 1f 00 2c lwz r0,44(r31) (*the_extension->Callouts.thread_exitted)( executing ); ffc0ce44: 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 ) ffc0ce48: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ce4c: 41 9e 00 0c beq- cr7,ffc0ce58 <_User_extensions_Thread_exitted+0x48> (*the_extension->Callouts.thread_exitted)( executing ); ffc0ce50: 7c 09 03 a6 mtctr r0 ffc0ce54: 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 ) { ffc0ce58: 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 ); ffc0ce5c: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0ce60: 40 9e ff e0 bne+ cr7,ffc0ce40 <_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 ); } } ffc0ce64: 80 01 00 1c lwz r0,28(r1) ffc0ce68: 83 a1 00 0c lwz r29,12(r1) ffc0ce6c: 7c 08 03 a6 mtlr r0 ffc0ce70: 83 c1 00 10 lwz r30,16(r1) ffc0ce74: 83 e1 00 14 lwz r31,20(r1) ffc0ce78: 38 21 00 18 addi r1,r1,24 ffc0ce7c: 4e 80 00 20 blr =============================================================================== ffc0e1b4 <_User_extensions_Thread_restart>: #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1b4: 94 21 ff e8 stwu r1,-24(r1) (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e1b8: 3d 20 00 00 lis r9,0 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1bc: 7c 08 02 a6 mflr r0 ffc0e1c0: 93 c1 00 10 stw r30,16(r1) (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e1c4: 3b c9 2e 34 addi r30,r9,11828 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0e1c8: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1cc: 93 e1 00 14 stw r31,20(r1) (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e1d0: 83 e9 2e 34 lwz r31,11828(r9) #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1d4: 93 a1 00 0c stw r29,12(r1) ffc0e1d8: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0e1dc: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1e0: 90 01 00 1c stw r0,28(r1) ffc0e1e4: 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 ); ffc0e1e8: 41 9e 00 34 beq- cr7,ffc0e21c <_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)( ffc0e1ec: 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 ) ffc0e1f0: 80 1f 00 1c lwz r0,28(r31) (*the_extension->Callouts.thread_restart)( ffc0e1f4: 39 3c 31 84 addi r9,r28,12676 ffc0e1f8: 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 ) ffc0e1fc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e200: 41 9e 00 10 beq- cr7,ffc0e210 <_User_extensions_Thread_restart+0x5c> (*the_extension->Callouts.thread_restart)( ffc0e204: 80 69 00 0c lwz r3,12(r9) ffc0e208: 7c 09 03 a6 mtctr r0 ffc0e20c: 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 ) { ffc0e210: 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 ); ffc0e214: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0e218: 40 9e ff d8 bne+ cr7,ffc0e1f0 <_User_extensions_Thread_restart+0x3c> (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e21c: 80 01 00 1c lwz r0,28(r1) ffc0e220: 83 81 00 08 lwz r28,8(r1) ffc0e224: 7c 08 03 a6 mtlr r0 ffc0e228: 83 a1 00 0c lwz r29,12(r1) ffc0e22c: 83 c1 00 10 lwz r30,16(r1) ffc0e230: 83 e1 00 14 lwz r31,20(r1) ffc0e234: 38 21 00 18 addi r1,r1,24 ffc0e238: 4e 80 00 20 blr =============================================================================== ffc0d050 <_User_extensions_Thread_start>: #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d050: 94 21 ff e8 stwu r1,-24(r1) (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d054: 3d 20 00 00 lis r9,0 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d058: 7c 08 02 a6 mflr r0 ffc0d05c: 93 c1 00 10 stw r30,16(r1) (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d060: 3b c9 2d b4 addi r30,r9,11700 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d064: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d068: 93 e1 00 14 stw r31,20(r1) (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d06c: 83 e9 2d b4 lwz r31,11700(r9) #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d070: 93 a1 00 0c stw r29,12(r1) ffc0d074: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d078: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d07c: 90 01 00 1c stw r0,28(r1) ffc0d080: 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 ); ffc0d084: 41 9e 00 34 beq- cr7,ffc0d0b8 <_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)( ffc0d088: 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 ) ffc0d08c: 80 1f 00 18 lwz r0,24(r31) (*the_extension->Callouts.thread_start)( ffc0d090: 39 3c 31 04 addi r9,r28,12548 ffc0d094: 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 ) ffc0d098: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d09c: 41 9e 00 10 beq- cr7,ffc0d0ac <_User_extensions_Thread_start+0x5c> (*the_extension->Callouts.thread_start)( ffc0d0a0: 80 69 00 0c lwz r3,12(r9) ffc0d0a4: 7c 09 03 a6 mtctr r0 ffc0d0a8: 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 ) { ffc0d0ac: 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 ); ffc0d0b0: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d0b4: 40 9e ff d8 bne+ cr7,ffc0d08c <_User_extensions_Thread_start+0x3c> (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d0b8: 80 01 00 1c lwz r0,28(r1) ffc0d0bc: 83 81 00 08 lwz r28,8(r1) ffc0d0c0: 7c 08 03 a6 mtlr r0 ffc0d0c4: 83 a1 00 0c lwz r29,12(r1) ffc0d0c8: 83 c1 00 10 lwz r30,16(r1) ffc0d0cc: 83 e1 00 14 lwz r31,20(r1) ffc0d0d0: 38 21 00 18 addi r1,r1,24 ffc0d0d4: 4e 80 00 20 blr =============================================================================== ffc0d0d8 <_User_extensions_Thread_switch>: void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d0d8: 94 21 ff e8 stwu r1,-24(r1) the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d0dc: 3d 20 00 00 lis r9,0 void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d0e0: 7c 08 02 a6 mflr r0 ffc0d0e4: 93 c1 00 10 stw r30,16(r1) the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d0e8: 3b c9 2c 70 addi r30,r9,11376 ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); ffc0d0ec: 3b de 00 04 addi r30,r30,4 void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d0f0: 93 e1 00 14 stw r31,20(r1) the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d0f4: 83 e9 2c 70 lwz r31,11376(r9) void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d0f8: 93 81 00 08 stw r28,8(r1) ffc0d0fc: 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 ); ffc0d100: 7f 9f f0 00 cmpw cr7,r31,r30 void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d104: 93 a1 00 0c stw r29,12(r1) ffc0d108: 7c 9d 23 78 mr r29,r4 ffc0d10c: 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 ); ffc0d110: 41 9e 00 24 beq- cr7,ffc0d134 <_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 ); ffc0d114: 80 1f 00 08 lwz r0,8(r31) ffc0d118: 7f 83 e3 78 mr r3,r28 ffc0d11c: 7f a4 eb 78 mr r4,r29 ffc0d120: 7c 09 03 a6 mtctr r0 ffc0d124: 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 ) { ffc0d128: 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 ); ffc0d12c: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d130: 40 9e ff e4 bne+ cr7,ffc0d114 <_User_extensions_Thread_switch+0x3c> the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d134: 80 01 00 1c lwz r0,28(r1) ffc0d138: 83 81 00 08 lwz r28,8(r1) ffc0d13c: 7c 08 03 a6 mtlr r0 ffc0d140: 83 a1 00 0c lwz r29,12(r1) ffc0d144: 83 c1 00 10 lwz r30,16(r1) ffc0d148: 83 e1 00 14 lwz r31,20(r1) ffc0d14c: 38 21 00 18 addi r1,r1,24 ffc0d150: 4e 80 00 20 blr =============================================================================== ffc0f660 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { ffc0f660: 94 21 ff e0 stwu r1,-32(r1) ffc0f664: 7c 08 02 a6 mflr r0 ffc0f668: 93 c1 00 18 stw r30,24(r1) ffc0f66c: 7c be 2b 78 mr r30,r5 ffc0f670: 93 e1 00 1c stw r31,28(r1) ffc0f674: 7c 7f 1b 78 mr r31,r3 ffc0f678: 90 01 00 24 stw r0,36(r1) ffc0f67c: 93 61 00 0c stw r27,12(r1) ffc0f680: 93 81 00 10 stw r28,16(r1) ffc0f684: 93 a1 00 14 stw r29,20(r1) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0f688: 7c 00 00 a6 mfmsr r0 ffc0f68c: 7d 30 42 a6 mfsprg r9,0 ffc0f690: 7c 09 48 78 andc r9,r0,r9 ffc0f694: 7d 20 01 24 mtmsr r9 } } _ISR_Enable( level ); } ffc0f698: 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 ); ffc0f69c: 3b 83 00 04 addi r28,r3,4 Watchdog_Interval units ) { ISR_Level level; _ISR_Disable( level ); ffc0f6a0: 7c 0b 03 78 mr r11,r0 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { ffc0f6a4: 7f 89 e0 00 cmpw cr7,r9,r28 ffc0f6a8: 41 9e 00 74 beq- cr7,ffc0f71c <_Watchdog_Adjust+0xbc> switch ( direction ) { ffc0f6ac: 2f 84 00 00 cmpwi cr7,r4,0 ffc0f6b0: 40 9e 00 94 bne- cr7,ffc0f744 <_Watchdog_Adjust+0xe4> case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0f6b4: 2f 85 00 00 cmpwi cr7,r5,0 ffc0f6b8: 7c 0b 03 78 mr r11,r0 ffc0f6bc: 41 9e 00 60 beq- cr7,ffc0f71c <_Watchdog_Adjust+0xbc> <== NEVER TAKEN if ( units < _Watchdog_First( header )->delta_interval ) { ffc0f6c0: 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; ffc0f6c4: 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 ) { ffc0f6c8: 7f 85 e8 40 cmplw cr7,r5,r29 ffc0f6cc: 40 bc 00 18 bge+ cr7,ffc0f6e4 <_Watchdog_Adjust+0x84> <== ALWAYS TAKEN ffc0f6d0: 48 00 00 b0 b ffc0f780 <_Watchdog_Adjust+0x120> <== NOT EXECUTED switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0f6d4: 41 82 00 48 beq- ffc0f71c <_Watchdog_Adjust+0xbc> <== NEVER TAKEN if ( units < _Watchdog_First( header )->delta_interval ) { ffc0f6d8: 83 a9 00 10 lwz r29,16(r9) ffc0f6dc: 7f 9d f0 40 cmplw cr7,r29,r30 ffc0f6e0: 41 9d 00 a0 bgt- cr7,ffc0f780 <_Watchdog_Adjust+0x120> _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; ffc0f6e4: 93 69 00 10 stw r27,16(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0f6e8: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); _Watchdog_Tickle( header ); ffc0f6ec: 7f e3 fb 78 mr r3,r31 ffc0f6f0: 48 00 03 3d bl ffc0fa2c <_Watchdog_Tickle> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0f6f4: 7d 60 00 a6 mfmsr r11 ffc0f6f8: 7c 10 42 a6 mfsprg r0,0 ffc0f6fc: 7d 60 00 78 andc r0,r11,r0 ffc0f700: 7c 00 01 24 mtmsr r0 } } _ISR_Enable( level ); } ffc0f704: 80 1f 00 00 lwz r0,0(r31) switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0f708: 7f dd f0 51 subf. r30,r29,r30 _Watchdog_Tickle( header ); _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) ffc0f70c: 7f 9c 00 00 cmpw cr7,r28,r0 RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); ffc0f710: 7c 09 03 78 mr r9,r0 ffc0f714: 7d 60 5b 78 mr r0,r11 ffc0f718: 40 9e ff bc bne+ cr7,ffc0f6d4 <_Watchdog_Adjust+0x74> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0f71c: 7d 60 01 24 mtmsr r11 } } _ISR_Enable( level ); } ffc0f720: 80 01 00 24 lwz r0,36(r1) ffc0f724: 83 61 00 0c lwz r27,12(r1) ffc0f728: 7c 08 03 a6 mtlr r0 ffc0f72c: 83 81 00 10 lwz r28,16(r1) ffc0f730: 83 a1 00 14 lwz r29,20(r1) ffc0f734: 83 c1 00 18 lwz r30,24(r1) ffc0f738: 83 e1 00 1c lwz r31,28(r1) ffc0f73c: 38 21 00 20 addi r1,r1,32 ffc0f740: 4e 80 00 20 blr * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { ffc0f744: 2f 84 00 01 cmpwi cr7,r4,1 ffc0f748: 40 9e ff d4 bne+ cr7,ffc0f71c <_Watchdog_Adjust+0xbc> <== NEVER TAKEN case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; ffc0f74c: 80 09 00 10 lwz r0,16(r9) ffc0f750: 7f c0 2a 14 add r30,r0,r5 ffc0f754: 93 c9 00 10 stw r30,16(r9) ffc0f758: 7d 60 01 24 mtmsr r11 } } _ISR_Enable( level ); } ffc0f75c: 80 01 00 24 lwz r0,36(r1) ffc0f760: 83 61 00 0c lwz r27,12(r1) ffc0f764: 7c 08 03 a6 mtlr r0 ffc0f768: 83 81 00 10 lwz r28,16(r1) ffc0f76c: 83 a1 00 14 lwz r29,20(r1) ffc0f770: 83 c1 00 18 lwz r30,24(r1) ffc0f774: 83 e1 00 1c lwz r31,28(r1) ffc0f778: 38 21 00 20 addi r1,r1,32 ffc0f77c: 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; ffc0f780: 7f de e8 50 subf r30,r30,r29 ffc0f784: 93 c9 00 10 stw r30,16(r9) break; ffc0f788: 4b ff ff 94 b ffc0f71c <_Watchdog_Adjust+0xbc> =============================================================================== ffc213a0 <_Watchdog_Adjust_to_chain>: { Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; if ( units <= 0 ) { ffc213a0: 2c 04 00 00 cmpwi r4,0 Chain_Control *header, Watchdog_Interval units_arg, Chain_Control *to_fire ) { ffc213a4: 94 21 ff f0 stwu r1,-16(r1) ffc213a8: 93 e1 00 0c stw r31,12(r1) Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; if ( units <= 0 ) { ffc213ac: 41 82 00 94 beq- ffc21440 <_Watchdog_Adjust_to_chain+0xa0> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc213b0: 7c c0 00 a6 mfmsr r6 ffc213b4: 7c 10 42 a6 mfsprg r0,0 ffc213b8: 7c c0 00 78 andc r0,r6,r0 ffc213bc: 7c 00 01 24 mtmsr r0 return; } _ISR_Disable( level ); ffc213c0: 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; ffc213c4: 3b e0 00 00 li r31,0 ffc213c8: 38 e3 00 04 addi r7,r3,4 ffc213cc: 39 85 00 04 addi r12,r5,4 while ( 1 ) { if ( units <= 0 ) { break; } if ( _Chain_Is_empty( header ) ) { ffc213d0: 7f 89 38 00 cmpw cr7,r9,r7 ffc213d4: 41 9e 00 68 beq- cr7,ffc2143c <_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 ) { ffc213d8: 80 09 00 10 lwz r0,16(r9) ffc213dc: 7f 80 20 40 cmplw cr7,r0,r4 ffc213e0: 41 9d 00 6c bgt- cr7,ffc2144c <_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; ffc213e4: 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; ffc213e8: 7c 80 20 50 subf r4,r0,r4 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc213ec: 81 09 00 00 lwz r8,0(r9) previous = the_node->previous; ffc213f0: 81 49 00 04 lwz r10,4(r9) next->previous = previous; ffc213f4: 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; ffc213f8: 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; ffc213fc: 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; ffc21400: 91 89 00 00 stw r12,0(r9) tail->previous = the_node; old_last->next = the_node; ffc21404: 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; ffc21408: 91 25 00 08 stw r9,8(r5) old_last->next = the_node; the_node->previous = old_last; ffc2140c: 91 69 00 04 stw r11,4(r9) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; asm volatile ( ffc21410: 7c 00 00 a6 mfmsr r0 ffc21414: 7c c0 01 24 mtmsr r6 ffc21418: 7c 00 01 24 mtmsr r0 break; } } _ISR_Enable( level ); } ffc2141c: 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 ) ) ffc21420: 7f 87 48 00 cmpw cr7,r7,r9 ffc21424: 41 9e 00 10 beq- cr7,ffc21434 <_Watchdog_Adjust_to_chain+0x94> break; first = _Watchdog_First( header ); if ( first->delta_interval != 0 ) ffc21428: 80 09 00 10 lwz r0,16(r9) ffc2142c: 2f 80 00 00 cmpwi cr7,r0,0 ffc21430: 41 9e ff bc beq+ cr7,ffc213ec <_Watchdog_Adjust_to_chain+0x4c><== NEVER TAKEN } _ISR_Disable( level ); while ( 1 ) { if ( units <= 0 ) { ffc21434: 2f 84 00 00 cmpwi cr7,r4,0 ffc21438: 40 9e ff 98 bne+ cr7,ffc213d0 <_Watchdog_Adjust_to_chain+0x30> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc2143c: 7c c0 01 24 mtmsr r6 break; } } _ISR_Enable( level ); } ffc21440: 83 e1 00 0c lwz r31,12(r1) ffc21444: 38 21 00 10 addi r1,r1,16 ffc21448: 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; ffc2144c: 7c 04 00 50 subf r0,r4,r0 ffc21450: 90 09 00 10 stw r0,16(r9) break; ffc21454: 4b ff ff e8 b ffc2143c <_Watchdog_Adjust_to_chain+0x9c> =============================================================================== ffc0d154 <_Watchdog_Insert>: Watchdog_Control *after; uint32_t insert_isr_nest_level; Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; ffc0d154: 3d 20 00 00 lis r9,0 ffc0d158: 80 09 31 0c lwz r0,12556(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0d15c: 7c e0 00 a6 mfmsr r7 ffc0d160: 7d 30 42 a6 mfsprg r9,0 ffc0d164: 7c e9 48 78 andc r9,r7,r9 ffc0d168: 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 ) { ffc0d16c: 81 24 00 08 lwz r9,8(r4) ffc0d170: 2f 89 00 00 cmpwi cr7,r9,0 ffc0d174: 40 9e 01 0c bne- cr7,ffc0d280 <_Watchdog_Insert+0x12c> _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; _Watchdog_Sync_count++; ffc0d178: 3c a0 00 00 lis r5,0 ffc0d17c: 81 25 27 e0 lwz r9,10208(r5) if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; ffc0d180: 39 60 00 01 li r11,1 ffc0d184: 91 64 00 08 stw r11,8(r4) ffc0d188: 3d 80 00 00 lis r12,0 _Watchdog_Sync_count++; ffc0d18c: 39 29 00 01 addi r9,r9,1 ffc0d190: 91 25 27 e0 stw r9,10208(r5) restart: delta_interval = the_watchdog->initial; ffc0d194: 81 24 00 0c lwz r9,12(r4) RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); ffc0d198: 81 63 00 00 lwz r11,0(r3) for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d19c: 2f 89 00 00 cmpwi cr7,r9,0 ffc0d1a0: 41 9e 00 98 beq- cr7,ffc0d238 <_Watchdog_Insert+0xe4> ffc0d1a4: 81 4b 00 00 lwz r10,0(r11) ffc0d1a8: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d1ac: 41 9e 00 8c beq- cr7,ffc0d238 <_Watchdog_Insert+0xe4> break; if ( delta_interval < after->delta_interval ) { ffc0d1b0: 81 4b 00 10 lwz r10,16(r11) ffc0d1b4: 7f 89 50 40 cmplw cr7,r9,r10 ffc0d1b8: 41 9c 00 d0 blt- cr7,ffc0d288 <_Watchdog_Insert+0x134> static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; asm volatile ( ffc0d1bc: 7d 00 00 a6 mfmsr r8 ffc0d1c0: 7c e0 01 24 mtmsr r7 ffc0d1c4: 7d 00 01 24 mtmsr r8 delta_interval -= after->delta_interval; _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { ffc0d1c8: 81 04 00 08 lwz r8,8(r4) ffc0d1cc: 2f 88 00 01 cmpwi cr7,r8,1 ffc0d1d0: 40 9e 00 98 bne- cr7,ffc0d268 <_Watchdog_Insert+0x114> goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { ffc0d1d4: 81 0c 27 d0 lwz r8,10192(r12) ffc0d1d8: 38 cc 27 d0 addi r6,r12,10192 if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; ffc0d1dc: 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 ) { ffc0d1e0: 7f 80 40 40 cmplw cr7,r0,r8 ffc0d1e4: 40 bc 00 48 bge+ cr7,ffc0d22c <_Watchdog_Insert+0xd8> ffc0d1e8: 48 00 00 dc b ffc0d2c4 <_Watchdog_Insert+0x170> for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d1ec: 81 4b 00 00 lwz r10,0(r11) ffc0d1f0: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d1f4: 41 9e 00 44 beq- cr7,ffc0d238 <_Watchdog_Insert+0xe4> break; if ( delta_interval < after->delta_interval ) { ffc0d1f8: 81 4b 00 10 lwz r10,16(r11) ffc0d1fc: 7f 8a 48 40 cmplw cr7,r10,r9 ffc0d200: 41 9d 00 88 bgt- cr7,ffc0d288 <_Watchdog_Insert+0x134> ffc0d204: 7d 00 00 a6 mfmsr r8 ffc0d208: 7c e0 01 24 mtmsr r7 ffc0d20c: 7d 00 01 24 mtmsr r8 delta_interval -= after->delta_interval; _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { ffc0d210: 81 04 00 08 lwz r8,8(r4) if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; ffc0d214: 7d 2a 48 50 subf r9,r10,r9 _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { ffc0d218: 2f 88 00 01 cmpwi cr7,r8,1 ffc0d21c: 40 9e 00 4c bne- cr7,ffc0d268 <_Watchdog_Insert+0x114> <== NEVER TAKEN goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { ffc0d220: 81 46 00 00 lwz r10,0(r6) ffc0d224: 7f 80 50 40 cmplw cr7,r0,r10 ffc0d228: 41 9c 00 9c blt- cr7,ffc0d2c4 <_Watchdog_Insert+0x170> <== NEVER TAKEN for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d22c: 2f 89 00 00 cmpwi cr7,r9,0 exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; _Watchdog_Sync_count--; _ISR_Enable( level ); } ffc0d230: 81 6b 00 00 lwz r11,0(r11) for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d234: 40 9e ff b8 bne+ cr7,ffc0d1ec <_Watchdog_Insert+0x98> _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); ffc0d238: 81 6b 00 04 lwz r11,4(r11) the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d23c: 3d 00 00 00 lis r8,0 ffc0d240: 81 08 27 e4 lwz r8,10212(r8) RTEMS_INLINE_ROUTINE void _Watchdog_Activate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_ACTIVE; ffc0d244: 38 c0 00 02 li r6,2 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0d248: 81 4b 00 00 lwz r10,0(r11) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0d24c: 91 64 00 04 stw r11,4(r4) ffc0d250: 90 c4 00 08 stw r6,8(r4) } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; ffc0d254: 91 24 00 10 stw r9,16(r4) before_node = after_node->next; after_node->next = the_node; ffc0d258: 90 8b 00 00 stw r4,0(r11) the_node->next = before_node; before_node->previous = the_node; ffc0d25c: 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; ffc0d260: 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; ffc0d264: 91 04 00 14 stw r8,20(r4) exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; ffc0d268: 90 0c 27 d0 stw r0,10192(r12) _Watchdog_Sync_count--; ffc0d26c: 81 25 27 e0 lwz r9,10208(r5) ffc0d270: 38 09 ff ff addi r0,r9,-1 ffc0d274: 90 05 27 e0 stw r0,10208(r5) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0d278: 7c e0 01 24 mtmsr r7 ffc0d27c: 4e 80 00 20 blr ffc0d280: 7c e0 01 24 mtmsr r7 ffc0d284: 4e 80 00 20 blr if ( delta_interval == 0 || !_Watchdog_Next( after ) ) break; if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; ffc0d288: 7d 49 50 50 subf r10,r9,r10 ffc0d28c: 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; ffc0d290: 3d 00 00 00 lis r8,0 ffc0d294: 38 c0 00 02 li r6,2 _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); ffc0d298: 81 6b 00 04 lwz r11,4(r11) the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d29c: 81 08 27 e4 lwz r8,10212(r8) ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0d2a0: 81 4b 00 00 lwz r10,0(r11) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0d2a4: 91 64 00 04 stw r11,4(r4) ffc0d2a8: 90 c4 00 08 stw r6,8(r4) } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; ffc0d2ac: 91 24 00 10 stw r9,16(r4) before_node = after_node->next; after_node->next = the_node; ffc0d2b0: 90 8b 00 00 stw r4,0(r11) the_node->next = before_node; before_node->previous = the_node; ffc0d2b4: 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; ffc0d2b8: 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; ffc0d2bc: 91 04 00 14 stw r8,20(r4) ffc0d2c0: 4b ff ff a8 b ffc0d268 <_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; ffc0d2c4: 90 0c 27 d0 stw r0,10192(r12) goto restart; ffc0d2c8: 4b ff fe cc b ffc0d194 <_Watchdog_Insert+0x40> =============================================================================== ffc0d324 <_Watchdog_Remove>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0d324: 7d 20 00 a6 mfmsr r9 ffc0d328: 7c 10 42 a6 mfsprg r0,0 ffc0d32c: 7d 20 00 78 andc r0,r9,r0 ffc0d330: 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; ffc0d334: 80 03 00 08 lwz r0,8(r3) switch ( previous_state ) { ffc0d338: 2f 80 00 01 cmpwi cr7,r0,1 ffc0d33c: 41 9e 00 98 beq- cr7,ffc0d3d4 <_Watchdog_Remove+0xb0> ffc0d340: 2b 80 00 01 cmplwi cr7,r0,1 ffc0d344: 40 9c 00 1c bge- cr7,ffc0d360 <_Watchdog_Remove+0x3c> _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; ffc0d348: 3d 60 00 00 lis r11,0 ffc0d34c: 81 6b 27 e4 lwz r11,10212(r11) ffc0d350: 91 63 00 18 stw r11,24(r3) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0d354: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d358: 7c 03 03 78 mr r3,r0 ffc0d35c: 4e 80 00 20 blr Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; switch ( previous_state ) { ffc0d360: 2b 80 00 03 cmplwi cr7,r0,3 ffc0d364: 41 bd ff e4 bgt- cr7,ffc0d348 <_Watchdog_Remove+0x24> <== NEVER TAKEN } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; _ISR_Enable( level ); return( previous_state ); } ffc0d368: 81 63 00 00 lwz r11,0(r3) break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; ffc0d36c: 39 00 00 00 li r8,0 ffc0d370: 91 03 00 08 stw r8,8(r3) next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) ffc0d374: 81 4b 00 00 lwz r10,0(r11) ffc0d378: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d37c: 41 9e 00 14 beq- cr7,ffc0d390 <_Watchdog_Remove+0x6c> next_watchdog->delta_interval += the_watchdog->delta_interval; ffc0d380: 81 0b 00 10 lwz r8,16(r11) ffc0d384: 81 43 00 10 lwz r10,16(r3) ffc0d388: 7d 48 52 14 add r10,r8,r10 ffc0d38c: 91 4b 00 10 stw r10,16(r11) if ( _Watchdog_Sync_count ) ffc0d390: 3d 40 00 00 lis r10,0 ffc0d394: 81 4a 27 e0 lwz r10,10208(r10) ffc0d398: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d39c: 41 9e 00 14 beq- cr7,ffc0d3b0 <_Watchdog_Remove+0x8c> _Watchdog_Sync_level = _ISR_Nest_level; ffc0d3a0: 3d 40 00 00 lis r10,0 ffc0d3a4: 81 0a 31 0c lwz r8,12556(r10) ffc0d3a8: 3d 40 00 00 lis r10,0 ffc0d3ac: 91 0a 27 d0 stw r8,10192(r10) { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; ffc0d3b0: 81 43 00 04 lwz r10,4(r3) next->previous = previous; ffc0d3b4: 91 4b 00 04 stw r10,4(r11) previous->next = next; ffc0d3b8: 91 6a 00 00 stw r11,0(r10) _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; ffc0d3bc: 3d 60 00 00 lis r11,0 ffc0d3c0: 81 6b 27 e4 lwz r11,10212(r11) ffc0d3c4: 91 63 00 18 stw r11,24(r3) ffc0d3c8: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d3cc: 7c 03 03 78 mr r3,r0 ffc0d3d0: 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; ffc0d3d4: 39 60 00 00 li r11,0 ffc0d3d8: 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; ffc0d3dc: 3d 60 00 00 lis r11,0 ffc0d3e0: 81 6b 27 e4 lwz r11,10212(r11) ffc0d3e4: 91 63 00 18 stw r11,24(r3) ffc0d3e8: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d3ec: 7c 03 03 78 mr r3,r0 ffc0d3f0: 4e 80 00 20 blr =============================================================================== ffc0eda8 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { ffc0eda8: 94 21 ff e8 stwu r1,-24(r1) ffc0edac: 7c 08 02 a6 mflr r0 ffc0edb0: 93 c1 00 10 stw r30,16(r1) ffc0edb4: 7c 7e 1b 78 mr r30,r3 ffc0edb8: 93 e1 00 14 stw r31,20(r1) ffc0edbc: 7c 9f 23 78 mr r31,r4 ffc0edc0: 90 01 00 1c stw r0,28(r1) ffc0edc4: 93 81 00 08 stw r28,8(r1) ffc0edc8: 93 a1 00 0c stw r29,12(r1) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0edcc: 7f a0 00 a6 mfmsr r29 ffc0edd0: 7c 10 42 a6 mfsprg r0,0 ffc0edd4: 7f a0 00 78 andc r0,r29,r0 ffc0edd8: 7c 00 01 24 mtmsr r0 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); ffc0eddc: 3c 60 ff c2 lis r3,-62 ffc0ede0: 7f e5 fb 78 mr r5,r31 ffc0ede4: 38 63 2d b0 addi r3,r3,11696 ffc0ede8: 7f c4 f3 78 mr r4,r30 ffc0edec: 4c c6 31 82 crclr 4*cr1+eq ffc0edf0: 4b ff 7e 25 bl ffc06c14 printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } ffc0edf4: 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 ); ffc0edf8: 3b ff 00 04 addi r31,r31,4 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { ffc0edfc: 7f 9c f8 00 cmpw cr7,r28,r31 ffc0ee00: 41 9e 00 54 beq- cr7,ffc0ee54 <_Watchdog_Report_chain+0xac> node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); ffc0ee04: 7f 84 e3 78 mr r4,r28 ffc0ee08: 38 60 00 00 li r3,0 ffc0ee0c: 48 00 00 5d bl ffc0ee68 <_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 ) ffc0ee10: 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 ) ; ffc0ee14: 7f 9c f8 00 cmpw cr7,r28,r31 ffc0ee18: 40 9e ff ec bne+ cr7,ffc0ee04 <_Watchdog_Report_chain+0x5c><== NEVER TAKEN { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); ffc0ee1c: 3c 60 ff c2 lis r3,-62 ffc0ee20: 38 63 2d c8 addi r3,r3,11720 ffc0ee24: 7f c4 f3 78 mr r4,r30 ffc0ee28: 4c c6 31 82 crclr 4*cr1+eq ffc0ee2c: 4b ff 7d e9 bl ffc06c14 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0ee30: 7f a0 01 24 mtmsr r29 } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } ffc0ee34: 80 01 00 1c lwz r0,28(r1) ffc0ee38: 83 81 00 08 lwz r28,8(r1) ffc0ee3c: 7c 08 03 a6 mtlr r0 ffc0ee40: 83 a1 00 0c lwz r29,12(r1) ffc0ee44: 83 c1 00 10 lwz r30,16(r1) ffc0ee48: 83 e1 00 14 lwz r31,20(r1) ffc0ee4c: 38 21 00 18 addi r1,r1,24 ffc0ee50: 4e 80 00 20 blr _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); ffc0ee54: 3c 60 ff c2 lis r3,-62 ffc0ee58: 38 63 2d d8 addi r3,r3,11736 ffc0ee5c: 4c c6 31 82 crclr 4*cr1+eq ffc0ee60: 4b ff 7d b5 bl ffc06c14 ffc0ee64: 4b ff ff cc b ffc0ee30 <_Watchdog_Report_chain+0x88> =============================================================================== ffc08da0 : int adjtime( struct timeval *delta, struct timeval *olddelta ) { ffc08da0: 94 21 ff d8 stwu r1,-40(r1) ffc08da4: 7d 80 00 26 mfcr r12 ffc08da8: 7c 08 02 a6 mflr r0 ffc08dac: 93 e1 00 24 stw r31,36(r1) long adjustment; /* * Simple validations */ if ( !delta ) ffc08db0: 7c 7f 1b 79 mr. r31,r3 int adjtime( struct timeval *delta, struct timeval *olddelta ) { ffc08db4: 93 c1 00 20 stw r30,32(r1) ffc08db8: 7c 9e 23 78 mr r30,r4 ffc08dbc: 90 01 00 2c stw r0,44(r1) ffc08dc0: 93 a1 00 1c stw r29,28(r1) ffc08dc4: 91 81 00 18 stw r12,24(r1) long adjustment; /* * Simple validations */ if ( !delta ) ffc08dc8: 41 82 01 78 beq- ffc08f40 rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) ffc08dcc: 81 3f 00 04 lwz r9,4(r31) ffc08dd0: 3c 00 00 0f lis r0,15 ffc08dd4: 60 00 42 3f ori r0,r0,16959 ffc08dd8: 7f 89 00 40 cmplw cr7,r9,r0 ffc08ddc: 41 9d 01 64 bgt- cr7,ffc08f40 rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { ffc08de0: 2e 04 00 00 cmpwi cr4,r4,0 ffc08de4: 41 92 00 14 beq- cr4,ffc08df8 olddelta->tv_sec = 0; ffc08de8: 38 00 00 00 li r0,0 olddelta->tv_usec = 0; ffc08dec: 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; ffc08df0: 90 04 00 00 stw r0,0(r4) olddelta->tv_usec = 0; ffc08df4: 81 3f 00 04 lwz r9,4(r31) } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); ffc08df8: 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; ffc08dfc: 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); ffc08e00: 54 0a 40 2e rlwinm r10,r0,8,0,23 ffc08e04: 54 0b 18 38 rlwinm r11,r0,3,0,28 ffc08e08: 7d 6b 50 50 subf r11,r11,r10 ffc08e0c: 55 6a 30 32 rlwinm r10,r11,6,0,25 ffc08e10: 7d 6b 50 50 subf r11,r11,r10 ffc08e14: 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() ) ffc08e18: 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); ffc08e1c: 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() ) ffc08e20: 81 4b 20 ac lwz r10,8364(r11) olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); adjustment += delta->tv_usec; ffc08e24: 7d 29 02 14 add r9,r9,r0 /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) ffc08e28: 7f 89 50 40 cmplw cr7,r9,r10 ffc08e2c: 40 9c 00 28 bge- cr7,ffc08e54 /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; } ffc08e30: 80 01 00 2c lwz r0,44(r1) ffc08e34: 81 81 00 18 lwz r12,24(r1) ffc08e38: 7c 08 03 a6 mtlr r0 ffc08e3c: 83 a1 00 1c lwz r29,28(r1) ffc08e40: 83 c1 00 20 lwz r30,32(r1) ffc08e44: 7d 80 81 20 mtcrf 8,r12 ffc08e48: 83 e1 00 24 lwz r31,36(r1) ffc08e4c: 38 21 00 28 addi r1,r1,40 ffc08e50: 4e 80 00 20 blr rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc08e54: 3d 20 00 00 lis r9,0 ffc08e58: 81 69 28 e8 lwz r11,10472(r9) ffc08e5c: 38 0b 00 01 addi r0,r11,1 ffc08e60: 90 09 28 e8 stw r0,10472(r9) * This prevents context switches while we are adjusting the TOD */ _Thread_Disable_dispatch(); _TOD_Get( &ts ); ffc08e64: 3b a1 00 08 addi r29,r1,8 ffc08e68: 7f a3 eb 78 mr r3,r29 ffc08e6c: 48 00 1f f9 bl ffc0ae64 <_TOD_Get> ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; ffc08e70: 81 3f 00 04 lwz r9,4(r31) ffc08e74: 80 01 00 0c lwz r0,12(r1) ffc08e78: 1d 29 03 e8 mulli r9,r9,1000 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ffc08e7c: 81 41 00 08 lwz r10,8(r1) ffc08e80: 81 7f 00 00 lwz r11,0(r31) ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; ffc08e84: 7d 29 02 14 add r9,r9,r0 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08e88: 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; ffc08e8c: 91 21 00 0c stw r9,12(r1) /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08e90: 60 00 c9 ff ori r0,r0,51711 ffc08e94: 7f 89 00 40 cmplw cr7,r9,r0 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ffc08e98: 7d 6a 5a 14 add r11,r10,r11 ffc08e9c: 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 ) { ffc08ea0: 40 9d 00 20 ble- cr7,ffc08ec0 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ffc08ea4: 3d 29 c4 65 addis r9,r9,-15259 ffc08ea8: 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 ) { ffc08eac: 7f 89 00 40 cmplw cr7,r9,r0 * At one point there was a static variable named adjustment * used by this implementation. I don't see any reason for it * to be here based upon the GNU/Linux documentation. */ int adjtime( ffc08eb0: 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 ) { ffc08eb4: 41 9d ff f0 bgt+ cr7,ffc08ea4 <== NEVER TAKEN ffc08eb8: 91 21 00 0c stw r9,12(r1) ffc08ebc: 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) ) { ffc08ec0: 3c 00 c4 65 lis r0,-15259 ffc08ec4: 60 00 36 00 ori r0,r0,13824 ffc08ec8: 7f 89 00 40 cmplw cr7,r9,r0 ffc08ecc: 41 9d 00 24 bgt- cr7,ffc08ef0 <== NEVER TAKEN ffc08ed0: 81 61 00 08 lwz r11,8(r1) ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ffc08ed4: 3d 29 3b 9b addis r9,r9,15259 ffc08ed8: 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) ) { ffc08edc: 7f 89 00 40 cmplw cr7,r9,r0 * At one point there was a static variable named adjustment * used by this implementation. I don't see any reason for it * to be here based upon the GNU/Linux documentation. */ int adjtime( ffc08ee0: 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) ) { ffc08ee4: 40 9d ff f0 ble+ cr7,ffc08ed4 ffc08ee8: 91 21 00 0c stw r9,12(r1) ffc08eec: 91 61 00 08 stw r11,8(r1) ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ts.tv_sec--; } _TOD_Set( &ts ); ffc08ef0: 7f a3 eb 78 mr r3,r29 ffc08ef4: 48 00 20 41 bl ffc0af34 <_TOD_Set> _Thread_Enable_dispatch(); ffc08ef8: 48 00 3b c9 bl ffc0cac0 <_Thread_Enable_dispatch> /* set the user's output */ if ( olddelta ) ffc08efc: 41 92 00 3c beq- cr4,ffc08f38 *olddelta = *delta; return 0; } ffc08f00: 80 01 00 2c lwz r0,44(r1) /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; ffc08f04: 38 60 00 00 li r3,0 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08f08: 81 3f 00 00 lwz r9,0(r31) return 0; } ffc08f0c: 7c 08 03 a6 mtlr r0 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08f10: 81 5f 00 04 lwz r10,4(r31) return 0; } ffc08f14: 81 81 00 18 lwz r12,24(r1) _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08f18: 91 3e 00 00 stw r9,0(r30) return 0; } ffc08f1c: 7d 80 81 20 mtcrf 8,r12 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08f20: 91 5e 00 04 stw r10,4(r30) return 0; } ffc08f24: 83 a1 00 1c lwz r29,28(r1) ffc08f28: 83 c1 00 20 lwz r30,32(r1) ffc08f2c: 83 e1 00 24 lwz r31,36(r1) ffc08f30: 38 21 00 28 addi r1,r1,40 ffc08f34: 4e 80 00 20 blr /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; ffc08f38: 38 60 00 00 li r3,0 ffc08f3c: 4b ff fe f4 b ffc08e30 */ 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 ); ffc08f40: 48 00 b5 8d bl ffc144cc <__errno> ffc08f44: 38 00 00 16 li r0,22 ffc08f48: 90 03 00 00 stw r0,0(r3) ffc08f4c: 38 60 ff ff li r3,-1 ffc08f50: 4b ff fe e0 b ffc08e30 =============================================================================== ffc09834 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc09834: 94 21 ff e8 stwu r1,-24(r1) ffc09838: 7c 08 02 a6 mflr r0 ffc0983c: 93 e1 00 14 stw r31,20(r1) rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc09840: 3f e0 00 00 lis r31,0 ffc09844: 3b ff 2c 50 addi r31,r31,11344 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc09848: 93 a1 00 0c stw r29,12(r1) ffc0984c: 7c 7d 1b 78 mr r29,r3 rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc09850: 7f e3 fb 78 mr r3,r31 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc09854: 90 01 00 1c stw r0,28(r1) ffc09858: 93 c1 00 10 stw r30,16(r1) ffc0985c: 7c 9e 23 78 mr r30,r4 ffc09860: 93 81 00 08 stw r28,8(r1) rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc09864: 48 00 16 ad bl ffc0af10 if (fcntl (fildes, F_GETFD) < 0) { ffc09868: 7f a3 eb 78 mr r3,r29 ffc0986c: 38 80 00 01 li r4,1 ffc09870: 4c c6 31 82 crclr 4*cr1+eq ffc09874: 48 00 8f 09 bl ffc1277c ffc09878: 2f 83 00 00 cmpwi cr7,r3,0 ffc0987c: 41 9c 01 bc blt- cr7,ffc09a38 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) { ffc09880: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09884: 41 9e 01 08 beq- cr7,ffc0998c pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { ffc09888: 83 9e 00 00 lwz r28,0(r30) ffc0988c: 7f 9c e8 00 cmpw cr7,r28,r29 ffc09890: 40 9e 00 e0 bne- cr7,ffc09970 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); ffc09894: 38 7f 00 48 addi r3,r31,72 ffc09898: 7f 84 e3 78 mr r4,r28 ffc0989c: 38 a0 00 00 li r5,0 ffc098a0: 48 00 03 c1 bl ffc09c60 if (r_chain == NULL) { ffc098a4: 7c 7d 1b 79 mr. r29,r3 ffc098a8: 41 82 00 54 beq- ffc098fc return AIO_ALLDONE; } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); ffc098ac: 3b 9d 00 1c addi r28,r29,28 ffc098b0: 7f 83 e3 78 mr r3,r28 ffc098b4: 48 00 16 5d bl ffc0af10 result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); ffc098b8: 7f c4 f3 78 mr r4,r30 ffc098bc: 38 7d 00 08 addi r3,r29,8 ffc098c0: 48 00 09 25 bl ffc0a1e4 ffc098c4: 7c 7e 1b 78 mr r30,r3 pthread_mutex_unlock (&r_chain->mutex); ffc098c8: 7f 83 e3 78 mr r3,r28 ffc098cc: 48 00 17 11 bl ffc0afdc pthread_mutex_unlock (&aio_request_queue.mutex); ffc098d0: 7f e3 fb 78 mr r3,r31 ffc098d4: 48 00 17 09 bl ffc0afdc return result; } return AIO_ALLDONE; } ffc098d8: 80 01 00 1c lwz r0,28(r1) ffc098dc: 7f c3 f3 78 mr r3,r30 ffc098e0: 83 81 00 08 lwz r28,8(r1) ffc098e4: 7c 08 03 a6 mtlr r0 ffc098e8: 83 a1 00 0c lwz r29,12(r1) ffc098ec: 83 c1 00 10 lwz r30,16(r1) ffc098f0: 83 e1 00 14 lwz r31,20(r1) ffc098f4: 38 21 00 18 addi r1,r1,24 ffc098f8: 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)) { ffc098fc: 81 3f 00 54 lwz r9,84(r31) ffc09900: 38 1f 00 58 addi r0,r31,88 ffc09904: 7f 89 00 00 cmpw cr7,r9,r0 ffc09908: 41 9e 00 58 beq- cr7,ffc09960 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); ffc0990c: 38 7f 00 54 addi r3,r31,84 ffc09910: 7f 84 e3 78 mr r4,r28 ffc09914: 38 a0 00 00 li r5,0 ffc09918: 48 00 03 49 bl ffc09c60 if (r_chain == NULL) { ffc0991c: 2c 03 00 00 cmpwi r3,0 ffc09920: 41 82 00 50 beq- ffc09970 rtems_set_errno_and_return_minus_one (EINVAL); } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); ffc09924: 7f c4 f3 78 mr r4,r30 ffc09928: 38 63 00 08 addi r3,r3,8 ffc0992c: 48 00 08 b9 bl ffc0a1e4 ffc09930: 7c 7e 1b 78 mr r30,r3 pthread_mutex_unlock (&aio_request_queue.mutex); ffc09934: 7f e3 fb 78 mr r3,r31 ffc09938: 48 00 16 a5 bl ffc0afdc pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_unlock (&aio_request_queue.mutex); return result; } return AIO_ALLDONE; } ffc0993c: 80 01 00 1c lwz r0,28(r1) ffc09940: 7f c3 f3 78 mr r3,r30 ffc09944: 83 81 00 08 lwz r28,8(r1) ffc09948: 7c 08 03 a6 mtlr r0 ffc0994c: 83 a1 00 0c lwz r29,12(r1) ffc09950: 83 c1 00 10 lwz r30,16(r1) ffc09954: 83 e1 00 14 lwz r31,20(r1) ffc09958: 38 21 00 18 addi r1,r1,24 ffc0995c: 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); ffc09960: 7f e3 fb 78 mr r3,r31 ffc09964: 48 00 16 79 bl ffc0afdc return AIO_ALLDONE; ffc09968: 3b c0 00 02 li r30,2 ffc0996c: 4b ff ff 6c b ffc098d8 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); ffc09970: 7f e3 fb 78 mr r3,r31 ffc09974: 48 00 16 69 bl ffc0afdc rtems_set_errno_and_return_minus_one (EINVAL); ffc09978: 3b c0 ff ff li r30,-1 ffc0997c: 48 00 d3 21 bl ffc16c9c <__errno> ffc09980: 38 00 00 16 li r0,22 ffc09984: 90 03 00 00 stw r0,0(r3) ffc09988: 4b ff ff 50 b ffc098d8 /* 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); ffc0998c: 38 7f 00 48 addi r3,r31,72 ffc09990: 7f a4 eb 78 mr r4,r29 ffc09994: 38 a0 00 00 li r5,0 ffc09998: 48 00 02 c9 bl ffc09c60 if (r_chain == NULL) { ffc0999c: 7c 7e 1b 79 mr. r30,r3 ffc099a0: 41 82 00 38 beq- ffc099d8 return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); ffc099a4: 3b be 00 1c addi r29,r30,28 ffc099a8: 7f a3 eb 78 mr r3,r29 ffc099ac: 48 00 15 65 bl ffc0af10 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc099b0: 7f c3 f3 78 mr r3,r30 ffc099b4: 48 00 38 d5 bl ffc0d288 <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); ffc099b8: 7f c3 f3 78 mr r3,r30 ffc099bc: 48 00 07 a1 bl ffc0a15c pthread_mutex_unlock (&r_chain->mutex); ffc099c0: 7f a3 eb 78 mr r3,r29 ffc099c4: 48 00 16 19 bl ffc0afdc pthread_mutex_unlock (&aio_request_queue.mutex); ffc099c8: 7f e3 fb 78 mr r3,r31 ffc099cc: 48 00 16 11 bl ffc0afdc return AIO_CANCELED; ffc099d0: 3b c0 00 00 li r30,0 ffc099d4: 4b ff ff 04 b ffc098d8 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)) { ffc099d8: 81 3f 00 54 lwz r9,84(r31) ffc099dc: 38 1f 00 58 addi r0,r31,88 ffc099e0: 7f 89 00 00 cmpw cr7,r9,r0 ffc099e4: 41 be ff 7c beq- cr7,ffc09960 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); ffc099e8: 38 7f 00 54 addi r3,r31,84 ffc099ec: 7f a4 eb 78 mr r4,r29 ffc099f0: 38 a0 00 00 li r5,0 ffc099f4: 48 00 02 6d bl ffc09c60 if (r_chain == NULL) { ffc099f8: 7c 7e 1b 79 mr. r30,r3 ffc099fc: 41 a2 ff 64 beq- ffc09960 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); ffc09a00: 3b be 00 1c addi r29,r30,28 ffc09a04: 48 00 38 85 bl ffc0d288 <_Chain_Extract> } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); ffc09a08: 7f c3 f3 78 mr r3,r30 ffc09a0c: 48 00 07 51 bl ffc0a15c pthread_mutex_destroy (&r_chain->mutex); ffc09a10: 7f a3 eb 78 mr r3,r29 ffc09a14: 48 00 11 a9 bl ffc0abbc pthread_cond_destroy (&r_chain->mutex); ffc09a18: 7f a3 eb 78 mr r3,r29 ffc09a1c: 48 00 0c b5 bl ffc0a6d0 free (r_chain); ffc09a20: 7f c3 f3 78 mr r3,r30 ffc09a24: 4b ff bf 2d bl ffc05950 pthread_mutex_unlock (&aio_request_queue.mutex); ffc09a28: 7f e3 fb 78 mr r3,r31 ffc09a2c: 48 00 15 b1 bl ffc0afdc return AIO_CANCELED; ffc09a30: 3b c0 00 00 li r30,0 ffc09a34: 4b ff fe a4 b ffc098d8 int result; pthread_mutex_lock (&aio_request_queue.mutex); if (fcntl (fildes, F_GETFD) < 0) { pthread_mutex_unlock(&aio_request_queue.mutex); ffc09a38: 7f e3 fb 78 mr r3,r31 ffc09a3c: 48 00 15 a1 bl ffc0afdc rtems_set_errno_and_return_minus_one (EBADF); ffc09a40: 3b c0 ff ff li r30,-1 ffc09a44: 48 00 d2 59 bl ffc16c9c <__errno> ffc09a48: 38 00 00 09 li r0,9 ffc09a4c: 90 03 00 00 stw r0,0(r3) ffc09a50: 4b ff fe 88 b ffc098d8 =============================================================================== ffc09a5c : ) { rtems_aio_request *req; int mode; if (op != O_SYNC) ffc09a5c: 2f 83 20 00 cmpwi cr7,r3,8192 int aio_fsync( int op, struct aiocb *aiocbp ) { ffc09a60: 94 21 ff f0 stwu r1,-16(r1) ffc09a64: 7c 08 02 a6 mflr r0 ffc09a68: 93 e1 00 0c stw r31,12(r1) ffc09a6c: 7c 9f 23 78 mr r31,r4 ffc09a70: 90 01 00 14 stw r0,20(r1) ffc09a74: 93 c1 00 08 stw r30,8(r1) rtems_aio_request *req; int mode; if (op != O_SYNC) ffc09a78: 40 9e 00 94 bne- cr7,ffc09b0c rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc09a7c: 80 64 00 00 lwz r3,0(r4) ffc09a80: 38 80 00 03 li r4,3 ffc09a84: 4c c6 31 82 crclr 4*cr1+eq ffc09a88: 48 00 8c f5 bl ffc1277c if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc09a8c: 54 63 07 be clrlwi r3,r3,30 ffc09a90: 38 63 ff ff addi r3,r3,-1 ffc09a94: 2b 83 00 01 cmplwi cr7,r3,1 ffc09a98: 41 9d 00 40 bgt- cr7,ffc09ad8 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc09a9c: 38 60 00 18 li r3,24 ffc09aa0: 4b ff c6 61 bl ffc06100 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc09aa4: 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) ffc09aa8: 7c 69 1b 79 mr. r9,r3 ffc09aac: 41 82 00 30 beq- ffc09adc <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; ffc09ab0: 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; ffc09ab4: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_SYNC; ffc09ab8: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc09abc: 48 00 07 d5 bl ffc0a290 } ffc09ac0: 80 01 00 14 lwz r0,20(r1) ffc09ac4: 83 c1 00 08 lwz r30,8(r1) ffc09ac8: 7c 08 03 a6 mtlr r0 ffc09acc: 83 e1 00 0c lwz r31,12(r1) ffc09ad0: 38 21 00 10 addi r1,r1,16 ffc09ad4: 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); ffc09ad8: 3b c0 00 09 li r30,9 ffc09adc: 38 00 ff ff li r0,-1 ffc09ae0: 93 df 00 34 stw r30,52(r31) ffc09ae4: 90 1f 00 38 stw r0,56(r31) ffc09ae8: 48 00 d1 b5 bl ffc16c9c <__errno> req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } ffc09aec: 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); ffc09af0: 93 c3 00 00 stw r30,0(r3) ffc09af4: 38 60 ff ff li r3,-1 req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } ffc09af8: 7c 08 03 a6 mtlr r0 ffc09afc: 83 c1 00 08 lwz r30,8(r1) ffc09b00: 83 e1 00 0c lwz r31,12(r1) ffc09b04: 38 21 00 10 addi r1,r1,16 ffc09b08: 4e 80 00 20 blr { rtems_aio_request *req; int mode; if (op != O_SYNC) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); ffc09b0c: 3b c0 00 16 li r30,22 ffc09b10: 4b ff ff cc b ffc09adc =============================================================================== ffc0a4c8 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a4c8: 94 21 ff f0 stwu r1,-16(r1) ffc0a4cc: 7c 08 02 a6 mflr r0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a4d0: 38 80 00 03 li r4,3 * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a4d4: 90 01 00 14 stw r0,20(r1) ffc0a4d8: 93 e1 00 0c stw r31,12(r1) ffc0a4dc: 7c 7f 1b 78 mr r31,r3 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a4e0: 80 63 00 00 lwz r3,0(r3) * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a4e4: 93 c1 00 08 stw r30,8(r1) rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a4e8: 4c c6 31 82 crclr 4*cr1+eq ffc0a4ec: 48 00 82 91 bl ffc1277c if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc0a4f0: 70 63 00 03 andi. r3,r3,3 ffc0a4f4: 41 82 00 10 beq- ffc0a504 <== NEVER TAKEN ffc0a4f8: 2f 83 00 02 cmpwi cr7,r3,2 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); ffc0a4fc: 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))) ffc0a500: 40 9e 00 5c bne- cr7,ffc0a55c rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) ffc0a504: 80 1f 00 18 lwz r0,24(r31) ffc0a508: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a50c: 40 9e 00 4c bne- cr7,ffc0a558 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) ffc0a510: 80 1f 00 08 lwz r0,8(r31) ffc0a514: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a518: 41 9c 00 40 blt- cr7,ffc0a558 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc0a51c: 38 60 00 18 li r3,24 ffc0a520: 4b ff bb e1 bl ffc06100 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc0a524: 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) ffc0a528: 7c 69 1b 79 mr. r9,r3 ffc0a52c: 41 82 00 30 beq- ffc0a55c <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; ffc0a530: 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; ffc0a534: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_READ; ffc0a538: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc0a53c: 4b ff fd 55 bl ffc0a290 } ffc0a540: 80 01 00 14 lwz r0,20(r1) ffc0a544: 83 c1 00 08 lwz r30,8(r1) ffc0a548: 7c 08 03 a6 mtlr r0 ffc0a54c: 83 e1 00 0c lwz r31,12(r1) ffc0a550: 38 21 00 10 addi r1,r1,16 ffc0a554: 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); ffc0a558: 3b c0 00 16 li r30,22 ffc0a55c: 38 00 ff ff li r0,-1 ffc0a560: 93 df 00 34 stw r30,52(r31) ffc0a564: 90 1f 00 38 stw r0,56(r31) ffc0a568: 48 00 c7 35 bl ffc16c9c <__errno> ffc0a56c: 93 c3 00 00 stw r30,0(r3) ffc0a570: 38 60 ff ff li r3,-1 ffc0a574: 4b ff ff cc b ffc0a540 =============================================================================== ffc0a580 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a580: 94 21 ff f0 stwu r1,-16(r1) ffc0a584: 7c 08 02 a6 mflr r0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a588: 38 80 00 03 li r4,3 * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a58c: 90 01 00 14 stw r0,20(r1) ffc0a590: 93 e1 00 0c stw r31,12(r1) ffc0a594: 7c 7f 1b 78 mr r31,r3 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a598: 80 63 00 00 lwz r3,0(r3) * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a59c: 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); ffc0a5a0: 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); ffc0a5a4: 4c c6 31 82 crclr 4*cr1+eq ffc0a5a8: 48 00 81 d5 bl ffc1277c if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc0a5ac: 54 63 07 be clrlwi r3,r3,30 ffc0a5b0: 38 63 ff ff addi r3,r3,-1 ffc0a5b4: 2b 83 00 01 cmplwi cr7,r3,1 ffc0a5b8: 41 9d 00 5c bgt- cr7,ffc0a614 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) ffc0a5bc: 80 1f 00 18 lwz r0,24(r31) ffc0a5c0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a5c4: 40 9e 00 4c bne- cr7,ffc0a610 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) ffc0a5c8: 80 1f 00 08 lwz r0,8(r31) ffc0a5cc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a5d0: 41 9c 00 40 blt- cr7,ffc0a610 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc0a5d4: 38 60 00 18 li r3,24 ffc0a5d8: 4b ff bb 29 bl ffc06100 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc0a5dc: 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) ffc0a5e0: 7c 69 1b 79 mr. r9,r3 ffc0a5e4: 41 82 00 30 beq- ffc0a614 <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; ffc0a5e8: 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; ffc0a5ec: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_WRITE; ffc0a5f0: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc0a5f4: 4b ff fc 9d bl ffc0a290 } ffc0a5f8: 80 01 00 14 lwz r0,20(r1) ffc0a5fc: 83 c1 00 08 lwz r30,8(r1) ffc0a600: 7c 08 03 a6 mtlr r0 ffc0a604: 83 e1 00 0c lwz r31,12(r1) ffc0a608: 38 21 00 10 addi r1,r1,16 ffc0a60c: 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); ffc0a610: 3b c0 00 16 li r30,22 ffc0a614: 38 00 ff ff li r0,-1 ffc0a618: 93 df 00 34 stw r30,52(r31) ffc0a61c: 90 1f 00 38 stw r0,56(r31) ffc0a620: 48 00 c6 7d bl ffc16c9c <__errno> ffc0a624: 93 c3 00 00 stw r30,0(r3) ffc0a628: 38 60 ff ff li r3,-1 ffc0a62c: 4b ff ff cc b ffc0a5f8 =============================================================================== ffc08ba0 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { if ( !tp ) ffc08ba0: 2c 04 00 00 cmpwi r4,0 int clock_gettime( clockid_t clock_id, struct timespec *tp ) { ffc08ba4: 94 21 ff f8 stwu r1,-8(r1) ffc08ba8: 7c 08 02 a6 mflr r0 ffc08bac: 90 01 00 0c stw r0,12(r1) if ( !tp ) ffc08bb0: 41 82 00 24 beq- ffc08bd4 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { ffc08bb4: 2f 83 00 01 cmpwi cr7,r3,1 ffc08bb8: 41 9e 00 78 beq- cr7,ffc08c30 _TOD_Get(tp); return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { ffc08bbc: 2f 83 00 04 cmpwi cr7,r3,4 ffc08bc0: 41 9e 00 54 beq- cr7,ffc08c14 <== NEVER TAKEN return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { ffc08bc4: 2f 83 00 02 cmpwi cr7,r3,2 ffc08bc8: 41 9e 00 4c beq- cr7,ffc08c14 return 0; } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) ffc08bcc: 2f 83 00 03 cmpwi cr7,r3,3 ffc08bd0: 41 9e 00 24 beq- cr7,ffc08bf4 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif rtems_set_errno_and_return_minus_one( EINVAL ); ffc08bd4: 48 00 c0 69 bl ffc14c3c <__errno> ffc08bd8: 38 00 00 16 li r0,22 ffc08bdc: 90 03 00 00 stw r0,0(r3) ffc08be0: 38 60 ff ff li r3,-1 return 0; } ffc08be4: 80 01 00 0c lwz r0,12(r1) ffc08be8: 38 21 00 08 addi r1,r1,8 ffc08bec: 7c 08 03 a6 mtlr r0 ffc08bf0: 4e 80 00 20 blr } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); ffc08bf4: 48 00 c0 49 bl ffc14c3c <__errno> ffc08bf8: 38 00 00 58 li r0,88 ffc08bfc: 90 03 00 00 stw r0,0(r3) ffc08c00: 38 60 ff ff li r3,-1 #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08c04: 80 01 00 0c lwz r0,12(r1) ffc08c08: 38 21 00 08 addi r1,r1,8 ffc08c0c: 7c 08 03 a6 mtlr r0 ffc08c10: 4e 80 00 20 blr } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { _TOD_Get_uptime_as_timespec( tp ); ffc08c14: 7c 83 23 78 mr r3,r4 ffc08c18: 48 00 29 f9 bl ffc0b610 <_TOD_Get_uptime_as_timespec> #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08c1c: 80 01 00 0c lwz r0,12(r1) #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { _TOD_Get_uptime_as_timespec( tp ); return 0; ffc08c20: 38 60 00 00 li r3,0 #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08c24: 7c 08 03 a6 mtlr r0 ffc08c28: 38 21 00 08 addi r1,r1,8 ffc08c2c: 4e 80 00 20 blr { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { _TOD_Get(tp); ffc08c30: 7c 83 23 78 mr r3,r4 ffc08c34: 48 00 29 45 bl ffc0b578 <_TOD_Get> return 0; ffc08c38: 38 60 00 00 li r3,0 ffc08c3c: 4b ff ff a8 b ffc08be4 =============================================================================== ffc08c40 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { if ( !tp ) ffc08c40: 2c 04 00 00 cmpwi r4,0 int clock_settime( clockid_t clock_id, const struct timespec *tp ) { ffc08c44: 94 21 ff f8 stwu r1,-8(r1) ffc08c48: 7c 08 02 a6 mflr r0 ffc08c4c: 90 01 00 0c stw r0,12(r1) if ( !tp ) ffc08c50: 41 82 00 1c beq- ffc08c6c <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { ffc08c54: 2f 83 00 01 cmpwi cr7,r3,1 ffc08c58: 41 9e 00 34 beq- cr7,ffc08c8c _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) ffc08c5c: 2f 83 00 02 cmpwi cr7,r3,2 ffc08c60: 41 9e 00 70 beq- cr7,ffc08cd0 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) ffc08c64: 2f 83 00 03 cmpwi cr7,r3,3 ffc08c68: 41 9e 00 68 beq- cr7,ffc08cd0 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); ffc08c6c: 48 00 bf d1 bl ffc14c3c <__errno> ffc08c70: 38 00 00 16 li r0,22 ffc08c74: 90 03 00 00 stw r0,0(r3) ffc08c78: 38 60 ff ff li r3,-1 return 0; } ffc08c7c: 80 01 00 0c lwz r0,12(r1) ffc08c80: 38 21 00 08 addi r1,r1,8 ffc08c84: 7c 08 03 a6 mtlr r0 ffc08c88: 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 ) ffc08c8c: 81 24 00 00 lwz r9,0(r4) ffc08c90: 3c 00 21 da lis r0,8666 ffc08c94: 60 00 e4 ff ori r0,r0,58623 ffc08c98: 7f 89 00 40 cmplw cr7,r9,r0 ffc08c9c: 40 bd ff d0 ble- cr7,ffc08c6c rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc08ca0: 3d 20 00 00 lis r9,0 ffc08ca4: 81 69 28 38 lwz r11,10296(r9) ffc08ca8: 38 0b 00 01 addi r0,r11,1 ffc08cac: 90 09 28 38 stw r0,10296(r9) rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); ffc08cb0: 7c 83 23 78 mr r3,r4 ffc08cb4: 48 00 29 d5 bl ffc0b688 <_TOD_Set> _Thread_Enable_dispatch(); ffc08cb8: 48 00 45 5d bl ffc0d214 <_Thread_Enable_dispatch> #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08cbc: 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; ffc08cc0: 38 60 00 00 li r3,0 } ffc08cc4: 7c 08 03 a6 mtlr r0 ffc08cc8: 38 21 00 08 addi r1,r1,8 ffc08ccc: 4e 80 00 20 blr else if ( clock_id == CLOCK_PROCESS_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); ffc08cd0: 48 00 bf 6d bl ffc14c3c <__errno> ffc08cd4: 38 00 00 58 li r0,88 ffc08cd8: 90 03 00 00 stw r0,0(r3) ffc08cdc: 38 60 ff ff li r3,-1 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08ce0: 80 01 00 0c lwz r0,12(r1) ffc08ce4: 38 21 00 08 addi r1,r1,8 ffc08ce8: 7c 08 03 a6 mtlr r0 ffc08cec: 4e 80 00 20 blr =============================================================================== ffc29fb4 : int killinfo( pid_t pid, int sig, const union sigval *value ) { ffc29fb4: 94 21 ff d0 stwu r1,-48(r1) ffc29fb8: 7c 08 02 a6 mflr r0 ffc29fbc: 93 61 00 1c stw r27,28(r1) ffc29fc0: 7c bb 2b 78 mr r27,r5 ffc29fc4: 93 81 00 20 stw r28,32(r1) ffc29fc8: 7c 9c 23 78 mr r28,r4 ffc29fcc: 93 e1 00 2c stw r31,44(r1) ffc29fd0: 7c 7f 1b 78 mr r31,r3 ffc29fd4: 90 01 00 34 stw r0,52(r1) ffc29fd8: 93 41 00 18 stw r26,24(r1) ffc29fdc: 93 a1 00 24 stw r29,36(r1) ffc29fe0: 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() ) ffc29fe4: 4b ff fb b9 bl ffc29b9c ffc29fe8: 7f 83 f8 00 cmpw cr7,r3,r31 ffc29fec: 40 9e 02 9c bne- cr7,ffc2a288 rtems_set_errno_and_return_minus_one( ESRCH ); /* * Validate the signal passed. */ if ( !sig ) ffc29ff0: 2f 9c 00 00 cmpwi cr7,r28,0 ffc29ff4: 41 9e 02 a8 beq- cr7,ffc2a29c static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc29ff8: 3b fc ff ff addi r31,r28,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc29ffc: 2b 9f 00 1f cmplwi cr7,r31,31 ffc2a000: 41 9d 02 9c bgt- cr7,ffc2a29c 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 ) ffc2a004: 1f dc 00 0c mulli r30,r28,12 ffc2a008: 3f a0 00 00 lis r29,0 ffc2a00c: 3b bd 32 e0 addi r29,r29,13024 ffc2a010: 7d 3d f2 14 add r9,r29,r30 ffc2a014: 80 09 00 08 lwz r0,8(r9) return 0; ffc2a018: 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 ) ffc2a01c: 2f 80 00 01 cmpwi cr7,r0,1 ffc2a020: 41 9e 01 ac beq- cr7,ffc2a1cc /* * 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 ) ) ffc2a024: 2f 9c 00 08 cmpwi cr7,r28,8 ffc2a028: 41 9e 01 cc beq- cr7,ffc2a1f4 ffc2a02c: 2f 9c 00 04 cmpwi cr7,r28,4 ffc2a030: 41 9e 01 c4 beq- cr7,ffc2a1f4 ffc2a034: 2f 9c 00 0b cmpwi cr7,r28,11 ffc2a038: 41 9e 01 bc beq- cr7,ffc2a1f4 * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { ffc2a03c: 2f 9b 00 00 cmpwi cr7,r27,0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; ffc2a040: 93 81 00 08 stw r28,8(r1) static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); ffc2a044: 38 00 00 01 li r0,1 ffc2a048: 7c 1f f8 30 slw r31,r0,r31 siginfo->si_code = SI_USER; ffc2a04c: 90 01 00 0c stw r0,12(r1) if ( !value ) { ffc2a050: 41 9e 02 1c beq- cr7,ffc2a26c siginfo->si_value.sival_int = 0; } else { siginfo->si_value = *value; ffc2a054: 80 1b 00 00 lwz r0,0(r27) ffc2a058: 90 01 00 10 stw r0,16(r1) ffc2a05c: 3d 20 00 00 lis r9,0 ffc2a060: 81 69 28 2c lwz r11,10284(r9) ffc2a064: 38 0b 00 01 addi r0,r11,1 ffc2a068: 90 09 28 2c stw r0,10284(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; ffc2a06c: 3d 20 00 00 lis r9,0 ffc2a070: 80 69 32 90 lwz r3,12944(r9) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { ffc2a074: 81 23 01 34 lwz r9,308(r3) ffc2a078: 80 09 00 d0 lwz r0,208(r9) ffc2a07c: 7f e6 00 79 andc. r6,r31,r0 ffc2a080: 40 82 01 1c bne- ffc2a19c } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } ffc2a084: 3d 20 00 00 lis r9,0 ffc2a088: 39 49 34 6c addi r10,r9,13420 ffc2a08c: 81 29 34 6c lwz r9,13420(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 ); ffc2a090: 39 4a 00 04 addi r10,r10,4 ffc2a094: 7f 89 50 00 cmpw cr7,r9,r10 ffc2a098: 41 9e 00 54 beq- cr7,ffc2a0ec #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc2a09c: 80 09 00 30 lwz r0,48(r9) 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; ffc2a0a0: 7d 23 4b 78 mr r3,r9 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc2a0a4: 81 69 01 34 lwz r11,308(r9) #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc2a0a8: 7f e8 00 39 and. r8,r31,r0 ffc2a0ac: 40 82 00 f0 bne- ffc2a19c /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) ffc2a0b0: 80 0b 00 d0 lwz r0,208(r11) ffc2a0b4: 7f eb 00 79 andc. r11,r31,r0 ffc2a0b8: 41 a2 00 24 beq+ ffc2a0dc ffc2a0bc: 48 00 00 e0 b ffc2a19c #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc2a0c0: 80 09 00 30 lwz r0,48(r9) <== 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 ]; ffc2a0c4: 81 69 01 34 lwz r11,308(r9) <== NOT EXECUTED #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc2a0c8: 7f fa 00 39 and. r26,r31,r0 <== NOT EXECUTED ffc2a0cc: 40 82 00 d0 bne- ffc2a19c <== NOT EXECUTED /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) ffc2a0d0: 80 0b 00 d0 lwz r0,208(r11) <== NOT EXECUTED ffc2a0d4: 7f fb 00 79 andc. r27,r31,r0 <== NOT EXECUTED ffc2a0d8: 40 82 00 c4 bne- ffc2a19c <== 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 ) { ffc2a0dc: 81 29 00 00 lwz r9,0(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 ); ffc2a0e0: 7f 89 50 00 cmpw cr7,r9,r10 !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; ffc2a0e4: 7d 23 4b 78 mr r3,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 ); ffc2a0e8: 40 9e ff d8 bne+ cr7,ffc2a0c0 <== NEVER TAKEN * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; ffc2a0ec: 3d 20 00 00 lis r9,0 ffc2a0f0: 88 e9 27 6c lbz r7,10092(r9) ffc2a0f4: 3c a0 00 00 lis r5,0 ffc2a0f8: 38 a5 2d 84 addi r5,r5,11652 ffc2a0fc: 38 e7 00 01 addi r7,r7,1 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( ffc2a100: 38 85 00 08 addi r4,r5,8 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; ffc2a104: 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 ] ) ffc2a108: 85 25 00 04 lwzu r9,4(r5) ffc2a10c: 2f 89 00 00 cmpwi cr7,r9,0 ffc2a110: 41 9e 00 7c beq- cr7,ffc2a18c <== NEVER TAKEN continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; ffc2a114: 81 29 00 04 lwz r9,4(r9) */ if ( !the_info ) continue; #endif maximum = the_info->maximum; ffc2a118: a1 09 00 10 lhz r8,16(r9) object_table = the_info->local_table; ffc2a11c: 81 49 00 1c lwz r10,28(r9) for ( index = 1 ; index <= maximum ; index++ ) { ffc2a120: 2f 88 00 00 cmpwi cr7,r8,0 ffc2a124: 41 9e 00 68 beq- cr7,ffc2a18c ffc2a128: 39 60 00 01 li r11,1 the_thread = (Thread_Control *) object_table[ index ]; ffc2a12c: 85 2a 00 04 lwzu r9,4(r10) if ( !the_thread ) ffc2a130: 2f 89 00 00 cmpwi cr7,r9,0 ffc2a134: 41 9e 00 4c beq- cr7,ffc2a180 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) ffc2a138: 80 09 00 14 lwz r0,20(r9) ffc2a13c: 7f 80 38 40 cmplw cr7,r0,r7 ffc2a140: 41 9d 00 40 bgt- cr7,ffc2a180 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) ffc2a144: 80 c9 01 34 lwz r6,308(r9) ffc2a148: 80 c6 00 d0 lwz r6,208(r6) ffc2a14c: 7f fa 30 79 andc. r26,r31,r6 ffc2a150: 41 82 00 30 beq- ffc2a180 * * 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 ) { ffc2a154: 41 9c 00 24 blt- cr7,ffc2a178 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { ffc2a158: 2f 83 00 00 cmpwi cr7,r3,0 ffc2a15c: 41 9e 00 24 beq- cr7,ffc2a180 <== NEVER TAKEN ffc2a160: 80 c3 00 10 lwz r6,16(r3) ffc2a164: 2f 86 00 00 cmpwi cr7,r6,0 ffc2a168: 41 9e 00 18 beq- cr7,ffc2a180 <== NEVER TAKEN /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { ffc2a16c: 83 69 00 10 lwz r27,16(r9) ffc2a170: 2f 9b 00 00 cmpwi cr7,r27,0 ffc2a174: 40 9e 01 00 bne- cr7,ffc2a274 ffc2a178: 7c 07 03 78 mr r7,r0 ffc2a17c: 7d 23 4b 78 mr r3,r9 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { ffc2a180: 39 6b 00 01 addi r11,r11,1 ffc2a184: 7f 88 58 40 cmplw cr7,r8,r11 ffc2a188: 40 9c ff a4 bge+ cr7,ffc2a12c * + 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++) { ffc2a18c: 7f 85 20 00 cmpw cr7,r5,r4 ffc2a190: 40 be ff 78 bne- cr7,ffc2a108 } } } } if ( interested ) { ffc2a194: 2f 83 00 00 cmpwi cr7,r3,0 ffc2a198: 41 9e 00 18 beq- cr7,ffc2a1b0 /* * 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 ) ) { ffc2a19c: 7f 84 e3 78 mr r4,r28 ffc2a1a0: 38 a1 00 08 addi r5,r1,8 ffc2a1a4: 48 00 01 4d bl ffc2a2f0 <_POSIX_signals_Unblock_thread> ffc2a1a8: 2f 83 00 00 cmpwi cr7,r3,0 ffc2a1ac: 40 9e 00 18 bne- cr7,ffc2a1c4 /* * 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 ); ffc2a1b0: 7f e3 fb 78 mr r3,r31 ffc2a1b4: 48 00 01 15 bl ffc2a2c8 <_POSIX_signals_Set_process_signals> if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { ffc2a1b8: 7c 1d f0 2e lwzx r0,r29,r30 ffc2a1bc: 2f 80 00 02 cmpwi cr7,r0,2 ffc2a1c0: 41 9e 00 68 beq- cr7,ffc2a228 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); ffc2a1c4: 4b fe 8b ad bl ffc12d70 <_Thread_Enable_dispatch> return 0; ffc2a1c8: 38 60 00 00 li r3,0 } ffc2a1cc: 80 01 00 34 lwz r0,52(r1) ffc2a1d0: 83 41 00 18 lwz r26,24(r1) ffc2a1d4: 7c 08 03 a6 mtlr r0 ffc2a1d8: 83 61 00 1c lwz r27,28(r1) ffc2a1dc: 83 81 00 20 lwz r28,32(r1) ffc2a1e0: 83 a1 00 24 lwz r29,36(r1) ffc2a1e4: 83 c1 00 28 lwz r30,40(r1) ffc2a1e8: 83 e1 00 2c lwz r31,44(r1) ffc2a1ec: 38 21 00 30 addi r1,r1,48 ffc2a1f0: 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 ); ffc2a1f4: 48 00 03 75 bl ffc2a568 ffc2a1f8: 7f 84 e3 78 mr r4,r28 ffc2a1fc: 48 00 02 61 bl ffc2a45c } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } ffc2a200: 80 01 00 34 lwz r0,52(r1) ffc2a204: 83 41 00 18 lwz r26,24(r1) ffc2a208: 7c 08 03 a6 mtlr r0 ffc2a20c: 83 61 00 1c lwz r27,28(r1) ffc2a210: 83 81 00 20 lwz r28,32(r1) ffc2a214: 83 a1 00 24 lwz r29,36(r1) ffc2a218: 83 c1 00 28 lwz r30,40(r1) ffc2a21c: 83 e1 00 2c lwz r31,44(r1) ffc2a220: 38 21 00 30 addi r1,r1,48 ffc2a224: 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 *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); ffc2a228: 3c 60 00 00 lis r3,0 ffc2a22c: 38 63 34 60 addi r3,r3,13408 ffc2a230: 4b fe 69 59 bl ffc10b88 <_Chain_Get> if ( !psiginfo ) { ffc2a234: 7c 69 1b 79 mr. r9,r3 ffc2a238: 41 82 00 78 beq- ffc2a2b0 _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc2a23c: 80 01 00 08 lwz r0,8(r1) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc2a240: 3c 60 00 00 lis r3,0 ffc2a244: 38 63 34 d4 addi r3,r3,13524 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc2a248: 90 09 00 08 stw r0,8(r9) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc2a24c: 7c 63 f2 14 add r3,r3,r30 ffc2a250: 7d 24 4b 78 mr r4,r9 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc2a254: 80 01 00 0c lwz r0,12(r1) ffc2a258: 90 09 00 0c stw r0,12(r9) ffc2a25c: 80 01 00 10 lwz r0,16(r1) ffc2a260: 90 09 00 10 stw r0,16(r9) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc2a264: 4b fe 68 cd bl ffc10b30 <_Chain_Append> ffc2a268: 4b ff ff 5c b ffc2a1c4 */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { siginfo->si_value.sival_int = 0; ffc2a26c: 93 61 00 10 stw r27,16(r1) ffc2a270: 4b ff fd ec b ffc2a05c continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { ffc2a274: 74 da 10 00 andis. r26,r6,4096 ffc2a278: 40 a2 ff 08 bne- ffc2a180 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { ffc2a27c: 77 66 10 00 andis. r6,r27,4096 ffc2a280: 41 a2 ff 00 beq- ffc2a180 ffc2a284: 4b ff fe f4 b ffc2a178 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) rtems_set_errno_and_return_minus_one( ESRCH ); ffc2a288: 4b ff 03 f9 bl ffc1a680 <__errno> ffc2a28c: 38 00 00 03 li r0,3 ffc2a290: 90 03 00 00 stw r0,0(r3) ffc2a294: 38 60 ff ff li r3,-1 ffc2a298: 4b ff ff 34 b ffc2a1cc */ if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc2a29c: 4b ff 03 e5 bl ffc1a680 <__errno> ffc2a2a0: 38 00 00 16 li r0,22 ffc2a2a4: 90 03 00 00 stw r0,0(r3) ffc2a2a8: 38 60 ff ff li r3,-1 ffc2a2ac: 4b ff ff 20 b ffc2a1cc 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(); ffc2a2b0: 4b fe 8a c1 bl ffc12d70 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); ffc2a2b4: 4b ff 03 cd bl ffc1a680 <__errno> ffc2a2b8: 38 00 00 0b li r0,11 ffc2a2bc: 90 03 00 00 stw r0,0(r3) ffc2a2c0: 38 60 ff ff li r3,-1 ffc2a2c4: 4b ff ff 08 b ffc2a1cc =============================================================================== ffc0e840 : rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0e840: 3d 20 00 00 lis r9,0 int oflag, ... /* mode_t mode, */ /* struct mq_attr attr */ ) { ffc0e844: 94 21 ff b0 stwu r1,-80(r1) ffc0e848: 7c 08 02 a6 mflr r0 ffc0e84c: 81 69 2a 30 lwz r11,10800(r9) ffc0e850: 7d 80 00 26 mfcr r12 ffc0e854: 93 81 00 40 stw r28,64(r1) ffc0e858: 7c 9c 23 78 mr r28,r4 ffc0e85c: 39 6b 00 01 addi r11,r11,1 ffc0e860: 93 a1 00 44 stw r29,68(r1) ffc0e864: 7c 7d 1b 78 mr r29,r3 ffc0e868: 90 01 00 54 stw r0,84(r1) ffc0e86c: 93 41 00 38 stw r26,56(r1) ffc0e870: 93 61 00 3c stw r27,60(r1) ffc0e874: 93 c1 00 48 stw r30,72(r1) ffc0e878: 93 e1 00 4c stw r31,76(r1) ffc0e87c: 91 81 00 34 stw r12,52(r1) ffc0e880: 90 a1 00 28 stw r5,40(r1) ffc0e884: 90 c1 00 2c stw r6,44(r1) ffc0e888: 91 69 2a 30 stw r11,10800(r9) POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0e88c: 54 80 bf fe rlwinm r0,r4,23,31,31 ffc0e890: 2e 00 00 00 cmpwi cr4,r0,0 ffc0e894: 40 92 01 10 bne- cr4,ffc0e9a4 RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) _Objects_Allocate( &_POSIX_Message_queue_Information_fds ); ffc0e898: 3f c0 00 00 lis r30,0 ffc0e89c: 3b de 36 18 addi r30,r30,13848 ffc0e8a0: 7f c3 f3 78 mr r3,r30 ffc0e8a4: 48 00 3e 65 bl ffc12708 <_Objects_Allocate> /* struct mq_attr attr */ ) { va_list arg; mode_t mode; struct mq_attr *attr = NULL; ffc0e8a8: 3b 40 00 00 li r26,0 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 ) { ffc0e8ac: 7c 7f 1b 79 mr. r31,r3 ffc0e8b0: 41 82 01 28 beq- ffc0e9d8 <== NEVER TAKEN _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( ENFILE ); } the_mq_fd->oflag = oflag; ffc0e8b4: 93 9f 00 14 stw r28,20(r31) status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); ffc0e8b8: 7f a3 eb 78 mr r3,r29 ffc0e8bc: 38 81 00 08 addi r4,r1,8 ffc0e8c0: 48 00 90 cd bl ffc1798c <_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 ) { ffc0e8c4: 7c 7b 1b 79 mr. r27,r3 ffc0e8c8: 40 82 00 88 bne- ffc0e950 } else { /* name -> ID translation succeeded */ /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { ffc0e8cc: 73 9c 0a 00 andi. r28,r28,2560 ffc0e8d0: 2f 9c 0a 00 cmpwi cr7,r28,2560 ffc0e8d4: 41 9e 01 48 beq- cr7,ffc0ea1c Objects_Id id, Objects_Locations *location ) { return (POSIX_Message_queue_Control *) _Objects_Get( &_POSIX_Message_queue_Information, id, location ); ffc0e8d8: 80 81 00 08 lwz r4,8(r1) ffc0e8dc: 3c 60 00 00 lis r3,0 ffc0e8e0: 38 a1 00 10 addi r5,r1,16 ffc0e8e4: 38 63 34 8c addi r3,r3,13452 ffc0e8e8: 48 00 44 3d bl ffc12d24 <_Objects_Get> Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( ffc0e8ec: 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; ffc0e8f0: 81 63 00 18 lwz r11,24(r3) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0e8f4: 81 3e 00 1c lwz r9,28(r30) ffc0e8f8: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0e8fc: 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 ); ffc0e900: 90 61 00 0c stw r3,12(r1) the_mq->open_count += 1; ffc0e904: 91 63 00 18 stw r11,24(r3) the_mq_fd->Queue = the_mq; ffc0e908: 90 7f 00 10 stw r3,16(r31) ffc0e90c: 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; ffc0e910: 93 7f 00 0c stw r27,12(r31) _Objects_Open_string( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); ffc0e914: 48 00 53 e9 bl ffc13cfc <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); ffc0e918: 48 00 53 e5 bl ffc13cfc <_Thread_Enable_dispatch> return (mqd_t)the_mq_fd->Object.id; ffc0e91c: 80 7f 00 08 lwz r3,8(r31) ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0e920: 80 01 00 54 lwz r0,84(r1) ffc0e924: 81 81 00 34 lwz r12,52(r1) ffc0e928: 7c 08 03 a6 mtlr r0 ffc0e92c: 83 41 00 38 lwz r26,56(r1) ffc0e930: 83 61 00 3c lwz r27,60(r1) ffc0e934: 7d 80 81 20 mtcrf 8,r12 ffc0e938: 83 81 00 40 lwz r28,64(r1) ffc0e93c: 83 a1 00 44 lwz r29,68(r1) ffc0e940: 83 c1 00 48 lwz r30,72(r1) ffc0e944: 83 e1 00 4c lwz r31,76(r1) ffc0e948: 38 21 00 50 addi r1,r1,80 ffc0e94c: 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) ) ) { ffc0e950: 2f 9b 00 02 cmpwi cr7,r27,2 ffc0e954: 41 9e 01 18 beq- cr7,ffc0ea6c 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 ); ffc0e958: 7f c3 f3 78 mr r3,r30 ffc0e95c: 7f e4 fb 78 mr r4,r31 ffc0e960: 48 00 41 d1 bl ffc12b30 <_Objects_Free> _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); ffc0e964: 48 00 53 99 bl ffc13cfc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); ffc0e968: 48 00 d6 11 bl ffc1bf78 <__errno> ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0e96c: 80 01 00 54 lwz r0,84(r1) ffc0e970: 81 81 00 34 lwz r12,52(r1) ffc0e974: 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 ); ffc0e978: 93 63 00 00 stw r27,0(r3) ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0e97c: 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 ); ffc0e980: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0e984: 83 41 00 38 lwz r26,56(r1) ffc0e988: 83 61 00 3c lwz r27,60(r1) ffc0e98c: 83 81 00 40 lwz r28,64(r1) ffc0e990: 83 a1 00 44 lwz r29,68(r1) ffc0e994: 83 c1 00 48 lwz r30,72(r1) ffc0e998: 83 e1 00 4c lwz r31,76(r1) ffc0e99c: 38 21 00 50 addi r1,r1,80 ffc0e9a0: 4e 80 00 20 blr Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0e9a4: 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 * ); ffc0e9a8: 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 *) _Objects_Allocate( &_POSIX_Message_queue_Information_fds ); ffc0e9ac: 3f c0 00 00 lis r30,0 Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0e9b0: 90 01 00 18 stw r0,24(r1) ffc0e9b4: 3b de 36 18 addi r30,r30,13848 ffc0e9b8: 38 01 00 20 addi r0,r1,32 ffc0e9bc: 90 01 00 1c stw r0,28(r1) ffc0e9c0: 7f c3 f3 78 mr r3,r30 mode = (mode_t) va_arg( arg, unsigned int ); attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); ffc0e9c4: 38 00 00 04 li r0,4 ffc0e9c8: 98 01 00 14 stb r0,20(r1) ffc0e9cc: 48 00 3d 3d bl ffc12708 <_Objects_Allocate> va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { ffc0e9d0: 7c 7f 1b 79 mr. r31,r3 ffc0e9d4: 40 82 fe e0 bne+ ffc0e8b4 _Thread_Enable_dispatch(); ffc0e9d8: 48 00 53 25 bl ffc13cfc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( ENFILE ); ffc0e9dc: 48 00 d5 9d bl ffc1bf78 <__errno> ffc0e9e0: 38 00 00 17 li r0,23 ffc0e9e4: 90 03 00 00 stw r0,0(r3) ffc0e9e8: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0e9ec: 80 01 00 54 lwz r0,84(r1) ffc0e9f0: 81 81 00 34 lwz r12,52(r1) ffc0e9f4: 7c 08 03 a6 mtlr r0 ffc0e9f8: 83 41 00 38 lwz r26,56(r1) ffc0e9fc: 83 61 00 3c lwz r27,60(r1) ffc0ea00: 7d 80 81 20 mtcrf 8,r12 ffc0ea04: 83 81 00 40 lwz r28,64(r1) ffc0ea08: 83 a1 00 44 lwz r29,68(r1) ffc0ea0c: 83 c1 00 48 lwz r30,72(r1) ffc0ea10: 83 e1 00 4c lwz r31,76(r1) ffc0ea14: 38 21 00 50 addi r1,r1,80 ffc0ea18: 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 ); ffc0ea1c: 7f c3 f3 78 mr r3,r30 ffc0ea20: 7f e4 fb 78 mr r4,r31 ffc0ea24: 48 00 41 0d bl ffc12b30 <_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(); ffc0ea28: 48 00 52 d5 bl ffc13cfc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, mqd_t ); ffc0ea2c: 48 00 d5 4d bl ffc1bf78 <__errno> ffc0ea30: 38 00 00 11 li r0,17 ffc0ea34: 90 03 00 00 stw r0,0(r3) ffc0ea38: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ea3c: 80 01 00 54 lwz r0,84(r1) ffc0ea40: 81 81 00 34 lwz r12,52(r1) ffc0ea44: 7c 08 03 a6 mtlr r0 ffc0ea48: 83 41 00 38 lwz r26,56(r1) ffc0ea4c: 83 61 00 3c lwz r27,60(r1) ffc0ea50: 7d 80 81 20 mtcrf 8,r12 ffc0ea54: 83 81 00 40 lwz r28,64(r1) ffc0ea58: 83 a1 00 44 lwz r29,68(r1) ffc0ea5c: 83 c1 00 48 lwz r30,72(r1) ffc0ea60: 83 e1 00 4c lwz r31,76(r1) ffc0ea64: 38 21 00 50 addi r1,r1,80 ffc0ea68: 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) ) ) { ffc0ea6c: 41 92 fe ec beq+ cr4,ffc0e958 /* * 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( ffc0ea70: 7f a3 eb 78 mr r3,r29 ffc0ea74: 38 80 00 01 li r4,1 ffc0ea78: 7f 45 d3 78 mr r5,r26 ffc0ea7c: 38 c1 00 0c addi r6,r1,12 ffc0ea80: 48 00 8d 45 bl ffc177c4 <_POSIX_Message_queue_Create_support> ); /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { ffc0ea84: 2f 83 ff ff cmpwi cr7,r3,-1 ffc0ea88: 41 9e 00 30 beq- cr7,ffc0eab8 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( ffc0ea8c: a0 1f 00 0a lhz r0,10(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0ea90: 81 3e 00 1c lwz r9,28(r30) _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); return (mqd_t) -1; } the_mq_fd->Queue = the_mq; ffc0ea94: 81 61 00 0c lwz r11,12(r1) ffc0ea98: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0ea9c: 91 7f 00 10 stw r11,16(r31) ffc0eaa0: 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; ffc0eaa4: 38 00 00 00 li r0,0 ffc0eaa8: 90 1f 00 0c stw r0,12(r31) &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); ffc0eaac: 48 00 52 51 bl ffc13cfc <_Thread_Enable_dispatch> return (mqd_t) the_mq_fd->Object.id; ffc0eab0: 80 7f 00 08 lwz r3,8(r31) ffc0eab4: 4b ff fe 6c b ffc0e920 ffc0eab8: 7f c3 f3 78 mr r3,r30 ffc0eabc: 7f e4 fb 78 mr r4,r31 ffc0eac0: 48 00 40 71 bl ffc12b30 <_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(); ffc0eac4: 48 00 52 39 bl ffc13cfc <_Thread_Enable_dispatch> return (mqd_t) -1; ffc0eac8: 38 60 ff ff li r3,-1 ffc0eacc: 4b ff fe 54 b ffc0e920 =============================================================================== ffc0e870 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) ffc0e870: 7c 69 1b 79 mr. r9,r3 return EINVAL; ffc0e874: 38 60 00 16 li r3,22 int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) ffc0e878: 4d 82 00 20 beqlr ffc0e87c: 80 09 00 00 lwz r0,0(r9) ffc0e880: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e884: 4d 9e 00 20 beqlr cr7 return EINVAL; switch ( policy ) { ffc0e888: 2b 84 00 04 cmplwi cr7,r4,4 ffc0e88c: 40 9d 00 0c ble- cr7,ffc0e898 case SCHED_SPORADIC: attr->schedpolicy = policy; return 0; default: return ENOTSUP; ffc0e890: 38 60 00 86 li r3,134 } } ffc0e894: 4e 80 00 20 blr ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( policy ) { ffc0e898: 38 00 00 01 li r0,1 ffc0e89c: 7c 00 20 30 slw r0,r0,r4 ffc0e8a0: 70 0b 00 17 andi. r11,r0,23 ffc0e8a4: 41 a2 ff ec beq- ffc0e890 <== NEVER TAKEN case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; ffc0e8a8: 90 89 00 14 stw r4,20(r9) return 0; ffc0e8ac: 38 60 00 00 li r3,0 ffc0e8b0: 4e 80 00 20 blr =============================================================================== ffc092a4 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { ffc092a4: 94 21 ff d0 stwu r1,-48(r1) ffc092a8: 7c 08 02 a6 mflr r0 ffc092ac: 93 e1 00 2c stw r31,44(r1) const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) ffc092b0: 7c 7f 1b 79 mr. r31,r3 return EINVAL; ffc092b4: 38 60 00 16 li r3,22 int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { ffc092b8: 90 01 00 34 stw r0,52(r1) ffc092bc: 93 81 00 20 stw r28,32(r1) ffc092c0: 93 a1 00 24 stw r29,36(r1) ffc092c4: 93 c1 00 28 stw r30,40(r1) const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) ffc092c8: 41 82 00 8c beq- ffc09354 return EINVAL; if ( count == 0 ) ffc092cc: 2f 85 00 00 cmpwi cr7,r5,0 ffc092d0: 41 9e 00 84 beq- cr7,ffc09354 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { ffc092d4: 2f 84 00 00 cmpwi cr7,r4,0 ffc092d8: 41 9e 00 a8 beq- cr7,ffc09380 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc092dc: 80 04 00 00 lwz r0,0(r4) return EINVAL; ffc092e0: 38 60 00 16 li r3,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc092e4: 2f 80 00 00 cmpwi cr7,r0,0 ffc092e8: 41 9e 00 6c beq- cr7,ffc09354 return EINVAL; switch ( the_attr->process_shared ) { ffc092ec: 83 c4 00 04 lwz r30,4(r4) ffc092f0: 2f 9e 00 00 cmpwi cr7,r30,0 ffc092f4: 40 9e 00 60 bne- cr7,ffc09354 <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc092f8: 3d 20 00 00 lis r9,0 } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; ffc092fc: 93 c1 00 08 stw r30,8(r1) ffc09300: 81 69 27 f4 lwz r11,10228(r9) the_attributes.maximum_count = count; ffc09304: 90 a1 00 0c stw r5,12(r1) ffc09308: 38 0b 00 01 addi r0,r11,1 ffc0930c: 90 09 27 f4 stw r0,10228(r9) * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void ) { return (POSIX_Barrier_Control *) _Objects_Allocate( &_POSIX_Barrier_Information ); ffc09310: 3f 80 00 00 lis r28,0 ffc09314: 3b 9c 2f ac addi r28,r28,12204 ffc09318: 7f 83 e3 78 mr r3,r28 ffc0931c: 48 00 2b b5 bl ffc0bed0 <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { ffc09320: 7c 7d 1b 79 mr. r29,r3 ffc09324: 41 82 00 50 beq- ffc09374 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); ffc09328: 38 7d 00 10 addi r3,r29,16 ffc0932c: 38 81 00 08 addi r4,r1,8 ffc09330: 48 00 1f 61 bl ffc0b290 <_CORE_barrier_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc09334: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc09338: 81 7c 00 1c lwz r11,28(r28) ffc0933c: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc09340: 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; ffc09344: 93 dd 00 0c stw r30,12(r29) ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; ffc09348: 90 1f 00 00 stw r0,0(r31) _Thread_Enable_dispatch(); ffc0934c: 48 00 40 b9 bl ffc0d404 <_Thread_Enable_dispatch> return 0; ffc09350: 38 60 00 00 li r3,0 } ffc09354: 80 01 00 34 lwz r0,52(r1) ffc09358: 83 81 00 20 lwz r28,32(r1) ffc0935c: 7c 08 03 a6 mtlr r0 ffc09360: 83 a1 00 24 lwz r29,36(r1) ffc09364: 83 c1 00 28 lwz r30,40(r1) ffc09368: 83 e1 00 2c lwz r31,44(r1) ffc0936c: 38 21 00 30 addi r1,r1,48 ffc09370: 4e 80 00 20 blr _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { _Thread_Enable_dispatch(); ffc09374: 48 00 40 91 bl ffc0d404 <_Thread_Enable_dispatch> return EAGAIN; ffc09378: 38 60 00 0b li r3,11 ffc0937c: 4b ff ff d8 b ffc09354 * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); ffc09380: 3b c1 00 10 addi r30,r1,16 ffc09384: 90 a1 00 18 stw r5,24(r1) ffc09388: 7f c3 f3 78 mr r3,r30 ffc0938c: 4b ff fe 09 bl ffc09194 the_attr = &my_attr; ffc09390: 7f c4 f3 78 mr r4,r30 ffc09394: 80 a1 00 18 lwz r5,24(r1) ffc09398: 4b ff ff 44 b ffc092dc =============================================================================== ffc0893c : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { ffc0893c: 94 21 ff f0 stwu r1,-16(r1) ffc08940: 7c 08 02 a6 mflr r0 ffc08944: 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 ) ffc08948: 7c 7e 1b 79 mr. r30,r3 void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { ffc0894c: 93 e1 00 0c stw r31,12(r1) ffc08950: 7c 9f 23 78 mr r31,r4 ffc08954: 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 ) ffc08958: 41 82 00 48 beq- ffc089a0 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0895c: 3d 20 00 00 lis r9,0 ffc08960: 81 69 27 ec lwz r11,10220(r9) ffc08964: 38 0b 00 01 addi r0,r11,1 ffc08968: 90 09 27 ec stw r0,10220(r9) return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); ffc0896c: 38 60 00 10 li r3,16 ffc08970: 48 00 5c 09 bl ffc0e578 <_Workspace_Allocate> if ( handler ) { ffc08974: 7c 69 1b 79 mr. r9,r3 ffc08978: 41 82 00 24 beq- ffc0899c <== NEVER TAKEN thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc0897c: 3d 60 00 00 lis r11,0 ffc08980: 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 ); ffc08984: 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; ffc08988: 80 6b 01 34 lwz r3,308(r11) handler->routine = routine; ffc0898c: 93 c9 00 08 stw r30,8(r9) handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); ffc08990: 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; ffc08994: 93 e9 00 0c stw r31,12(r9) _Chain_Append( handler_stack, &handler->Node ); ffc08998: 48 00 20 91 bl ffc0aa28 <_Chain_Append> } _Thread_Enable_dispatch(); ffc0899c: 48 00 41 bd bl ffc0cb58 <_Thread_Enable_dispatch> } ffc089a0: 80 01 00 14 lwz r0,20(r1) ffc089a4: 83 c1 00 08 lwz r30,8(r1) ffc089a8: 7c 08 03 a6 mtlr r0 ffc089ac: 83 e1 00 0c lwz r31,12(r1) ffc089b0: 38 21 00 10 addi r1,r1,16 ffc089b4: 4e 80 00 20 blr =============================================================================== ffc09c68 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { ffc09c68: 94 21 ff e8 stwu r1,-24(r1) ffc09c6c: 7c 08 02 a6 mflr r0 ffc09c70: 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; ffc09c74: 7c 9c 23 79 mr. r28,r4 int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { ffc09c78: 93 c1 00 10 stw r30,16(r1) ffc09c7c: 7c 7e 1b 78 mr r30,r3 ffc09c80: 90 01 00 1c stw r0,28(r1) ffc09c84: 93 a1 00 0c stw r29,12(r1) ffc09c88: 93 e1 00 14 stw r31,20(r1) POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; ffc09c8c: 41 82 00 d0 beq- ffc09d5c else the_attr = &_POSIX_Condition_variables_Default_attributes; /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) ffc09c90: 80 1c 00 04 lwz r0,4(r28) return EINVAL; ffc09c94: 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 ) ffc09c98: 2f 80 00 01 cmpwi cr7,r0,1 ffc09c9c: 41 9e 00 10 beq- cr7,ffc09cac <== NEVER TAKEN return EINVAL; if ( !the_attr->is_initialized ) ffc09ca0: 80 1c 00 00 lwz r0,0(r28) ffc09ca4: 2f 80 00 00 cmpwi cr7,r0,0 ffc09ca8: 40 9e 00 24 bne- cr7,ffc09ccc *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } ffc09cac: 80 01 00 1c lwz r0,28(r1) ffc09cb0: 83 81 00 08 lwz r28,8(r1) ffc09cb4: 7c 08 03 a6 mtlr r0 ffc09cb8: 83 a1 00 0c lwz r29,12(r1) ffc09cbc: 83 c1 00 10 lwz r30,16(r1) ffc09cc0: 83 e1 00 14 lwz r31,20(r1) ffc09cc4: 38 21 00 18 addi r1,r1,24 ffc09cc8: 4e 80 00 20 blr rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc09ccc: 3d 20 00 00 lis r9,0 ffc09cd0: 81 69 28 00 lwz r11,10240(r9) ffc09cd4: 38 0b 00 01 addi r0,r11,1 ffc09cd8: 90 09 28 00 stw r0,10240(r9) RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); ffc09cdc: 3f a0 00 00 lis r29,0 ffc09ce0: 3b bd 30 44 addi r29,r29,12356 ffc09ce4: 7f a3 eb 78 mr r3,r29 ffc09ce8: 48 00 33 b5 bl ffc0d09c <_Objects_Allocate> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { ffc09cec: 7c 7f 1b 79 mr. r31,r3 ffc09cf0: 41 82 00 78 beq- ffc09d68 _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; ffc09cf4: 80 1c 00 04 lwz r0,4(r28) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; ffc09cf8: 3b 80 00 00 li r28,0 ffc09cfc: 93 9f 00 14 stw r28,20(r31) _Thread_queue_Initialize( ffc09d00: 3c a0 10 00 lis r5,4096 ffc09d04: 38 7f 00 18 addi r3,r31,24 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; ffc09d08: 90 1f 00 10 stw r0,16(r31) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( ffc09d0c: 38 80 00 00 li r4,0 ffc09d10: 60 a5 08 00 ori r5,r5,2048 ffc09d14: 38 c0 00 74 li r6,116 ffc09d18: 48 00 53 25 bl ffc0f03c <_Thread_queue_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc09d1c: 80 1f 00 08 lwz r0,8(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc09d20: 81 7d 00 1c lwz r11,28(r29) ffc09d24: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc09d28: 7f eb 49 2e stwx r31,r11,r9 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; ffc09d2c: 93 9f 00 0c stw r28,12(r31) &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; ffc09d30: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc09d34: 48 00 48 9d bl ffc0e5d0 <_Thread_Enable_dispatch> return 0; } ffc09d38: 80 01 00 1c lwz r0,28(r1) *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; ffc09d3c: 38 60 00 00 li r3,0 } ffc09d40: 83 81 00 08 lwz r28,8(r1) ffc09d44: 7c 08 03 a6 mtlr r0 ffc09d48: 83 a1 00 0c lwz r29,12(r1) ffc09d4c: 83 c1 00 10 lwz r30,16(r1) ffc09d50: 83 e1 00 14 lwz r31,20(r1) ffc09d54: 38 21 00 18 addi r1,r1,24 ffc09d58: 4e 80 00 20 blr { 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; ffc09d5c: 3f 80 00 00 lis r28,0 ffc09d60: 3b 9c 27 50 addi r28,r28,10064 ffc09d64: 4b ff ff 2c b ffc09c90 _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { _Thread_Enable_dispatch(); ffc09d68: 48 00 48 69 bl ffc0e5d0 <_Thread_Enable_dispatch> return ENOMEM; ffc09d6c: 38 60 00 0c li r3,12 ffc09d70: 4b ff ff 3c b ffc09cac =============================================================================== ffc08f00 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08f00: 94 21 ff 80 stwu r1,-128(r1) ffc08f04: 7c 08 02 a6 mflr r0 ffc08f08: 93 61 00 6c stw r27,108(r1) int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) ffc08f0c: 7c bb 2b 79 mr. r27,r5 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08f10: 93 81 00 70 stw r28,112(r1) ffc08f14: 7c dc 33 78 mr r28,r6 ffc08f18: 93 a1 00 74 stw r29,116(r1) ffc08f1c: 7c 7d 1b 78 mr r29,r3 ffc08f20: 93 c1 00 78 stw r30,120(r1) struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) return EFAULT; ffc08f24: 3b c0 00 0e li r30,14 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08f28: 90 01 00 84 stw r0,132(r1) ffc08f2c: 92 a1 00 54 stw r21,84(r1) ffc08f30: 92 c1 00 58 stw r22,88(r1) ffc08f34: 92 e1 00 5c stw r23,92(r1) ffc08f38: 93 01 00 60 stw r24,96(r1) ffc08f3c: 93 21 00 64 stw r25,100(r1) ffc08f40: 93 41 00 68 stw r26,104(r1) ffc08f44: 93 e1 00 7c stw r31,124(r1) int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) ffc08f48: 41 82 00 58 beq- ffc08fa0 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; ffc08f4c: 2f 84 00 00 cmpwi cr7,r4,0 ffc08f50: 7c 9f 23 78 mr r31,r4 ffc08f54: 41 9e 01 b4 beq- cr7,ffc09108 if ( !the_attr->is_initialized ) ffc08f58: 80 1f 00 00 lwz r0,0(r31) return EINVAL; ffc08f5c: 3b c0 00 16 li r30,22 if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; if ( !the_attr->is_initialized ) ffc08f60: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f64: 41 9e 00 3c beq- cr7,ffc08fa0 * 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) ) ffc08f68: 80 1f 00 04 lwz r0,4(r31) ffc08f6c: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f70: 41 9e 00 18 beq- cr7,ffc08f88 ffc08f74: 3d 60 00 00 lis r11,0 ffc08f78: 81 3f 00 08 lwz r9,8(r31) ffc08f7c: 80 0b 27 10 lwz r0,10000(r11) ffc08f80: 7f 89 00 40 cmplw cr7,r9,r0 ffc08f84: 41 9c 00 1c blt- cr7,ffc08fa0 * 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 ) { ffc08f88: 80 1f 00 10 lwz r0,16(r31) ffc08f8c: 2f 80 00 01 cmpwi cr7,r0,1 ffc08f90: 41 9e 01 84 beq- cr7,ffc09114 ffc08f94: 2f 80 00 02 cmpwi cr7,r0,2 schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; break; default: return EINVAL; ffc08f98: 3b c0 00 16 li r30,22 * If inheritsched is set to PTHREAD_INHERIT_SCHED, then this thread * inherits scheduling attributes from the creating thread. If it is * PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the * attributes structure. */ switch ( the_attr->inheritsched ) { ffc08f9c: 41 9e 00 44 beq- cr7,ffc08fe0 */ *thread = the_thread->Object.id; _RTEMS_Unlock_allocator(); return 0; } ffc08fa0: 80 01 00 84 lwz r0,132(r1) ffc08fa4: 7f c3 f3 78 mr r3,r30 ffc08fa8: 82 a1 00 54 lwz r21,84(r1) ffc08fac: 7c 08 03 a6 mtlr r0 ffc08fb0: 82 c1 00 58 lwz r22,88(r1) ffc08fb4: 82 e1 00 5c lwz r23,92(r1) ffc08fb8: 83 01 00 60 lwz r24,96(r1) ffc08fbc: 83 21 00 64 lwz r25,100(r1) ffc08fc0: 83 41 00 68 lwz r26,104(r1) ffc08fc4: 83 61 00 6c lwz r27,108(r1) ffc08fc8: 83 81 00 70 lwz r28,112(r1) ffc08fcc: 83 a1 00 74 lwz r29,116(r1) ffc08fd0: 83 c1 00 78 lwz r30,120(r1) ffc08fd4: 83 e1 00 7c lwz r31,124(r1) ffc08fd8: 38 21 00 80 addi r1,r1,128 ffc08fdc: 4e 80 00 20 blr schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; ffc08fe0: 80 df 00 18 lwz r6,24(r31) ffc08fe4: 80 ff 00 1c lwz r7,28(r31) ffc08fe8: 81 1f 00 20 lwz r8,32(r31) ffc08fec: 81 5f 00 24 lwz r10,36(r31) ffc08ff0: 81 7f 00 28 lwz r11,40(r31) ffc08ff4: 81 3f 00 2c lwz r9,44(r31) ffc08ff8: 80 1f 00 30 lwz r0,48(r31) schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; ffc08ffc: 83 5f 00 14 lwz r26,20(r31) schedparam = the_attr->schedparam; ffc09000: 90 c1 00 20 stw r6,32(r1) ffc09004: 90 e1 00 24 stw r7,36(r1) ffc09008: 91 01 00 28 stw r8,40(r1) ffc0900c: 91 41 00 2c stw r10,44(r1) ffc09010: 91 61 00 30 stw r11,48(r1) ffc09014: 91 21 00 34 stw r9,52(r1) ffc09018: 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 ) ffc0901c: 80 1f 00 0c lwz r0,12(r31) return ENOTSUP; ffc09020: 3b c0 00 86 li r30,134 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) ffc09024: 2f 80 00 00 cmpwi cr7,r0,0 ffc09028: 40 be ff 78 bne- cr7,ffc08fa0 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) ffc0902c: 80 61 00 20 lwz r3,32(r1) return EINVAL; ffc09030: 3b c0 00 16 li r30,22 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) ffc09034: 48 00 82 75 bl ffc112a8 <_POSIX_Priority_Is_valid> ffc09038: 2f 83 00 00 cmpwi cr7,r3,0 ffc0903c: 41 9e ff 64 beq+ cr7,ffc08fa0 <== NEVER TAKEN return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); ffc09040: 7c 24 0b 78 mr r4,r1 ffc09044: 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); ffc09048: 3d 20 00 00 lis r9,0 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( ffc0904c: 7f 43 d3 78 mr r3,r26 ffc09050: 8a a9 27 14 lbz r21,10004(r9) ffc09054: 38 a1 00 18 addi r5,r1,24 ffc09058: 38 c1 00 1c addi r6,r1,28 ffc0905c: 48 00 82 71 bl ffc112cc <_POSIX_Thread_Translate_sched_param> schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) ffc09060: 7c 7e 1b 79 mr. r30,r3 ffc09064: 40 82 ff 3c bne+ ffc08fa0 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); ffc09068: 3e e0 00 00 lis r23,0 ffc0906c: 80 77 28 14 lwz r3,10260(r23) * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); ffc09070: 3f 20 00 00 lis r25,0 ffc09074: 3b 39 2e 0c addi r25,r25,11788 ffc09078: 48 00 20 c5 bl ffc0b13c <_API_Mutex_Lock> ffc0907c: 7f 23 cb 78 mr r3,r25 ffc09080: 48 00 2d 79 bl ffc0bdf8 <_Objects_Allocate> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { ffc09084: 7c 78 1b 79 mr. r24,r3 ffc09088: 41 82 00 70 beq- ffc090f8 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc0908c: 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( ffc09090: 80 1f 00 08 lwz r0,8(r31) static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc09094: 80 c9 27 10 lwz r6,10000(r9) /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( ffc09098: 80 bf 00 04 lwz r5,4(r31) static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc0909c: 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( ffc090a0: 7f 86 00 40 cmplw cr7,r6,r0 ffc090a4: 40 9c 00 08 bge- cr7,ffc090ac ffc090a8: 7c 06 03 78 mr r6,r0 ffc090ac: 38 00 00 00 li r0,0 ffc090b0: 81 81 00 1c lwz r12,28(r1) ffc090b4: 7c 2b 0b 78 mr r11,r1 ffc090b8: 81 41 00 18 lwz r10,24(r1) ffc090bc: 94 0b 00 48 stwu r0,72(r11) ffc090c0: 7f 23 cb 78 mr r3,r25 ffc090c4: 7f 04 c3 78 mr r4,r24 ffc090c8: 38 e0 00 01 li r7,1 ffc090cc: 91 81 00 08 stw r12,8(r1) ffc090d0: 7d 16 a8 50 subf r8,r22,r21 ffc090d4: 39 20 00 01 li r9,1 ffc090d8: 90 01 00 0c stw r0,12(r1) ffc090dc: 91 61 00 10 stw r11,16(r1) ffc090e0: 48 00 43 25 bl ffc0d404 <_Thread_Initialize> budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { ffc090e4: 2f 83 00 00 cmpwi cr7,r3,0 ffc090e8: 40 9e 00 78 bne- cr7,ffc09160 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); ffc090ec: 7f 23 cb 78 mr r3,r25 ffc090f0: 7f 04 c3 78 mr r4,r24 ffc090f4: 48 00 31 2d bl ffc0c220 <_Objects_Free> _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); ffc090f8: 80 77 28 14 lwz r3,10260(r23) return EAGAIN; ffc090fc: 3b c0 00 0b li r30,11 name /* posix threads don't have a name */ ); if ( !status ) { _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); ffc09100: 48 00 20 bd bl ffc0b1bc <_API_Mutex_Unlock> return EAGAIN; ffc09104: 4b ff fe 9c b ffc08fa0 int rc; if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; ffc09108: 3f e0 ff c2 lis r31,-62 ffc0910c: 3b ff 25 c4 addi r31,r31,9668 ffc09110: 4b ff fe 48 b ffc08f58 * 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 ]; ffc09114: 3d 20 00 00 lis r9,0 ffc09118: 81 29 31 10 lwz r9,12560(r9) ffc0911c: 81 29 01 34 lwz r9,308(r9) schedpolicy = api->schedpolicy; schedparam = api->schedparam; ffc09120: 80 a9 00 88 lwz r5,136(r9) ffc09124: 80 c9 00 8c lwz r6,140(r9) ffc09128: 80 e9 00 90 lwz r7,144(r9) ffc0912c: 81 09 00 94 lwz r8,148(r9) ffc09130: 81 49 00 98 lwz r10,152(r9) ffc09134: 81 69 00 9c lwz r11,156(r9) ffc09138: 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; ffc0913c: 83 49 00 84 lwz r26,132(r9) schedparam = api->schedparam; ffc09140: 90 a1 00 20 stw r5,32(r1) ffc09144: 90 c1 00 24 stw r6,36(r1) ffc09148: 90 e1 00 28 stw r7,40(r1) ffc0914c: 91 01 00 2c stw r8,44(r1) ffc09150: 91 41 00 30 stw r10,48(r1) ffc09154: 91 61 00 34 stw r11,52(r1) ffc09158: 90 01 00 38 stw r0,56(r1) break; ffc0915c: 4b ff fe c0 b ffc0901c } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc09160: 83 38 01 34 lwz r25,308(r24) api->Attributes = *the_attr; ffc09164: 7f e4 fb 78 mr r4,r31 ffc09168: 38 a0 00 40 li r5,64 ffc0916c: 7f 23 cb 78 mr r3,r25 ffc09170: 48 00 c1 c1 bl ffc15330 api->detachstate = the_attr->detachstate; ffc09174: 80 1f 00 3c lwz r0,60(r31) api->schedpolicy = schedpolicy; ffc09178: 93 59 00 84 stw r26,132(r25) api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc0917c: 7f 03 c3 78 mr r3,r24 ffc09180: 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; ffc09184: 90 19 00 40 stw r0,64(r25) api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc09188: 7f 65 db 78 mr r5,r27 ffc0918c: 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; ffc09190: 80 01 00 20 lwz r0,32(r1) /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc09194: 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; ffc09198: 90 19 00 88 stw r0,136(r25) ffc0919c: 80 01 00 24 lwz r0,36(r1) ffc091a0: 90 19 00 8c stw r0,140(r25) ffc091a4: 80 01 00 28 lwz r0,40(r1) ffc091a8: 90 19 00 90 stw r0,144(r25) ffc091ac: 80 01 00 2c lwz r0,44(r1) ffc091b0: 90 19 00 94 stw r0,148(r25) ffc091b4: 80 01 00 30 lwz r0,48(r1) ffc091b8: 90 19 00 98 stw r0,152(r25) ffc091bc: 80 01 00 34 lwz r0,52(r1) ffc091c0: 90 19 00 9c stw r0,156(r25) ffc091c4: 80 01 00 38 lwz r0,56(r1) ffc091c8: 90 19 00 a0 stw r0,160(r25) /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc091cc: 48 00 4f 6d bl ffc0e138 <_Thread_Start> _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { ffc091d0: 2f 9a 00 04 cmpwi cr7,r26,4 ffc091d4: 41 9e 00 18 beq- cr7,ffc091ec } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; ffc091d8: 80 18 00 08 lwz r0,8(r24) _RTEMS_Unlock_allocator(); ffc091dc: 80 77 28 14 lwz r3,10260(r23) } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; ffc091e0: 90 1d 00 00 stw r0,0(r29) _RTEMS_Unlock_allocator(); ffc091e4: 48 00 1f d9 bl ffc0b1bc <_API_Mutex_Unlock> return 0; ffc091e8: 4b ff fd b8 b ffc08fa0 return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { _Watchdog_Insert_ticks( ffc091ec: 38 79 00 90 addi r3,r25,144 ffc091f0: 48 00 51 f1 bl ffc0e3e0 <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc091f4: 38 99 00 a8 addi r4,r25,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc091f8: 90 79 00 b4 stw r3,180(r25) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc091fc: 3c 60 00 00 lis r3,0 ffc09200: 38 63 2d 28 addi r3,r3,11560 ffc09204: 48 00 57 89 bl ffc0e98c <_Watchdog_Insert> ffc09208: 4b ff ff d0 b ffc091d8 =============================================================================== ffc0b594 : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { ffc0b594: 94 21 ff e0 stwu r1,-32(r1) ffc0b598: 7c 08 02 a6 mflr r0 ffc0b59c: 93 c1 00 18 stw r30,24(r1) ffc0b5a0: 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 ); ffc0b5a4: 7c 83 23 78 mr r3,r4 ffc0b5a8: 38 81 00 08 addi r4,r1,8 int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { ffc0b5ac: 93 e1 00 1c stw r31,28(r1) ffc0b5b0: 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 ); ffc0b5b4: 48 00 01 2d bl ffc0b6e0 <_POSIX_Absolute_timeout_to_ticks> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0b5b8: 2f 83 00 03 cmpwi cr7,r3,3 * * 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 ); ffc0b5bc: 7c 7f 1b 78 mr r31,r3 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0b5c0: 41 9e 00 50 beq- cr7,ffc0b610 do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); ffc0b5c4: 80 a1 00 08 lwz r5,8(r1) ffc0b5c8: 7f c3 f3 78 mr r3,r30 ffc0b5cc: 38 80 00 00 li r4,0 ffc0b5d0: 4b ff fe 3d bl ffc0b40c <_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) ) { ffc0b5d4: 2f 83 00 10 cmpwi cr7,r3,16 ffc0b5d8: 41 9e 00 1c beq- cr7,ffc0b5f4 <== ALWAYS TAKEN status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } ffc0b5dc: 80 01 00 24 lwz r0,36(r1) ffc0b5e0: 83 c1 00 18 lwz r30,24(r1) ffc0b5e4: 7c 08 03 a6 mtlr r0 ffc0b5e8: 83 e1 00 1c lwz r31,28(r1) ffc0b5ec: 38 21 00 20 addi r1,r1,32 ffc0b5f0: 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 ) ffc0b5f4: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0b5f8: 41 9e 00 40 beq- cr7,ffc0b638 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0b5fc: 3b ff ff ff addi r31,r31,-1 ffc0b600: 2b 9f 00 01 cmplwi cr7,r31,1 ffc0b604: 41 9d ff d8 bgt+ cr7,ffc0b5dc <== NEVER TAKEN status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0b608: 38 60 00 74 li r3,116 ffc0b60c: 4b ff ff d0 b ffc0b5dc */ 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 ); ffc0b610: 80 a1 00 08 lwz r5,8(r1) ffc0b614: 7f c3 f3 78 mr r3,r30 ffc0b618: 38 80 00 01 li r4,1 ffc0b61c: 4b ff fd f1 bl ffc0b40c <_POSIX_Mutex_Lock_support> status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } ffc0b620: 80 01 00 24 lwz r0,36(r1) ffc0b624: 83 c1 00 18 lwz r30,24(r1) ffc0b628: 7c 08 03 a6 mtlr r0 ffc0b62c: 83 e1 00 1c lwz r31,28(r1) ffc0b630: 38 21 00 20 addi r1,r1,32 ffc0b634: 4e 80 00 20 blr * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) return EINVAL; ffc0b638: 38 60 00 16 li r3,22 <== NOT EXECUTED ffc0b63c: 4b ff ff a0 b ffc0b5dc <== NOT EXECUTED =============================================================================== ffc097c8 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { ffc097c8: 94 21 ff d8 stwu r1,-40(r1) ffc097cc: 7c 08 02 a6 mflr r0 ffc097d0: 93 e1 00 24 stw r31,36(r1) if ( !once_control || !init_routine ) ffc097d4: 7c 7f 1b 79 mr. r31,r3 return EINVAL; ffc097d8: 38 60 00 16 li r3,22 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { ffc097dc: 93 c1 00 20 stw r30,32(r1) ffc097e0: 7c 9e 23 78 mr r30,r4 ffc097e4: 90 01 00 2c stw r0,44(r1) ffc097e8: 93 a1 00 1c stw r29,28(r1) if ( !once_control || !init_routine ) ffc097ec: 41 82 00 1c beq- ffc09808 ffc097f0: 2f 84 00 00 cmpwi cr7,r4,0 ffc097f4: 41 9e 00 14 beq- cr7,ffc09808 return EINVAL; if ( !once_control->init_executed ) { ffc097f8: 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; ffc097fc: 38 60 00 00 li r3,0 ) { if ( !once_control || !init_routine ) return EINVAL; if ( !once_control->init_executed ) { ffc09800: 2f 80 00 00 cmpwi cr7,r0,0 ffc09804: 41 9e 00 20 beq- cr7,ffc09824 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } ffc09808: 80 01 00 2c lwz r0,44(r1) ffc0980c: 83 a1 00 1c lwz r29,28(r1) ffc09810: 7c 08 03 a6 mtlr r0 ffc09814: 83 c1 00 20 lwz r30,32(r1) ffc09818: 83 e1 00 24 lwz r31,36(r1) ffc0981c: 38 21 00 28 addi r1,r1,40 ffc09820: 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); ffc09824: 3b a1 00 08 addi r29,r1,8 ffc09828: 38 60 01 00 li r3,256 ffc0982c: 38 80 01 00 li r4,256 ffc09830: 7f a5 eb 78 mr r5,r29 ffc09834: 48 00 0f 9d bl ffc0a7d0 if ( !once_control->init_executed ) { ffc09838: 80 1f 00 04 lwz r0,4(r31) ffc0983c: 2f 80 00 00 cmpwi cr7,r0,0 ffc09840: 41 9e 00 34 beq- cr7,ffc09874 <== ALWAYS TAKEN once_control->is_initialized = true; once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); ffc09844: 80 61 00 08 lwz r3,8(r1) ffc09848: 7f a5 eb 78 mr r5,r29 ffc0984c: 38 80 01 00 li r4,256 ffc09850: 48 00 0f 81 bl ffc0a7d0 } return 0; } ffc09854: 80 01 00 2c lwz r0,44(r1) once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; ffc09858: 38 60 00 00 li r3,0 } ffc0985c: 83 a1 00 1c lwz r29,28(r1) ffc09860: 7c 08 03 a6 mtlr r0 ffc09864: 83 c1 00 20 lwz r30,32(r1) ffc09868: 83 e1 00 24 lwz r31,36(r1) ffc0986c: 38 21 00 28 addi r1,r1,40 ffc09870: 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; ffc09874: 38 00 00 01 li r0,1 once_control->init_executed = true; (*init_routine)(); ffc09878: 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; ffc0987c: 90 1f 00 00 stw r0,0(r31) once_control->init_executed = true; ffc09880: 90 1f 00 04 stw r0,4(r31) (*init_routine)(); ffc09884: 4e 80 04 21 bctrl ffc09888: 4b ff ff bc b ffc09844 =============================================================================== ffc0a140 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { ffc0a140: 94 21 ff d8 stwu r1,-40(r1) ffc0a144: 7c 08 02 a6 mflr r0 ffc0a148: 93 c1 00 20 stw r30,32(r1) const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) ffc0a14c: 7c 7e 1b 79 mr. r30,r3 return EINVAL; ffc0a150: 38 60 00 16 li r3,22 int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { ffc0a154: 90 01 00 2c stw r0,44(r1) ffc0a158: 93 81 00 18 stw r28,24(r1) ffc0a15c: 93 a1 00 1c stw r29,28(r1) ffc0a160: 93 e1 00 24 stw r31,36(r1) const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) ffc0a164: 41 82 00 80 beq- ffc0a1e4 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { ffc0a168: 2f 84 00 00 cmpwi cr7,r4,0 ffc0a16c: 41 9e 00 a4 beq- cr7,ffc0a210 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc0a170: 80 04 00 00 lwz r0,0(r4) return EINVAL; ffc0a174: 38 60 00 16 li r3,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc0a178: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a17c: 41 9e 00 68 beq- cr7,ffc0a1e4 <== NEVER TAKEN return EINVAL; switch ( the_attr->process_shared ) { ffc0a180: 83 e4 00 04 lwz r31,4(r4) ffc0a184: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0a188: 40 9e 00 5c bne- cr7,ffc0a1e4 <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0a18c: 3d 20 00 00 lis r9,0 */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; ffc0a190: 93 e1 00 08 stw r31,8(r1) ffc0a194: 81 69 27 f4 lwz r11,10228(r9) ffc0a198: 38 0b 00 01 addi r0,r11,1 ffc0a19c: 90 09 27 f4 stw r0,10228(r9) * the inactive chain of free RWLock control blocks. */ RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void ) { return (POSIX_RWLock_Control *) _Objects_Allocate( &_POSIX_RWLock_Information ); ffc0a1a0: 3f 80 00 00 lis r28,0 ffc0a1a4: 3b 9c 2d ec addi r28,r28,11756 ffc0a1a8: 7f 83 e3 78 mr r3,r28 ffc0a1ac: 48 00 33 75 bl ffc0d520 <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { ffc0a1b0: 7c 7d 1b 79 mr. r29,r3 ffc0a1b4: 41 82 00 50 beq- ffc0a204 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); ffc0a1b8: 38 7d 00 10 addi r3,r29,16 ffc0a1bc: 38 81 00 08 addi r4,r1,8 ffc0a1c0: 48 00 28 39 bl ffc0c9f8 <_CORE_RWLock_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc0a1c4: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0a1c8: 81 7c 00 1c lwz r11,28(r28) ffc0a1cc: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc0a1d0: 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; ffc0a1d4: 93 fd 00 0c stw r31,12(r29) &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; ffc0a1d8: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc0a1dc: 48 00 48 79 bl ffc0ea54 <_Thread_Enable_dispatch> return 0; ffc0a1e0: 38 60 00 00 li r3,0 } ffc0a1e4: 80 01 00 2c lwz r0,44(r1) ffc0a1e8: 83 81 00 18 lwz r28,24(r1) ffc0a1ec: 7c 08 03 a6 mtlr r0 ffc0a1f0: 83 a1 00 1c lwz r29,28(r1) ffc0a1f4: 83 c1 00 20 lwz r30,32(r1) ffc0a1f8: 83 e1 00 24 lwz r31,36(r1) ffc0a1fc: 38 21 00 28 addi r1,r1,40 ffc0a200: 4e 80 00 20 blr _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { _Thread_Enable_dispatch(); ffc0a204: 48 00 48 51 bl ffc0ea54 <_Thread_Enable_dispatch> return EAGAIN; ffc0a208: 38 60 00 0b li r3,11 ffc0a20c: 4b ff ff d8 b ffc0a1e4 * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); ffc0a210: 3b e1 00 0c addi r31,r1,12 ffc0a214: 7f e3 fb 78 mr r3,r31 ffc0a218: 48 00 0c 41 bl ffc0ae58 the_attr = &default_attr; ffc0a21c: 7f e4 fb 78 mr r4,r31 ffc0a220: 4b ff ff 50 b ffc0a170 =============================================================================== ffc0a2b0 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a2b0: 94 21 ff d8 stwu r1,-40(r1) ffc0a2b4: 7c 08 02 a6 mflr r0 ffc0a2b8: 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 ) ffc0a2bc: 7c 7c 1b 79 mr. r28,r3 int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a2c0: 7c 83 23 78 mr r3,r4 ffc0a2c4: 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; ffc0a2c8: 3b e0 00 16 li r31,22 int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a2cc: 90 01 00 2c stw r0,44(r1) ffc0a2d0: 93 a1 00 1c stw r29,28(r1) ffc0a2d4: 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 ) ffc0a2d8: 41 82 00 7c beq- ffc0a354 * * 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 ); ffc0a2dc: 38 81 00 0c addi r4,r1,12 ffc0a2e0: 48 00 85 29 bl ffc12808 <_POSIX_Absolute_timeout_to_ticks> ffc0a2e4: 80 9c 00 00 lwz r4,0(r28) ffc0a2e8: 7c 7d 1b 78 mr r29,r3 ffc0a2ec: 3c 60 00 00 lis r3,0 ffc0a2f0: 38 63 2d ec addi r3,r3,11756 ffc0a2f4: 38 a1 00 08 addi r5,r1,8 ffc0a2f8: 48 00 38 45 bl ffc0db3c <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { ffc0a2fc: 80 01 00 08 lwz r0,8(r1) ffc0a300: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a304: 40 9e 00 50 bne- cr7,ffc0a354 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, ffc0a308: 6b be 00 03 xori r30,r29,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( ffc0a30c: 80 9c 00 00 lwz r4,0(r28) ffc0a310: 7f de 00 34 cntlzw r30,r30 ffc0a314: 80 c1 00 0c lwz r6,12(r1) ffc0a318: 57 de d9 7e rlwinm r30,r30,27,5,31 ffc0a31c: 38 63 00 10 addi r3,r3,16 ffc0a320: 7f c5 f3 78 mr r5,r30 ffc0a324: 38 e0 00 00 li r7,0 ffc0a328: 48 00 27 11 bl ffc0ca38 <_CORE_RWLock_Obtain_for_reading> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); ffc0a32c: 48 00 47 29 bl ffc0ea54 <_Thread_Enable_dispatch> if ( !do_wait ) { ffc0a330: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a334: 40 9e 00 60 bne- cr7,ffc0a394 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { ffc0a338: 3d 20 00 00 lis r9,0 ffc0a33c: 81 29 31 30 lwz r9,12592(r9) ffc0a340: 80 69 00 34 lwz r3,52(r9) ffc0a344: 2f 83 00 02 cmpwi cr7,r3,2 ffc0a348: 41 9e 00 30 beq- cr7,ffc0a378 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( ffc0a34c: 48 00 01 4d bl ffc0a498 <_POSIX_RWLock_Translate_core_RWLock_return_code> ffc0a350: 7c 7f 1b 78 mr r31,r3 case OBJECTS_ERROR: break; } return EINVAL; } ffc0a354: 80 01 00 2c lwz r0,44(r1) ffc0a358: 7f e3 fb 78 mr r3,r31 ffc0a35c: 83 81 00 18 lwz r28,24(r1) ffc0a360: 7c 08 03 a6 mtlr r0 ffc0a364: 83 a1 00 1c lwz r29,28(r1) ffc0a368: 83 c1 00 20 lwz r30,32(r1) ffc0a36c: 83 e1 00 24 lwz r31,36(r1) ffc0a370: 38 21 00 28 addi r1,r1,40 ffc0a374: 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 ) ffc0a378: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0a37c: 41 be ff d8 beq- cr7,ffc0a354 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0a380: 3b bd ff ff addi r29,r29,-1 ffc0a384: 2b 9d 00 01 cmplwi cr7,r29,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0a388: 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 || ffc0a38c: 41 9d ff c0 bgt+ cr7,ffc0a34c <== NEVER TAKEN ffc0a390: 4b ff ff c4 b ffc0a354 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait ) { ffc0a394: 3d 20 00 00 lis r9,0 ffc0a398: 81 29 31 30 lwz r9,12592(r9) ffc0a39c: 80 69 00 34 lwz r3,52(r9) ffc0a3a0: 4b ff ff ac b ffc0a34c =============================================================================== ffc0a3a4 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a3a4: 94 21 ff d8 stwu r1,-40(r1) ffc0a3a8: 7c 08 02 a6 mflr r0 ffc0a3ac: 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 ) ffc0a3b0: 7c 7c 1b 79 mr. r28,r3 int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a3b4: 7c 83 23 78 mr r3,r4 ffc0a3b8: 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; ffc0a3bc: 3b e0 00 16 li r31,22 int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a3c0: 90 01 00 2c stw r0,44(r1) ffc0a3c4: 93 a1 00 1c stw r29,28(r1) ffc0a3c8: 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 ) ffc0a3cc: 41 82 00 7c beq- ffc0a448 * * 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 ); ffc0a3d0: 38 81 00 0c addi r4,r1,12 ffc0a3d4: 48 00 84 35 bl ffc12808 <_POSIX_Absolute_timeout_to_ticks> ffc0a3d8: 80 9c 00 00 lwz r4,0(r28) ffc0a3dc: 7c 7d 1b 78 mr r29,r3 ffc0a3e0: 3c 60 00 00 lis r3,0 ffc0a3e4: 38 63 2d ec addi r3,r3,11756 ffc0a3e8: 38 a1 00 08 addi r5,r1,8 ffc0a3ec: 48 00 37 51 bl ffc0db3c <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { ffc0a3f0: 80 01 00 08 lwz r0,8(r1) ffc0a3f4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a3f8: 40 9e 00 50 bne- cr7,ffc0a448 (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, ffc0a3fc: 6b be 00 03 xori r30,r29,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( ffc0a400: 80 9c 00 00 lwz r4,0(r28) ffc0a404: 7f de 00 34 cntlzw r30,r30 ffc0a408: 80 c1 00 0c lwz r6,12(r1) ffc0a40c: 57 de d9 7e rlwinm r30,r30,27,5,31 ffc0a410: 38 63 00 10 addi r3,r3,16 ffc0a414: 7f c5 f3 78 mr r5,r30 ffc0a418: 38 e0 00 00 li r7,0 ffc0a41c: 48 00 27 61 bl ffc0cb7c <_CORE_RWLock_Obtain_for_writing> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); ffc0a420: 48 00 46 35 bl ffc0ea54 <_Thread_Enable_dispatch> if ( !do_wait && ffc0a424: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a428: 40 9e 00 60 bne- cr7,ffc0a488 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { ffc0a42c: 3d 20 00 00 lis r9,0 ffc0a430: 81 29 31 30 lwz r9,12592(r9) ffc0a434: 80 69 00 34 lwz r3,52(r9) ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && ffc0a438: 2f 83 00 02 cmpwi cr7,r3,2 ffc0a43c: 41 9e 00 30 beq- cr7,ffc0a46c if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( ffc0a440: 48 00 00 59 bl ffc0a498 <_POSIX_RWLock_Translate_core_RWLock_return_code> ffc0a444: 7c 7f 1b 78 mr r31,r3 case OBJECTS_ERROR: break; } return EINVAL; } ffc0a448: 80 01 00 2c lwz r0,44(r1) ffc0a44c: 7f e3 fb 78 mr r3,r31 ffc0a450: 83 81 00 18 lwz r28,24(r1) ffc0a454: 7c 08 03 a6 mtlr r0 ffc0a458: 83 a1 00 1c lwz r29,28(r1) ffc0a45c: 83 c1 00 20 lwz r30,32(r1) ffc0a460: 83 e1 00 24 lwz r31,36(r1) ffc0a464: 38 21 00 28 addi r1,r1,40 ffc0a468: 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 ) ffc0a46c: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0a470: 41 be ff d8 beq- cr7,ffc0a448 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0a474: 3b bd ff ff addi r29,r29,-1 ffc0a478: 2b 9d 00 01 cmplwi cr7,r29,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0a47c: 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 || ffc0a480: 41 9d ff c0 bgt+ cr7,ffc0a440 <== NEVER TAKEN ffc0a484: 4b ff ff c4 b ffc0a448 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && ffc0a488: 3d 20 00 00 lis r9,0 ffc0a48c: 81 29 31 30 lwz r9,12592(r9) ffc0a490: 80 69 00 34 lwz r3,52(r9) ffc0a494: 4b ff ff ac b ffc0a440 =============================================================================== ffc0c160 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0c160: 94 21 ff d0 stwu r1,-48(r1) ffc0c164: 7c 08 02 a6 mflr r0 ffc0c168: 93 e1 00 2c stw r31,44(r1) int rc; /* * Check all the parameters */ if ( !param ) ffc0c16c: 7c bf 2b 79 mr. r31,r5 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0c170: 93 81 00 20 stw r28,32(r1) /* * Check all the parameters */ if ( !param ) return EINVAL; ffc0c174: 3b 80 00 16 li r28,22 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0c178: 93 a1 00 24 stw r29,36(r1) ffc0c17c: 7c 7d 1b 78 mr r29,r3 ffc0c180: 93 c1 00 28 stw r30,40(r1) ffc0c184: 7c 9e 23 78 mr r30,r4 ffc0c188: 90 01 00 34 stw r0,52(r1) ffc0c18c: 93 61 00 1c stw r27,28(r1) int rc; /* * Check all the parameters */ if ( !param ) ffc0c190: 41 82 00 20 beq- ffc0c1b0 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( ffc0c194: 7c 83 23 78 mr r3,r4 ffc0c198: 38 a1 00 08 addi r5,r1,8 ffc0c19c: 7f e4 fb 78 mr r4,r31 ffc0c1a0: 38 c1 00 0c addi r6,r1,12 ffc0c1a4: 48 00 7a 89 bl ffc13c2c <_POSIX_Thread_Translate_sched_param> policy, param, &budget_algorithm, &budget_callout ); if ( rc ) ffc0c1a8: 7c 7c 1b 79 mr. r28,r3 ffc0c1ac: 41 82 00 2c beq- ffc0c1d8 case OBJECTS_ERROR: break; } return ESRCH; } ffc0c1b0: 80 01 00 34 lwz r0,52(r1) ffc0c1b4: 7f 83 e3 78 mr r3,r28 ffc0c1b8: 83 61 00 1c lwz r27,28(r1) ffc0c1bc: 7c 08 03 a6 mtlr r0 ffc0c1c0: 83 81 00 20 lwz r28,32(r1) ffc0c1c4: 83 a1 00 24 lwz r29,36(r1) ffc0c1c8: 83 c1 00 28 lwz r30,40(r1) ffc0c1cc: 83 e1 00 2c lwz r31,44(r1) ffc0c1d0: 38 21 00 30 addi r1,r1,48 ffc0c1d4: 4e 80 00 20 blr ffc0c1d8: 3c 60 00 00 lis r3,0 ffc0c1dc: 38 63 2e 6c addi r3,r3,11884 ffc0c1e0: 7f a4 eb 78 mr r4,r29 ffc0c1e4: 38 a1 00 10 addi r5,r1,16 ffc0c1e8: 48 00 2a 59 bl ffc0ec40 <_Objects_Get> /* * Actually change the scheduling policy and parameters */ the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { ffc0c1ec: 80 01 00 10 lwz r0,16(r1) ffc0c1f0: 7c 7b 1b 78 mr r27,r3 ffc0c1f4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c1f8: 40 9e 00 c4 bne- cr7,ffc0c2bc case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0c1fc: 83 a3 01 34 lwz r29,308(r3) if ( api->schedpolicy == SCHED_SPORADIC ) ffc0c200: 80 1d 00 84 lwz r0,132(r29) ffc0c204: 2f 80 00 04 cmpwi cr7,r0,4 ffc0c208: 41 9e 01 08 beq- cr7,ffc0c310 (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; ffc0c20c: 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 ) { ffc0c210: 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; ffc0c214: 81 5f 00 04 lwz r10,4(r31) ffc0c218: 81 7f 00 08 lwz r11,8(r31) ffc0c21c: 81 3f 00 0c lwz r9,12(r31) ffc0c220: 80 1f 00 00 lwz r0,0(r31) ffc0c224: 91 5d 00 8c stw r10,140(r29) ffc0c228: 90 1d 00 88 stw r0,136(r29) ffc0c22c: 91 7d 00 90 stw r11,144(r29) ffc0c230: 91 3d 00 94 stw r9,148(r29) ffc0c234: 81 3f 00 18 lwz r9,24(r31) ffc0c238: 81 5f 00 10 lwz r10,16(r31) ffc0c23c: 81 7f 00 14 lwz r11,20(r31) ffc0c240: 91 3d 00 a0 stw r9,160(r29) the_thread->budget_algorithm = budget_algorithm; ffc0c244: 81 21 00 08 lwz r9,8(r1) if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; ffc0c248: 91 5d 00 98 stw r10,152(r29) ffc0c24c: 91 7d 00 9c stw r11,156(r29) the_thread->budget_algorithm = budget_algorithm; ffc0c250: 91 3b 00 7c stw r9,124(r27) the_thread->budget_callout = budget_callout; ffc0c254: 81 21 00 0c lwz r9,12(r1) ffc0c258: 91 3b 00 80 stw r9,128(r27) switch ( api->schedpolicy ) { ffc0c25c: 41 9c 00 34 blt- cr7,ffc0c290 <== NEVER TAKEN ffc0c260: 2f 9e 00 02 cmpwi cr7,r30,2 ffc0c264: 41 9d 00 84 bgt- cr7,ffc0c2e8 ffc0c268: 3d 20 00 00 lis r9,0 ffc0c26c: 88 89 27 54 lbz r4,10068(r9) case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0c270: 3d 20 00 00 lis r9,0 ffc0c274: 81 29 28 44 lwz r9,10308(r9) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c278: 7f 63 db 78 mr r3,r27 ffc0c27c: 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; ffc0c280: 91 3b 00 78 stw r9,120(r27) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c284: 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 = ffc0c288: 90 9b 00 18 stw r4,24(r27) _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c28c: 48 00 31 fd bl ffc0f488 <_Thread_Change_priority> _Watchdog_Remove( &api->Sporadic_timer ); _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); break; } _Thread_Enable_dispatch(); ffc0c290: 48 00 38 c9 bl ffc0fb58 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return ESRCH; } ffc0c294: 80 01 00 34 lwz r0,52(r1) ffc0c298: 7f 83 e3 78 mr r3,r28 ffc0c29c: 83 61 00 1c lwz r27,28(r1) ffc0c2a0: 7c 08 03 a6 mtlr r0 ffc0c2a4: 83 81 00 20 lwz r28,32(r1) ffc0c2a8: 83 a1 00 24 lwz r29,36(r1) ffc0c2ac: 83 c1 00 28 lwz r30,40(r1) ffc0c2b0: 83 e1 00 2c lwz r31,44(r1) ffc0c2b4: 38 21 00 30 addi r1,r1,48 ffc0c2b8: 4e 80 00 20 blr ffc0c2bc: 80 01 00 34 lwz r0,52(r1) #endif case OBJECTS_ERROR: break; } return ESRCH; ffc0c2c0: 3b 80 00 03 li r28,3 } ffc0c2c4: 7f 83 e3 78 mr r3,r28 ffc0c2c8: 83 61 00 1c lwz r27,28(r1) ffc0c2cc: 7c 08 03 a6 mtlr r0 ffc0c2d0: 83 81 00 20 lwz r28,32(r1) ffc0c2d4: 83 a1 00 24 lwz r29,36(r1) ffc0c2d8: 83 c1 00 28 lwz r30,40(r1) ffc0c2dc: 83 e1 00 2c lwz r31,44(r1) ffc0c2e0: 38 21 00 30 addi r1,r1,48 ffc0c2e4: 4e 80 00 20 blr api->schedpolicy = policy; api->schedparam = *param; the_thread->budget_algorithm = budget_algorithm; the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { ffc0c2e8: 2f 9e 00 04 cmpwi cr7,r30,4 ffc0c2ec: 40 9e ff a4 bne+ cr7,ffc0c290 <== NEVER TAKEN true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; ffc0c2f0: 90 1d 00 a4 stw r0,164(r29) _Watchdog_Remove( &api->Sporadic_timer ); ffc0c2f4: 38 7d 00 a8 addi r3,r29,168 ffc0c2f8: 48 00 51 e9 bl ffc114e0 <_Watchdog_Remove> _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); ffc0c2fc: 38 60 00 00 li r3,0 ffc0c300: 7f 64 db 78 mr r4,r27 ffc0c304: 4b ff fc b5 bl ffc0bfb8 <_POSIX_Threads_Sporadic_budget_TSR> break; } _Thread_Enable_dispatch(); ffc0c308: 48 00 38 51 bl ffc0fb58 <_Thread_Enable_dispatch> ffc0c30c: 4b ff ff 88 b ffc0c294 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); ffc0c310: 38 7d 00 a8 addi r3,r29,168 ffc0c314: 48 00 51 cd bl ffc114e0 <_Watchdog_Remove> ffc0c318: 4b ff fe f4 b ffc0c20c =============================================================================== ffc117b4 : sigset_t *oset ) { POSIX_API_Control *api; if ( !set && !oset ) ffc117b4: 2c 04 00 00 cmpwi r4,0 int pthread_sigmask( int how, const sigset_t *set, sigset_t *oset ) { ffc117b8: 94 21 ff f0 stwu r1,-16(r1) ffc117bc: 7c 08 02 a6 mflr r0 ffc117c0: 90 01 00 14 stw r0,20(r1) POSIX_API_Control *api; if ( !set && !oset ) ffc117c4: 41 82 00 c4 beq- ffc11888 rtems_set_errno_and_return_minus_one( EINVAL ); api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; if ( oset ) ffc117c8: 2f 85 00 00 cmpwi cr7,r5,0 POSIX_API_Control *api; if ( !set && !oset ) rtems_set_errno_and_return_minus_one( EINVAL ); api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc117cc: 3d 20 00 00 lis r9,0 ffc117d0: 81 29 31 70 lwz r9,12656(r9) ffc117d4: 81 29 01 34 lwz r9,308(r9) if ( oset ) ffc117d8: 41 9e 00 10 beq- cr7,ffc117e8 *oset = api->signals_blocked; ffc117dc: 80 09 00 d0 lwz r0,208(r9) ffc117e0: 90 05 00 00 stw r0,0(r5) if ( !set ) ffc117e4: 41 82 00 c4 beq- ffc118a8 <== NEVER TAKEN return 0; switch ( how ) { ffc117e8: 2f 83 00 01 cmpwi cr7,r3,1 ffc117ec: 41 9e 00 88 beq- cr7,ffc11874 ffc117f0: 2f 83 00 02 cmpwi cr7,r3,2 ffc117f4: 41 9e 00 4c beq- cr7,ffc11840 ffc117f8: 2f 83 00 00 cmpwi cr7,r3,0 ffc117fc: 40 9e 00 58 bne- cr7,ffc11854 break; case SIG_UNBLOCK: api->signals_blocked &= ~*set; break; case SIG_SETMASK: api->signals_blocked = *set; ffc11800: 80 04 00 00 lwz r0,0(r4) ffc11804: 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) ) { ffc11808: 3d 60 00 00 lis r11,0 ffc1180c: 81 29 00 d4 lwz r9,212(r9) ffc11810: 81 6b 28 84 lwz r11,10372(r11) _Thread_Dispatch(); } return 0; ffc11814: 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) ) { ffc11818: 7d 69 4b 78 or r9,r11,r9 /* XXX are there critical section problems here? */ /* XXX evaluate the new set */ if ( ~api->signals_blocked & ffc1181c: 7d 2b 00 79 andc. r11,r9,r0 ffc11820: 41 a2 00 10 beq+ ffc11830 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); ffc11824: 90 61 00 08 stw r3,8(r1) ffc11828: 4b ff b7 fd bl ffc0d024 <_Thread_Dispatch> ffc1182c: 80 61 00 08 lwz r3,8(r1) } return 0; } ffc11830: 80 01 00 14 lwz r0,20(r1) ffc11834: 38 21 00 10 addi r1,r1,16 ffc11838: 7c 08 03 a6 mtlr r0 ffc1183c: 4e 80 00 20 blr switch ( how ) { case SIG_BLOCK: api->signals_blocked |= *set; break; case SIG_UNBLOCK: api->signals_blocked &= ~*set; ffc11840: 81 64 00 00 lwz r11,0(r4) ffc11844: 80 09 00 d0 lwz r0,208(r9) ffc11848: 7c 00 58 78 andc r0,r0,r11 ffc1184c: 90 09 00 d0 stw r0,208(r9) break; ffc11850: 4b ff ff b8 b ffc11808 case SIG_SETMASK: api->signals_blocked = *set; break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc11854: 48 00 33 e9 bl ffc14c3c <__errno> ffc11858: 38 00 00 16 li r0,22 ffc1185c: 90 03 00 00 stw r0,0(r3) ffc11860: 38 60 ff ff li r3,-1 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc11864: 80 01 00 14 lwz r0,20(r1) ffc11868: 38 21 00 10 addi r1,r1,16 ffc1186c: 7c 08 03 a6 mtlr r0 ffc11870: 4e 80 00 20 blr if ( !set ) return 0; switch ( how ) { case SIG_BLOCK: api->signals_blocked |= *set; ffc11874: 80 09 00 d0 lwz r0,208(r9) ffc11878: 81 64 00 00 lwz r11,0(r4) ffc1187c: 7c 00 5b 78 or r0,r0,r11 ffc11880: 90 09 00 d0 stw r0,208(r9) break; ffc11884: 4b ff ff 84 b ffc11808 sigset_t *oset ) { POSIX_API_Control *api; if ( !set && !oset ) ffc11888: 2f 85 00 00 cmpwi cr7,r5,0 ffc1188c: 41 be ff c8 beq- cr7,ffc11854 rtems_set_errno_and_return_minus_one( EINVAL ); api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc11890: 3d 20 00 00 lis r9,0 ffc11894: 81 29 31 70 lwz r9,12656(r9) ffc11898: 81 29 01 34 lwz r9,308(r9) if ( oset ) *oset = api->signals_blocked; ffc1189c: 80 09 00 d0 lwz r0,208(r9) ffc118a0: 90 05 00 00 stw r0,0(r5) if ( !set ) ffc118a4: 40 82 ff 44 bne+ ffc117e8 <== NEVER TAKEN (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc118a8: 80 01 00 14 lwz r0,20(r1) if ( oset ) *oset = api->signals_blocked; if ( !set ) return 0; ffc118ac: 38 60 00 00 li r3,0 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc118b0: 38 21 00 10 addi r1,r1,16 ffc118b4: 7c 08 03 a6 mtlr r0 ffc118b8: 4e 80 00 20 blr =============================================================================== ffc093c8 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { ffc093c8: 94 21 ff f0 stwu r1,-16(r1) ffc093cc: 7c 08 02 a6 mflr r0 ffc093d0: 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() ) ffc093d4: 3f e0 00 00 lis r31,0 ffc093d8: 3b ff 31 04 addi r31,r31,12548 * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { ffc093dc: 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() ) ffc093e0: 80 1f 00 08 lwz r0,8(r31) ffc093e4: 2f 80 00 00 cmpwi cr7,r0,0 ffc093e8: 40 9e 00 44 bne- cr7,ffc0942c <== NEVER TAKEN ffc093ec: 3d 20 00 00 lis r9,0 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc093f0: 81 7f 00 0c lwz r11,12(r31) ffc093f4: 81 49 27 ec lwz r10,10220(r9) ffc093f8: 81 6b 01 34 lwz r11,308(r11) ffc093fc: 38 0a 00 01 addi r0,r10,1 ffc09400: 90 09 27 ec stw r0,10220(r9) _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc09404: 80 0b 00 d8 lwz r0,216(r11) ffc09408: 2f 80 00 00 cmpwi cr7,r0,0 ffc0940c: 40 9e 00 34 bne- cr7,ffc09440 <== NEVER TAKEN ffc09410: 80 0b 00 e0 lwz r0,224(r11) ffc09414: 2f 80 00 00 cmpwi cr7,r0,0 ffc09418: 41 9e 00 28 beq- cr7,ffc09440 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); ffc0941c: 48 00 37 3d bl ffc0cb58 <_Thread_Enable_dispatch> if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); ffc09420: 80 7f 00 0c lwz r3,12(r31) ffc09424: 38 80 ff ff li r4,-1 ffc09428: 48 00 78 fd bl ffc10d24 <_POSIX_Thread_Exit> } ffc0942c: 80 01 00 14 lwz r0,20(r1) <== NOT EXECUTED ffc09430: 83 e1 00 0c lwz r31,12(r1) <== NOT EXECUTED ffc09434: 38 21 00 10 addi r1,r1,16 <== NOT EXECUTED ffc09438: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0943c: 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(); ffc09440: 48 00 37 19 bl ffc0cb58 <_Thread_Enable_dispatch> if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); } ffc09444: 80 01 00 14 lwz r0,20(r1) ffc09448: 83 e1 00 0c lwz r31,12(r1) ffc0944c: 38 21 00 10 addi r1,r1,16 ffc09450: 7c 08 03 a6 mtlr r0 ffc09454: 4e 80 00 20 blr =============================================================================== ffc0a290 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a290: 94 21 ff b0 stwu r1,-80(r1) ffc0a294: 7c 08 02 a6 mflr r0 ffc0a298: 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); ffc0a29c: 3f e0 00 00 lis r31,0 ffc0a2a0: 3b ff 2c 50 addi r31,r31,11344 * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a2a4: 93 a1 00 44 stw r29,68(r1) ffc0a2a8: 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); ffc0a2ac: 7f e3 fb 78 mr r3,r31 * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a2b0: 93 c1 00 48 stw r30,72(r1) ffc0a2b4: 90 01 00 54 stw r0,84(r1) ffc0a2b8: 93 61 00 3c stw r27,60(r1) ffc0a2bc: 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); ffc0a2c0: 48 00 0c 51 bl ffc0af10 if (result != 0) { ffc0a2c4: 7c 7e 1b 79 mr. r30,r3 ffc0a2c8: 40 82 00 d4 bne- ffc0a39c <== 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); ffc0a2cc: 48 00 17 d1 bl ffc0ba9c ffc0a2d0: 38 81 00 0c addi r4,r1,12 ffc0a2d4: 38 a1 00 10 addi r5,r1,16 ffc0a2d8: 48 00 11 e1 bl ffc0b4b8 req->caller_thread = pthread_self (); ffc0a2dc: 48 00 17 c1 bl ffc0ba9c 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) && ffc0a2e0: 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; ffc0a2e4: 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) && ffc0a2e8: 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; ffc0a2ec: 81 61 00 10 lwz r11,16(r1) ffc0a2f0: 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 (); ffc0a2f4: 90 7d 00 10 stw r3,16(r29) req->priority = param.sched_priority - req->aiocbp->aio_reqprio; ffc0a2f8: 7c 00 58 50 subf r0,r0,r11 ffc0a2fc: 90 1d 00 0c stw r0,12(r29) req->policy = policy; ffc0a300: 80 01 00 0c lwz r0,12(r1) ffc0a304: 90 1d 00 08 stw r0,8(r29) req->aiocbp->error_code = EINPROGRESS; ffc0a308: 38 00 00 77 li r0,119 ffc0a30c: 90 09 00 34 stw r0,52(r9) req->aiocbp->return_value = 0; ffc0a310: 93 c9 00 38 stw r30,56(r9) if ((aio_request_queue.idle_threads == 0) && ffc0a314: 40 9e 00 10 bne- cr7,ffc0a324 <== NEVER TAKEN ffc0a318: 80 1f 00 64 lwz r0,100(r31) ffc0a31c: 2f 80 00 04 cmpwi cr7,r0,4 ffc0a320: 40 9d 00 ac ble- cr7,ffc0a3cc 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, ffc0a324: 3f 60 00 00 lis r27,0 ffc0a328: 80 89 00 00 lwz r4,0(r9) ffc0a32c: 3b 7b 2c 98 addi r27,r27,11416 ffc0a330: 7f 63 db 78 mr r3,r27 ffc0a334: 38 a0 00 00 li r5,0 ffc0a338: 4b ff f9 29 bl ffc09c60 req->aiocbp->aio_fildes, 0); if (r_chain != NULL) ffc0a33c: 7c 7c 1b 79 mr. r28,r3 ffc0a340: 41 82 01 04 beq- ffc0a444 { pthread_mutex_lock (&r_chain->mutex); ffc0a344: 3b 7c 00 1c addi r27,r28,28 ffc0a348: 7f 63 db 78 mr r3,r27 ffc0a34c: 48 00 0b c5 bl ffc0af10 rtems_aio_insert_prio (&r_chain->perfd, req); ffc0a350: 38 7c 00 08 addi r3,r28,8 ffc0a354: 7f a4 eb 78 mr r4,r29 ffc0a358: 4b ff fd 81 bl ffc0a0d8 pthread_cond_signal (&r_chain->cond); ffc0a35c: 38 7c 00 20 addi r3,r28,32 ffc0a360: 48 00 05 8d bl ffc0a8ec pthread_mutex_unlock (&r_chain->mutex); ffc0a364: 7f 63 db 78 mr r3,r27 ffc0a368: 48 00 0c 75 bl ffc0afdc if (aio_request_queue.idle_threads > 0) pthread_cond_signal (&aio_request_queue.new_req); } } pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a36c: 7f e3 fb 78 mr r3,r31 ffc0a370: 48 00 0c 6d bl ffc0afdc return 0; } ffc0a374: 80 01 00 54 lwz r0,84(r1) ffc0a378: 7f c3 f3 78 mr r3,r30 ffc0a37c: 83 61 00 3c lwz r27,60(r1) ffc0a380: 7c 08 03 a6 mtlr r0 ffc0a384: 83 81 00 40 lwz r28,64(r1) ffc0a388: 83 a1 00 44 lwz r29,68(r1) ffc0a38c: 83 c1 00 48 lwz r30,72(r1) ffc0a390: 83 e1 00 4c lwz r31,76(r1) ffc0a394: 38 21 00 50 addi r1,r1,80 ffc0a398: 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); ffc0a39c: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc0a3a0: 4b ff b5 b1 bl ffc05950 <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); return 0; } ffc0a3a4: 80 01 00 54 lwz r0,84(r1) <== NOT EXECUTED ffc0a3a8: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc0a3ac: 83 61 00 3c lwz r27,60(r1) <== NOT EXECUTED ffc0a3b0: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0a3b4: 83 81 00 40 lwz r28,64(r1) <== NOT EXECUTED ffc0a3b8: 83 a1 00 44 lwz r29,68(r1) <== NOT EXECUTED ffc0a3bc: 83 c1 00 48 lwz r30,72(r1) <== NOT EXECUTED ffc0a3c0: 83 e1 00 4c lwz r31,76(r1) <== NOT EXECUTED ffc0a3c4: 38 21 00 50 addi r1,r1,80 <== NOT EXECUTED ffc0a3c8: 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); ffc0a3cc: 80 89 00 00 lwz r4,0(r9) ffc0a3d0: 38 7f 00 48 addi r3,r31,72 ffc0a3d4: 38 a0 00 01 li r5,1 ffc0a3d8: 4b ff f8 89 bl ffc09c60 if (r_chain->new_fd == 1) { ffc0a3dc: 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); ffc0a3e0: 7c 7c 1b 78 mr r28,r3 if (r_chain->new_fd == 1) { ffc0a3e4: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a3e8: 40 9e ff 5c bne+ cr7,ffc0a344 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); ffc0a3ec: 7f a4 eb 78 mr r4,r29 ffc0a3f0: 38 63 00 08 addi r3,r3,8 ffc0a3f4: 48 00 2f 01 bl ffc0d2f4 <_Chain_Insert> rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; ffc0a3f8: 93 dc 00 18 stw r30,24(r28) pthread_mutex_init (&r_chain->mutex, NULL); ffc0a3fc: 38 80 00 00 li r4,0 ffc0a400: 38 7c 00 1c addi r3,r28,28 ffc0a404: 48 00 09 7d bl ffc0ad80 pthread_cond_init (&r_chain->cond, NULL); ffc0a408: 38 80 00 00 li r4,0 ffc0a40c: 38 7c 00 20 addi r3,r28,32 ffc0a410: 48 00 03 d1 bl ffc0a7e0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, ffc0a414: 3c a0 ff c1 lis r5,-63 ffc0a418: 38 61 00 08 addi r3,r1,8 ffc0a41c: 38 9f 00 08 addi r4,r31,8 ffc0a420: 38 a5 9e 00 addi r5,r5,-25088 ffc0a424: 7f 86 e3 78 mr r6,r28 ffc0a428: 48 00 0d 85 bl ffc0b1ac rtems_aio_handle, (void *) r_chain); if (result != 0) { ffc0a42c: 7c 7d 1b 79 mr. r29,r3 ffc0a430: 40 82 00 88 bne- ffc0a4b8 <== NEVER TAKEN pthread_mutex_unlock (&aio_request_queue.mutex); return result; } ++aio_request_queue.active_threads; ffc0a434: 81 3f 00 64 lwz r9,100(r31) ffc0a438: 38 09 00 01 addi r0,r9,1 ffc0a43c: 90 1f 00 64 stw r0,100(r31) ffc0a440: 4b ff ff 2c b ffc0a36c } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); ffc0a444: 81 3d 00 14 lwz r9,20(r29) ffc0a448: 38 7b 00 0c addi r3,r27,12 ffc0a44c: 38 a0 00 01 li r5,1 ffc0a450: 80 89 00 00 lwz r4,0(r9) ffc0a454: 4b ff f8 0d bl ffc09c60 if (r_chain->new_fd == 1) { ffc0a458: 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); ffc0a45c: 7c 7b 1b 78 mr r27,r3 if (r_chain->new_fd == 1) { ffc0a460: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a464: 41 9e 00 28 beq- cr7,ffc0a48c 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); ffc0a468: 38 63 00 08 addi r3,r3,8 ffc0a46c: 7f a4 eb 78 mr r4,r29 ffc0a470: 4b ff fc 69 bl ffc0a0d8 if (aio_request_queue.idle_threads > 0) ffc0a474: 80 1f 00 68 lwz r0,104(r31) ffc0a478: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a47c: 40 bd fe f0 ble- cr7,ffc0a36c <== ALWAYS TAKEN pthread_cond_signal (&aio_request_queue.new_req); ffc0a480: 38 7f 00 04 addi r3,r31,4 <== NOT EXECUTED ffc0a484: 48 00 04 69 bl ffc0a8ec <== NOT EXECUTED ffc0a488: 4b ff fe e4 b ffc0a36c <== NOT EXECUTED ffc0a48c: 7f a4 eb 78 mr r4,r29 ffc0a490: 38 63 00 08 addi r3,r3,8 ffc0a494: 48 00 2e 61 bl ffc0d2f4 <_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; ffc0a498: 93 9b 00 18 stw r28,24(r27) pthread_mutex_init (&r_chain->mutex, NULL); ffc0a49c: 38 7b 00 1c addi r3,r27,28 ffc0a4a0: 38 80 00 00 li r4,0 ffc0a4a4: 48 00 08 dd bl ffc0ad80 pthread_cond_init (&r_chain->cond, NULL); ffc0a4a8: 38 7b 00 20 addi r3,r27,32 ffc0a4ac: 38 80 00 00 li r4,0 ffc0a4b0: 48 00 03 31 bl ffc0a7e0 ffc0a4b4: 4b ff ff c0 b ffc0a474 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); ffc0a4b8: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc0a4bc: 48 00 0b 21 bl ffc0afdc <== NOT EXECUTED return result; ffc0a4c0: 7f be eb 78 mr r30,r29 <== NOT EXECUTED ffc0a4c4: 4b ff fe b0 b ffc0a374 <== NOT EXECUTED =============================================================================== ffc09e00 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e00: 94 21 ff 90 stwu r1,-112(r1) ffc09e04: 7c 08 02 a6 mflr r0 ffc09e08: 93 01 00 50 stw r24,80(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); ffc09e0c: 3f 00 00 00 lis r24,0 ffc09e10: 3b 18 2c 50 addi r24,r24,11344 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e14: 90 01 00 74 stw r0,116(r1) ffc09e18: 92 61 00 3c stw r19,60(r1) ffc09e1c: 93 e1 00 6c stw r31,108(r1) ffc09e20: 92 81 00 40 stw r20,64(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, ffc09e24: 3a 98 00 04 addi r20,r24,4 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e28: 92 a1 00 44 stw r21,68(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)) { ffc09e2c: 3a b8 00 58 addi r21,r24,88 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e30: 92 c1 00 48 stw r22,72(r1) pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); ffc09e34: 3a c1 00 0c addi r22,r1,12 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e38: 92 e1 00 4c stw r23,76(r1) default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; ffc09e3c: 3a e0 ff ff li r23,-1 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e40: 93 21 00 54 stw r25,84(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 19 c3 78 mr r25,r24 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e48: 93 41 00 58 stw r26,88(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 40 00 00 li r26,0 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e50: 93 61 00 5c stw r27,92(r1) 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); ffc09e54: 3b 61 00 08 addi r27,r1,8 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e58: 93 81 00 60 stw r28,96(r1) 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); ffc09e5c: 3b 81 00 14 addi r28,r1,20 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e60: 93 a1 00 64 stw r29,100(r1) ffc09e64: 3b a3 00 1c addi r29,r3,28 ffc09e68: 93 c1 00 68 stw r30,104(r1) ffc09e6c: 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); ffc09e70: 7f a3 eb 78 mr r3,r29 ffc09e74: 48 00 10 9d bl ffc0af10 if (result != 0) ffc09e78: 7c 73 1b 79 mr. r19,r3 ffc09e7c: 40 82 00 8c bne- ffc09f08 <== NEVER TAKEN } } AIO_printf ("Thread finished\n"); return NULL; } ffc09e80: 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 ); ffc09e84: 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)) { ffc09e88: 7f 9f 00 00 cmpw cr7,r31,r0 ffc09e8c: 41 9e 01 1c beq- cr7,ffc09fa8 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); ffc09e90: 48 00 1c 0d bl ffc0ba9c ffc09e94: 7f 64 db 78 mr r4,r27 ffc09e98: 7f 85 e3 78 mr r5,r28 ffc09e9c: 48 00 16 1d bl ffc0b4b8 param.sched_priority = req->priority; ffc09ea0: 80 1f 00 0c lwz r0,12(r31) ffc09ea4: 90 01 00 14 stw r0,20(r1) pthread_setschedparam (pthread_self(), req->policy, ¶m); ffc09ea8: 48 00 1b f5 bl ffc0ba9c ffc09eac: 7f 85 e3 78 mr r5,r28 ffc09eb0: 80 9f 00 08 lwz r4,8(r31) ffc09eb4: 48 00 1b f9 bl ffc0baac */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc09eb8: 7f e3 fb 78 mr r3,r31 ffc09ebc: 48 00 33 cd bl ffc0d288 <_Chain_Extract> rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); ffc09ec0: 7f a3 eb 78 mr r3,r29 ffc09ec4: 48 00 11 19 bl ffc0afdc switch (req->aiocbp->aio_lio_opcode) { ffc09ec8: 82 7f 00 14 lwz r19,20(r31) ffc09ecc: 80 13 00 30 lwz r0,48(r19) ffc09ed0: 2f 80 00 02 cmpwi cr7,r0,2 ffc09ed4: 41 9e 00 b8 beq- cr7,ffc09f8c ffc09ed8: 2f 80 00 03 cmpwi cr7,r0,3 ffc09edc: 41 9e 00 a4 beq- cr7,ffc09f80 <== NEVER TAKEN ffc09ee0: 2f 80 00 01 cmpwi cr7,r0,1 ffc09ee4: 41 9e 00 6c beq- cr7,ffc09f50 <== ALWAYS TAKEN default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; ffc09ee8: 92 f3 00 38 stw r23,56(r19) <== NOT EXECUTED req->aiocbp->error_code = errno; ffc09eec: 48 00 cd b1 bl ffc16c9c <__errno> <== NOT EXECUTED ffc09ef0: 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); ffc09ef4: 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; ffc09ef8: 90 13 00 34 stw r0,52(r19) <== 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); ffc09efc: 48 00 10 15 bl ffc0af10 <== NOT EXECUTED if (result != 0) ffc09f00: 7c 73 1b 79 mr. r19,r3 <== NOT EXECUTED ffc09f04: 41 82 ff 7c beq+ ffc09e80 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } ffc09f08: 80 01 00 74 lwz r0,116(r1) ffc09f0c: 38 60 00 00 li r3,0 ffc09f10: 82 61 00 3c lwz r19,60(r1) ffc09f14: 7c 08 03 a6 mtlr r0 ffc09f18: 82 81 00 40 lwz r20,64(r1) ffc09f1c: 82 a1 00 44 lwz r21,68(r1) ffc09f20: 82 c1 00 48 lwz r22,72(r1) ffc09f24: 82 e1 00 4c lwz r23,76(r1) ffc09f28: 83 01 00 50 lwz r24,80(r1) ffc09f2c: 83 21 00 54 lwz r25,84(r1) ffc09f30: 83 41 00 58 lwz r26,88(r1) ffc09f34: 83 61 00 5c lwz r27,92(r1) ffc09f38: 83 81 00 60 lwz r28,96(r1) ffc09f3c: 83 a1 00 64 lwz r29,100(r1) ffc09f40: 83 c1 00 68 lwz r30,104(r1) ffc09f44: 83 e1 00 6c lwz r31,108(r1) ffc09f48: 38 21 00 70 addi r1,r1,112 ffc09f4c: 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, ffc09f50: 80 73 00 00 lwz r3,0(r19) ffc09f54: 80 93 00 10 lwz r4,16(r19) ffc09f58: 80 b3 00 14 lwz r5,20(r19) ffc09f5c: 80 f3 00 08 lwz r7,8(r19) ffc09f60: 81 13 00 0c lwz r8,12(r19) ffc09f64: 48 00 dc 9d bl ffc17c00 break; default: result = -1; } if (result == -1) { ffc09f68: 2f 83 ff ff cmpwi cr7,r3,-1 ffc09f6c: 41 9e 01 4c beq- cr7,ffc0a0b8 <== NEVER TAKEN req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; } else { req->aiocbp->return_value = result; ffc09f70: 81 3f 00 14 lwz r9,20(r31) ffc09f74: 90 69 00 38 stw r3,56(r9) req->aiocbp->error_code = 0; ffc09f78: 93 49 00 34 stw r26,52(r9) ffc09f7c: 4b ff fe f4 b ffc09e70 req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_SYNC: AIO_printf ("sync\n"); result = fsync (req->aiocbp->aio_fildes); ffc09f80: 80 73 00 00 lwz r3,0(r19) <== NOT EXECUTED ffc09f84: 48 00 8a a1 bl ffc12a24 <== NOT EXECUTED break; ffc09f88: 4b ff ff e0 b ffc09f68 <== NOT EXECUTED req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_WRITE: AIO_printf ("write\n"); result = pwrite (req->aiocbp->aio_fildes, ffc09f8c: 80 73 00 00 lwz r3,0(r19) ffc09f90: 80 93 00 10 lwz r4,16(r19) ffc09f94: 80 b3 00 14 lwz r5,20(r19) ffc09f98: 80 f3 00 08 lwz r7,8(r19) ffc09f9c: 81 13 00 0c lwz r8,12(r19) ffc09fa0: 48 00 dd 99 bl ffc17d38 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; ffc09fa4: 4b ff ff c4 b ffc09f68 struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); ffc09fa8: 7f a3 eb 78 mr r3,r29 ffc09fac: 48 00 10 31 bl ffc0afdc pthread_mutex_lock (&aio_request_queue.mutex); ffc09fb0: 7f 23 cb 78 mr r3,r25 ffc09fb4: 48 00 0f 5d bl ffc0af10 if (rtems_chain_is_empty (chain)) ffc09fb8: 80 1e 00 08 lwz r0,8(r30) ffc09fbc: 7f 9f 00 00 cmpw cr7,r31,r0 ffc09fc0: 41 9e 00 10 beq- cr7,ffc09fd0 <== 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); ffc09fc4: 7f 23 cb 78 mr r3,r25 ffc09fc8: 48 00 10 15 bl ffc0afdc ffc09fcc: 4b ff fe a4 b ffc09e70 pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); ffc09fd0: 7e c4 b3 78 mr r4,r22 ffc09fd4: 38 60 00 01 li r3,1 ffc09fd8: 48 00 06 59 bl ffc0a630 timeout.tv_sec += 3; ffc09fdc: 81 21 00 0c lwz r9,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc09fe0: 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; ffc09fe4: 92 61 00 10 stw r19,16(r1) pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; ffc09fe8: 38 09 00 03 addi r0,r9,3 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc09fec: 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; ffc09ff0: 90 01 00 0c stw r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc09ff4: 7f 24 cb 78 mr r4,r25 ffc09ff8: 7e c5 b3 78 mr r5,r22 ffc09ffc: 48 00 09 cd bl ffc0a9c8 &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) { ffc0a000: 2f 83 00 74 cmpwi cr7,r3,116 ffc0a004: 40 9e ff c0 bne+ cr7,ffc09fc4 <== NEVER TAKEN ffc0a008: 7f c3 f3 78 mr r3,r30 ffc0a00c: 48 00 32 7d bl ffc0d288 <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); ffc0a010: 7f a3 eb 78 mr r3,r29 ffc0a014: 48 00 0b a9 bl ffc0abbc pthread_cond_destroy (&r_chain->cond); ffc0a018: 7f e3 fb 78 mr r3,r31 ffc0a01c: 48 00 06 b5 bl ffc0a6d0 free (r_chain); ffc0a020: 7f c3 f3 78 mr r3,r30 ffc0a024: 4b ff b9 2d bl ffc05950 } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a028: 83 d9 00 54 lwz r30,84(r25) 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)) { ffc0a02c: 7f 9e a8 00 cmpw cr7,r30,r21 ffc0a030: 41 9e 00 34 beq- cr7,ffc0a064 } /* 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; ++aio_request_queue.active_threads; ffc0a034: 81 78 00 64 lwz r11,100(r24) ffc0a038: 7f c3 f3 78 mr r3,r30 } } /* 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; ffc0a03c: 81 38 00 68 lwz r9,104(r24) ffc0a040: 3b be 00 1c addi r29,r30,28 ++aio_request_queue.active_threads; ffc0a044: 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; ffc0a048: 39 29 ff ff addi r9,r9,-1 ++aio_request_queue.active_threads; ffc0a04c: 90 18 00 64 stw r0,100(r24) } } /* 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; ffc0a050: 91 38 00 68 stw r9,104(r24) ffc0a054: 48 00 32 35 bl ffc0d288 <_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); ffc0a058: 7f c3 f3 78 mr r3,r30 ffc0a05c: 4b ff fd 15 bl ffc09d70 ffc0a060: 4b ff ff 64 b ffc09fc4 /* 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; ffc0a064: 81 39 00 68 lwz r9,104(r25) --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); ffc0a068: 7e c4 b3 78 mr r4,r22 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; ffc0a06c: 80 19 00 64 lwz r0,100(r25) clock_gettime (CLOCK_REALTIME, &timeout); ffc0a070: 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; ffc0a074: 39 29 00 01 addi r9,r9,1 --aio_request_queue.active_threads; ffc0a078: 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; ffc0a07c: 91 39 00 68 stw r9,104(r25) --aio_request_queue.active_threads; ffc0a080: 90 19 00 64 stw r0,100(r25) clock_gettime (CLOCK_REALTIME, &timeout); ffc0a084: 48 00 05 ad bl ffc0a630 timeout.tv_sec += 3; ffc0a088: 80 01 00 0c lwz r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a08c: 7e 83 a3 78 mr r3,r20 ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; ffc0a090: 92 61 00 10 stw r19,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; ffc0a094: 30 00 00 03 addic r0,r0,3 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a098: 7f 24 cb 78 mr r4,r25 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; ffc0a09c: 90 01 00 0c stw r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a0a0: 7e c5 b3 78 mr r5,r22 ffc0a0a4: 48 00 09 25 bl ffc0a9c8 &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { ffc0a0a8: 2f 83 00 74 cmpwi cr7,r3,116 ffc0a0ac: 41 9e 00 14 beq- cr7,ffc0a0c0 <== ALWAYS TAKEN ffc0a0b0: 83 d9 00 54 lwz r30,84(r25) <== NOT EXECUTED ffc0a0b4: 4b ff ff 80 b ffc0a034 <== NOT EXECUTED break; default: result = -1; } if (result == -1) { ffc0a0b8: 82 7f 00 14 lwz r19,20(r31) <== NOT EXECUTED ffc0a0bc: 4b ff fe 2c b ffc09ee8 <== 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; ffc0a0c0: 80 19 00 68 lwz r0,104(r25) pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a0c4: 7f 23 cb 78 mr r3,r25 /* 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; ffc0a0c8: 30 00 ff ff addic r0,r0,-1 ffc0a0cc: 90 19 00 68 stw r0,104(r25) pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a0d0: 48 00 0f 0d bl ffc0afdc return NULL; ffc0a0d4: 4b ff fe 34 b ffc09f08 =============================================================================== ffc09b14 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { ffc09b14: 94 21 ff e8 stwu r1,-24(r1) ffc09b18: 7c 08 02 a6 mflr r0 ffc09b1c: 93 c1 00 10 stw r30,16(r1) int result = 0; result = pthread_attr_init (&aio_request_queue.attr); ffc09b20: 3f c0 00 00 lis r30,0 ffc09b24: 3b de 2c 58 addi r30,r30,11352 ffc09b28: 7f c3 f3 78 mr r3,r30 * 0 - if initialization succeeded */ int rtems_aio_init (void) { ffc09b2c: 93 a1 00 0c stw r29,12(r1) ffc09b30: 90 01 00 1c stw r0,28(r1) ffc09b34: 93 e1 00 14 stw r31,20(r1) int result = 0; result = pthread_attr_init (&aio_request_queue.attr); ffc09b38: 48 00 16 09 bl ffc0b140 if (result != 0) ffc09b3c: 7c 7d 1b 79 mr. r29,r3 ffc09b40: 41 82 00 24 beq- ffc09b64 <== ALWAYS TAKEN aio_request_queue.active_threads = 0; aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; return result; } ffc09b44: 80 01 00 1c lwz r0,28(r1) <== NOT EXECUTED ffc09b48: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc09b4c: 83 c1 00 10 lwz r30,16(r1) <== NOT EXECUTED ffc09b50: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc09b54: 83 a1 00 0c lwz r29,12(r1) <== NOT EXECUTED ffc09b58: 83 e1 00 14 lwz r31,20(r1) <== NOT EXECUTED ffc09b5c: 38 21 00 18 addi r1,r1,24 <== NOT EXECUTED ffc09b60: 4e 80 00 20 blr <== NOT EXECUTED result = pthread_attr_init (&aio_request_queue.attr); if (result != 0) return result; result = ffc09b64: 7f c3 f3 78 mr r3,r30 ffc09b68: 38 80 00 00 li r4,0 ffc09b6c: 48 00 16 15 bl ffc0b180 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) ffc09b70: 2f 83 00 00 cmpwi cr7,r3,0 ffc09b74: 40 9e 00 94 bne- cr7,ffc09c08 <== NEVER TAKEN pthread_attr_destroy (&aio_request_queue.attr); result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09b78: 3f e0 00 00 lis r31,0 ffc09b7c: 3b ff 2c 50 addi r31,r31,11344 ffc09b80: 7f e3 fb 78 mr r3,r31 ffc09b84: 38 80 00 00 li r4,0 ffc09b88: 48 00 11 f9 bl ffc0ad80 if (result != 0) ffc09b8c: 2f 83 00 00 cmpwi cr7,r3,0 ffc09b90: 40 9e 00 9c bne- cr7,ffc09c2c <== NEVER TAKEN pthread_attr_destroy (&aio_request_queue.attr); result = pthread_cond_init (&aio_request_queue.new_req, NULL); ffc09b94: 3c 60 00 00 lis r3,0 ffc09b98: 38 63 2c 54 addi r3,r3,11348 ffc09b9c: 38 80 00 00 li r4,0 ffc09ba0: 48 00 0c 41 bl ffc0a7e0 if (result != 0) { ffc09ba4: 7c 7d 1b 79 mr. r29,r3 ffc09ba8: 40 82 00 a4 bne- ffc09c4c <== NEVER TAKEN { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; ffc09bac: 38 00 00 00 li r0,0 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc09bb0: 39 1f 00 4c addi r8,r31,76 head->previous = NULL; ffc09bb4: 90 1f 00 4c stw r0,76(r31) tail->previous = head; ffc09bb8: 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; ffc09bbc: 39 7f 00 58 addi r11,r31,88 head->previous = NULL; ffc09bc0: 90 1f 00 58 stw r0,88(r31) tail->previous = head; ffc09bc4: 39 3f 00 54 addi r9,r31,84 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc09bc8: 91 1f 00 48 stw r8,72(r31) aio_request_queue.active_threads = 0; aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; return result; } ffc09bcc: 7f a3 eb 78 mr r3,r29 head->previous = NULL; tail->previous = head; ffc09bd0: 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; ffc09bd4: 91 7f 00 54 stw r11,84(r31) head->previous = NULL; tail->previous = head; ffc09bd8: 91 3f 00 5c stw r9,92(r31) } rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; ffc09bdc: 90 1f 00 64 stw r0,100(r31) aio_request_queue.idle_threads = 0; ffc09be0: 90 1f 00 68 stw r0,104(r31) aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; ffc09be4: 60 00 b0 0b ori r0,r0,45067 ffc09be8: 90 1f 00 60 stw r0,96(r31) return result; } ffc09bec: 80 01 00 1c lwz r0,28(r1) ffc09bf0: 83 a1 00 0c lwz r29,12(r1) ffc09bf4: 7c 08 03 a6 mtlr r0 ffc09bf8: 83 c1 00 10 lwz r30,16(r1) ffc09bfc: 83 e1 00 14 lwz r31,20(r1) ffc09c00: 38 21 00 18 addi r1,r1,24 ffc09c04: 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); ffc09c08: 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); ffc09c0c: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09c10: 3b ff 2c 50 addi r31,r31,11344 <== NOT EXECUTED result = pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) pthread_attr_destroy (&aio_request_queue.attr); ffc09c14: 48 00 15 05 bl ffc0b118 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09c18: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc09c1c: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc09c20: 48 00 11 61 bl ffc0ad80 <== NOT EXECUTED if (result != 0) ffc09c24: 2f 83 00 00 cmpwi cr7,r3,0 <== NOT EXECUTED ffc09c28: 41 9e ff 6c beq+ cr7,ffc09b94 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); ffc09c2c: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc09c30: 48 00 14 e9 bl ffc0b118 <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); ffc09c34: 3c 60 00 00 lis r3,0 <== NOT EXECUTED ffc09c38: 38 63 2c 54 addi r3,r3,11348 <== NOT EXECUTED ffc09c3c: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc09c40: 48 00 0b a1 bl ffc0a7e0 <== NOT EXECUTED if (result != 0) { ffc09c44: 7c 7d 1b 79 mr. r29,r3 <== NOT EXECUTED ffc09c48: 41 82 ff 64 beq+ ffc09bac <== NOT EXECUTED pthread_mutex_destroy (&aio_request_queue.mutex); ffc09c4c: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc09c50: 48 00 0f 6d bl ffc0abbc <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); ffc09c54: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc09c58: 48 00 14 c1 bl ffc0b118 <== NOT EXECUTED ffc09c5c: 4b ff ff 50 b ffc09bac <== NOT EXECUTED =============================================================================== ffc0a0d8 : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { ffc0a0d8: 94 21 ff f8 stwu r1,-8(r1) ffc0a0dc: 7c 08 02 a6 mflr r0 ffc0a0e0: 7c 8b 23 78 mr r11,r4 ffc0a0e4: 90 01 00 0c stw r0,12(r1) ffc0a0e8: 38 03 00 04 addi r0,r3,4 } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a0ec: 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)) { ffc0a0f0: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a0f4: 41 9e 00 4c beq- cr7,ffc0a140 <== 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 && ffc0a0f8: 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; ffc0a0fc: 81 49 00 14 lwz r10,20(r9) while (req->aiocbp->aio_reqprio > prio && ffc0a100: 80 e8 00 18 lwz r7,24(r8) ffc0a104: 81 0a 00 18 lwz r8,24(r10) ffc0a108: 7d 2a 4b 78 mr r10,r9 ffc0a10c: 7f 88 38 00 cmpw cr7,r8,r7 ffc0a110: 41 bc 00 0c blt+ cr7,ffc0a11c <== NEVER TAKEN ffc0a114: 48 00 00 24 b ffc0a138 ffc0a118: 41 9a 00 3c beq- cr6,ffc0a154 } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a11c: 81 49 00 00 lwz r10,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; ffc0a120: 81 2a 00 14 lwz r9,20(r10) <== NOT EXECUTED rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && ffc0a124: 7f 0a 00 00 cmpw cr6,r10,r0 <== NOT EXECUTED ffc0a128: 81 09 00 18 lwz r8,24(r9) <== NOT EXECUTED ffc0a12c: 7d 49 53 78 mr r9,r10 <== NOT EXECUTED ffc0a130: 7f 88 38 00 cmpw cr7,r8,r7 <== NOT EXECUTED ffc0a134: 41 9c ff e4 blt+ cr7,ffc0a118 <== 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 ); ffc0a138: 80 6a 00 04 lwz r3,4(r10) ffc0a13c: 7d 64 5b 78 mr r4,r11 ffc0a140: 48 00 31 b5 bl ffc0d2f4 <_Chain_Insert> } rtems_chain_insert (node->previous, &req->next_prio); } } ffc0a144: 80 01 00 0c lwz r0,12(r1) ffc0a148: 38 21 00 08 addi r1,r1,8 ffc0a14c: 7c 08 03 a6 mtlr r0 ffc0a150: 4e 80 00 20 blr } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a154: 7c 0a 03 78 mr r10,r0 <== NOT EXECUTED ffc0a158: 4b ff ff e0 b ffc0a138 <== NOT EXECUTED =============================================================================== ffc09d70 : * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { ffc09d70: 94 21 ff f8 stwu r1,-8(r1) ffc09d74: 7c 08 02 a6 mflr r0 } } AIO_printf ("Thread finished\n"); return NULL; } ffc09d78: 3d 60 00 00 lis r11,0 * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { ffc09d7c: 90 01 00 0c stw r0,12(r1) } } AIO_printf ("Thread finished\n"); return NULL; } ffc09d80: 39 6b 2c 50 addi r11,r11,11344 * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { ffc09d84: 7c 64 1b 78 mr r4,r3 } } AIO_printf ("Thread finished\n"); return NULL; } ffc09d88: 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 && ffc09d8c: 81 03 00 14 lwz r8,20(r3) ffc09d90: 80 09 00 14 lwz r0,20(r9) ffc09d94: 7d 2a 4b 78 mr r10,r9 ffc09d98: 7f 80 40 00 cmpw cr7,r0,r8 ffc09d9c: 40 9c 00 30 bge- cr7,ffc09dcc <== NEVER TAKEN ffc09da0: 39 6b 00 4c addi r11,r11,76 ffc09da4: 7f 89 58 00 cmpw cr7,r9,r11 ffc09da8: 40 be 00 0c bne+ cr7,ffc09db4 <== ALWAYS TAKEN ffc09dac: 48 00 00 20 b ffc09dcc ffc09db0: 41 9a 00 34 beq- cr6,ffc09de4 <== NEVER TAKEN } } AIO_printf ("Thread finished\n"); return NULL; } ffc09db4: 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 && ffc09db8: 80 0a 00 14 lwz r0,20(r10) ffc09dbc: 7f 0a 58 00 cmpw cr6,r10,r11 ffc09dc0: 7d 49 53 78 mr r9,r10 ffc09dc4: 7f 80 40 00 cmpw cr7,r0,r8 ffc09dc8: 41 9c ff e8 blt+ cr7,ffc09db0 ffc09dcc: 80 6a 00 04 lwz r3,4(r10) ffc09dd0: 48 00 35 25 bl ffc0d2f4 <_Chain_Insert> node = rtems_chain_next (node); temp = (rtems_aio_request_chain *) node; } rtems_chain_insert (rtems_chain_previous (node), &r_chain->next_fd); } ffc09dd4: 80 01 00 0c lwz r0,12(r1) ffc09dd8: 38 21 00 08 addi r1,r1,8 ffc09ddc: 7c 08 03 a6 mtlr r0 ffc09de0: 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 && ffc09de4: 7d 6a 5b 78 mr r10,r11 <== NOT EXECUTED ffc09de8: 80 6a 00 04 lwz r3,4(r10) <== NOT EXECUTED ffc09dec: 48 00 35 09 bl ffc0d2f4 <_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); } ffc09df0: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc09df4: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc09df8: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc09dfc: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc0a15c : * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { ffc0a15c: 94 21 ff e0 stwu r1,-32(r1) ffc0a160: 7c 08 02 a6 mflr r0 ffc0a164: 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)); ffc0a168: 3b a3 00 0c addi r29,r3,12 ffc0a16c: 90 01 00 24 stw r0,36(r1) ffc0a170: 93 61 00 0c stw r27,12(r1) ffc0a174: 93 81 00 10 stw r28,16(r1) ffc0a178: 93 c1 00 18 stw r30,24(r1) ffc0a17c: 93 e1 00 1c stw r31,28(r1) } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a180: 83 e3 00 08 lwz r31,8(r3) rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) ffc0a184: 7f 9f e8 00 cmpw cr7,r31,r29 ffc0a188: 41 9e 00 38 beq- cr7,ffc0a1c0 <== NEVER TAKEN { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; ffc0a18c: 3b 60 00 8c li r27,140 req->aiocbp->return_value = -1; ffc0a190: 3b 80 ff ff li r28,-1 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc0a194: 7f e3 fb 78 mr r3,r31 ffc0a198: 48 00 30 f1 bl ffc0d288 <_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; ffc0a19c: 81 3f 00 14 lwz r9,20(r31) } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a1a0: 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); ffc0a1a4: 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; ffc0a1a8: 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); ffc0a1ac: 7f df f3 78 mr r31,r30 req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; ffc0a1b0: 93 89 00 38 stw r28,56(r9) free (req); ffc0a1b4: 4b ff b7 9d bl ffc05950 rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) ffc0a1b8: 7f 9e e8 00 cmpw cr7,r30,r29 ffc0a1bc: 40 9e ff d8 bne+ cr7,ffc0a194 node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; free (req); } } ffc0a1c0: 80 01 00 24 lwz r0,36(r1) ffc0a1c4: 83 61 00 0c lwz r27,12(r1) ffc0a1c8: 7c 08 03 a6 mtlr r0 ffc0a1cc: 83 81 00 10 lwz r28,16(r1) ffc0a1d0: 83 a1 00 14 lwz r29,20(r1) ffc0a1d4: 83 c1 00 18 lwz r30,24(r1) ffc0a1d8: 83 e1 00 1c lwz r31,28(r1) ffc0a1dc: 38 21 00 20 addi r1,r1,32 ffc0a1e0: 4e 80 00 20 blr =============================================================================== ffc0a1e4 : * 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) { ffc0a1e4: 94 21 ff f0 stwu r1,-16(r1) ffc0a1e8: 7c 08 02 a6 mflr r0 ffc0a1ec: 93 e1 00 0c stw r31,12(r1) ffc0a1f0: 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 ); ffc0a1f4: 38 03 00 04 addi r0,r3,4 } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a1f8: 81 23 00 00 lwz r9,0(r3) */ int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp) { if (rtems_chain_is_empty (chain)) return AIO_ALLDONE; ffc0a1fc: 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)) ffc0a200: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a204: 41 9e 00 3c beq- cr7,ffc0a240 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) { ffc0a208: 81 69 00 14 lwz r11,20(r9) return AIO_ALLDONE; rtems_chain_node *node = rtems_chain_first (chain); rtems_aio_request *current; current = (rtems_aio_request *) node; ffc0a20c: 7d 3f 4b 78 mr r31,r9 while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) { ffc0a210: 7f 8b 20 00 cmpw cr7,r11,r4 ffc0a214: 40 be 00 14 bne+ cr7,ffc0a228 <== NEVER TAKEN ffc0a218: 48 00 00 3c b ffc0a254 ffc0a21c: 81 6b 00 14 lwz r11,20(r11) <== NOT EXECUTED ffc0a220: 7f 8b 20 00 cmpw cr7,r11,r4 <== NOT EXECUTED ffc0a224: 41 9e 00 30 beq- cr7,ffc0a254 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a228: 81 69 00 00 lwz r11,0(r9) <== 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) { ffc0a22c: 7f 8b 00 00 cmpw cr7,r11,r0 <== NOT EXECUTED node = rtems_chain_next (node); current = (rtems_aio_request *) node; ffc0a230: 7d 7f 5b 78 mr r31,r11 <== 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) { ffc0a234: 7d 69 5b 78 mr r9,r11 <== NOT EXECUTED ffc0a238: 40 9e ff e4 bne+ cr7,ffc0a21c <== NOT EXECUTED node = rtems_chain_next (node); current = (rtems_aio_request *) node; } if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; ffc0a23c: 38 60 00 01 li r3,1 <== NOT EXECUTED current->aiocbp->return_value = -1; free (current); } return AIO_CANCELED; } ffc0a240: 80 01 00 14 lwz r0,20(r1) ffc0a244: 83 e1 00 0c lwz r31,12(r1) ffc0a248: 38 21 00 10 addi r1,r1,16 ffc0a24c: 7c 08 03 a6 mtlr r0 ffc0a250: 4e 80 00 20 blr 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) { ffc0a254: 7f e3 fb 78 mr r3,r31 ffc0a258: 48 00 30 31 bl ffc0d288 <_Chain_Extract> if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; ffc0a25c: 81 3f 00 14 lwz r9,20(r31) ffc0a260: 38 00 00 8c li r0,140 ffc0a264: 90 09 00 34 stw r0,52(r9) current->aiocbp->return_value = -1; ffc0a268: 38 00 ff ff li r0,-1 free (current); ffc0a26c: 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; ffc0a270: 90 09 00 38 stw r0,56(r9) free (current); ffc0a274: 4b ff b6 dd bl ffc05950 } return AIO_CANCELED; } ffc0a278: 80 01 00 14 lwz r0,20(r1) current->aiocbp->error_code = ECANCELED; current->aiocbp->return_value = -1; free (current); } return AIO_CANCELED; ffc0a27c: 38 60 00 00 li r3,0 } ffc0a280: 83 e1 00 0c lwz r31,12(r1) ffc0a284: 7c 08 03 a6 mtlr r0 ffc0a288: 38 21 00 10 addi r1,r1,16 ffc0a28c: 4e 80 00 20 blr =============================================================================== ffc13990 : rtems_name name, rtems_attribute attribute_set, uint32_t maximum_waiters, rtems_id *id ) { ffc13990: 94 21 ff d0 stwu r1,-48(r1) ffc13994: 7c 08 02 a6 mflr r0 ffc13998: 93 e1 00 2c stw r31,44(r1) Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) ffc1399c: 7c 7f 1b 79 mr. r31,r3 return RTEMS_INVALID_NAME; ffc139a0: 38 60 00 03 li r3,3 rtems_name name, rtems_attribute attribute_set, uint32_t maximum_waiters, rtems_id *id ) { ffc139a4: 93 a1 00 24 stw r29,36(r1) ffc139a8: 7c dd 33 78 mr r29,r6 ffc139ac: 90 01 00 34 stw r0,52(r1) ffc139b0: 93 81 00 20 stw r28,32(r1) ffc139b4: 93 c1 00 28 stw r30,40(r1) Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) ffc139b8: 41 82 00 90 beq- ffc13a48 return RTEMS_INVALID_NAME; if ( !id ) ffc139bc: 2f 86 00 00 cmpwi cr7,r6,0 return RTEMS_INVALID_ADDRESS; ffc139c0: 38 60 00 09 li r3,9 CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !id ) ffc139c4: 41 9e 00 84 beq- cr7,ffc13a48 return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { ffc139c8: 70 80 00 10 andi. r0,r4,16 ffc139cc: 41 82 00 9c beq- ffc13a68 the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) ffc139d0: 2f 85 00 00 cmpwi cr7,r5,0 if ( !id ) return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; ffc139d4: 38 00 00 00 li r0,0 ffc139d8: 90 01 00 08 stw r0,8(r1) if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; ffc139dc: 38 60 00 0a li r3,10 return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) ffc139e0: 41 9e 00 68 beq- cr7,ffc13a48 ffc139e4: 3d 20 00 00 lis r9,0 return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; the_attributes.maximum_count = maximum_waiters; ffc139e8: 90 a1 00 0c stw r5,12(r1) ffc139ec: 81 69 27 c8 lwz r11,10184(r9) ffc139f0: 38 0b 00 01 addi r0,r11,1 ffc139f4: 90 09 27 c8 stw r0,10184(r9) * This function allocates a barrier control block from * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE Barrier_Control *_Barrier_Allocate( void ) { return (Barrier_Control *) _Objects_Allocate( &_Barrier_Information ); ffc139f8: 3f 80 00 00 lis r28,0 ffc139fc: 90 81 00 18 stw r4,24(r1) ffc13a00: 3b 9c 35 1c addi r28,r28,13596 ffc13a04: 7f 83 e3 78 mr r3,r28 ffc13a08: 4b ff 98 15 bl ffc0d21c <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { ffc13a0c: 80 81 00 18 lwz r4,24(r1) ffc13a10: 7c 7e 1b 79 mr. r30,r3 ffc13a14: 41 82 00 90 beq- ffc13aa4 <== NEVER TAKEN _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } the_barrier->attribute_set = attribute_set; ffc13a18: 90 9e 00 10 stw r4,16(r30) _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); ffc13a1c: 38 7e 00 14 addi r3,r30,20 ffc13a20: 38 81 00 08 addi r4,r1,8 ffc13a24: 48 00 0a d1 bl ffc144f4 <_CORE_barrier_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc13a28: 80 1e 00 08 lwz r0,8(r30) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc13a2c: 81 7c 00 1c lwz r11,28(r28) ffc13a30: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc13a34: 7f cb 49 2e stwx r30,r11,r9 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc13a38: 93 fe 00 0c stw r31,12(r30) &_Barrier_Information, &the_barrier->Object, (Objects_Name) name ); *id = the_barrier->Object.id; ffc13a3c: 90 1d 00 00 stw r0,0(r29) _Thread_Enable_dispatch(); ffc13a40: 4b ff ad 69 bl ffc0e7a8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc13a44: 38 60 00 00 li r3,0 } ffc13a48: 80 01 00 34 lwz r0,52(r1) ffc13a4c: 83 81 00 20 lwz r28,32(r1) ffc13a50: 7c 08 03 a6 mtlr r0 ffc13a54: 83 a1 00 24 lwz r29,36(r1) ffc13a58: 83 c1 00 28 lwz r30,40(r1) ffc13a5c: 83 e1 00 2c lwz r31,44(r1) ffc13a60: 38 21 00 30 addi r1,r1,48 ffc13a64: 4e 80 00 20 blr ffc13a68: 3d 20 00 00 lis r9,0 the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; the_attributes.maximum_count = maximum_waiters; ffc13a6c: 90 a1 00 0c stw r5,12(r1) if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; ffc13a70: 38 00 00 01 li r0,1 ffc13a74: 81 69 27 c8 lwz r11,10184(r9) ffc13a78: 90 01 00 08 stw r0,8(r1) ffc13a7c: 38 0b 00 01 addi r0,r11,1 ffc13a80: 90 09 27 c8 stw r0,10184(r9) ffc13a84: 3f 80 00 00 lis r28,0 ffc13a88: 90 81 00 18 stw r4,24(r1) ffc13a8c: 3b 9c 35 1c addi r28,r28,13596 ffc13a90: 7f 83 e3 78 mr r3,r28 ffc13a94: 4b ff 97 89 bl ffc0d21c <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { ffc13a98: 80 81 00 18 lwz r4,24(r1) ffc13a9c: 7c 7e 1b 79 mr. r30,r3 ffc13aa0: 40 82 ff 78 bne+ ffc13a18 _Thread_Enable_dispatch(); ffc13aa4: 4b ff ad 05 bl ffc0e7a8 <_Thread_Enable_dispatch> *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } ffc13aa8: 80 01 00 34 lwz r0,52(r1) the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; ffc13aac: 38 60 00 05 li r3,5 *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } ffc13ab0: 83 81 00 20 lwz r28,32(r1) ffc13ab4: 7c 08 03 a6 mtlr r0 ffc13ab8: 83 a1 00 24 lwz r29,36(r1) ffc13abc: 83 c1 00 28 lwz r30,40(r1) ffc13ac0: 83 e1 00 2c lwz r31,44(r1) ffc13ac4: 38 21 00 30 addi r1,r1,48 ffc13ac8: 4e 80 00 20 blr =============================================================================== ffc09d34 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { ffc09d34: 94 21 ff f0 stwu r1,-16(r1) ffc09d38: 7c 08 02 a6 mflr r0 ffc09d3c: 93 c1 00 08 stw r30,8(r1) ffc09d40: 7c de 33 78 mr r30,r6 ffc09d44: 93 e1 00 0c stw r31,12(r1) ffc09d48: 7c bf 2b 78 mr r31,r5 ffc09d4c: 90 01 00 14 stw r0,20(r1) RTEMS_INLINE_ROUTINE bool rtems_chain_append_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Append_with_empty_check( chain, node ); ffc09d50: 48 00 07 b9 bl ffc0a508 <_Chain_Append_with_empty_check> rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { ffc09d54: 2f 83 00 00 cmpwi cr7,r3,0 rtems_chain_node *node, rtems_id task, rtems_event_set events ) { rtems_status_code sc = RTEMS_SUCCESSFUL; ffc09d58: 38 60 00 00 li r3,0 bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { ffc09d5c: 41 be 00 10 beq+ cr7,ffc09d6c <== NEVER TAKEN sc = rtems_event_send( task, events ); ffc09d60: 7f e3 fb 78 mr r3,r31 ffc09d64: 7f c4 f3 78 mr r4,r30 ffc09d68: 4b ff f2 01 bl ffc08f68 } return sc; } ffc09d6c: 80 01 00 14 lwz r0,20(r1) ffc09d70: 83 c1 00 08 lwz r30,8(r1) ffc09d74: 7c 08 03 a6 mtlr r0 ffc09d78: 83 e1 00 0c lwz r31,12(r1) ffc09d7c: 38 21 00 10 addi r1,r1,16 ffc09d80: 4e 80 00 20 blr =============================================================================== ffc09dd8 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { ffc09dd8: 94 21 ff d0 stwu r1,-48(r1) ffc09ddc: 7c 08 02 a6 mflr r0 ffc09de0: 93 e1 00 2c stw r31,44(r1) ffc09de4: 90 01 00 34 stw r0,52(r1) ffc09de8: 93 41 00 18 stw r26,24(r1) ffc09dec: 7c da 33 78 mr r26,r6 ffc09df0: 93 61 00 1c stw r27,28(r1) ffc09df4: 7c 7b 1b 78 mr r27,r3 ffc09df8: 93 81 00 20 stw r28,32(r1) ffc09dfc: 7c 9c 23 78 mr r28,r4 ffc09e00: 93 a1 00 24 stw r29,36(r1) ffc09e04: 7c bd 2b 78 mr r29,r5 ffc09e08: 93 c1 00 28 stw r30,40(r1) while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ) { rtems_event_set out; sc = rtems_event_receive( ffc09e0c: 3b c1 00 08 addi r30,r1,8 */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); ffc09e10: 7f 63 db 78 mr r3,r27 ffc09e14: 48 00 07 ed bl ffc0a600 <_Chain_Get> ffc09e18: 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 ffc09e1c: 7c 7f 1b 79 mr. r31,r3 ) { rtems_event_set out; sc = rtems_event_receive( ffc09e20: 7f a5 eb 78 mr r5,r29 ffc09e24: 7f c6 f3 78 mr r6,r30 ffc09e28: 7f 83 e3 78 mr r3,r28 rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ffc09e2c: 40 82 00 3c bne- ffc09e68 ) { rtems_event_set out; sc = rtems_event_receive( ffc09e30: 4b ff ef 35 bl ffc08d64 ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( ffc09e34: 2c 03 00 00 cmpwi r3,0 ffc09e38: 41 82 ff d8 beq+ ffc09e10 <== NEVER TAKEN } *node_ptr = node; return sc; } ffc09e3c: 80 01 00 34 lwz r0,52(r1) timeout, &out ); } *node_ptr = node; ffc09e40: 93 fa 00 00 stw r31,0(r26) return sc; } ffc09e44: 7c 08 03 a6 mtlr r0 ffc09e48: 83 41 00 18 lwz r26,24(r1) ffc09e4c: 83 61 00 1c lwz r27,28(r1) ffc09e50: 83 81 00 20 lwz r28,32(r1) ffc09e54: 83 a1 00 24 lwz r29,36(r1) ffc09e58: 83 c1 00 28 lwz r30,40(r1) ffc09e5c: 83 e1 00 2c lwz r31,44(r1) ffc09e60: 38 21 00 30 addi r1,r1,48 ffc09e64: 4e 80 00 20 blr ffc09e68: 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 ffc09e6c: 38 60 00 00 li r3,0 timeout, &out ); } *node_ptr = node; ffc09e70: 93 fa 00 00 stw r31,0(r26) return sc; } ffc09e74: 7c 08 03 a6 mtlr r0 ffc09e78: 83 41 00 18 lwz r26,24(r1) ffc09e7c: 83 61 00 1c lwz r27,28(r1) ffc09e80: 83 81 00 20 lwz r28,32(r1) ffc09e84: 83 a1 00 24 lwz r29,36(r1) ffc09e88: 83 c1 00 28 lwz r30,40(r1) ffc09e8c: 83 e1 00 2c lwz r31,44(r1) ffc09e90: 38 21 00 30 addi r1,r1,48 ffc09e94: 4e 80 00 20 blr =============================================================================== ffc09e98 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { ffc09e98: 94 21 ff f0 stwu r1,-16(r1) ffc09e9c: 7c 08 02 a6 mflr r0 ffc09ea0: 93 c1 00 08 stw r30,8(r1) ffc09ea4: 7c de 33 78 mr r30,r6 ffc09ea8: 93 e1 00 0c stw r31,12(r1) ffc09eac: 7c bf 2b 78 mr r31,r5 ffc09eb0: 90 01 00 14 stw r0,20(r1) RTEMS_INLINE_ROUTINE bool rtems_chain_prepend_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Prepend_with_empty_check( chain, node ); ffc09eb4: 48 00 07 bd bl ffc0a670 <_Chain_Prepend_with_empty_check> rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { ffc09eb8: 2f 83 00 00 cmpwi cr7,r3,0 rtems_chain_node *node, rtems_id task, rtems_event_set events ) { rtems_status_code sc = RTEMS_SUCCESSFUL; ffc09ebc: 38 60 00 00 li r3,0 bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { ffc09ec0: 41 be 00 10 beq+ cr7,ffc09ed0 <== NEVER TAKEN sc = rtems_event_send( task, events ); ffc09ec4: 7f e3 fb 78 mr r3,r31 ffc09ec8: 7f c4 f3 78 mr r4,r30 ffc09ecc: 4b ff f0 9d bl ffc08f68 } return sc; } ffc09ed0: 80 01 00 14 lwz r0,20(r1) ffc09ed4: 83 c1 00 08 lwz r30,8(r1) ffc09ed8: 7c 08 03 a6 mtlr r0 ffc09edc: 83 e1 00 0c lwz r31,12(r1) ffc09ee0: 38 21 00 10 addi r1,r1,16 ffc09ee4: 4e 80 00 20 blr =============================================================================== ffc0ac9c : 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 ) { ffc0ac9c: 94 21 ff f0 stwu r1,-16(r1) ffc0aca0: 7c 08 02 a6 mflr r0 rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0aca4: 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 ) { ffc0aca8: 90 01 00 14 stw r0,20(r1) rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0acac: 80 09 31 cc lwz r0,12748(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; ffc0acb0: 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 ) { ffc0acb4: 93 e1 00 0c stw r31,12(r1) ffc0acb8: 7c 7f 1b 78 mr r31,r3 rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0acbc: 2f 80 00 00 cmpwi cr7,r0,0 return RTEMS_CALLED_FROM_ISR; ffc0acc0: 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; ffc0acc4: 80 09 28 18 lwz r0,10264(r9) if ( rtems_interrupt_is_in_progress() ) ffc0acc8: 40 9e 00 ec bne- cr7,ffc0adb4 return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) ffc0accc: 2f 85 00 00 cmpwi cr7,r5,0 return RTEMS_INVALID_ADDRESS; ffc0acd0: 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 ) ffc0acd4: 41 9e 00 e0 beq- cr7,ffc0adb4 return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; if ( driver_table == NULL ) ffc0acd8: 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; ffc0acdc: 90 05 00 00 stw r0,0(r5) if ( driver_table == NULL ) ffc0ace0: 41 9e 00 d4 beq- cr7,ffc0adb4 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ace4: 81 64 00 00 lwz r11,0(r4) ffc0ace8: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0acec: 41 9e 01 14 beq- cr7,ffc0ae00 return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) ffc0acf0: 7f 80 f8 40 cmplw cr7,r0,r31 return RTEMS_INVALID_NUMBER; ffc0acf4: 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 ) ffc0acf8: 40 9d 00 bc ble- cr7,ffc0adb4 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0acfc: 3d 60 00 00 lis r11,0 ffc0ad00: 81 4b 27 c4 lwz r10,10180(r11) ffc0ad04: 38 0a 00 01 addi r0,r10,1 ffc0ad08: 90 0b 27 c4 stw r0,10180(r11) return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { ffc0ad0c: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0ad10: 40 9e 00 b8 bne- cr7,ffc0adc8 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; ffc0ad14: 81 49 28 18 lwz r10,10264(r9) rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { ffc0ad18: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0ad1c: 41 9e 00 f4 beq- cr7,ffc0ae10 <== NEVER TAKEN ffc0ad20: 3d 60 00 00 lis r11,0 ffc0ad24: 7d 49 03 a6 mtctr r10 ffc0ad28: 81 2b 28 1c lwz r9,10268(r11) ffc0ad2c: 40 be 00 14 bne+ cr7,ffc0ad40 <== ALWAYS TAKEN ffc0ad30: 48 00 01 04 b ffc0ae34 <== NOT EXECUTED ffc0ad34: 3b ff 00 01 addi r31,r31,1 ffc0ad38: 39 29 00 18 addi r9,r9,24 ffc0ad3c: 42 40 00 1c bdz- ffc0ad58 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ad40: 80 09 00 00 lwz r0,0(r9) ffc0ad44: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ad48: 40 9e ff ec bne+ cr7,ffc0ad34 ffc0ad4c: 80 09 00 04 lwz r0,4(r9) ffc0ad50: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ad54: 40 9e ff e0 bne+ cr7,ffc0ad34 } /* Assigns invalid value in case of failure */ *major = m; if ( m != n ) ffc0ad58: 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; ffc0ad5c: 93 e5 00 00 stw r31,0(r5) if ( m != n ) ffc0ad60: 1c 1f 00 18 mulli r0,r31,24 ffc0ad64: 41 9e 00 b0 beq- cr7,ffc0ae14 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; ffc0ad68: 81 6b 28 1c lwz r11,10268(r11) ffc0ad6c: 80 c4 00 00 lwz r6,0(r4) ffc0ad70: 80 e4 00 04 lwz r7,4(r4) ffc0ad74: 7d 2b 02 14 add r9,r11,r0 ffc0ad78: 81 04 00 08 lwz r8,8(r4) ffc0ad7c: 81 44 00 0c lwz r10,12(r4) ffc0ad80: 7c cb 01 2e stwx r6,r11,r0 ffc0ad84: 90 e9 00 04 stw r7,4(r9) ffc0ad88: 91 09 00 08 stw r8,8(r9) ffc0ad8c: 91 49 00 0c stw r10,12(r9) ffc0ad90: 81 64 00 10 lwz r11,16(r4) ffc0ad94: 80 04 00 14 lwz r0,20(r4) ffc0ad98: 91 69 00 10 stw r11,16(r9) ffc0ad9c: 90 09 00 14 stw r0,20(r9) _Thread_Enable_dispatch(); ffc0ada0: 48 00 25 cd bl ffc0d36c <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); ffc0ada4: 7f e3 fb 78 mr r3,r31 ffc0ada8: 38 80 00 00 li r4,0 ffc0adac: 38 a0 00 00 li r5,0 ffc0adb0: 48 00 a6 69 bl ffc15418 } ffc0adb4: 80 01 00 14 lwz r0,20(r1) ffc0adb8: 83 e1 00 0c lwz r31,12(r1) ffc0adbc: 38 21 00 10 addi r1,r1,16 ffc0adc0: 7c 08 03 a6 mtlr r0 ffc0adc4: 4e 80 00 20 blr _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; ffc0adc8: 3d 60 00 00 lis r11,0 ffc0adcc: 1c 1f 00 18 mulli r0,r31,24 ffc0add0: 81 2b 28 1c lwz r9,10268(r11) static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0add4: 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; ffc0add8: 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; ffc0addc: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0ade0: 41 9e 00 40 beq- cr7,ffc0ae20 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(); ffc0ade4: 48 00 25 89 bl ffc0d36c <_Thread_Enable_dispatch> _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } ffc0ade8: 80 01 00 14 lwz r0,20(r1) } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; ffc0adec: 38 60 00 0c li r3,12 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } ffc0adf0: 83 e1 00 0c lwz r31,12(r1) ffc0adf4: 7c 08 03 a6 mtlr r0 ffc0adf8: 38 21 00 10 addi r1,r1,16 ffc0adfc: 4e 80 00 20 blr static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ae00: 81 64 00 04 lwz r11,4(r4) ffc0ae04: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0ae08: 40 9e fe e8 bne+ cr7,ffc0acf0 ffc0ae0c: 4b ff ff a8 b ffc0adb4 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; ffc0ae10: 93 e5 00 00 stw r31,0(r5) <== NOT EXECUTED if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); ffc0ae14: 48 00 25 59 bl ffc0d36c <_Thread_Enable_dispatch> *major = m; if ( m != n ) return RTEMS_SUCCESSFUL; return RTEMS_TOO_MANY; ffc0ae18: 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; ffc0ae1c: 4b ff ff 98 b ffc0adb4 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ae20: 81 29 00 04 lwz r9,4(r9) ffc0ae24: 2f 89 00 00 cmpwi cr7,r9,0 ffc0ae28: 40 9e ff bc bne+ cr7,ffc0ade4 if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; ffc0ae2c: 93 e5 00 00 stw r31,0(r5) ffc0ae30: 4b ff ff 38 b ffc0ad68 ffc0ae34: 38 00 00 01 li r0,1 <== NOT EXECUTED ffc0ae38: 7c 09 03 a6 mtctr r0 <== NOT EXECUTED ffc0ae3c: 4b ff ff 04 b ffc0ad40 <== NOT EXECUTED =============================================================================== ffc0c810 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { ffc0c810: 94 21 ff e0 stwu r1,-32(r1) ffc0c814: 7c 08 02 a6 mflr r0 ffc0c818: 90 01 00 24 stw r0,36(r1) uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) ffc0c81c: 7c 60 1b 79 mr. r0,r3 #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { ffc0c820: 93 81 00 10 stw r28,16(r1) ffc0c824: 93 a1 00 14 stw r29,20(r1) ffc0c828: 93 c1 00 18 stw r30,24(r1) ffc0c82c: 93 e1 00 1c stw r31,28(r1) uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) ffc0c830: 90 01 00 08 stw r0,8(r1) ffc0c834: 41 82 00 6c beq- ffc0c8a0 <== NEVER TAKEN ffc0c838: 3f a0 00 01 lis r29,1 ffc0c83c: 3b bd aa 40 addi r29,r29,-21952 #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) ffc0c840: 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 ]; ffc0c844: 85 3d 00 04 lwzu r9,4(r29) ffc0c848: 83 c9 00 04 lwz r30,4(r9) if ( !information ) ffc0c84c: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0c850: 41 9e 00 48 beq- cr7,ffc0c898 continue; for ( i=1 ; i <= information->maximum ; i++ ) { ffc0c854: a0 1e 00 10 lhz r0,16(r30) ffc0c858: 70 09 ff ff andi. r9,r0,65535 ffc0c85c: 41 82 00 3c beq- ffc0c898 ffc0c860: 3b e0 00 01 li r31,1 the_thread = (Thread_Control *)information->local_table[ i ]; ffc0c864: 81 7e 00 1c lwz r11,28(r30) ffc0c868: 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++ ) { ffc0c86c: 3b ff 00 01 addi r31,r31,1 the_thread = (Thread_Control *)information->local_table[ i ]; ffc0c870: 7c 6b 48 2e lwzx r3,r11,r9 if ( !the_thread ) ffc0c874: 2f 83 00 00 cmpwi cr7,r3,0 ffc0c878: 41 9e 00 14 beq- cr7,ffc0c88c continue; (*routine)(the_thread); ffc0c87c: 80 01 00 08 lwz r0,8(r1) ffc0c880: 7c 09 03 a6 mtctr r0 ffc0c884: 4e 80 04 21 bctrl ffc0c888: 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++ ) { ffc0c88c: 54 09 04 3e clrlwi r9,r0,16 ffc0c890: 7f 89 f8 40 cmplw cr7,r9,r31 ffc0c894: 40 9c ff d0 bge+ cr7,ffc0c864 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { ffc0c898: 7f 9d e0 00 cmpw cr7,r29,r28 ffc0c89c: 40 9e ff a8 bne+ cr7,ffc0c844 (*routine)(the_thread); } } } ffc0c8a0: 80 01 00 24 lwz r0,36(r1) ffc0c8a4: 83 81 00 10 lwz r28,16(r1) ffc0c8a8: 7c 08 03 a6 mtlr r0 ffc0c8ac: 83 a1 00 14 lwz r29,20(r1) ffc0c8b0: 83 c1 00 18 lwz r30,24(r1) ffc0c8b4: 83 e1 00 1c lwz r31,28(r1) ffc0c8b8: 38 21 00 20 addi r1,r1,32 ffc0c8bc: 4e 80 00 20 blr =============================================================================== ffc0ada0 : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { ffc0ada0: 94 21 ff f0 stwu r1,-16(r1) ffc0ada4: 7c 08 02 a6 mflr r0 ffc0ada8: 93 e1 00 0c stw r31,12(r1) int i; /* * Validate parameters and look up information structure. */ if ( !info ) ffc0adac: 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 ) { ffc0adb0: 90 01 00 14 stw r0,20(r1) /* * Validate parameters and look up information structure. */ if ( !info ) return RTEMS_INVALID_ADDRESS; ffc0adb4: 38 00 00 09 li r0,9 int i; /* * Validate parameters and look up information structure. */ if ( !info ) ffc0adb8: 41 82 00 7c beq- ffc0ae34 return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); ffc0adbc: 54 84 04 3e clrlwi r4,r4,16 ffc0adc0: 48 00 25 45 bl ffc0d304 <_Objects_Get_information> if ( !obj_info ) return RTEMS_INVALID_NUMBER; ffc0adc4: 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 ) ffc0adc8: 2c 03 00 00 cmpwi r3,0 ffc0adcc: 41 82 00 68 beq- ffc0ae34 * 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; ffc0add0: 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; ffc0add4: 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++ ) ffc0add8: 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; ffc0addc: 81 63 00 0c lwz r11,12(r3) info->auto_extend = obj_info->auto_extend; ffc0ade0: 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; ffc0ade4: 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++ ) ffc0ade8: 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; ffc0adec: 91 7f 00 04 stw r11,4(r31) info->auto_extend = obj_info->auto_extend; ffc0adf0: 99 3f 00 0c stb r9,12(r31) info->maximum = obj_info->maximum; ffc0adf4: 91 1f 00 08 stw r8,8(r31) for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) ffc0adf8: 41 9e 00 34 beq- cr7,ffc0ae2c <== NEVER TAKEN ffc0adfc: 80 e3 00 1c lwz r7,28(r3) ffc0ae00: 39 60 00 01 li r11,1 ffc0ae04: 39 20 00 01 li r9,1 ffc0ae08: 39 29 00 01 addi r9,r9,1 ffc0ae0c: 7f 88 48 40 cmplw cr7,r8,r9 if ( !obj_info->local_table[i] ) ffc0ae10: 55 6b 10 3a rlwinm r11,r11,2,0,29 ffc0ae14: 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++ ) ffc0ae18: 7d 2b 4b 78 mr r11,r9 if ( !obj_info->local_table[i] ) unallocated++; ffc0ae1c: 20 ca 00 00 subfic r6,r10,0 ffc0ae20: 7c c0 01 94 addze r6,r0 ffc0ae24: 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++ ) ffc0ae28: 40 9c ff e0 bge+ cr7,ffc0ae08 if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; ffc0ae2c: 90 1f 00 10 stw r0,16(r31) return RTEMS_SUCCESSFUL; ffc0ae30: 38 00 00 00 li r0,0 } ffc0ae34: 7c 03 03 78 mr r3,r0 ffc0ae38: 80 01 00 14 lwz r0,20(r1) ffc0ae3c: 83 e1 00 0c lwz r31,12(r1) ffc0ae40: 38 21 00 10 addi r1,r1,16 ffc0ae44: 7c 08 03 a6 mtlr r0 ffc0ae48: 4e 80 00 20 blr =============================================================================== ffc18484 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { ffc18484: 94 21 ff d0 stwu r1,-48(r1) ffc18488: 7c 08 02 a6 mflr r0 ffc1848c: 93 e1 00 2c stw r31,44(r1) register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) ffc18490: 7c 7f 1b 79 mr. r31,r3 return RTEMS_INVALID_NAME; ffc18494: 38 60 00 03 li r3,3 uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { ffc18498: 93 c1 00 28 stw r30,40(r1) ffc1849c: 7c be 2b 78 mr r30,r5 ffc184a0: 90 01 00 34 stw r0,52(r1) ffc184a4: 93 61 00 1c stw r27,28(r1) ffc184a8: 93 81 00 20 stw r28,32(r1) ffc184ac: 93 a1 00 24 stw r29,36(r1) register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) ffc184b0: 41 82 00 48 beq- ffc184f8 return RTEMS_INVALID_NAME; if ( !starting_address ) ffc184b4: 2f 84 00 00 cmpwi cr7,r4,0 return RTEMS_INVALID_ADDRESS; ffc184b8: 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 ) ffc184bc: 41 9e 00 3c beq- cr7,ffc184f8 return RTEMS_INVALID_ADDRESS; if ( !id ) ffc184c0: 2f 88 00 00 cmpwi cr7,r8,0 ffc184c4: 41 9e 00 34 beq- cr7,ffc184f8 <== NEVER TAKEN return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || ffc184c8: 2f 85 00 00 cmpwi cr7,r5,0 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; ffc184cc: 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 || ffc184d0: 41 9e 00 28 beq- cr7,ffc184f8 ffc184d4: 2f 86 00 00 cmpwi cr7,r6,0 ffc184d8: 41 9e 00 20 beq- cr7,ffc184f8 ffc184dc: 7f 85 30 40 cmplw cr7,r5,r6 ffc184e0: 41 9c 00 18 blt- cr7,ffc184f8 ffc184e4: 70 c0 00 07 andi. r0,r6,7 ffc184e8: 40 82 00 10 bne- ffc184f8 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) ffc184ec: 70 9b 00 07 andi. r27,r4,7 return RTEMS_INVALID_ADDRESS; ffc184f0: 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 ) ) ffc184f4: 41 82 00 28 beq- ffc1851c ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } ffc184f8: 80 01 00 34 lwz r0,52(r1) ffc184fc: 83 61 00 1c lwz r27,28(r1) ffc18500: 7c 08 03 a6 mtlr r0 ffc18504: 83 81 00 20 lwz r28,32(r1) ffc18508: 83 a1 00 24 lwz r29,36(r1) ffc1850c: 83 c1 00 28 lwz r30,40(r1) ffc18510: 83 e1 00 2c lwz r31,44(r1) ffc18514: 38 21 00 30 addi r1,r1,48 ffc18518: 4e 80 00 20 blr ffc1851c: 3d 20 00 00 lis r9,0 ffc18520: 81 69 28 a0 lwz r11,10400(r9) ffc18524: 38 0b 00 01 addi r0,r11,1 ffc18528: 90 09 28 a0 stw r0,10400(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 ); ffc1852c: 3f 80 00 00 lis r28,0 ffc18530: 90 81 00 08 stw r4,8(r1) ffc18534: 3b 9c 6e e0 addi r28,r28,28384 ffc18538: 7f 83 e3 78 mr r3,r28 ffc1853c: 90 c1 00 0c stw r6,12(r1) ffc18540: 90 e1 00 10 stw r7,16(r1) ffc18544: 91 01 00 14 stw r8,20(r1) ffc18548: 48 00 60 4d bl ffc1e594 <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { ffc1854c: 7c 7d 1b 79 mr. r29,r3 ffc18550: 80 81 00 08 lwz r4,8(r1) ffc18554: 80 c1 00 0c lwz r6,12(r1) ffc18558: 80 e1 00 10 lwz r7,16(r1) ffc1855c: 81 01 00 14 lwz r8,20(r1) ffc18560: 41 82 00 50 beq- ffc185b0 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, ffc18564: 7c be 33 96 divwu r5,r30,r6 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; ffc18568: 90 9d 00 10 stw r4,16(r29) the_partition->length = length; the_partition->buffer_size = buffer_size; ffc1856c: 90 dd 00 18 stw r6,24(r29) the_partition->attribute_set = attribute_set; ffc18570: 90 fd 00 1c stw r7,28(r29) return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; the_partition->length = length; ffc18574: 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; ffc18578: 93 7d 00 20 stw r27,32(r29) _Chain_Initialize( &the_partition->Memory, starting_address, ffc1857c: 91 01 00 14 stw r8,20(r1) ffc18580: 38 7d 00 24 addi r3,r29,36 ffc18584: 48 00 42 51 bl ffc1c7d4 <_Chain_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc18588: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc1858c: 81 7c 00 1c lwz r11,28(r28) ffc18590: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc18594: 7f ab 49 2e stwx r29,r11,r9 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc18598: 93 fd 00 0c stw r31,12(r29) &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; ffc1859c: 81 01 00 14 lwz r8,20(r1) ffc185a0: 90 08 00 00 stw r0,0(r8) name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); ffc185a4: 48 00 75 6d bl ffc1fb10 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc185a8: 38 60 00 00 li r3,0 ffc185ac: 4b ff ff 4c b ffc184f8 _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { _Thread_Enable_dispatch(); ffc185b0: 48 00 75 61 bl ffc1fb10 <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; ffc185b4: 38 60 00 05 li r3,5 ffc185b8: 4b ff ff 40 b ffc184f8 =============================================================================== ffc18748 : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { ffc18748: 94 21 ff e0 stwu r1,-32(r1) ffc1874c: 7c 08 02 a6 mflr r0 ffc18750: 90 01 00 24 stw r0,36(r1) ffc18754: 7c 60 1b 78 mr r0,r3 Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) _Objects_Get( &_Partition_Information, id, location ); ffc18758: 3c 60 00 00 lis r3,0 ffc1875c: 93 e1 00 1c stw r31,28(r1) ffc18760: 38 63 6e e0 addi r3,r3,28384 ffc18764: 7c 9f 23 78 mr r31,r4 ffc18768: 38 a1 00 08 addi r5,r1,8 ffc1876c: 93 c1 00 18 stw r30,24(r1) ffc18770: 7c 04 03 78 mr r4,r0 ffc18774: 48 00 64 85 bl ffc1ebf8 <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { ffc18778: 80 01 00 08 lwz r0,8(r1) ffc1877c: 7c 7e 1b 78 mr r30,r3 ffc18780: 2f 80 00 00 cmpwi cr7,r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc18784: 38 60 00 04 li r3,4 { register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { ffc18788: 40 9e 00 58 bne- cr7,ffc187e0 ) { void *starting; void *ending; starting = the_partition->starting_address; ffc1878c: 80 1e 00 10 lwz r0,16(r30) ending = _Addresses_Add_offset( starting, the_partition->length ); ffc18790: 81 3e 00 14 lwz r9,20(r30) const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); ffc18794: 7f 9f 00 40 cmplw cr7,r31,r0 ffc18798: 41 9c 00 60 blt- cr7,ffc187f8 RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); ffc1879c: 7d 20 4a 14 add r9,r0,r9 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); ffc187a0: 7f 9f 48 40 cmplw cr7,r31,r9 ffc187a4: 41 9d 00 54 bgt- cr7,ffc187f8 <== NEVER TAKEN offset = (uint32_t) _Addresses_Subtract( the_buffer, the_partition->starting_address ); return ((offset % the_partition->buffer_size) == 0); ffc187a8: 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); ffc187ac: 7c 00 f8 50 subf r0,r0,r31 ffc187b0: 7d 60 4b 96 divwu r11,r0,r9 ffc187b4: 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 ) && ffc187b8: 7f 80 48 00 cmpw cr7,r0,r9 ffc187bc: 40 9e 00 3c bne- cr7,ffc187f8 RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); ffc187c0: 38 7e 00 24 addi r3,r30,36 ffc187c4: 7f e4 fb 78 mr r4,r31 ffc187c8: 48 00 3f 71 bl ffc1c738 <_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; ffc187cc: 81 3e 00 20 lwz r9,32(r30) ffc187d0: 38 09 ff ff addi r0,r9,-1 ffc187d4: 90 1e 00 20 stw r0,32(r30) _Thread_Enable_dispatch(); ffc187d8: 48 00 73 39 bl ffc1fb10 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc187dc: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc187e0: 80 01 00 24 lwz r0,36(r1) ffc187e4: 83 c1 00 18 lwz r30,24(r1) ffc187e8: 7c 08 03 a6 mtlr r0 ffc187ec: 83 e1 00 1c lwz r31,28(r1) ffc187f0: 38 21 00 20 addi r1,r1,32 ffc187f4: 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(); ffc187f8: 48 00 73 19 bl ffc1fb10 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc187fc: 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; ffc18800: 38 60 00 09 li r3,9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc18804: 83 c1 00 18 lwz r30,24(r1) ffc18808: 7c 08 03 a6 mtlr r0 ffc1880c: 83 e1 00 1c lwz r31,28(r1) ffc18810: 38 21 00 20 addi r1,r1,32 ffc18814: 4e 80 00 20 blr =============================================================================== ffc0a1d8 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { ffc0a1d8: 94 21 ff d0 stwu r1,-48(r1) ffc0a1dc: 7c 08 02 a6 mflr r0 ffc0a1e0: 93 e1 00 2c stw r31,44(r1) ffc0a1e4: 7c 7f 1b 78 mr r31,r3 Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) _Objects_Get( &_Rate_monotonic_Information, id, location ); ffc0a1e8: 3c 60 00 00 lis r3,0 ffc0a1ec: 93 c1 00 28 stw r30,40(r1) ffc0a1f0: 38 63 2c 58 addi r3,r3,11352 ffc0a1f4: 7c 9e 23 78 mr r30,r4 ffc0a1f8: 38 a1 00 08 addi r5,r1,8 ffc0a1fc: 90 01 00 34 stw r0,52(r1) ffc0a200: 7f e4 fb 78 mr r4,r31 ffc0a204: 93 a1 00 24 stw r29,36(r1) ffc0a208: 93 61 00 1c stw r27,28(r1) ffc0a20c: 93 81 00 20 stw r28,32(r1) ffc0a210: 48 00 2e 59 bl ffc0d068 <_Objects_Get> ffc0a214: 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 ) { ffc0a218: 80 01 00 08 lwz r0,8(r1) ffc0a21c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a220: 41 9e 00 30 beq- cr7,ffc0a250 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a224: 3b e0 00 04 li r31,4 } ffc0a228: 80 01 00 34 lwz r0,52(r1) ffc0a22c: 7f e3 fb 78 mr r3,r31 ffc0a230: 83 61 00 1c lwz r27,28(r1) ffc0a234: 7c 08 03 a6 mtlr r0 ffc0a238: 83 81 00 20 lwz r28,32(r1) ffc0a23c: 83 a1 00 24 lwz r29,36(r1) ffc0a240: 83 c1 00 28 lwz r30,40(r1) ffc0a244: 83 e1 00 2c lwz r31,44(r1) ffc0a248: 38 21 00 30 addi r1,r1,48 ffc0a24c: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc0a250: 3f 80 00 00 lis r28,0 the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { ffc0a254: 81 23 00 40 lwz r9,64(r3) ffc0a258: 3b 9c 32 24 addi r28,r28,12836 ffc0a25c: 80 1c 00 0c lwz r0,12(r28) ffc0a260: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a264: 41 9e 00 34 beq- cr7,ffc0a298 _Thread_Enable_dispatch(); ffc0a268: 48 00 3d 19 bl ffc0df80 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a26c: 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; ffc0a270: 3b e0 00 17 li r31,23 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a274: 83 61 00 1c lwz r27,28(r1) ffc0a278: 7c 08 03 a6 mtlr r0 ffc0a27c: 7f e3 fb 78 mr r3,r31 ffc0a280: 83 81 00 20 lwz r28,32(r1) ffc0a284: 83 a1 00 24 lwz r29,36(r1) ffc0a288: 83 c1 00 28 lwz r30,40(r1) ffc0a28c: 83 e1 00 2c lwz r31,44(r1) ffc0a290: 38 21 00 30 addi r1,r1,48 ffc0a294: 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 ) { ffc0a298: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a29c: 40 9e 00 1c bne- cr7,ffc0a2b8 switch ( the_period->state ) { ffc0a2a0: 80 03 00 38 lwz r0,56(r3) ffc0a2a4: 3b e0 00 00 li r31,0 ffc0a2a8: 2b 80 00 04 cmplwi cr7,r0,4 ffc0a2ac: 40 9d 00 70 ble- cr7,ffc0a31c <== ALWAYS TAKEN case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); ffc0a2b0: 48 00 3c d1 bl ffc0df80 <_Thread_Enable_dispatch> <== NOT EXECUTED return( return_value ); ffc0a2b4: 4b ff ff 74 b ffc0a228 <== NOT EXECUTED static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0a2b8: 7f 60 00 a6 mfmsr r27 ffc0a2bc: 7c 10 42 a6 mfsprg r0,0 ffc0a2c0: 7f 60 00 78 andc r0,r27,r0 ffc0a2c4: 7c 00 01 24 mtmsr r0 } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { ffc0a2c8: 80 03 00 38 lwz r0,56(r3) ffc0a2cc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a2d0: 41 9e 00 64 beq- cr7,ffc0a334 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { ffc0a2d4: 2f 80 00 02 cmpwi cr7,r0,2 ffc0a2d8: 41 9e 00 ac beq- cr7,ffc0a384 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { ffc0a2dc: 2f 80 00 04 cmpwi cr7,r0,4 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a2e0: 3b e0 00 04 li r31,4 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { ffc0a2e4: 40 9e ff 44 bne+ cr7,ffc0a228 <== NEVER TAKEN /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); ffc0a2e8: 4b ff fd a9 bl ffc0a090 <_Rate_monotonic_Update_statistics> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0a2ec: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a2f0: 38 00 00 02 li r0,2 the_period->next_length = length; ffc0a2f4: 93 dd 00 3c stw r30,60(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a2f8: 3c 60 00 00 lis r3,0 */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a2fc: 90 1d 00 38 stw r0,56(r29) ffc0a300: 38 63 2e 48 addi r3,r3,11848 ffc0a304: 38 9d 00 10 addi r4,r29,16 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a308: 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; ffc0a30c: 3b e0 00 06 li r31,6 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a310: 48 00 52 c5 bl ffc0f5d4 <_Watchdog_Insert> the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); ffc0a314: 48 00 3c 6d bl ffc0df80 <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; ffc0a318: 4b ff ff 10 b ffc0a228 _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { switch ( the_period->state ) { ffc0a31c: 3d 20 ff c2 lis r9,-62 ffc0a320: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0a324: 39 29 2c 28 addi r9,r9,11304 ffc0a328: 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(); ffc0a32c: 48 00 3c 55 bl ffc0df80 <_Thread_Enable_dispatch> ffc0a330: 4b ff fe f8 b ffc0a228 ffc0a334: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); ffc0a338: 4b ff fc a1 bl ffc09fd8 <_Rate_monotonic_Initiate_statistics> the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a33c: 39 20 00 02 li r9,2 ffc0a340: 91 3d 00 38 stw r9,56(r29) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc0a344: 3d 20 ff c1 lis r9,-63 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0a348: 38 00 00 00 li r0,0 the_watchdog->routine = routine; ffc0a34c: 39 29 a7 ec addi r9,r9,-22548 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0a350: 90 1d 00 18 stw r0,24(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a354: 3c 60 00 00 lis r3,0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc0a358: 91 3d 00 2c stw r9,44(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a35c: 38 63 2e 48 addi r3,r3,11848 ffc0a360: 38 9d 00 10 addi r4,r29,16 void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; ffc0a364: 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; ffc0a368: 3b e0 00 00 li r31,0 the_watchdog->user_data = user_data; ffc0a36c: 90 1d 00 34 stw r0,52(r29) _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; ffc0a370: 93 dd 00 3c stw r30,60(r29) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a374: 93 dd 00 1c stw r30,28(r29) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a378: 48 00 52 5d bl ffc0f5d4 <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); ffc0a37c: 48 00 3c 05 bl ffc0df80 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a380: 4b ff fe a8 b ffc0a228 if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); ffc0a384: 4b ff fd 0d bl ffc0a090 <_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; ffc0a388: 38 00 00 01 li r0,1 ffc0a38c: 90 1d 00 38 stw r0,56(r29) the_period->next_length = length; ffc0a390: 93 dd 00 3c stw r30,60(r29) ffc0a394: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; ffc0a398: 81 3c 00 0c lwz r9,12(r28) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a39c: 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; ffc0a3a0: 80 1d 00 08 lwz r0,8(r29) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a3a4: 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; ffc0a3a8: 90 09 00 20 stw r0,32(r9) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a3ac: 48 00 47 49 bl ffc0eaf4 <_Thread_Set_state> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc0a3b0: 7d 20 00 a6 mfmsr r9 ffc0a3b4: 7c 10 42 a6 mfsprg r0,0 ffc0a3b8: 7d 20 00 78 andc r0,r9,r0 ffc0a3bc: 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; ffc0a3c0: 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; ffc0a3c4: 80 1d 00 38 lwz r0,56(r29) the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a3c8: 91 7d 00 38 stw r11,56(r29) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc0a3cc: 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 ) ffc0a3d0: 2f 80 00 03 cmpwi cr7,r0,3 ffc0a3d4: 41 9e 00 10 beq- cr7,ffc0a3e4 <== NEVER TAKEN _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); _Thread_Enable_dispatch(); ffc0a3d8: 48 00 3b a9 bl ffc0df80 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a3dc: 3b e0 00 00 li r31,0 ffc0a3e0: 4b ff fe 48 b ffc0a228 /* * 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 ); ffc0a3e4: 80 7c 00 0c lwz r3,12(r28) <== NOT EXECUTED ffc0a3e8: 38 80 40 00 li r4,16384 <== NOT EXECUTED ffc0a3ec: 48 00 36 c9 bl ffc0dab4 <_Thread_Clear_state> <== NOT EXECUTED ffc0a3f0: 4b ff ff e8 b ffc0a3d8 <== NOT EXECUTED =============================================================================== ffc0a3f4 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { ffc0a3f4: 94 21 ff 58 stwu r1,-168(r1) ffc0a3f8: 7c 08 02 a6 mflr r0 ffc0a3fc: 90 01 00 ac stw r0,172(r1) rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) ffc0a400: 7c 80 23 79 mr. r0,r4 */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { ffc0a404: 93 a1 00 9c stw r29,156(r1) ffc0a408: 7c 7d 1b 78 mr r29,r3 ffc0a40c: 92 41 00 70 stw r18,112(r1) ffc0a410: 92 61 00 74 stw r19,116(r1) ffc0a414: 92 81 00 78 stw r20,120(r1) ffc0a418: 92 a1 00 7c stw r21,124(r1) ffc0a41c: 92 c1 00 80 stw r22,128(r1) ffc0a420: 92 e1 00 84 stw r23,132(r1) ffc0a424: 93 01 00 88 stw r24,136(r1) ffc0a428: 93 21 00 8c stw r25,140(r1) ffc0a42c: 93 41 00 90 stw r26,144(r1) ffc0a430: 93 61 00 94 stw r27,148(r1) ffc0a434: 93 81 00 98 stw r28,152(r1) ffc0a438: 93 c1 00 a0 stw r30,160(r1) ffc0a43c: 93 e1 00 a4 stw r31,164(r1) rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) ffc0a440: 90 01 00 68 stw r0,104(r1) ffc0a444: 41 82 01 88 beq- ffc0a5cc <== NEVER TAKEN return; (*print)( context, "Period information by period\n" ); ffc0a448: 3c 80 ff c2 lis r4,-62 ffc0a44c: 7c 09 03 a6 mtctr r0 ffc0a450: 38 84 2c 3c addi r4,r4,11324 /* * 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 ; ffc0a454: 3f c0 00 00 lis r30,0 ffc0a458: 3b de 2c 58 addi r30,r30,11352 char name[5]; if ( !print ) return; (*print)( context, "Period information by period\n" ); ffc0a45c: 4c c6 31 82 crclr 4*cr1+eq ffc0a460: 4e 80 04 21 bctrl #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); ffc0a464: 80 01 00 68 lwz r0,104(r1) ffc0a468: 3c 80 ff c2 lis r4,-62 ffc0a46c: 7c 09 03 a6 mtctr r0 ffc0a470: 38 84 2c 5c addi r4,r4,11356 ffc0a474: 7f a3 eb 78 mr r3,r29 ffc0a478: 4c c6 31 82 crclr 4*cr1+eq ffc0a47c: 4e 80 04 21 bctrl (*print)( context, "--- Wall times are in seconds ---\n" ); ffc0a480: 80 01 00 68 lwz r0,104(r1) ffc0a484: 3c 80 ff c2 lis r4,-62 ffc0a488: 7c 09 03 a6 mtctr r0 ffc0a48c: 38 84 2c 80 addi r4,r4,11392 ffc0a490: 7f a3 eb 78 mr r3,r29 ffc0a494: 4c c6 31 82 crclr 4*cr1+eq ffc0a498: 4e 80 04 21 bctrl Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " ffc0a49c: 80 01 00 68 lwz r0,104(r1) ffc0a4a0: 3c 80 ff c2 lis r4,-62 ffc0a4a4: 7c 09 03 a6 mtctr r0 ffc0a4a8: 38 84 2c a4 addi r4,r4,11428 ffc0a4ac: 7f a3 eb 78 mr r3,r29 ffc0a4b0: 4c c6 31 82 crclr 4*cr1+eq ffc0a4b4: 4e 80 04 21 bctrl #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " ffc0a4b8: 80 01 00 68 lwz r0,104(r1) ffc0a4bc: 3c 80 ff c2 lis r4,-62 ffc0a4c0: 7c 09 03 a6 mtctr r0 ffc0a4c4: 7f a3 eb 78 mr r3,r29 ffc0a4c8: 38 84 2c f0 addi r4,r4,11504 ffc0a4cc: 4c c6 31 82 crclr 4*cr1+eq ffc0a4d0: 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 ; ffc0a4d4: 83 fe 00 08 lwz r31,8(r30) ffc0a4d8: 80 1e 00 0c lwz r0,12(r30) ffc0a4dc: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0a4e0: 41 9d 00 ec bgt- cr7,ffc0a5cc <== 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, ffc0a4e4: 3e c0 ff c2 lis r22,-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, ffc0a4e8: 3e 60 ff c2 lis r19,-62 ffc0a4ec: 3f 60 10 62 lis r27,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, ffc0a4f0: 3e 40 ff c2 lis r18,-62 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a4f4: 3f 00 ff c2 lis r24,-62 ffc0a4f8: 3b 81 00 30 addi r28,r1,48 #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 ); ffc0a4fc: 3a a1 00 18 addi r21,r1,24 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); ffc0a500: 3b 41 00 08 addi r26,r1,8 /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc0a504: 3a d6 2d 3c addi r22,r22,11580 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; ffc0a508: 3a e1 00 48 addi r23,r1,72 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); ffc0a50c: 3b 21 00 10 addi r25,r1,16 (*print)( context, ffc0a510: 3a 73 2d 54 addi r19,r19,11604 ffc0a514: 63 7b 4d d3 ori r27,r27,19923 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; ffc0a518: 3a 81 00 60 addi r20,r1,96 _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); (*print)( context, ffc0a51c: 3a 52 2d 74 addi r18,r18,11636 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a520: 3b 18 19 20 addi r24,r24,6432 ffc0a524: 48 00 00 14 b ffc0a538 /* * 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 ; ffc0a528: 80 1e 00 0c lwz r0,12(r30) id <= _Rate_monotonic_Information.maximum_id ; id++ ) { ffc0a52c: 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 ; ffc0a530: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a534: 41 9c 00 98 blt- cr7,ffc0a5cc id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); ffc0a538: 7f e3 fb 78 mr r3,r31 ffc0a53c: 7f 84 e3 78 mr r4,r28 ffc0a540: 48 00 80 15 bl ffc12554 if ( status != RTEMS_SUCCESSFUL ) ffc0a544: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a548: 40 9e ff e0 bne+ cr7,ffc0a528 #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 ); ffc0a54c: 7e a4 ab 78 mr r4,r21 ffc0a550: 7f e3 fb 78 mr r3,r31 ffc0a554: 48 00 81 11 bl ffc12664 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); ffc0a558: 80 61 00 18 lwz r3,24(r1) ffc0a55c: 7f 45 d3 78 mr r5,r26 ffc0a560: 38 80 00 05 li r4,5 ffc0a564: 48 00 03 51 bl ffc0a8b4 /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc0a568: 80 01 00 68 lwz r0,104(r1) ffc0a56c: 7e c4 b3 78 mr r4,r22 ffc0a570: 80 e1 00 30 lwz r7,48(r1) ffc0a574: 7f e5 fb 78 mr r5,r31 ffc0a578: 7c 09 03 a6 mtctr r0 ffc0a57c: 7f a3 eb 78 mr r3,r29 ffc0a580: 81 01 00 34 lwz r8,52(r1) ffc0a584: 7f 46 d3 78 mr r6,r26 ffc0a588: 4c c6 31 82 crclr 4*cr1+eq ffc0a58c: 4e 80 04 21 bctrl ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a590: 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 ); ffc0a594: 7e e3 bb 78 mr r3,r23 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a598: 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 ); ffc0a59c: 7f 25 cb 78 mr r5,r25 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a5a0: 7f 04 c3 78 mr r4,r24 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a5a4: 40 9e 00 70 bne- cr7,ffc0a614 (*print)( context, "\n" ); ffc0a5a8: 80 01 00 68 lwz r0,104(r1) ffc0a5ac: 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++ ) { ffc0a5b0: 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" ); ffc0a5b4: 7c 09 03 a6 mtctr r0 ffc0a5b8: 4c c6 31 82 crclr 4*cr1+eq ffc0a5bc: 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 ; ffc0a5c0: 80 1e 00 0c lwz r0,12(r30) ffc0a5c4: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a5c8: 40 9c ff 70 bge+ cr7,ffc0a538 <== ALWAYS TAKEN the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall ); #endif } } } ffc0a5cc: 80 01 00 ac lwz r0,172(r1) ffc0a5d0: 82 41 00 70 lwz r18,112(r1) ffc0a5d4: 7c 08 03 a6 mtlr r0 ffc0a5d8: 82 61 00 74 lwz r19,116(r1) ffc0a5dc: 82 81 00 78 lwz r20,120(r1) ffc0a5e0: 82 a1 00 7c lwz r21,124(r1) ffc0a5e4: 82 c1 00 80 lwz r22,128(r1) ffc0a5e8: 82 e1 00 84 lwz r23,132(r1) ffc0a5ec: 83 01 00 88 lwz r24,136(r1) ffc0a5f0: 83 21 00 8c lwz r25,140(r1) ffc0a5f4: 83 41 00 90 lwz r26,144(r1) ffc0a5f8: 83 61 00 94 lwz r27,148(r1) ffc0a5fc: 83 81 00 98 lwz r28,152(r1) ffc0a600: 83 a1 00 9c lwz r29,156(r1) ffc0a604: 83 c1 00 a0 lwz r30,160(r1) ffc0a608: 83 e1 00 a4 lwz r31,164(r1) ffc0a60c: 38 21 00 a8 addi r1,r1,168 ffc0a610: 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 ); ffc0a614: 7c 04 03 78 mr r4,r0 ffc0a618: 48 00 49 7d bl ffc0ef94 <_Timespec_Divide_by_integer> (*print)( context, ffc0a61c: 80 01 00 14 lwz r0,20(r1) ffc0a620: 80 81 00 3c lwz r4,60(r1) ffc0a624: 7f a3 eb 78 mr r3,r29 ffc0a628: 81 61 00 44 lwz r11,68(r1) ffc0a62c: 7d 40 d8 96 mulhw r10,r0,r27 ffc0a630: 80 e1 00 40 lwz r7,64(r1) ffc0a634: 7c c4 d8 96 mulhw r6,r4,r27 ffc0a638: 81 21 00 10 lwz r9,16(r1) ffc0a63c: 80 a1 00 38 lwz r5,56(r1) ffc0a640: 7d 0b d8 96 mulhw r8,r11,r27 ffc0a644: 7c 00 fe 70 srawi r0,r0,31 ffc0a648: 7d 4a 36 70 srawi r10,r10,6 ffc0a64c: 7d 40 50 50 subf r10,r0,r10 ffc0a650: 80 01 00 68 lwz r0,104(r1) ffc0a654: 7d 6b fe 70 srawi r11,r11,31 ffc0a658: 7c 84 fe 70 srawi r4,r4,31 ffc0a65c: 7c 09 03 a6 mtctr r0 ffc0a660: 7c c6 36 70 srawi r6,r6,6 ffc0a664: 7d 08 36 70 srawi r8,r8,6 ffc0a668: 7c c4 30 50 subf r6,r4,r6 ffc0a66c: 7d 0b 40 50 subf r8,r11,r8 ffc0a670: 7e 64 9b 78 mr r4,r19 ffc0a674: 4c c6 31 82 crclr 4*cr1+eq ffc0a678: 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); ffc0a67c: 80 81 00 30 lwz r4,48(r1) ffc0a680: 7e 83 a3 78 mr r3,r20 ffc0a684: 7f 25 cb 78 mr r5,r25 ffc0a688: 48 00 49 0d bl ffc0ef94 <_Timespec_Divide_by_integer> (*print)( context, ffc0a68c: 80 01 00 14 lwz r0,20(r1) ffc0a690: 80 c1 00 54 lwz r6,84(r1) ffc0a694: 7f a3 eb 78 mr r3,r29 ffc0a698: 81 61 00 5c lwz r11,92(r1) ffc0a69c: 7d 40 d8 96 mulhw r10,r0,r27 ffc0a6a0: 80 a1 00 50 lwz r5,80(r1) ffc0a6a4: 7d 86 d8 96 mulhw r12,r6,r27 ffc0a6a8: 80 e1 00 58 lwz r7,88(r1) ffc0a6ac: 81 21 00 10 lwz r9,16(r1) ffc0a6b0: 7d 0b d8 96 mulhw r8,r11,r27 ffc0a6b4: 7c 00 fe 70 srawi r0,r0,31 ffc0a6b8: 7d 4a 36 70 srawi r10,r10,6 ffc0a6bc: 7d 40 50 50 subf r10,r0,r10 ffc0a6c0: 80 01 00 68 lwz r0,104(r1) ffc0a6c4: 7d 8c 36 70 srawi r12,r12,6 ffc0a6c8: 7d 6b fe 70 srawi r11,r11,31 ffc0a6cc: 7c 09 03 a6 mtctr r0 ffc0a6d0: 7c c6 fe 70 srawi r6,r6,31 ffc0a6d4: 7d 08 36 70 srawi r8,r8,6 ffc0a6d8: 7e 44 93 78 mr r4,r18 ffc0a6dc: 7c c6 60 50 subf r6,r6,r12 ffc0a6e0: 7d 0b 40 50 subf r8,r11,r8 ffc0a6e4: 4c c6 31 82 crclr 4*cr1+eq ffc0a6e8: 4e 80 04 21 bctrl ffc0a6ec: 4b ff fe 3c b ffc0a528 =============================================================================== ffc0a700 : rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0a700: 3d 20 00 00 lis r9,0 /* * rtems_rate_monotonic_reset_all_statistics */ void rtems_rate_monotonic_reset_all_statistics( void ) { ffc0a704: 94 21 ff f0 stwu r1,-16(r1) ffc0a708: 7c 08 02 a6 mflr r0 ffc0a70c: 81 69 28 2c lwz r11,10284(r9) ffc0a710: 90 01 00 14 stw r0,20(r1) ffc0a714: 38 0b 00 01 addi r0,r11,1 ffc0a718: 93 c1 00 08 stw r30,8(r1) ffc0a71c: 93 e1 00 0c stw r31,12(r1) ffc0a720: 90 09 28 2c stw r0,10284(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 ; ffc0a724: 3f c0 00 00 lis r30,0 ffc0a728: 3b de 2c 58 addi r30,r30,11352 ffc0a72c: 83 fe 00 08 lwz r31,8(r30) ffc0a730: 80 1e 00 0c lwz r0,12(r30) ffc0a734: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0a738: 41 9d 00 1c bgt- cr7,ffc0a754 <== NEVER TAKEN id <= _Rate_monotonic_Information.maximum_id ; id++ ) { (void) rtems_rate_monotonic_reset_statistics( id ); ffc0a73c: 7f e3 fb 78 mr r3,r31 ffc0a740: 48 00 00 31 bl ffc0a770 /* * 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: 80 1e 00 0c lwz r0,12(r30) id <= _Rate_monotonic_Information.maximum_id ; id++ ) { ffc0a748: 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 ; ffc0a74c: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a750: 40 9c ff ec bge+ cr7,ffc0a73c } /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); ffc0a754: 48 00 38 2d bl ffc0df80 <_Thread_Enable_dispatch> } ffc0a758: 80 01 00 14 lwz r0,20(r1) ffc0a75c: 83 c1 00 08 lwz r30,8(r1) ffc0a760: 7c 08 03 a6 mtlr r0 ffc0a764: 83 e1 00 0c lwz r31,12(r1) ffc0a768: 38 21 00 10 addi r1,r1,16 ffc0a76c: 4e 80 00 20 blr =============================================================================== ffc1a1a4 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { ffc1a1a4: 94 21 ff e0 stwu r1,-32(r1) ffc1a1a8: 7c 08 02 a6 mflr r0 ffc1a1ac: 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 ) ffc1a1b0: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { ffc1a1b4: 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; ffc1a1b8: 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 ) ffc1a1bc: 40 82 00 1c bne- ffc1a1d8 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1a1c0: 7c 03 03 78 mr r3,r0 ffc1a1c4: 80 01 00 24 lwz r0,36(r1) ffc1a1c8: 83 e1 00 1c lwz r31,28(r1) ffc1a1cc: 38 21 00 20 addi r1,r1,32 ffc1a1d0: 7c 08 03 a6 mtlr r0 ffc1a1d4: 4e 80 00 20 blr ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); ffc1a1d8: 38 81 00 08 addi r4,r1,8 ffc1a1dc: 48 00 59 55 bl ffc1fb30 <_Thread_Get> switch ( location ) { ffc1a1e0: 80 01 00 08 lwz r0,8(r1) ffc1a1e4: 2f 80 00 00 cmpwi cr7,r0,0 ffc1a1e8: 41 9e 00 20 beq- cr7,ffc1a208 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1a1ec: 38 00 00 04 li r0,4 } ffc1a1f0: 83 e1 00 1c lwz r31,28(r1) ffc1a1f4: 7c 03 03 78 mr r3,r0 ffc1a1f8: 80 01 00 24 lwz r0,36(r1) ffc1a1fc: 38 21 00 20 addi r1,r1,32 ffc1a200: 7c 08 03 a6 mtlr r0 ffc1a204: 4e 80 00 20 blr the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; ffc1a208: 81 23 01 30 lwz r9,304(r3) asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { ffc1a20c: 80 09 00 0c lwz r0,12(r9) ffc1a210: 2f 80 00 00 cmpwi cr7,r0,0 ffc1a214: 41 9e 00 9c beq- cr7,ffc1a2b0 if ( asr->is_enabled ) { ffc1a218: 88 09 00 08 lbz r0,8(r9) ffc1a21c: 2f 80 00 00 cmpwi cr7,r0,0 ffc1a220: 41 9e 00 50 beq- cr7,ffc1a270 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc1a224: 7c 00 00 a6 mfmsr r0 ffc1a228: 7d 70 42 a6 mfsprg r11,0 ffc1a22c: 7c 0b 58 78 andc r11,r0,r11 ffc1a230: 7d 60 01 24 mtmsr r11 ) { ISR_Level _level; _ISR_Disable( _level ); *signal_set |= signals; ffc1a234: 81 69 00 14 lwz r11,20(r9) ffc1a238: 7d 7f fb 78 or r31,r11,r31 ffc1a23c: 93 e9 00 14 stw r31,20(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc1a240: 7c 00 01 24 mtmsr r0 _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc1a244: 3d 20 00 00 lis r9,0 ffc1a248: 39 29 75 24 addi r9,r9,29988 ffc1a24c: 80 09 00 08 lwz r0,8(r9) ffc1a250: 2f 80 00 00 cmpwi cr7,r0,0 ffc1a254: 41 9e 00 3c beq- cr7,ffc1a290 ffc1a258: 80 09 00 0c lwz r0,12(r9) ffc1a25c: 7f 83 00 00 cmpw cr7,r3,r0 ffc1a260: 40 be 00 30 bne+ cr7,ffc1a290 <== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc1a264: 38 00 00 01 li r0,1 ffc1a268: 98 09 00 18 stb r0,24(r9) ffc1a26c: 48 00 00 24 b ffc1a290 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc1a270: 7c 00 00 a6 mfmsr r0 ffc1a274: 7d 70 42 a6 mfsprg r11,0 ffc1a278: 7c 0b 58 78 andc r11,r0,r11 ffc1a27c: 7d 60 01 24 mtmsr r11 ffc1a280: 81 69 00 18 lwz r11,24(r9) ffc1a284: 7d 7f fb 78 or r31,r11,r31 ffc1a288: 93 e9 00 18 stw r31,24(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc1a28c: 7c 00 01 24 mtmsr r0 } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); ffc1a290: 48 00 58 81 bl ffc1fb10 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc1a294: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1a298: 7c 03 03 78 mr r3,r0 ffc1a29c: 80 01 00 24 lwz r0,36(r1) ffc1a2a0: 83 e1 00 1c lwz r31,28(r1) ffc1a2a4: 38 21 00 20 addi r1,r1,32 ffc1a2a8: 7c 08 03 a6 mtlr r0 ffc1a2ac: 4e 80 00 20 blr _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); ffc1a2b0: 48 00 58 61 bl ffc1fb10 <_Thread_Enable_dispatch> return RTEMS_NOT_DEFINED; ffc1a2b4: 38 00 00 0b li r0,11 ffc1a2b8: 4b ff ff 08 b ffc1a1c0 =============================================================================== ffc12dbc : ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) ffc12dbc: 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 ) { ffc12dc0: 7c 08 02 a6 mflr r0 ffc12dc4: 94 21 ff f8 stwu r1,-8(r1) ffc12dc8: 90 01 00 0c stw r0,12(r1) ffc12dcc: 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; ffc12dd0: 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 ) ffc12dd4: 41 82 01 34 beq- ffc12f08 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; ffc12dd8: 3c c0 00 00 lis r6,0 ffc12ddc: 38 c6 31 04 addi r6,r6,12548 ffc12de0: 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 ) ffc12de4: 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; ffc12de8: 89 09 00 74 lbz r8,116(r9) if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc12dec: 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 ]; ffc12df0: 81 69 01 30 lwz r11,304(r9) asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; ffc12df4: 7d 08 00 34 cntlzw r8,r8 ffc12df8: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc12dfc: 55 07 40 2e rlwinm r7,r8,8,0,23 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc12e00: 40 9e 01 18 bne- cr7,ffc12f18 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; ffc12e04: 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); ffc12e08: 39 40 00 00 li r10,0 ffc12e0c: 7d 08 00 34 cntlzw r8,r8 ffc12e10: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc12e14: 55 08 50 2a rlwinm r8,r8,10,0,21 ffc12e18: 7d 07 3b 78 or r7,r8,r7 ffc12e1c: 7d 40 00 a6 mfmsr r10 if (msr & MSR_EE) return 0; ffc12e20: 55 48 8f fe rlwinm r8,r10,17,31,31 ffc12e24: 2f 88 00 00 cmpwi cr7,r8,0 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc12e28: 70 8a 01 00 andi. r10,r4,256 ffc12e2c: 7d 40 00 26 mfcr r10 ffc12e30: 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(); ffc12e34: 7c e7 53 78 or r7,r7,r10 *previous_mode_set = old_mode; ffc12e38: 90 e5 00 00 stw r7,0(r5) /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc12e3c: 41 82 00 14 beq- ffc12e50 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; ffc12e40: 70 08 01 00 andi. r8,r0,256 ffc12e44: 7d 40 00 26 mfcr r10 ffc12e48: 55 4a 1f fe rlwinm r10,r10,3,31,31 ffc12e4c: 99 49 00 74 stb r10,116(r9) if ( mask & RTEMS_TIMESLICE_MASK ) { ffc12e50: 70 8a 02 00 andi. r10,r4,512 ffc12e54: 41 82 00 20 beq- ffc12e74 if ( _Modes_Is_timeslice(mode_set) ) { ffc12e58: 70 0a 02 00 andi. r10,r0,512 ffc12e5c: 41 82 01 54 beq- ffc12fb0 executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc12e60: 3d 40 00 00 lis r10,0 ffc12e64: 81 4a 27 a4 lwz r10,10148(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; ffc12e68: 39 00 00 01 li r8,1 ffc12e6c: 91 09 00 7c stw r8,124(r9) executing->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc12e70: 91 49 00 78 stw r10,120(r9) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc12e74: 70 88 00 01 andi. r8,r4,1 ffc12e78: 41 82 00 20 beq- ffc12e98 } static inline void _CPU_ISR_Set_level( uint32_t level ) { register unsigned int msr; _CPU_MSR_GET(msr); ffc12e7c: 39 20 00 00 li r9,0 ffc12e80: 7d 20 00 a6 mfmsr r9 if (!(level & CPU_MODES_INTERRUPT_MASK)) { ffc12e84: 70 0a 00 01 andi. r10,r0,1 ffc12e88: 40 82 01 18 bne- ffc12fa0 static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; asm volatile ( ffc12e8c: 7d 50 42 a6 mfsprg r10,0 msr |= ppc_interrupt_get_disable_mask(); ffc12e90: 7d 49 4b 78 or r9,r10,r9 } else { msr &= ~ppc_interrupt_get_disable_mask(); } _CPU_MSR_SET(msr); ffc12e94: 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 ) { ffc12e98: 70 88 04 00 andi. r8,r4,1024 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; ffc12e9c: 39 40 00 00 li r10,0 if ( mask & RTEMS_ASR_MASK ) { ffc12ea0: 41 82 00 54 beq- ffc12ef4 * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( ffc12ea4: 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 ) { ffc12ea8: 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( ffc12eac: 7c 00 00 26 mfcr r0 ffc12eb0: 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 ) { ffc12eb4: 7f 89 00 00 cmpw cr7,r9,r0 ffc12eb8: 41 9e 00 3c beq- cr7,ffc12ef4 asr->is_enabled = is_asr_enabled; ffc12ebc: 98 0b 00 08 stb r0,8(r11) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc12ec0: 7c 00 00 a6 mfmsr r0 ffc12ec4: 7d 30 42 a6 mfsprg r9,0 ffc12ec8: 7c 09 48 78 andc r9,r0,r9 ffc12ecc: 7d 20 01 24 mtmsr r9 { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; ffc12ed0: 81 4b 00 18 lwz r10,24(r11) information->signals_pending = information->signals_posted; ffc12ed4: 81 2b 00 14 lwz r9,20(r11) information->signals_posted = _signals; ffc12ed8: 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; ffc12edc: 91 2b 00 18 stw r9,24(r11) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc12ee0: 7c 00 01 24 mtmsr r0 _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { ffc12ee4: 80 0b 00 14 lwz r0,20(r11) needs_asr_dispatching = true; ffc12ee8: 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 ) ) { ffc12eec: 2f 80 00 00 cmpwi cr7,r0,0 ffc12ef0: 41 9e 00 d0 beq- cr7,ffc12fc0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc12ef4: 3d 20 00 00 lis r9,0 ffc12ef8: 80 09 27 ec lwz r0,10220(r9) if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; ffc12efc: 38 60 00 00 li r3,0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc12f00: 2f 80 00 03 cmpwi cr7,r0,3 ffc12f04: 41 9e 00 58 beq- cr7,ffc12f5c <== ALWAYS TAKEN if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; } ffc12f08: 80 01 00 0c lwz r0,12(r1) ffc12f0c: 38 21 00 08 addi r1,r1,8 ffc12f10: 7c 08 03 a6 mtlr r0 ffc12f14: 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; ffc12f18: 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; ffc12f1c: 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); ffc12f20: 39 40 00 00 li r10,0 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; ffc12f24: 7d 08 00 34 cntlzw r8,r8 ffc12f28: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc12f2c: 55 08 50 2a rlwinm r8,r8,10,0,21 ffc12f30: 7d 07 3b 78 or r7,r8,r7 ffc12f34: 7d 40 00 a6 mfmsr r10 if (msr & MSR_EE) return 0; ffc12f38: 55 48 8f fe rlwinm r8,r10,17,31,31 ffc12f3c: 2f 88 00 00 cmpwi cr7,r8,0 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc12f40: 70 8a 01 00 andi. r10,r4,256 ffc12f44: 7d 40 00 26 mfcr r10 ffc12f48: 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(); ffc12f4c: 7c e7 53 78 or r7,r7,r10 *previous_mode_set = old_mode; ffc12f50: 90 e5 00 00 stw r7,0(r5) /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc12f54: 41 a2 fe fc beq- ffc12e50 ffc12f58: 4b ff fe e8 b ffc12e40 { Thread_Control *executing; executing = _Thread_Executing; if ( are_signals_pending || ffc12f5c: 2f 8a 00 00 cmpwi cr7,r10,0 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; ffc12f60: 81 26 00 0c lwz r9,12(r6) if ( are_signals_pending || ffc12f64: 40 9e 00 1c bne- cr7,ffc12f80 ffc12f68: 80 06 00 10 lwz r0,16(r6) ffc12f6c: 7f 89 00 00 cmpw cr7,r9,r0 ffc12f70: 41 be ff 98 beq- cr7,ffc12f08 (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { ffc12f74: 88 09 00 74 lbz r0,116(r9) ffc12f78: 2f 80 00 00 cmpwi cr7,r0,0 ffc12f7c: 41 be ff 8c beq- cr7,ffc12f08 <== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc12f80: 38 00 00 01 li r0,1 ffc12f84: 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(); ffc12f88: 4b ff 8a ad bl ffc0ba34 <_Thread_Dispatch> } return RTEMS_SUCCESSFUL; } ffc12f8c: 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; ffc12f90: 38 60 00 00 li r3,0 } ffc12f94: 7c 08 03 a6 mtlr r0 ffc12f98: 38 21 00 08 addi r1,r1,8 ffc12f9c: 4e 80 00 20 blr static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; asm volatile ( ffc12fa0: 7d 50 42 a6 mfsprg r10,0 _CPU_MSR_GET(msr); if (!(level & CPU_MODES_INTERRUPT_MASK)) { msr |= ppc_interrupt_get_disable_mask(); } else { msr &= ~ppc_interrupt_get_disable_mask(); ffc12fa4: 7d 29 50 78 andc r9,r9,r10 } _CPU_MSR_SET(msr); ffc12fa8: 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 ) ); ffc12fac: 4b ff fe ec b ffc12e98 } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc12fb0: 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; ffc12fb4: 91 49 00 7c stw r10,124(r9) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc12fb8: 41 a2 fe e0 beq- ffc12e98 ffc12fbc: 4b ff fe c0 b ffc12e7c /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; ffc12fc0: 39 40 00 00 li r10,0 ffc12fc4: 4b ff ff 30 b ffc12ef4 =============================================================================== ffc0e964 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { ffc0e964: 7d 80 00 26 mfcr r12 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0e968: 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 ) { ffc0e96c: 94 21 ff d8 stwu r1,-40(r1) ffc0e970: 7c 08 02 a6 mflr r0 ffc0e974: 93 c1 00 20 stw r30,32(r1) ffc0e978: 7c be 2b 78 mr r30,r5 ffc0e97c: 93 e1 00 24 stw r31,36(r1) register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0e980: 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 ) { ffc0e984: 90 01 00 2c stw r0,44(r1) ffc0e988: 91 81 00 1c stw r12,28(r1) register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0e98c: 41 92 00 18 beq- cr4,ffc0e9a4 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 ) ); ffc0e990: 3d 20 00 00 lis r9,0 ffc0e994: 89 29 27 2c lbz r9,10028(r9) !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; ffc0e998: 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 ) && ffc0e99c: 7f 84 48 40 cmplw cr7,r4,r9 ffc0e9a0: 41 9d 00 60 bgt- cr7,ffc0ea00 if ( !old_priority ) ffc0e9a4: 2f 9e 00 00 cmpwi cr7,r30,0 return RTEMS_INVALID_ADDRESS; ffc0e9a8: 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 ) ffc0e9ac: 41 9e 00 54 beq- cr7,ffc0ea00 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); ffc0e9b0: 38 81 00 08 addi r4,r1,8 ffc0e9b4: 48 00 2c ad bl ffc11660 <_Thread_Get> switch ( location ) { ffc0e9b8: 80 01 00 08 lwz r0,8(r1) ffc0e9bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e9c0: 40 9e 00 64 bne- cr7,ffc0ea24 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; ffc0e9c4: 80 03 00 14 lwz r0,20(r3) ffc0e9c8: 90 1e 00 00 stw r0,0(r30) if ( new_priority != RTEMS_CURRENT_PRIORITY ) { ffc0e9cc: 41 92 00 2c beq- cr4,ffc0e9f8 the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || ffc0e9d0: 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; ffc0e9d4: 93 e3 00 18 stw r31,24(r3) if ( the_thread->resource_count == 0 || ffc0e9d8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e9dc: 41 9e 00 10 beq- cr7,ffc0e9ec ffc0e9e0: 80 03 00 14 lwz r0,20(r3) ffc0e9e4: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0e9e8: 40 9c 00 10 bge- cr7,ffc0e9f8 <== ALWAYS TAKEN the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); ffc0e9ec: 7f e4 fb 78 mr r4,r31 ffc0e9f0: 38 a0 00 00 li r5,0 ffc0e9f4: 48 00 25 7d bl ffc10f70 <_Thread_Change_priority> } _Thread_Enable_dispatch(); ffc0e9f8: 48 00 2c 49 bl ffc11640 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0e9fc: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0ea00: 7c 03 03 78 mr r3,r0 ffc0ea04: 80 01 00 2c lwz r0,44(r1) ffc0ea08: 81 81 00 1c lwz r12,28(r1) ffc0ea0c: 7c 08 03 a6 mtlr r0 ffc0ea10: 83 c1 00 20 lwz r30,32(r1) ffc0ea14: 83 e1 00 24 lwz r31,36(r1) ffc0ea18: 7d 80 81 20 mtcrf 8,r12 ffc0ea1c: 38 21 00 28 addi r1,r1,40 ffc0ea20: 4e 80 00 20 blr case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0ea24: 38 00 00 04 li r0,4 } ffc0ea28: 81 81 00 1c lwz r12,28(r1) ffc0ea2c: 7c 03 03 78 mr r3,r0 ffc0ea30: 80 01 00 2c lwz r0,44(r1) ffc0ea34: 83 c1 00 20 lwz r30,32(r1) ffc0ea38: 7d 80 81 20 mtcrf 8,r12 ffc0ea3c: 7c 08 03 a6 mtlr r0 ffc0ea40: 83 e1 00 24 lwz r31,36(r1) ffc0ea44: 38 21 00 28 addi r1,r1,40 ffc0ea48: 4e 80 00 20 blr =============================================================================== ffc0a650 : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { ffc0a650: 94 21 ff e0 stwu r1,-32(r1) ffc0a654: 7c 08 02 a6 mflr r0 ffc0a658: 93 e1 00 1c stw r31,28(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) ffc0a65c: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { ffc0a660: 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; ffc0a664: 38 00 00 09 li r0,9 { Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) ffc0a668: 41 82 00 58 beq- ffc0a6c0 return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); ffc0a66c: 38 81 00 08 addi r4,r1,8 ffc0a670: 48 00 2a 45 bl ffc0d0b4 <_Thread_Get> switch (location) { ffc0a674: 80 01 00 08 lwz r0,8(r1) ffc0a678: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a67c: 40 9e 00 5c bne- cr7,ffc0a6d8 case OBJECTS_LOCAL: tvp = the_thread->task_variables; ffc0a680: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc0a684: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a688: 41 9e 00 30 beq- cr7,ffc0a6b8 if (tvp->ptr == ptr) { ffc0a68c: 80 09 00 04 lwz r0,4(r9) ffc0a690: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a694: 40 be 00 18 bne+ cr7,ffc0a6ac ffc0a698: 48 00 00 88 b ffc0a720 ffc0a69c: 80 04 00 04 lwz r0,4(r4) ffc0a6a0: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a6a4: 41 9e 00 50 beq- cr7,ffc0a6f4 ffc0a6a8: 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; ffc0a6ac: 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) { ffc0a6b0: 2f 84 00 00 cmpwi cr7,r4,0 ffc0a6b4: 40 9e ff e8 bne+ cr7,ffc0a69c <== ALWAYS TAKEN return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); ffc0a6b8: 48 00 29 dd bl ffc0d094 <_Thread_Enable_dispatch> return RTEMS_INVALID_ADDRESS; ffc0a6bc: 38 00 00 09 li r0,9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a6c0: 7c 03 03 78 mr r3,r0 ffc0a6c4: 80 01 00 24 lwz r0,36(r1) ffc0a6c8: 83 e1 00 1c lwz r31,28(r1) ffc0a6cc: 38 21 00 20 addi r1,r1,32 ffc0a6d0: 7c 08 03 a6 mtlr r0 ffc0a6d4: 4e 80 00 20 blr case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a6d8: 38 00 00 04 li r0,4 } ffc0a6dc: 83 e1 00 1c lwz r31,28(r1) ffc0a6e0: 7c 03 03 78 mr r3,r0 ffc0a6e4: 80 01 00 24 lwz r0,36(r1) ffc0a6e8: 38 21 00 20 addi r1,r1,32 ffc0a6ec: 7c 08 03 a6 mtlr r0 ffc0a6f0: 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; ffc0a6f4: 80 04 00 00 lwz r0,0(r4) ffc0a6f8: 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 ); ffc0a6fc: 48 00 01 0d bl ffc0a808 <_RTEMS_Tasks_Invoke_task_variable_dtor> _Thread_Enable_dispatch(); ffc0a700: 48 00 29 95 bl ffc0d094 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a704: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a708: 7c 03 03 78 mr r3,r0 ffc0a70c: 80 01 00 24 lwz r0,36(r1) ffc0a710: 83 e1 00 1c lwz r31,28(r1) ffc0a714: 38 21 00 20 addi r1,r1,32 ffc0a718: 7c 08 03 a6 mtlr r0 ffc0a71c: 4e 80 00 20 blr while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; ffc0a720: 80 09 00 00 lwz r0,0(r9) ffc0a724: 7d 24 4b 78 mr r4,r9 ffc0a728: 90 03 01 3c stw r0,316(r3) ffc0a72c: 4b ff ff d0 b ffc0a6fc =============================================================================== ffc0a730 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { ffc0a730: 94 21 ff e0 stwu r1,-32(r1) ffc0a734: 7c 08 02 a6 mflr r0 ffc0a738: 93 e1 00 1c stw r31,28(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) ffc0a73c: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { ffc0a740: 90 01 00 24 stw r0,36(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) return RTEMS_INVALID_ADDRESS; ffc0a744: 38 00 00 09 li r0,9 rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { ffc0a748: 93 c1 00 18 stw r30,24(r1) ffc0a74c: 7c be 2b 78 mr r30,r5 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) ffc0a750: 41 82 00 58 beq- ffc0a7a8 return RTEMS_INVALID_ADDRESS; if ( !result ) ffc0a754: 2f 85 00 00 cmpwi cr7,r5,0 ffc0a758: 41 9e 00 50 beq- cr7,ffc0a7a8 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); ffc0a75c: 38 81 00 08 addi r4,r1,8 ffc0a760: 48 00 29 55 bl ffc0d0b4 <_Thread_Get> switch (location) { ffc0a764: 80 01 00 08 lwz r0,8(r1) ffc0a768: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a76c: 40 9e 00 58 bne- cr7,ffc0a7c4 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; ffc0a770: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc0a774: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a778: 40 be 00 14 bne+ cr7,ffc0a78c ffc0a77c: 48 00 00 68 b ffc0a7e4 */ *result = tvp->tval; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; ffc0a780: 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) { ffc0a784: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a788: 41 9e 00 5c beq- cr7,ffc0a7e4 <== NEVER TAKEN if (tvp->ptr == ptr) { ffc0a78c: 80 09 00 04 lwz r0,4(r9) ffc0a790: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a794: 40 9e ff ec bne+ cr7,ffc0a780 /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; ffc0a798: 80 09 00 0c lwz r0,12(r9) ffc0a79c: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc0a7a0: 48 00 28 f5 bl ffc0d094 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a7a4: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a7a8: 7c 03 03 78 mr r3,r0 ffc0a7ac: 80 01 00 24 lwz r0,36(r1) ffc0a7b0: 83 c1 00 18 lwz r30,24(r1) ffc0a7b4: 7c 08 03 a6 mtlr r0 ffc0a7b8: 83 e1 00 1c lwz r31,28(r1) ffc0a7bc: 38 21 00 20 addi r1,r1,32 ffc0a7c0: 4e 80 00 20 blr #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a7c4: 38 00 00 04 li r0,4 } ffc0a7c8: 83 c1 00 18 lwz r30,24(r1) ffc0a7cc: 7c 03 03 78 mr r3,r0 ffc0a7d0: 80 01 00 24 lwz r0,36(r1) ffc0a7d4: 83 e1 00 1c lwz r31,28(r1) ffc0a7d8: 38 21 00 20 addi r1,r1,32 ffc0a7dc: 7c 08 03 a6 mtlr r0 ffc0a7e0: 4e 80 00 20 blr _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); ffc0a7e4: 48 00 28 b1 bl ffc0d094 <_Thread_Enable_dispatch> return RTEMS_INVALID_ADDRESS; ffc0a7e8: 38 00 00 09 li r0,9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a7ec: 7c 03 03 78 mr r3,r0 ffc0a7f0: 80 01 00 24 lwz r0,36(r1) ffc0a7f4: 83 c1 00 18 lwz r30,24(r1) ffc0a7f8: 7c 08 03 a6 mtlr r0 ffc0a7fc: 83 e1 00 1c lwz r31,28(r1) ffc0a800: 38 21 00 20 addi r1,r1,32 ffc0a804: 4e 80 00 20 blr =============================================================================== ffc1afb0 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { ffc1afb0: 94 21 ff e8 stwu r1,-24(r1) ffc1afb4: 7c 08 02 a6 mflr r0 ffc1afb8: 7c 64 1b 78 mr r4,r3 Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); ffc1afbc: 3c 60 00 00 lis r3,0 ffc1afc0: 90 01 00 1c stw r0,28(r1) ffc1afc4: 38 63 79 5c addi r3,r3,31068 ffc1afc8: 38 a1 00 08 addi r5,r1,8 ffc1afcc: 48 00 3c 2d bl ffc1ebf8 <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { ffc1afd0: 80 01 00 08 lwz r0,8(r1) ffc1afd4: 2f 80 00 00 cmpwi cr7,r0,0 ffc1afd8: 41 9e 00 18 beq- cr7,ffc1aff0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1afdc: 80 01 00 1c lwz r0,28(r1) #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1afe0: 38 60 00 04 li r3,4 } ffc1afe4: 38 21 00 18 addi r1,r1,24 ffc1afe8: 7c 08 03 a6 mtlr r0 ffc1afec: 4e 80 00 20 blr the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) ffc1aff0: 80 03 00 38 lwz r0,56(r3) ffc1aff4: 2f 80 00 04 cmpwi cr7,r0,4 ffc1aff8: 41 9e 00 0c beq- cr7,ffc1b004 <== NEVER TAKEN (void) _Watchdog_Remove( &the_timer->Ticker ); ffc1affc: 38 63 00 10 addi r3,r3,16 ffc1b000: 48 00 66 29 bl ffc21628 <_Watchdog_Remove> _Thread_Enable_dispatch(); ffc1b004: 48 00 4b 0d bl ffc1fb10 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1b008: 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; ffc1b00c: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1b010: 7c 08 03 a6 mtlr r0 ffc1b014: 38 21 00 18 addi r1,r1,24 ffc1b018: 4e 80 00 20 blr =============================================================================== ffc1b67c : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc1b67c: 94 21 ff c8 stwu r1,-56(r1) Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; ffc1b680: 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 ) { ffc1b684: 7c 08 02 a6 mflr r0 ffc1b688: 93 e1 00 34 stw r31,52(r1) Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; ffc1b68c: 83 e9 28 fc lwz r31,10492(r9) rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc1b690: 93 21 00 1c stw r25,28(r1) Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; ffc1b694: 3b 20 00 0e li r25,14 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) ffc1b698: 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 ) { ffc1b69c: 93 61 00 24 stw r27,36(r1) ffc1b6a0: 7c db 33 78 mr r27,r6 ffc1b6a4: 93 81 00 28 stw r28,40(r1) ffc1b6a8: 7c 9c 23 78 mr r28,r4 ffc1b6ac: 93 a1 00 2c stw r29,44(r1) ffc1b6b0: 7c 7d 1b 78 mr r29,r3 ffc1b6b4: 93 c1 00 30 stw r30,48(r1) ffc1b6b8: 7c be 2b 78 mr r30,r5 ffc1b6bc: 90 01 00 3c stw r0,60(r1) ffc1b6c0: 93 01 00 18 stw r24,24(r1) ffc1b6c4: 93 41 00 20 stw r26,32(r1) Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) ffc1b6c8: 41 9e 00 38 beq- cr7,ffc1b700 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) ffc1b6cc: 3d 20 00 00 lis r9,0 ffc1b6d0: 88 09 28 a4 lbz r0,10404(r9) return RTEMS_NOT_DEFINED; ffc1b6d4: 3b 20 00 0b li r25,11 Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) ffc1b6d8: 2f 80 00 00 cmpwi cr7,r0,0 ffc1b6dc: 41 9e 00 24 beq- cr7,ffc1b700 <== NEVER TAKEN return RTEMS_NOT_DEFINED; if ( !routine ) ffc1b6e0: 2f 85 00 00 cmpwi cr7,r5,0 return RTEMS_INVALID_ADDRESS; ffc1b6e4: 3b 20 00 09 li r25,9 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) ffc1b6e8: 41 9e 00 18 beq- cr7,ffc1b700 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) ffc1b6ec: 7c 83 23 78 mr r3,r4 ffc1b6f0: 4b ff bf 59 bl ffc17648 <_TOD_Validate> return RTEMS_INVALID_CLOCK; ffc1b6f4: 3b 20 00 14 li r25,20 return RTEMS_NOT_DEFINED; if ( !routine ) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) ffc1b6f8: 2f 83 00 00 cmpwi cr7,r3,0 ffc1b6fc: 40 9e 00 38 bne- cr7,ffc1b734 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1b700: 80 01 00 3c lwz r0,60(r1) ffc1b704: 7f 23 cb 78 mr r3,r25 ffc1b708: 83 01 00 18 lwz r24,24(r1) ffc1b70c: 7c 08 03 a6 mtlr r0 ffc1b710: 83 21 00 1c lwz r25,28(r1) ffc1b714: 83 41 00 20 lwz r26,32(r1) ffc1b718: 83 61 00 24 lwz r27,36(r1) ffc1b71c: 83 81 00 28 lwz r28,40(r1) ffc1b720: 83 a1 00 2c lwz r29,44(r1) ffc1b724: 83 c1 00 30 lwz r30,48(r1) ffc1b728: 83 e1 00 34 lwz r31,52(r1) ffc1b72c: 38 21 00 38 addi r1,r1,56 ffc1b730: 4e 80 00 20 blr return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc1b734: 7f 83 e3 78 mr r3,r28 if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1b738: 3f 40 00 00 lis r26,0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc1b73c: 4b ff be 69 bl ffc175a4 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1b740: 80 1a 28 b8 lwz r0,10424(r26) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc1b744: 7c 7c 1b 78 mr r28,r3 if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1b748: 7f 83 00 40 cmplw cr7,r3,r0 ffc1b74c: 40 bd ff b4 ble- cr7,ffc1b700 ffc1b750: 3c 60 00 00 lis r3,0 ffc1b754: 38 63 79 5c addi r3,r3,31068 ffc1b758: 7f a4 eb 78 mr r4,r29 ffc1b75c: 38 a1 00 08 addi r5,r1,8 ffc1b760: 48 00 34 99 bl ffc1ebf8 <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { ffc1b764: 83 01 00 08 lwz r24,8(r1) ffc1b768: 7c 79 1b 78 mr r25,r3 ffc1b76c: 2f 98 00 00 cmpwi cr7,r24,0 ffc1b770: 40 9e 00 50 bne- cr7,ffc1b7c0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); ffc1b774: 38 63 00 10 addi r3,r3,16 ffc1b778: 48 00 5e b1 bl ffc21628 <_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(); ffc1b77c: 80 1a 28 b8 lwz r0,10424(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; ffc1b780: 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(); ffc1b784: 7f 80 e0 50 subf r28,r0,r28 (*timer_server->schedule_operation)( timer_server, the_timer ); ffc1b788: 80 1f 00 04 lwz r0,4(r31) ffc1b78c: 7f 24 cb 78 mr r4,r25 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; ffc1b790: 91 39 00 38 stw r9,56(r25) _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); (*timer_server->schedule_operation)( timer_server, the_timer ); ffc1b794: 7f e3 fb 78 mr r3,r31 ffc1b798: 7c 09 03 a6 mtctr r0 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc1b79c: 93 19 00 18 stw r24,24(r25) the_watchdog->routine = routine; ffc1b7a0: 93 d9 00 2c stw r30,44(r25) the_watchdog->id = id; ffc1b7a4: 93 b9 00 30 stw r29,48(r25) the_watchdog->user_data = user_data; ffc1b7a8: 93 79 00 34 stw r27,52(r25) case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); ffc1b7ac: 93 99 00 1c stw r28,28(r25) (*timer_server->schedule_operation)( timer_server, the_timer ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; ffc1b7b0: 3b 20 00 00 li r25,0 (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); (*timer_server->schedule_operation)( timer_server, the_timer ); ffc1b7b4: 4e 80 04 21 bctrl _Thread_Enable_dispatch(); ffc1b7b8: 48 00 43 59 bl ffc1fb10 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc1b7bc: 4b ff ff 44 b ffc1b700 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1b7c0: 3b 20 00 04 li r25,4 ffc1b7c4: 4b ff ff 3c b ffc1b700 =============================================================================== ffc0989c : int sched_get_priority_max( int policy ) { switch ( policy ) { ffc0989c: 2b 83 00 04 cmplwi cr7,r3,4 #include int sched_get_priority_max( int policy ) { ffc098a0: 94 21 ff f8 stwu r1,-8(r1) ffc098a4: 7c 08 02 a6 mflr r0 ffc098a8: 90 01 00 0c stw r0,12(r1) switch ( policy ) { ffc098ac: 40 9d 00 24 ble- cr7,ffc098d0 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc098b0: 48 00 ae 21 bl ffc146d0 <__errno> ffc098b4: 38 00 00 16 li r0,22 ffc098b8: 90 03 00 00 stw r0,0(r3) ffc098bc: 38 60 ff ff li r3,-1 } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; } ffc098c0: 80 01 00 0c lwz r0,12(r1) ffc098c4: 38 21 00 08 addi r1,r1,8 ffc098c8: 7c 08 03 a6 mtlr r0 ffc098cc: 4e 80 00 20 blr int sched_get_priority_max( int policy ) { switch ( policy ) { ffc098d0: 38 00 00 01 li r0,1 ffc098d4: 7c 03 18 30 slw r3,r0,r3 ffc098d8: 70 60 00 17 andi. r0,r3,23 ffc098dc: 41 a2 ff d4 beq- ffc098b0 <== NEVER TAKEN default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; } ffc098e0: 80 01 00 0c lwz r0,12(r1) default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; ffc098e4: 3d 20 00 00 lis r9,0 ffc098e8: 88 69 27 14 lbz r3,10004(r9) } ffc098ec: 38 21 00 08 addi r1,r1,8 ffc098f0: 7c 08 03 a6 mtlr r0 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; ffc098f4: 38 63 ff ff addi r3,r3,-1 } ffc098f8: 4e 80 00 20 blr =============================================================================== ffc098fc : int sched_get_priority_min( int policy ) { switch ( policy ) { ffc098fc: 2b 83 00 04 cmplwi cr7,r3,4 #include int sched_get_priority_min( int policy ) { ffc09900: 94 21 ff f8 stwu r1,-8(r1) ffc09904: 7c 08 02 a6 mflr r0 ffc09908: 90 01 00 0c stw r0,12(r1) switch ( policy ) { ffc0990c: 40 9d 00 24 ble- cr7,ffc09930 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc09910: 48 00 ad c1 bl ffc146d0 <__errno> ffc09914: 38 00 00 16 li r0,22 ffc09918: 90 03 00 00 stw r0,0(r3) ffc0991c: 38 60 ff ff li r3,-1 } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } ffc09920: 80 01 00 0c lwz r0,12(r1) ffc09924: 38 21 00 08 addi r1,r1,8 ffc09928: 7c 08 03 a6 mtlr r0 ffc0992c: 4e 80 00 20 blr int sched_get_priority_min( int policy ) { switch ( policy ) { ffc09930: 38 00 00 01 li r0,1 ffc09934: 7c 03 18 30 slw r3,r0,r3 ffc09938: 70 60 00 17 andi. r0,r3,23 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; ffc0993c: 38 60 00 01 li r3,1 int sched_get_priority_min( int policy ) { switch ( policy ) { ffc09940: 41 a2 ff d0 beq- ffc09910 <== NEVER TAKEN default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } ffc09944: 80 01 00 0c lwz r0,12(r1) ffc09948: 38 21 00 08 addi r1,r1,8 ffc0994c: 7c 08 03 a6 mtlr r0 ffc09950: 4e 80 00 20 blr =============================================================================== ffc09954 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { ffc09954: 94 21 ff e8 stwu r1,-24(r1) ffc09958: 7c 08 02 a6 mflr r0 ffc0995c: 93 e1 00 14 stw r31,20(r1) /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc09960: 7c 7f 1b 79 mr. r31,r3 int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { ffc09964: 90 01 00 1c stw r0,28(r1) /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc09968: 40 82 00 30 bne- ffc09998 <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( ESRCH ); if ( !interval ) ffc0996c: 2f 84 00 00 cmpwi cr7,r4,0 ffc09970: 41 9e 00 50 beq- cr7,ffc099c0 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); ffc09974: 3d 20 00 00 lis r9,0 ffc09978: 80 69 27 ec lwz r3,10220(r9) ffc0997c: 48 00 49 c5 bl ffc0e340 <_Timespec_From_ticks> return 0; ffc09980: 38 60 00 00 li r3,0 } ffc09984: 80 01 00 1c lwz r0,28(r1) ffc09988: 83 e1 00 14 lwz r31,20(r1) ffc0998c: 38 21 00 18 addi r1,r1,24 ffc09990: 7c 08 03 a6 mtlr r0 ffc09994: 4e 80 00 20 blr { /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc09998: 90 81 00 08 stw r4,8(r1) ffc0999c: 4b ff bb a1 bl ffc0553c ffc099a0: 7f 83 f8 00 cmpw cr7,r3,r31 ffc099a4: 80 81 00 08 lwz r4,8(r1) ffc099a8: 41 9e ff c4 beq+ cr7,ffc0996c rtems_set_errno_and_return_minus_one( ESRCH ); ffc099ac: 48 00 ad 25 bl ffc146d0 <__errno> ffc099b0: 38 00 00 03 li r0,3 ffc099b4: 90 03 00 00 stw r0,0(r3) ffc099b8: 38 60 ff ff li r3,-1 ffc099bc: 4b ff ff c8 b ffc09984 if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc099c0: 48 00 ad 11 bl ffc146d0 <__errno> ffc099c4: 38 00 00 16 li r0,22 ffc099c8: 90 03 00 00 stw r0,0(r3) ffc099cc: 38 60 ff ff li r3,-1 ffc099d0: 4b ff ff b4 b ffc09984 =============================================================================== ffc0c1b0 : rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0c1b0: 3d 20 00 00 lis r9,0 int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { ffc0c1b4: 94 21 ff b8 stwu r1,-72(r1) ffc0c1b8: 7c 08 02 a6 mflr r0 ffc0c1bc: 81 69 27 e8 lwz r11,10216(r9) ffc0c1c0: 7d 80 00 26 mfcr r12 ffc0c1c4: 93 c1 00 40 stw r30,64(r1) ffc0c1c8: 7c 9e 23 78 mr r30,r4 ffc0c1cc: 39 6b 00 01 addi r11,r11,1 ffc0c1d0: 93 e1 00 44 stw r31,68(r1) ffc0c1d4: 7c 7f 1b 78 mr r31,r3 ffc0c1d8: 90 01 00 4c stw r0,76(r1) ffc0c1dc: 93 81 00 38 stw r28,56(r1) ffc0c1e0: 93 a1 00 3c stw r29,60(r1) ffc0c1e4: 91 81 00 34 stw r12,52(r1) ffc0c1e8: 90 a1 00 28 stw r5,40(r1) ffc0c1ec: 90 c1 00 2c stw r6,44(r1) ffc0c1f0: 91 69 27 e8 stw r11,10216(r9) POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0c1f4: 54 80 bf fe rlwinm r0,r4,23,31,31 ffc0c1f8: 2e 00 00 00 cmpwi cr4,r0,0 ffc0c1fc: 40 92 00 c8 bne- cr4,ffc0c2c4 /* unsigned int value */ ) { va_list arg; mode_t mode; unsigned int value = 0; ffc0c200: 3b a0 00 00 li r29,0 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 ); ffc0c204: 7f e3 fb 78 mr r3,r31 ffc0c208: 38 81 00 08 addi r4,r1,8 ffc0c20c: 48 00 83 41 bl ffc1454c <_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 ) { ffc0c210: 7c 7c 1b 79 mr. r28,r3 ffc0c214: 41 82 00 48 beq- ffc0c25c /* * 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) ) ) { ffc0c218: 2f 9c 00 02 cmpwi cr7,r28,2 ffc0c21c: 40 9e 00 08 bne- cr7,ffc0c224 <== NEVER TAKEN ffc0c220: 40 92 00 c4 bne- cr4,ffc0c2e4 _Thread_Enable_dispatch(); ffc0c224: 48 00 3b 75 bl ffc0fd98 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); ffc0c228: 48 00 bf bd bl ffc181e4 <__errno> id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c22c: 80 01 00 4c lwz r0,76(r1) ffc0c230: 81 81 00 34 lwz r12,52(r1) ffc0c234: 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 * ); ffc0c238: 93 83 00 00 stw r28,0(r3) id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c23c: 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 * ); ffc0c240: 38 60 ff ff li r3,-1 id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c244: 83 81 00 38 lwz r28,56(r1) ffc0c248: 83 a1 00 3c lwz r29,60(r1) ffc0c24c: 83 c1 00 40 lwz r30,64(r1) ffc0c250: 83 e1 00 44 lwz r31,68(r1) ffc0c254: 38 21 00 48 addi r1,r1,72 ffc0c258: 4e 80 00 20 blr /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { ffc0c25c: 73 de 0a 00 andi. r30,r30,2560 ffc0c260: 2f 9e 0a 00 cmpwi cr7,r30,2560 ffc0c264: 41 9e 00 ac beq- cr7,ffc0c310 ffc0c268: 80 81 00 08 lwz r4,8(r1) ffc0c26c: 3c 60 00 00 lis r3,0 ffc0c270: 38 a1 00 10 addi r5,r1,16 ffc0c274: 38 63 30 ac addi r3,r3,12460 ffc0c278: 48 00 2b 49 bl ffc0edc0 <_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; ffc0c27c: 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 ); ffc0c280: 90 61 00 0c stw r3,12(r1) the_semaphore->open_count += 1; ffc0c284: 38 09 00 01 addi r0,r9,1 ffc0c288: 90 03 00 18 stw r0,24(r3) _Thread_Enable_dispatch(); ffc0c28c: 48 00 3b 0d bl ffc0fd98 <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); ffc0c290: 48 00 3b 09 bl ffc0fd98 <_Thread_Enable_dispatch> return_id: #if defined(RTEMS_USE_16_BIT_OBJECT) the_semaphore->Semaphore_id = the_semaphore->Object.id; id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; ffc0c294: 80 61 00 0c lwz r3,12(r1) ffc0c298: 38 63 00 08 addi r3,r3,8 #endif return id; } ffc0c29c: 80 01 00 4c lwz r0,76(r1) ffc0c2a0: 81 81 00 34 lwz r12,52(r1) ffc0c2a4: 7c 08 03 a6 mtlr r0 ffc0c2a8: 83 81 00 38 lwz r28,56(r1) ffc0c2ac: 83 a1 00 3c lwz r29,60(r1) ffc0c2b0: 7d 80 81 20 mtcrf 8,r12 ffc0c2b4: 83 c1 00 40 lwz r30,64(r1) ffc0c2b8: 83 e1 00 44 lwz r31,68(r1) ffc0c2bc: 38 21 00 48 addi r1,r1,72 ffc0c2c0: 4e 80 00 20 blr Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0c2c4: 38 01 00 50 addi r0,r1,80 mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0c2c8: 83 a1 00 2c lwz r29,44(r1) Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0c2cc: 90 01 00 18 stw r0,24(r1) ffc0c2d0: 38 01 00 20 addi r0,r1,32 ffc0c2d4: 90 01 00 1c stw r0,28(r1) mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0c2d8: 38 00 00 04 li r0,4 ffc0c2dc: 98 01 00 14 stb r0,20(r1) ffc0c2e0: 4b ff ff 24 b ffc0c204 /* * 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( ffc0c2e4: 38 80 00 00 li r4,0 ffc0c2e8: 7f a5 eb 78 mr r5,r29 ffc0c2ec: 38 c1 00 0c addi r6,r1,12 ffc0c2f0: 7f e3 fb 78 mr r3,r31 ffc0c2f4: 48 00 80 71 bl ffc14364 <_POSIX_Semaphore_Create_support> ffc0c2f8: 7c 7f 1b 78 mr r31,r3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); ffc0c2fc: 48 00 3a 9d bl ffc0fd98 <_Thread_Enable_dispatch> if ( status == -1 ) ffc0c300: 2f 9f ff ff cmpwi cr7,r31,-1 return SEM_FAILED; ffc0c304: 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 ) ffc0c308: 40 9e ff 8c bne+ cr7,ffc0c294 ffc0c30c: 4b ff ff 90 b ffc0c29c /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _Thread_Enable_dispatch(); ffc0c310: 48 00 3a 89 bl ffc0fd98 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); ffc0c314: 48 00 be d1 bl ffc181e4 <__errno> ffc0c318: 38 00 00 11 li r0,17 ffc0c31c: 90 03 00 00 stw r0,0(r3) ffc0c320: 38 60 ff ff li r3,-1 ffc0c324: 4b ff ff 78 b ffc0c29c =============================================================================== ffc0c39c : int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { ffc0c39c: 94 21 ff e0 stwu r1,-32(r1) ffc0c3a0: 7c 08 02 a6 mflr r0 ffc0c3a4: 93 e1 00 1c stw r31,28(r1) ffc0c3a8: 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 ); ffc0c3ac: 7c 83 23 78 mr r3,r4 ffc0c3b0: 38 81 00 08 addi r4,r1,8 int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { ffc0c3b4: 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 ); ffc0c3b8: 48 00 72 dd bl ffc13694 <_POSIX_Absolute_timeout_to_ticks> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0c3bc: 2f 83 00 03 cmpwi cr7,r3,3 ffc0c3c0: 41 9e 00 28 beq- cr7,ffc0c3e8 <== ALWAYS TAKEN do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); ffc0c3c4: 80 a1 00 08 lwz r5,8(r1) <== NOT EXECUTED ffc0c3c8: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc0c3cc: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc0c3d0: 48 00 82 41 bl ffc14610 <_POSIX_Semaphore_Wait_support><== NOT EXECUTED lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } ffc0c3d4: 80 01 00 24 lwz r0,36(r1) <== NOT EXECUTED ffc0c3d8: 83 e1 00 1c lwz r31,28(r1) <== NOT EXECUTED ffc0c3dc: 38 21 00 20 addi r1,r1,32 <== NOT EXECUTED ffc0c3e0: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0c3e4: 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 ); ffc0c3e8: 80 a1 00 08 lwz r5,8(r1) ffc0c3ec: 7f e3 fb 78 mr r3,r31 ffc0c3f0: 38 80 00 01 li r4,1 ffc0c3f4: 48 00 82 1d bl ffc14610 <_POSIX_Semaphore_Wait_support> lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } ffc0c3f8: 80 01 00 24 lwz r0,36(r1) ffc0c3fc: 83 e1 00 1c lwz r31,28(r1) ffc0c400: 38 21 00 20 addi r1,r1,32 ffc0c404: 7c 08 03 a6 mtlr r0 ffc0c408: 4e 80 00 20 blr =============================================================================== ffc097a0 : struct sigaction *oact ) { ISR_Level level; if ( oact ) ffc097a0: 2c 05 00 00 cmpwi r5,0 int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { ffc097a4: 94 21 ff e8 stwu r1,-24(r1) ffc097a8: 7c 08 02 a6 mflr r0 ffc097ac: 93 c1 00 10 stw r30,16(r1) ffc097b0: 7c 9e 23 78 mr r30,r4 ffc097b4: 93 e1 00 14 stw r31,20(r1) ffc097b8: 7c 7f 1b 78 mr r31,r3 ffc097bc: 90 01 00 1c stw r0,28(r1) ffc097c0: 93 a1 00 0c stw r29,12(r1) ISR_Level level; if ( oact ) ffc097c4: 41 82 00 2c beq- ffc097f0 *oact = _POSIX_signals_Vectors[ sig ]; ffc097c8: 1c 03 00 0c mulli r0,r3,12 ffc097cc: 3d 60 00 00 lis r11,0 ffc097d0: 39 6b 31 c0 addi r11,r11,12736 ffc097d4: 7d 2b 02 14 add r9,r11,r0 ffc097d8: 7d 4b 00 2e lwzx r10,r11,r0 ffc097dc: 81 69 00 04 lwz r11,4(r9) ffc097e0: 80 09 00 08 lwz r0,8(r9) ffc097e4: 91 45 00 00 stw r10,0(r5) ffc097e8: 91 65 00 04 stw r11,4(r5) ffc097ec: 90 05 00 08 stw r0,8(r5) if ( !sig ) ffc097f0: 2f 9f 00 00 cmpwi cr7,r31,0 ffc097f4: 41 9e 00 cc beq- cr7,ffc098c0 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc097f8: 38 1f ff ff addi r0,r31,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc097fc: 2b 80 00 1f cmplwi cr7,r0,31 ffc09800: 41 9d 00 c0 bgt- cr7,ffc098c0 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) ffc09804: 2f 9f 00 09 cmpwi cr7,r31,9 ffc09808: 41 9e 00 b8 beq- cr7,ffc098c0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { ffc0980c: 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; ffc09810: 38 60 00 00 li r3,0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { ffc09814: 41 9e 00 58 beq- cr7,ffc0986c <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc09818: 7f a0 00 a6 mfmsr r29 ffc0981c: 7c 10 42 a6 mfsprg r0,0 ffc09820: 7f a0 00 78 andc r0,r29,r0 ffc09824: 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 ) { ffc09828: 80 1e 00 08 lwz r0,8(r30) ffc0982c: 2f 80 00 00 cmpwi cr7,r0,0 ffc09830: 41 9e 00 58 beq- cr7,ffc09888 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); ffc09834: 7f e3 fb 78 mr r3,r31 ffc09838: 48 00 77 2d bl ffc10f64 <_POSIX_signals_Clear_process_signals> _POSIX_signals_Vectors[ sig ] = *act; ffc0983c: 1f ff 00 0c mulli r31,r31,12 ffc09840: 81 1e 00 00 lwz r8,0(r30) ffc09844: 3d 60 00 00 lis r11,0 ffc09848: 81 5e 00 04 lwz r10,4(r30) ffc0984c: 80 1e 00 08 lwz r0,8(r30) ffc09850: 39 6b 31 c0 addi r11,r11,12736 ffc09854: 7d 2b fa 14 add r9,r11,r31 ffc09858: 7d 0b f9 2e stwx r8,r11,r31 ffc0985c: 91 49 00 04 stw r10,4(r9) ffc09860: 90 09 00 08 stw r0,8(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc09864: 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; ffc09868: 38 60 00 00 li r3,0 } ffc0986c: 80 01 00 1c lwz r0,28(r1) ffc09870: 83 a1 00 0c lwz r29,12(r1) ffc09874: 7c 08 03 a6 mtlr r0 ffc09878: 83 c1 00 10 lwz r30,16(r1) ffc0987c: 83 e1 00 14 lwz r31,20(r1) ffc09880: 38 21 00 18 addi r1,r1,24 ffc09884: 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 ]; ffc09888: 1f ff 00 0c mulli r31,r31,12 ffc0988c: 3d 40 ff c2 lis r10,-62 ffc09890: 39 4a 3a a4 addi r10,r10,15012 ffc09894: 7d 2a fa 14 add r9,r10,r31 ffc09898: 7d 0a f8 2e lwzx r8,r10,r31 ffc0989c: 3d 60 00 00 lis r11,0 ffc098a0: 81 49 00 04 lwz r10,4(r9) ffc098a4: 39 6b 31 c0 addi r11,r11,12736 ffc098a8: 80 09 00 08 lwz r0,8(r9) ffc098ac: 7d 2b fa 14 add r9,r11,r31 ffc098b0: 7d 0b f9 2e stwx r8,r11,r31 ffc098b4: 91 49 00 04 stw r10,4(r9) ffc098b8: 90 09 00 08 stw r0,8(r9) ffc098bc: 4b ff ff a8 b ffc09864 * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc098c0: 48 00 b3 7d bl ffc14c3c <__errno> ffc098c4: 38 00 00 16 li r0,22 ffc098c8: 90 03 00 00 stw r0,0(r3) ffc098cc: 38 60 ff ff li r3,-1 ffc098d0: 4b ff ff 9c b ffc0986c =============================================================================== ffc09d54 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { ffc09d54: 94 21 ff d0 stwu r1,-48(r1) ffc09d58: 7c 08 02 a6 mflr r0 ffc09d5c: 93 a1 00 24 stw r29,36(r1) ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) ffc09d60: 7c 7d 1b 79 mr. r29,r3 int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { ffc09d64: 93 c1 00 28 stw r30,40(r1) ffc09d68: 7c be 2b 78 mr r30,r5 ffc09d6c: 93 e1 00 2c stw r31,44(r1) ffc09d70: 7c 9f 23 78 mr r31,r4 ffc09d74: 90 01 00 34 stw r0,52(r1) ffc09d78: 93 41 00 18 stw r26,24(r1) ffc09d7c: 93 61 00 1c stw r27,28(r1) ffc09d80: 93 81 00 20 stw r28,32(r1) ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) ffc09d84: 41 82 02 48 beq- ffc09fcc /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { ffc09d88: 2f 85 00 00 cmpwi cr7,r5,0 ffc09d8c: 41 9e 01 9c beq- cr7,ffc09f28 if ( !_Timespec_Is_valid( timeout ) ) ffc09d90: 7c a3 2b 78 mr r3,r5 ffc09d94: 48 00 4a 95 bl ffc0e828 <_Timespec_Is_valid> ffc09d98: 2f 83 00 00 cmpwi cr7,r3,0 ffc09d9c: 41 9e 02 30 beq- cr7,ffc09fcc rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); ffc09da0: 7f c3 f3 78 mr r3,r30 ffc09da4: 48 00 4b 15 bl ffc0e8b8 <_Timespec_To_ticks> if ( !interval ) ffc09da8: 7c 64 1b 79 mr. r4,r3 ffc09dac: 41 82 02 20 beq- ffc09fcc <== NEVER TAKEN /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09db0: 2f 9f 00 00 cmpwi cr7,r31,0 ffc09db4: 41 9e 01 80 beq- cr7,ffc09f34 <== NEVER TAKEN the_thread = _Thread_Executing; ffc09db8: 3f 80 00 00 lis r28,0 ffc09dbc: 3b 9c 31 64 addi r28,r28,12644 ffc09dc0: 81 3c 00 0c lwz r9,12(r28) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc09dc4: 83 49 01 34 lwz r26,308(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc09dc8: 7f 60 00 a6 mfmsr r27 ffc09dcc: 7c 10 42 a6 mfsprg r0,0 ffc09dd0: 7f 60 00 78 andc r0,r27,r0 ffc09dd4: 7c 00 01 24 mtmsr r0 */ /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { ffc09dd8: 80 1d 00 00 lwz r0,0(r29) ffc09ddc: 80 7a 00 d4 lwz r3,212(r26) ffc09de0: 7c 0b 18 39 and. r11,r0,r3 ffc09de4: 40 82 01 84 bne- ffc09f68 return the_info->si_signo; } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { ffc09de8: 3d 60 00 00 lis r11,0 ffc09dec: 80 6b 28 84 lwz r3,10372(r11) ffc09df0: 7c 0b 18 39 and. r11,r0,r3 ffc09df4: 40 82 00 d0 bne- ffc09ec4 ffc09df8: 3d 60 00 00 lis r11,0 ffc09dfc: 81 4b 28 38 lwz r10,10296(r11) ffc09e00: 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; ffc09e04: 39 40 ff ff li r10,-1 ffc09e08: 91 5f 00 00 stw r10,0(r31) ffc09e0c: 90 0b 28 38 stw r0,10296(r11) _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; ffc09e10: 38 00 00 04 li r0,4 ffc09e14: 90 09 00 34 stw r0,52(r9) } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; ffc09e18: 3d 60 00 00 lis r11,0 ffc09e1c: 39 6b 33 4c addi r11,r11,13132 the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; ffc09e20: 80 1d 00 00 lwz r0,0(r29) the_thread->Wait.return_argument = the_info; ffc09e24: 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; ffc09e28: 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; ffc09e2c: 38 00 00 01 li r0,1 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; ffc09e30: 91 69 00 44 stw r11,68(r9) ffc09e34: 90 0b 00 30 stw r0,48(r11) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc09e38: 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 ); ffc09e3c: 3c a0 ff c1 lis r5,-63 ffc09e40: 3c 60 00 00 lis r3,0 ffc09e44: 38 a5 e3 04 addi r5,r5,-7420 ffc09e48: 38 63 33 4c addi r3,r3,13132 ffc09e4c: 48 00 40 49 bl ffc0de94 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); ffc09e50: 48 00 39 c5 bl ffc0d814 <_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 ); ffc09e54: 80 9f 00 00 lwz r4,0(r31) ffc09e58: 7f 43 d3 78 mr r3,r26 ffc09e5c: 7f e5 fb 78 mr r5,r31 ffc09e60: 38 c0 00 00 li r6,0 ffc09e64: 38 e0 00 00 li r7,0 ffc09e68: 48 00 7a 35 bl ffc1189c <_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) ffc09e6c: 81 3c 00 0c lwz r9,12(r28) ffc09e70: 80 09 00 34 lwz r0,52(r9) ffc09e74: 2f 80 00 04 cmpwi cr7,r0,4 ffc09e78: 40 9e 01 68 bne- cr7,ffc09fe0 || !(*set & signo_to_mask( the_info->si_signo )) ) { ffc09e7c: 83 df 00 00 lwz r30,0(r31) ffc09e80: 39 60 00 01 li r11,1 ffc09e84: 80 1d 00 00 lwz r0,0(r29) ffc09e88: 39 3e ff ff addi r9,r30,-1 ffc09e8c: 7d 69 48 30 slw r9,r11,r9 ffc09e90: 7d 2b 00 39 and. r11,r9,r0 ffc09e94: 41 82 01 4c beq- ffc09fe0 errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09e98: 80 01 00 34 lwz r0,52(r1) ffc09e9c: 7f c3 f3 78 mr r3,r30 ffc09ea0: 83 41 00 18 lwz r26,24(r1) ffc09ea4: 7c 08 03 a6 mtlr r0 ffc09ea8: 83 61 00 1c lwz r27,28(r1) ffc09eac: 83 81 00 20 lwz r28,32(r1) ffc09eb0: 83 a1 00 24 lwz r29,36(r1) ffc09eb4: 83 c1 00 28 lwz r30,40(r1) ffc09eb8: 83 e1 00 2c lwz r31,44(r1) ffc09ebc: 38 21 00 30 addi r1,r1,48 ffc09ec0: 4e 80 00 20 blr } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); ffc09ec4: 4b ff fe 35 bl ffc09cf8 <_POSIX_signals_Get_lowest> _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); ffc09ec8: 7f e5 fb 78 mr r5,r31 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); ffc09ecc: 7c 7e 1b 78 mr r30,r3 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); ffc09ed0: 7f c4 f3 78 mr r4,r30 ffc09ed4: 7f 43 d3 78 mr r3,r26 ffc09ed8: 38 c0 00 01 li r6,1 ffc09edc: 38 e0 00 00 li r7,0 ffc09ee0: 48 00 79 bd bl ffc1189c <_POSIX_signals_Clear_signals> ffc09ee4: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); the_info->si_signo = signo; the_info->si_code = SI_USER; ffc09ee8: 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; ffc09eec: 93 df 00 00 stw r30,0(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09ef0: 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; ffc09ef4: 90 1f 00 04 stw r0,4(r31) the_info->si_value.sival_int = 0; ffc09ef8: 38 00 00 00 li r0,0 ffc09efc: 90 1f 00 08 stw r0,8(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09f00: 80 01 00 34 lwz r0,52(r1) ffc09f04: 83 41 00 18 lwz r26,24(r1) ffc09f08: 7c 08 03 a6 mtlr r0 ffc09f0c: 83 61 00 1c lwz r27,28(r1) ffc09f10: 83 81 00 20 lwz r28,32(r1) ffc09f14: 83 a1 00 24 lwz r29,36(r1) ffc09f18: 83 c1 00 28 lwz r30,40(r1) ffc09f1c: 83 e1 00 2c lwz r31,44(r1) ffc09f20: 38 21 00 30 addi r1,r1,48 ffc09f24: 4e 80 00 20 blr /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09f28: 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; ffc09f2c: 38 80 00 00 li r4,0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09f30: 40 9e fe 88 bne+ cr7,ffc09db8 the_thread = _Thread_Executing; ffc09f34: 3f 80 00 00 lis r28,0 ffc09f38: 3b 9c 31 64 addi r28,r28,12644 ffc09f3c: 81 3c 00 0c lwz r9,12(r28) /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09f40: 3b e1 00 08 addi r31,r1,8 the_thread = _Thread_Executing; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc09f44: 83 49 01 34 lwz r26,308(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; asm volatile ( ffc09f48: 7f 60 00 a6 mfmsr r27 ffc09f4c: 7c 10 42 a6 mfsprg r0,0 ffc09f50: 7f 60 00 78 andc r0,r27,r0 ffc09f54: 7c 00 01 24 mtmsr r0 */ /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { ffc09f58: 80 1d 00 00 lwz r0,0(r29) ffc09f5c: 80 7a 00 d4 lwz r3,212(r26) ffc09f60: 7c 0b 18 39 and. r11,r0,r3 ffc09f64: 41 82 fe 84 beq+ ffc09de8 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); ffc09f68: 4b ff fd 91 bl ffc09cf8 <_POSIX_signals_Get_lowest> _POSIX_signals_Clear_signals( ffc09f6c: 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 ); ffc09f70: 90 7f 00 00 stw r3,0(r31) ffc09f74: 7c 64 1b 78 mr r4,r3 _POSIX_signals_Clear_signals( ffc09f78: 38 c0 00 00 li r6,0 ffc09f7c: 7f 43 d3 78 mr r3,r26 ffc09f80: 38 e0 00 00 li r7,0 ffc09f84: 48 00 79 19 bl ffc1189c <_POSIX_signals_Clear_signals> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { asm volatile ( ffc09f88: 7f 60 01 24 mtmsr r27 false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; ffc09f8c: 38 00 00 01 li r0,1 the_info->si_value.sival_int = 0; return the_info->si_signo; ffc09f90: 83 df 00 00 lwz r30,0(r31) false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; ffc09f94: 90 1f 00 04 stw r0,4(r31) the_info->si_value.sival_int = 0; ffc09f98: 38 00 00 00 li r0,0 errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09f9c: 7f c3 f3 78 mr r3,r30 false ); _ISR_Enable( level ); the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; ffc09fa0: 90 1f 00 08 stw r0,8(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09fa4: 80 01 00 34 lwz r0,52(r1) ffc09fa8: 83 41 00 18 lwz r26,24(r1) ffc09fac: 7c 08 03 a6 mtlr r0 ffc09fb0: 83 61 00 1c lwz r27,28(r1) ffc09fb4: 83 81 00 20 lwz r28,32(r1) ffc09fb8: 83 a1 00 24 lwz r29,36(r1) ffc09fbc: 83 c1 00 28 lwz r30,40(r1) ffc09fc0: 83 e1 00 2c lwz r31,44(r1) ffc09fc4: 38 21 00 30 addi r1,r1,48 ffc09fc8: 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 ); ffc09fcc: 48 00 b4 b9 bl ffc15484 <__errno> ffc09fd0: 38 00 00 16 li r0,22 ffc09fd4: 90 03 00 00 stw r0,0(r3) ffc09fd8: 3b c0 ff ff li r30,-1 ffc09fdc: 4b ff fe bc b ffc09e98 * 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; ffc09fe0: 48 00 b4 a5 bl ffc15484 <__errno> ffc09fe4: 81 3c 00 0c lwz r9,12(r28) return -1; ffc09fe8: 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; ffc09fec: 80 09 00 34 lwz r0,52(r9) ffc09ff0: 90 03 00 00 stw r0,0(r3) return -1; ffc09ff4: 4b ff fe a4 b ffc09e98 =============================================================================== ffc0c330 : int sigwait( const sigset_t *set, int *sig ) { ffc0c330: 94 21 ff f0 stwu r1,-16(r1) ffc0c334: 7c 08 02 a6 mflr r0 int status; status = sigtimedwait( set, NULL, NULL ); ffc0c338: 38 a0 00 00 li r5,0 int sigwait( const sigset_t *set, int *sig ) { ffc0c33c: 93 e1 00 0c stw r31,12(r1) ffc0c340: 7c 9f 23 78 mr r31,r4 int status; status = sigtimedwait( set, NULL, NULL ); ffc0c344: 38 80 00 00 li r4,0 int sigwait( const sigset_t *set, int *sig ) { ffc0c348: 90 01 00 14 stw r0,20(r1) int status; status = sigtimedwait( set, NULL, NULL ); ffc0c34c: 4b ff fd 1d bl ffc0c068 if ( status != -1 ) { ffc0c350: 2f 83 ff ff cmpwi cr7,r3,-1 int *sig ) { int status; status = sigtimedwait( set, NULL, NULL ); ffc0c354: 7c 60 1b 78 mr r0,r3 if ( status != -1 ) { ffc0c358: 41 9e 00 28 beq- cr7,ffc0c380 if ( sig ) ffc0c35c: 2f 9f 00 00 cmpwi cr7,r31,0 *sig = status; return 0; ffc0c360: 38 60 00 00 li r3,0 int status; status = sigtimedwait( set, NULL, NULL ); if ( status != -1 ) { if ( sig ) ffc0c364: 41 9e 00 08 beq- cr7,ffc0c36c <== NEVER TAKEN *sig = status; ffc0c368: 90 1f 00 00 stw r0,0(r31) return 0; } return errno; } ffc0c36c: 80 01 00 14 lwz r0,20(r1) ffc0c370: 83 e1 00 0c lwz r31,12(r1) ffc0c374: 38 21 00 10 addi r1,r1,16 ffc0c378: 7c 08 03 a6 mtlr r0 ffc0c37c: 4e 80 00 20 blr if ( sig ) *sig = status; return 0; } return errno; ffc0c380: 48 00 af d9 bl ffc17358 <__errno> } ffc0c384: 80 01 00 14 lwz r0,20(r1) if ( sig ) *sig = status; return 0; } return errno; ffc0c388: 80 63 00 00 lwz r3,0(r3) } ffc0c38c: 7c 08 03 a6 mtlr r0 ffc0c390: 83 e1 00 0c lwz r31,12(r1) ffc0c394: 38 21 00 10 addi r1,r1,16 ffc0c398: 4e 80 00 20 blr =============================================================================== ffc08c48 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { ffc08c48: 7d 80 00 26 mfcr r12 POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) ffc08c4c: 2f 83 00 01 cmpwi cr7,r3,1 int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { ffc08c50: 94 21 ff e8 stwu r1,-24(r1) ffc08c54: 7c 08 02 a6 mflr r0 ffc08c58: 93 c1 00 10 stw r30,16(r1) ffc08c5c: 7c be 2b 78 mr r30,r5 ffc08c60: 93 e1 00 14 stw r31,20(r1) ffc08c64: 7c 9f 23 78 mr r31,r4 ffc08c68: 90 01 00 1c stw r0,28(r1) ffc08c6c: 93 a1 00 0c stw r29,12(r1) ffc08c70: 91 81 00 08 stw r12,8(r1) POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) ffc08c74: 40 9e 01 04 bne- cr7,ffc08d78 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) ffc08c78: 2f 85 00 00 cmpwi cr7,r5,0 ffc08c7c: 41 9e 00 fc beq- cr7,ffc08d78 /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { ffc08c80: 2e 04 00 00 cmpwi cr4,r4,0 ffc08c84: 41 92 00 2c beq- cr4,ffc08cb0 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && ffc08c88: 81 24 00 00 lwz r9,0(r4) ffc08c8c: 38 09 ff ff addi r0,r9,-1 ffc08c90: 2b 80 00 01 cmplwi cr7,r0,1 ffc08c94: 41 9d 00 e4 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 ) ffc08c98: 81 24 00 04 lwz r9,4(r4) ffc08c9c: 2f 89 00 00 cmpwi cr7,r9,0 ffc08ca0: 41 9e 00 d8 beq- cr7,ffc08d78 <== NEVER TAKEN static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc08ca4: 39 29 ff ff addi r9,r9,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) ffc08ca8: 2b 89 00 1f cmplwi cr7,r9,31 ffc08cac: 41 9d 00 cc bgt- cr7,ffc08d78 <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc08cb0: 3d 20 00 00 lis r9,0 ffc08cb4: 81 69 28 14 lwz r11,10260(r9) ffc08cb8: 38 0b 00 01 addi r0,r11,1 ffc08cbc: 90 09 28 14 stw r0,10260(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 d9 bl ffc0b5a4 <_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 3d 8d bl ffc0cad8 <_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 ba 91 bl ffc14808 <__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 2d bl ffc0cad8 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); ffc08db0: 48 00 ba 59 bl ffc14808 <__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 c0 stwu r1,-64(r1) ffc08dc8: 7c 08 02 a6 mflr r0 ffc08dcc: 93 a1 00 34 stw r29,52(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 30 stw r28,48(r1) ffc08dd8: 7c 9c 23 78 mr r28,r4 ffc08ddc: 93 c1 00 38 stw r30,56(r1) ffc08de0: 7c de 33 78 mr r30,r6 ffc08de4: 93 e1 00 3c stw r31,60(r1) ffc08de8: 7c 7f 1b 78 mr r31,r3 ffc08dec: 90 01 00 44 stw r0,68(r1) ffc08df0: 93 61 00 2c stw r27,44(r1) Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) ffc08df4: 41 82 01 c4 beq- ffc08fb8 <== 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) ) ) { ffc08df8: 38 7d 00 08 addi r3,r29,8 ffc08dfc: 48 00 4d 2d bl ffc0db28 <_Timespec_Is_valid> ffc08e00: 2f 83 00 00 cmpwi cr7,r3,0 ffc08e04: 41 9e 01 b4 beq- cr7,ffc08fb8 rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { ffc08e08: 7f a3 eb 78 mr r3,r29 ffc08e0c: 48 00 4d 1d bl ffc0db28 <_Timespec_Is_valid> ffc08e10: 2f 83 00 00 cmpwi cr7,r3,0 ffc08e14: 41 9e 01 a4 beq- cr7,ffc08fb8 <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { ffc08e18: 2f 9c 00 04 cmpwi cr7,r28,4 ffc08e1c: 41 9e 01 24 beq- cr7,ffc08f40 ffc08e20: 2f 9c 00 00 cmpwi cr7,r28,0 ffc08e24: 40 9e 01 94 bne- cr7,ffc08fb8 rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08e28: 80 1d 00 0c lwz r0,12(r29) timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) _Objects_Get( &_POSIX_Timer_Information, (Objects_Id) id, location ); ffc08e2c: 3c 60 00 00 lis r3,0 ffc08e30: 81 5d 00 00 lwz r10,0(r29) ffc08e34: 7f e4 fb 78 mr r4,r31 ffc08e38: 81 7d 00 04 lwz r11,4(r29) ffc08e3c: 38 63 2f 2c addi r3,r3,12076 ffc08e40: 81 3d 00 08 lwz r9,8(r29) ffc08e44: 38 a1 00 08 addi r5,r1,8 ffc08e48: 90 01 00 20 stw r0,32(r1) ffc08e4c: 91 41 00 14 stw r10,20(r1) ffc08e50: 91 61 00 18 stw r11,24(r1) ffc08e54: 91 21 00 1c stw r9,28(r1) ffc08e58: 48 00 2d 69 bl ffc0bbc0 <_Objects_Get> ffc08e5c: 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 ) { ffc08e60: 80 01 00 08 lwz r0,8(r1) ffc08e64: 2f 80 00 00 cmpwi cr7,r0,0 ffc08e68: 40 9e 01 50 bne- cr7,ffc08fb8 <== 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 ) { ffc08e6c: 80 01 00 1c lwz r0,28(r1) ffc08e70: 2f 80 00 00 cmpwi cr7,r0,0 ffc08e74: 40 9e 00 10 bne- cr7,ffc08e84 ffc08e78: 80 01 00 20 lwz r0,32(r1) ffc08e7c: 2f 80 00 00 cmpwi cr7,r0,0 ffc08e80: 41 9e 01 4c beq- cr7,ffc08fcc _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); ffc08e84: 7f a3 eb 78 mr r3,r29 ffc08e88: 48 00 4d 31 bl ffc0dbb8 <_Timespec_To_ticks> ffc08e8c: 90 7f 00 64 stw r3,100(r31) initial_period = _Timespec_To_ticks( &normalize.it_value ); ffc08e90: 38 61 00 1c addi r3,r1,28 ffc08e94: 48 00 4d 25 bl ffc0dbb8 <_Timespec_To_ticks> activated = _POSIX_Timer_Insert_helper( ffc08e98: 80 bf 00 08 lwz r5,8(r31) ffc08e9c: 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 ); ffc08ea0: 7c 64 1b 78 mr r4,r3 activated = _POSIX_Timer_Insert_helper( ffc08ea4: 38 c6 90 50 addi r6,r6,-28592 ffc08ea8: 38 7f 00 10 addi r3,r31,16 ffc08eac: 7f e7 fb 78 mr r7,r31 ffc08eb0: 48 00 81 41 bl ffc10ff0 <_POSIX_Timer_Insert_helper> initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { ffc08eb4: 2f 83 00 00 cmpwi cr7,r3,0 ffc08eb8: 41 9e 00 5c beq- cr7,ffc08f14 /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) ffc08ebc: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08ec0: 41 9e 00 24 beq- cr7,ffc08ee4 *ovalue = ptimer->timer_data; ffc08ec4: 81 5f 00 54 lwz r10,84(r31) ffc08ec8: 81 7f 00 58 lwz r11,88(r31) ffc08ecc: 81 3f 00 5c lwz r9,92(r31) ffc08ed0: 80 1f 00 60 lwz r0,96(r31) ffc08ed4: 91 5e 00 00 stw r10,0(r30) ffc08ed8: 91 7e 00 04 stw r11,4(r30) ffc08edc: 91 3e 00 08 stw r9,8(r30) ffc08ee0: 90 1e 00 0c stw r0,12(r30) ptimer->timer_data = normalize; ffc08ee4: 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 ); ffc08ee8: 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; ffc08eec: 90 1f 00 54 stw r0,84(r31) ffc08ef0: 80 01 00 18 lwz r0,24(r1) ffc08ef4: 90 1f 00 58 stw r0,88(r31) ffc08ef8: 80 01 00 1c lwz r0,28(r1) ffc08efc: 90 1f 00 5c stw r0,92(r31) ffc08f00: 80 01 00 20 lwz r0,32(r1) ffc08f04: 90 1f 00 60 stw r0,96(r31) /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc08f08: 38 00 00 03 li r0,3 ffc08f0c: 98 1f 00 3c stb r0,60(r31) _TOD_Get( &ptimer->time ); ffc08f10: 48 00 20 49 bl ffc0af58 <_TOD_Get> _Thread_Enable_dispatch(); ffc08f14: 48 00 3b c5 bl ffc0cad8 <_Thread_Enable_dispatch> return 0; ffc08f18: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc08f1c: 80 01 00 44 lwz r0,68(r1) ffc08f20: 83 61 00 2c lwz r27,44(r1) ffc08f24: 7c 08 03 a6 mtlr r0 ffc08f28: 83 81 00 30 lwz r28,48(r1) ffc08f2c: 83 a1 00 34 lwz r29,52(r1) ffc08f30: 83 c1 00 38 lwz r30,56(r1) ffc08f34: 83 e1 00 3c lwz r31,60(r1) ffc08f38: 38 21 00 40 addi r1,r1,64 ffc08f3c: 4e 80 00 20 blr if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08f40: 81 5d 00 00 lwz r10,0(r29) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); ffc08f44: 3b 81 00 0c addi r28,r1,12 if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08f48: 81 7d 00 04 lwz r11,4(r29) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); ffc08f4c: 7f 83 e3 78 mr r3,r28 if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08f50: 81 3d 00 08 lwz r9,8(r29) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) ffc08f54: 3b 61 00 1c addi r27,r1,28 if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08f58: 80 1d 00 0c lwz r0,12(r29) ffc08f5c: 91 41 00 14 stw r10,20(r1) ffc08f60: 91 61 00 18 stw r11,24(r1) ffc08f64: 91 21 00 1c stw r9,28(r1) ffc08f68: 90 01 00 20 stw r0,32(r1) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); ffc08f6c: 48 00 1f ed bl ffc0af58 <_TOD_Get> /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) ffc08f70: 7f 83 e3 78 mr r3,r28 ffc08f74: 7f 64 db 78 mr r4,r27 ffc08f78: 48 00 4b 75 bl ffc0daec <_Timespec_Greater_than> ffc08f7c: 2f 83 00 00 cmpwi cr7,r3,0 ffc08f80: 40 9e 00 38 bne- cr7,ffc08fb8 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); ffc08f84: 7f 64 db 78 mr r4,r27 ffc08f88: 7f 83 e3 78 mr r3,r28 ffc08f8c: 7f 65 db 78 mr r5,r27 ffc08f90: 48 00 4b d5 bl ffc0db64 <_Timespec_Subtract> ffc08f94: 3c 60 00 00 lis r3,0 ffc08f98: 7f e4 fb 78 mr r4,r31 ffc08f9c: 38 63 2f 2c addi r3,r3,12076 ffc08fa0: 38 a1 00 08 addi r5,r1,8 ffc08fa4: 48 00 2c 1d bl ffc0bbc0 <_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 ) { ffc08fa8: 80 01 00 08 lwz r0,8(r1) ffc08fac: 7c 7f 1b 78 mr r31,r3 ffc08fb0: 2f 80 00 00 cmpwi cr7,r0,0 ffc08fb4: 41 be fe b8 beq- cr7,ffc08e6c #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); ffc08fb8: 48 00 b8 51 bl ffc14808 <__errno> ffc08fbc: 38 00 00 16 li r0,22 ffc08fc0: 90 03 00 00 stw r0,0(r3) ffc08fc4: 38 60 ff ff li r3,-1 ffc08fc8: 4b ff ff 54 b ffc08f1c 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 ); ffc08fcc: 38 63 00 10 addi r3,r3,16 ffc08fd0: 48 00 53 0d bl ffc0e2dc <_Watchdog_Remove> /* The old data of the timer are returned */ if ( ovalue ) ffc08fd4: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08fd8: 41 9e 00 24 beq- cr7,ffc08ffc *ovalue = ptimer->timer_data; ffc08fdc: 81 5f 00 54 lwz r10,84(r31) ffc08fe0: 81 7f 00 58 lwz r11,88(r31) ffc08fe4: 81 3f 00 5c lwz r9,92(r31) ffc08fe8: 80 1f 00 60 lwz r0,96(r31) ffc08fec: 91 5e 00 00 stw r10,0(r30) ffc08ff0: 91 7e 00 04 stw r11,4(r30) ffc08ff4: 91 3e 00 08 stw r9,8(r30) ffc08ff8: 90 1e 00 0c stw r0,12(r30) /* The new data are set */ ptimer->timer_data = normalize; ffc08ffc: 80 01 00 14 lwz r0,20(r1) ffc09000: 90 1f 00 54 stw r0,84(r31) ffc09004: 80 01 00 18 lwz r0,24(r1) ffc09008: 90 1f 00 58 stw r0,88(r31) ffc0900c: 80 01 00 1c lwz r0,28(r1) ffc09010: 90 1f 00 5c stw r0,92(r31) ffc09014: 80 01 00 20 lwz r0,32(r1) ffc09018: 90 1f 00 60 stw r0,96(r31) /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; ffc0901c: 38 00 00 04 li r0,4 ffc09020: 98 1f 00 3c stb r0,60(r31) /* Returns with success */ _Thread_Enable_dispatch(); ffc09024: 48 00 3a b5 bl ffc0cad8 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc09028: 80 01 00 44 lwz r0,68(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; ffc0902c: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc09030: 83 61 00 2c lwz r27,44(r1) ffc09034: 7c 08 03 a6 mtlr r0 ffc09038: 83 81 00 30 lwz r28,48(r1) ffc0903c: 83 a1 00 34 lwz r29,52(r1) ffc09040: 83 c1 00 38 lwz r30,56(r1) ffc09044: 83 e1 00 3c lwz r31,60(r1) ffc09048: 38 21 00 40 addi r1,r1,64 ffc0904c: 4e 80 00 20 blr =============================================================================== ffc08af8 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08af8: 94 21 ff d8 stwu r1,-40(r1) ffc08afc: 7c 08 02 a6 mflr r0 ffc08b00: 93 e1 00 24 stw r31,36(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08b04: 3f e0 00 00 lis r31,0 ffc08b08: 3b ff 35 34 addi r31,r31,13620 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08b0c: 90 01 00 2c stw r0,44(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08b10: 80 1f 00 1c lwz r0,28(r31) useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08b14: 93 c1 00 20 stw r30,32(r1) ffc08b18: 7c 7e 1b 78 mr r30,r3 /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08b1c: 2f 80 00 00 cmpwi cr7,r0,0 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08b20: 93 81 00 18 stw r28,24(r1) ffc08b24: 93 a1 00 1c stw r29,28(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08b28: 41 9e 00 ac beq- cr7,ffc08bd4 _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); ffc08b2c: 7f e3 fb 78 mr r3,r31 ffc08b30: 48 00 52 05 bl ffc0dd34 <_Watchdog_Remove> useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; ffc08b34: 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) ) { ffc08b38: 38 63 ff fe addi r3,r3,-2 ffc08b3c: 2b 83 00 01 cmplwi cr7,r3,1 ffc08b40: 40 9d 00 b4 ble- cr7,ffc08bf4 <== 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 ) { ffc08b44: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08b48: 41 be 00 68 beq+ cr7,ffc08bb0 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; ffc08b4c: 3c 00 43 1b lis r0,17179 ffc08b50: 60 00 de 83 ori r0,r0,56963 ffc08b54: 7c 1e 00 16 mulhwu r0,r30,r0 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); ffc08b58: 3b 81 00 08 addi r28,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; ffc08b5c: 54 00 74 be rlwinm r0,r0,14,18,31 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc08b60: 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; ffc08b64: 90 01 00 08 stw r0,8(r1) tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc08b68: 54 09 18 38 rlwinm r9,r0,3,0,28 ffc08b6c: 7d 29 58 50 subf r9,r9,r11 ffc08b70: 55 2b 30 32 rlwinm r11,r9,6,0,25 ffc08b74: 7d 29 58 50 subf r9,r9,r11 ffc08b78: 7d 29 02 14 add r9,r9,r0 ffc08b7c: 55 29 30 32 rlwinm r9,r9,6,0,25 ffc08b80: 7f c9 f0 50 subf r30,r9,r30 ffc08b84: 1f de 03 e8 mulli r30,r30,1000 ticks = _Timespec_To_ticks( &tp ); ffc08b88: 7f 83 e3 78 mr r3,r28 */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc08b8c: 93 c1 00 0c stw r30,12(r1) ticks = _Timespec_To_ticks( &tp ); ffc08b90: 48 00 49 55 bl ffc0d4e4 <_Timespec_To_ticks> if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); ffc08b94: 7f 83 e3 78 mr r3,r28 ffc08b98: 48 00 49 4d bl ffc0d4e4 <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08b9c: 7f e4 fb 78 mr r4,r31 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc08ba0: 90 7f 00 0c stw r3,12(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08ba4: 3c 60 00 00 lis r3,0 ffc08ba8: 38 63 2d 88 addi r3,r3,11656 ffc08bac: 48 00 4f b9 bl ffc0db64 <_Watchdog_Insert> } return remaining; } ffc08bb0: 80 01 00 2c lwz r0,44(r1) ffc08bb4: 7f a3 eb 78 mr r3,r29 ffc08bb8: 83 81 00 18 lwz r28,24(r1) ffc08bbc: 7c 08 03 a6 mtlr r0 ffc08bc0: 83 a1 00 1c lwz r29,28(r1) ffc08bc4: 83 c1 00 20 lwz r30,32(r1) ffc08bc8: 83 e1 00 24 lwz r31,36(r1) ffc08bcc: 38 21 00 28 addi r1,r1,40 ffc08bd0: 4e 80 00 20 blr Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc08bd4: 3d 20 ff c1 lis r9,-63 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc08bd8: 90 1f 00 08 stw r0,8(r31) the_watchdog->routine = routine; ffc08bdc: 39 29 8a a8 addi r9,r9,-30040 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; ffc08be0: 3b a0 00 00 li r29,0 ffc08be4: 91 3f 00 1c stw r9,28(r31) the_watchdog->id = id; ffc08be8: 90 1f 00 20 stw r0,32(r31) the_watchdog->user_data = user_data; ffc08bec: 90 1f 00 24 stw r0,36(r31) ffc08bf0: 4b ff ff 54 b ffc08b44 * 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); ffc08bf4: 81 3f 00 0c lwz r9,12(r31) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); ffc08bf8: 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); ffc08bfc: 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; ffc08c00: 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); ffc08c04: 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; ffc08c08: 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); ffc08c0c: 7c 63 4a 14 add r3,r3,r9 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); ffc08c10: 7c 60 18 50 subf r3,r0,r3 ffc08c14: 48 00 48 31 bl ffc0d444 <_Timespec_From_ticks> remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; ffc08c18: 80 01 00 08 lwz r0,8(r1) remaining += tp.tv_nsec / 1000; ffc08c1c: 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; ffc08c20: 54 0a 40 2e rlwinm r10,r0,8,0,23 ffc08c24: 54 0b 18 38 rlwinm r11,r0,3,0,28 ffc08c28: 7d 6b 50 50 subf r11,r11,r10 remaining += tp.tv_nsec / 1000; ffc08c2c: 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; ffc08c30: 55 6a 30 32 rlwinm r10,r11,6,0,25 ffc08c34: 7d 6b 50 50 subf r11,r11,r10 ffc08c38: 7c 0b 02 14 add r0,r11,r0 remaining += tp.tv_nsec / 1000; ffc08c3c: 7f bd 36 70 srawi r29,r29,6 ffc08c40: 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; ffc08c44: 54 00 30 32 rlwinm r0,r0,6,0,25 remaining += tp.tv_nsec / 1000; ffc08c48: 7f a9 e8 50 subf r29,r9,r29 ffc08c4c: 7f bd 02 14 add r29,r29,r0 ffc08c50: 4b ff fe f4 b ffc08b44