=============================================================================== ffc09948 <_API_extensions_Run_postdriver>: * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc09948: 94 21 ff f0 stwu r1,-16(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc0994c: 3d 20 00 00 lis r9,0 * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc09950: 7c 08 02 a6 mflr r0 ffc09954: 93 c1 00 08 stw r30,8(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc09958: 3b c9 2d e0 addi r30,r9,11744 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc0995c: 3b de 00 04 addi r30,r30,4 * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc09960: 93 e1 00 0c stw r31,12(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc09964: 83 e9 2d e0 lwz r31,11744(r9) * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc09968: 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 ); ffc0996c: 7f 9f f0 00 cmpw cr7,r31,r30 ffc09970: 41 9e 00 1c beq- cr7,ffc0998c <_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)(); ffc09974: 80 1f 00 08 lwz r0,8(r31) ffc09978: 7c 09 03 a6 mtctr r0 ffc0997c: 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 ) { ffc09980: 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 ); ffc09984: 7f 9f f0 00 cmpw cr7,r31,r30 ffc09988: 40 9e ff ec bne+ cr7,ffc09974 <_API_extensions_Run_postdriver+0x2c> #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) if ( the_extension->postdriver_hook ) #endif (*the_extension->postdriver_hook)(); } } ffc0998c: 80 01 00 14 lwz r0,20(r1) ffc09990: 83 c1 00 08 lwz r30,8(r1) ffc09994: 7c 08 03 a6 mtlr r0 ffc09998: 83 e1 00 0c lwz r31,12(r1) ffc0999c: 38 21 00 10 addi r1,r1,16 ffc099a0: 4e 80 00 20 blr =============================================================================== ffc099a4 <_API_extensions_Run_postswitch>: * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc099a4: 94 21 ff e8 stwu r1,-24(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc099a8: 3d 20 00 00 lis r9,0 * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc099ac: 7c 08 02 a6 mflr r0 ffc099b0: 93 c1 00 10 stw r30,16(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc099b4: 3b c9 2d e0 addi r30,r9,11744 void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc099b8: 3b de 00 04 addi r30,r30,4 * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc099bc: 93 e1 00 14 stw r31,20(r1) the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc099c0: 83 e9 2d e0 lwz r31,11744(r9) * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc099c4: 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 ); ffc099c8: 7f 9f f0 00 cmpw cr7,r31,r30 * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc099cc: 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 ); ffc099d0: 41 9e 00 28 beq- cr7,ffc099f8 <_API_extensions_Run_postswitch+0x54><== NEVER TAKEN ffc099d4: 3f a0 00 00 lis r29,0 ffc099d8: 3b bd 31 24 addi r29,r29,12580 !_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 ); ffc099dc: 80 1f 00 0c lwz r0,12(r31) ffc099e0: 80 7d 00 0c lwz r3,12(r29) ffc099e4: 7c 09 03 a6 mtctr r0 ffc099e8: 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 ) { ffc099ec: 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 ); ffc099f0: 7f 9f f0 00 cmpw cr7,r31,r30 ffc099f4: 40 9e ff e8 bne+ cr7,ffc099dc <_API_extensions_Run_postswitch+0x38> the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc099f8: 80 01 00 1c lwz r0,28(r1) ffc099fc: 83 a1 00 0c lwz r29,12(r1) ffc09a00: 7c 08 03 a6 mtlr r0 ffc09a04: 83 c1 00 10 lwz r30,16(r1) ffc09a08: 83 e1 00 14 lwz r31,20(r1) ffc09a0c: 38 21 00 18 addi r1,r1,24 ffc09a10: 4e 80 00 20 blr =============================================================================== ffc0cca4 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { ffc0cca4: 94 21 ff f0 stwu r1,-16(r1) ffc0cca8: 7c 08 02 a6 mflr r0 ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0ccac: 3d 20 00 00 lis r9,0 */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { ffc0ccb0: 90 01 00 14 stw r0,20(r1) ffc0ccb4: 93 e1 00 0c stw r31,12(r1) ffc0ccb8: 7c 7f 1b 78 mr r31,r3 ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0ccbc: 81 29 31 30 lwz r9,12592(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0ccc0: 7d 60 00 a6 mfmsr r11 ffc0ccc4: 7c 10 42 a6 mfsprg r0,0 ffc0ccc8: 7d 60 00 78 andc r0,r11,r0 ffc0cccc: 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){ ffc0ccd0: 80 03 00 44 lwz r0,68(r3) ffc0ccd4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ccd8: 41 9e 00 cc beq- cr7,ffc0cda4 <_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 ) { ffc0ccdc: 2f 80 00 01 cmpwi cr7,r0,1 ffc0cce0: 41 9e 00 94 beq- cr7,ffc0cd74 <_CORE_RWLock_Release+0xd0> return CORE_RWLOCK_SUCCESSFUL; } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; ffc0cce4: 38 00 00 00 li r0,0 ffc0cce8: 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; ffc0ccec: 90 1f 00 44 stw r0,68(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0ccf0: 7d 60 01 24 mtmsr r11 _ISR_Enable( level ); next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); ffc0ccf4: 7f e3 fb 78 mr r3,r31 ffc0ccf8: 48 00 23 19 bl ffc0f010 <_Thread_queue_Dequeue> if ( next ) { ffc0ccfc: 2c 03 00 00 cmpwi r3,0 ffc0cd00: 41 82 00 5c beq- ffc0cd5c <_CORE_RWLock_Release+0xb8> if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { ffc0cd04: 80 03 00 30 lwz r0,48(r3) ffc0cd08: 2f 80 00 01 cmpwi cr7,r0,1 ffc0cd0c: 41 9e 00 bc beq- cr7,ffc0cdc8 <_CORE_RWLock_Release+0x124> } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; ffc0cd10: 81 3f 00 48 lwz r9,72(r31) ffc0cd14: 38 09 00 01 addi r0,r9,1 ffc0cd18: 90 1f 00 48 stw r0,72(r31) the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; ffc0cd1c: 38 00 00 01 li r0,1 ffc0cd20: 90 1f 00 44 stw r0,68(r31) ffc0cd24: 48 00 00 20 b ffc0cd44 <_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 || ffc0cd28: 80 09 00 30 lwz r0,48(r9) ffc0cd2c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0cd30: 41 9e 00 2c beq- cr7,ffc0cd5c <_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; ffc0cd34: 81 3f 00 48 lwz r9,72(r31) ffc0cd38: 38 09 00 01 addi r0,r9,1 ffc0cd3c: 90 1f 00 48 stw r0,72(r31) _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); ffc0cd40: 48 00 27 7d bl ffc0f4bc <_Thread_queue_Extract> /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); ffc0cd44: 7f e3 fb 78 mr r3,r31 ffc0cd48: 48 00 29 11 bl ffc0f658 <_Thread_queue_First> if ( !next || ffc0cd4c: 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 ); ffc0cd50: 7f e3 fb 78 mr r3,r31 ffc0cd54: 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 || ffc0cd58: 40 82 ff d0 bne+ ffc0cd28 <_CORE_RWLock_Release+0x84> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0cd5c: 80 01 00 14 lwz r0,20(r1) ffc0cd60: 38 60 00 00 li r3,0 ffc0cd64: 83 e1 00 0c lwz r31,12(r1) ffc0cd68: 38 21 00 10 addi r1,r1,16 ffc0cd6c: 7c 08 03 a6 mtlr r0 ffc0cd70: 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; ffc0cd74: 81 43 00 48 lwz r10,72(r3) ffc0cd78: 38 0a ff ff addi r0,r10,-1 if ( the_rwlock->number_of_readers != 0 ) { ffc0cd7c: 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; ffc0cd80: 90 03 00 48 stw r0,72(r3) if ( the_rwlock->number_of_readers != 0 ) { ffc0cd84: 41 9e ff 60 beq+ cr7,ffc0cce4 <_CORE_RWLock_Release+0x40> ffc0cd88: 7d 60 01 24 mtmsr r11 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0cd8c: 80 01 00 14 lwz r0,20(r1) ffc0cd90: 38 60 00 00 li r3,0 ffc0cd94: 83 e1 00 0c lwz r31,12(r1) ffc0cd98: 38 21 00 10 addi r1,r1,16 ffc0cd9c: 7c 08 03 a6 mtlr r0 ffc0cda0: 4e 80 00 20 blr ffc0cda4: 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; ffc0cda8: 38 00 00 02 li r0,2 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0cdac: 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; ffc0cdb0: 90 09 00 34 stw r0,52(r9) } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0cdb4: 38 60 00 00 li r3,0 ffc0cdb8: 80 01 00 14 lwz r0,20(r1) ffc0cdbc: 38 21 00 10 addi r1,r1,16 ffc0cdc0: 7c 08 03 a6 mtlr r0 ffc0cdc4: 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; ffc0cdc8: 38 00 00 02 li r0,2 ffc0cdcc: 90 1f 00 44 stw r0,68(r31) return CORE_RWLOCK_SUCCESSFUL; ffc0cdd0: 4b ff ff 8c b ffc0cd5c <_CORE_RWLock_Release+0xb8> =============================================================================== ffc0cdd4 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { ffc0cdd4: 94 21 ff e8 stwu r1,-24(r1) ffc0cdd8: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0cddc: 38 81 00 08 addi r4,r1,8 void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { ffc0cde0: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0cde4: 48 00 1e 05 bl ffc0ebe8 <_Thread_Get> switch ( location ) { ffc0cde8: 80 01 00 08 lwz r0,8(r1) ffc0cdec: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cdf0: 40 9e 00 18 bne- cr7,ffc0ce08 <_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 ); ffc0cdf4: 48 00 29 b9 bl ffc0f7ac <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc0cdf8: 3d 20 00 00 lis r9,0 ffc0cdfc: 81 69 28 14 lwz r11,10260(r9) ffc0ce00: 38 0b ff ff addi r0,r11,-1 ffc0ce04: 90 09 28 14 stw r0,10260(r9) _Thread_Unnest_dispatch(); break; } } ffc0ce08: 80 01 00 1c lwz r0,28(r1) ffc0ce0c: 38 21 00 18 addi r1,r1,24 ffc0ce10: 7c 08 03 a6 mtlr r0 ffc0ce14: 4e 80 00 20 blr =============================================================================== ffc15248 <_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 ) { ffc15248: 94 21 ff e0 stwu r1,-32(r1) ffc1524c: 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)) { ffc15250: 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 ) { ffc15254: 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)) { ffc15258: 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; ffc1525c: 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 ) { ffc15260: 93 a1 00 14 stw r29,20(r1) ffc15264: 7c 9d 23 78 mr r29,r4 ffc15268: 93 e1 00 1c stw r31,28(r1) ffc1526c: 7c 7f 1b 78 mr r31,r3 ffc15270: 93 81 00 10 stw r28,16(r1) ffc15274: 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; ffc15278: 90 a3 00 44 stw r5,68(r3) the_message_queue->number_of_pending_messages = 0; ffc1527c: 90 03 00 48 stw r0,72(r3) the_message_queue->maximum_message_size = maximum_message_size; ffc15280: 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; ffc15284: 90 03 00 60 stw r0,96(r3) the_message_queue->notify_argument = the_argument; ffc15288: 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)) { ffc1528c: 41 82 00 3c beq- ffc152c8 <_CORE_message_queue_Initialize+0x80> allocated_message_size += sizeof(uint32_t); ffc15290: 39 26 00 04 addi r9,r6,4 allocated_message_size &= ~(sizeof(uint32_t) - 1); ffc15294: 55 29 00 3a rlwinm r9,r9,0,0,29 } if (allocated_message_size < maximum_message_size) ffc15298: 7f 86 48 40 cmplw cr7,r6,r9 return false; ffc1529c: 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) ffc152a0: 40 9d 00 28 ble- cr7,ffc152c8 <_CORE_message_queue_Initialize+0x80><== ALWAYS TAKEN STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } ffc152a4: 80 01 00 24 lwz r0,36(r1) ffc152a8: 7f c3 f3 78 mr r3,r30 ffc152ac: 83 81 00 10 lwz r28,16(r1) ffc152b0: 7c 08 03 a6 mtlr r0 ffc152b4: 83 a1 00 14 lwz r29,20(r1) ffc152b8: 83 c1 00 18 lwz r30,24(r1) ffc152bc: 83 e1 00 1c lwz r31,28(r1) ffc152c0: 38 21 00 20 addi r1,r1,32 ffc152c4: 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)); ffc152c8: 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 * ffc152cc: 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; ffc152d0: 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) ffc152d4: 7f 83 48 40 cmplw cr7,r3,r9 ffc152d8: 41 9c ff cc blt+ cr7,ffc152a4 <_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 ); ffc152dc: 90 a1 00 08 stw r5,8(r1) ffc152e0: 48 00 3e 41 bl ffc19120 <_Workspace_Allocate> if (the_message_queue->message_buffers == 0) ffc152e4: 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 ); ffc152e8: 7c 64 1b 78 mr r4,r3 return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) ffc152ec: 90 7f 00 5c stw r3,92(r31) _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) ffc152f0: 80 a1 00 08 lwz r5,8(r1) ffc152f4: 41 be ff b0 beq- cr7,ffc152a4 <_CORE_message_queue_Initialize+0x5c> /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( ffc152f8: 38 7f 00 68 addi r3,r31,104 ffc152fc: 7f 86 e3 78 mr r6,r28 ffc15300: 48 00 6d 21 bl ffc1c020 <_Chain_Initialize> */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); ffc15304: 38 1f 00 50 addi r0,r31,80 Chain_Node *tail = _Chain_Tail( the_chain ); ffc15308: 39 3f 00 54 addi r9,r31,84 head->next = tail; head->previous = NULL; ffc1530c: 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( ffc15310: 7f e3 fb 78 mr r3,r31 tail->previous = head; ffc15314: 90 1f 00 58 stw r0,88(r31) ffc15318: 38 a0 00 80 li r5,128 ffc1531c: 38 c0 00 06 li r6,6 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc15320: 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; ffc15324: 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( ffc15328: 80 9d 00 00 lwz r4,0(r29) ffc1532c: 68 84 00 01 xori r4,r4,1 ffc15330: 7c 84 00 34 cntlzw r4,r4 ffc15334: 54 84 d9 7e rlwinm r4,r4,27,5,31 ffc15338: 48 00 2f 6d bl ffc182a4 <_Thread_queue_Initialize> STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } ffc1533c: 80 01 00 24 lwz r0,36(r1) ffc15340: 7f c3 f3 78 mr r3,r30 ffc15344: 83 81 00 10 lwz r28,16(r1) ffc15348: 7c 08 03 a6 mtlr r0 ffc1534c: 83 a1 00 14 lwz r29,20(r1) ffc15350: 83 c1 00 18 lwz r30,24(r1) ffc15354: 83 e1 00 1c lwz r31,28(r1) ffc15358: 38 21 00 20 addi r1,r1,32 ffc1535c: 4e 80 00 20 blr =============================================================================== ffc09db4 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { ffc09db4: 94 21 ff d8 stwu r1,-40(r1) ffc09db8: 7c 08 02 a6 mflr r0 ffc09dbc: 93 c1 00 20 stw r30,32(r1) _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09dc0: 3f c0 00 00 lis r30,0 Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { ffc09dc4: 90 01 00 2c stw r0,44(r1) _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09dc8: 80 1e 27 e8 lwz r0,10216(r30) Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { ffc09dcc: 93 61 00 14 stw r27,20(r1) ffc09dd0: 7c db 33 78 mr r27,r6 _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09dd4: 2f 80 00 00 cmpwi cr7,r0,0 Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { ffc09dd8: 93 81 00 18 stw r28,24(r1) ffc09ddc: 7c bc 2b 78 mr r28,r5 ffc09de0: 93 a1 00 1c stw r29,28(r1) ffc09de4: 7c 9d 23 78 mr r29,r4 ffc09de8: 93 e1 00 24 stw r31,36(r1) ffc09dec: 7c 7f 1b 78 mr r31,r3 ffc09df0: 90 e1 00 08 stw r7,8(r1) _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09df4: 41 9e 00 0c beq- cr7,ffc09e00 <_CORE_mutex_Seize+0x4c> ffc09df8: 2f 85 00 00 cmpwi cr7,r5,0 ffc09dfc: 40 9e 00 5c bne- cr7,ffc09e58 <_CORE_mutex_Seize+0xa4> <== ALWAYS TAKEN ffc09e00: 7f e3 fb 78 mr r3,r31 ffc09e04: 38 81 00 08 addi r4,r1,8 ffc09e08: 48 00 66 c1 bl ffc104c8 <_CORE_mutex_Seize_interrupt_trylock> ffc09e0c: 2f 83 00 00 cmpwi cr7,r3,0 ffc09e10: 41 9e 00 24 beq- cr7,ffc09e34 <_CORE_mutex_Seize+0x80> ffc09e14: 2f 9c 00 00 cmpwi cr7,r28,0 ffc09e18: 40 9e 00 60 bne- cr7,ffc09e78 <_CORE_mutex_Seize+0xc4> ffc09e1c: 80 01 00 08 lwz r0,8(r1) ffc09e20: 7c 00 01 24 mtmsr r0 ffc09e24: 3d 20 00 00 lis r9,0 ffc09e28: 81 29 31 30 lwz r9,12592(r9) ffc09e2c: 38 00 00 01 li r0,1 ffc09e30: 90 09 00 34 stw r0,52(r9) } ffc09e34: 80 01 00 2c lwz r0,44(r1) ffc09e38: 83 61 00 14 lwz r27,20(r1) ffc09e3c: 7c 08 03 a6 mtlr r0 ffc09e40: 83 81 00 18 lwz r28,24(r1) ffc09e44: 83 a1 00 1c lwz r29,28(r1) ffc09e48: 83 c1 00 20 lwz r30,32(r1) ffc09e4c: 83 e1 00 24 lwz r31,36(r1) ffc09e50: 38 21 00 28 addi r1,r1,40 ffc09e54: 4e 80 00 20 blr bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); ffc09e58: 3d 20 00 00 lis r9,0 ffc09e5c: 80 09 28 2c lwz r0,10284(r9) ffc09e60: 2b 80 00 01 cmplwi cr7,r0,1 ffc09e64: 40 9d ff 9c ble+ cr7,ffc09e00 <_CORE_mutex_Seize+0x4c> ffc09e68: 38 60 00 00 li r3,0 ffc09e6c: 38 80 00 00 li r4,0 ffc09e70: 38 a0 00 12 li r5,18 ffc09e74: 48 00 08 95 bl ffc0a708 <_Internal_error_Occurred> ffc09e78: 3d 20 00 00 lis r9,0 ffc09e7c: 81 7e 27 e8 lwz r11,10216(r30) ffc09e80: 81 29 31 30 lwz r9,12592(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; ffc09e84: 38 00 00 01 li r0,1 ffc09e88: 90 1f 00 30 stw r0,48(r31) ffc09e8c: 38 0b 00 01 addi r0,r11,1 ffc09e90: 93 e9 00 44 stw r31,68(r9) ffc09e94: 93 a9 00 20 stw r29,32(r9) ffc09e98: 90 1e 27 e8 stw r0,10216(r30) ffc09e9c: 80 01 00 08 lwz r0,8(r1) ffc09ea0: 7c 00 01 24 mtmsr r0 ffc09ea4: 7f e3 fb 78 mr r3,r31 ffc09ea8: 7f 64 db 78 mr r4,r27 ffc09eac: 4b ff fe 45 bl ffc09cf0 <_CORE_mutex_Seize_interrupt_blocking> } ffc09eb0: 80 01 00 2c lwz r0,44(r1) ffc09eb4: 83 61 00 14 lwz r27,20(r1) ffc09eb8: 7c 08 03 a6 mtlr r0 ffc09ebc: 83 81 00 18 lwz r28,24(r1) ffc09ec0: 83 a1 00 1c lwz r29,28(r1) ffc09ec4: 83 c1 00 20 lwz r30,32(r1) ffc09ec8: 83 e1 00 24 lwz r31,36(r1) ffc09ecc: 38 21 00 28 addi r1,r1,40 ffc09ed0: 4e 80 00 20 blr =============================================================================== ffc0a094 <_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 ) { ffc0a094: 94 21 ff f0 stwu r1,-16(r1) ffc0a098: 7c 08 02 a6 mflr r0 ffc0a09c: 93 e1 00 0c stw r31,12(r1) ffc0a0a0: 7c 7f 1b 78 mr r31,r3 ffc0a0a4: 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)) ) { ffc0a0a8: 48 00 21 39 bl ffc0c1e0 <_Thread_queue_Dequeue> ffc0a0ac: 2f 83 00 00 cmpwi cr7,r3,0 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; ffc0a0b0: 38 60 00 00 li r3,0 if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { ffc0a0b4: 41 9e 00 18 beq- cr7,ffc0a0cc <_CORE_semaphore_Surrender+0x38> status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } ffc0a0b8: 80 01 00 14 lwz r0,20(r1) ffc0a0bc: 83 e1 00 0c lwz r31,12(r1) ffc0a0c0: 38 21 00 10 addi r1,r1,16 ffc0a0c4: 7c 08 03 a6 mtlr r0 ffc0a0c8: 4e 80 00 20 blr static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a0cc: 7c 00 00 a6 mfmsr r0 ffc0a0d0: 7d 30 42 a6 mfsprg r9,0 ffc0a0d4: 7c 09 48 78 andc r9,r0,r9 ffc0a0d8: 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 ) ffc0a0dc: 81 3f 00 48 lwz r9,72(r31) the_semaphore->count += 1; else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; ffc0a0e0: 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 ) ffc0a0e4: 81 7f 00 40 lwz r11,64(r31) ffc0a0e8: 7f 89 58 40 cmplw cr7,r9,r11 ffc0a0ec: 40 9c 00 10 bge- cr7,ffc0a0fc <_CORE_semaphore_Surrender+0x68><== NEVER TAKEN the_semaphore->count += 1; ffc0a0f0: 39 29 00 01 addi r9,r9,1 ffc0a0f4: 91 3f 00 48 stw r9,72(r31) { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; ffc0a0f8: 38 60 00 00 li r3,0 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a0fc: 7c 00 01 24 mtmsr r0 status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } ffc0a100: 80 01 00 14 lwz r0,20(r1) ffc0a104: 83 e1 00 0c lwz r31,12(r1) ffc0a108: 38 21 00 10 addi r1,r1,16 ffc0a10c: 7c 08 03 a6 mtlr r0 ffc0a110: 4e 80 00 20 blr =============================================================================== ffc10470 <_Chain_Initialize>: Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10470: 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; ffc10474: 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 ); ffc10478: 39 43 00 04 addi r10,r3,4 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; ffc1047c: 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; ffc10480: 7c 69 1b 78 mr r9,r3 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10484: 41 82 00 38 beq- ffc104bc <_Chain_Initialize+0x4c> <== NEVER TAKEN ffc10488: 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; ffc1048c: 7c a9 03 a6 mtctr r5 Chain_Node *next = starting_address; ffc10490: 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; ffc10494: 7c 6b 1b 78 mr r11,r3 ffc10498: 48 00 00 0c b ffc104a4 <_Chain_Initialize+0x34> Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc1049c: 7d 2b 4b 78 mr r11,r9 current->next = next; next->previous = current; current = next; next = (Chain_Node *) ffc104a0: 7c 09 03 78 mr r9,r0 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { current->next = next; ffc104a4: 91 2b 00 00 stw r9,0(r11) * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( ffc104a8: 7c 09 32 14 add r0,r9,r6 head->previous = NULL; while ( count-- ) { current->next = next; next->previous = current; ffc104ac: 91 69 00 04 stw r11,4(r9) Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc104b0: 42 00 ff ec bdnz+ ffc1049c <_Chain_Initialize+0x2c> * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( ffc104b4: 7c c6 41 d6 mullw r6,r6,r8 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc104b8: 7d 24 32 14 add r9,r4,r6 current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; ffc104bc: 91 49 00 00 stw r10,0(r9) tail->previous = current; ffc104c0: 91 23 00 08 stw r9,8(r3) } ffc104c4: 4e 80 00 20 blr =============================================================================== ffc0881c <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { ffc0881c: 94 21 ff f0 stwu r1,-16(r1) ffc08820: 7c 08 02 a6 mflr r0 ffc08824: 90 01 00 14 stw r0,20(r1) ffc08828: 93 e1 00 0c stw r31,12(r1) ffc0882c: 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 ]; ffc08830: 81 63 01 30 lwz r11,304(r3) option_set = (rtems_option) the_thread->Wait.option; ffc08834: 80 c3 00 30 lwz r6,48(r3) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc08838: 7d 40 00 a6 mfmsr r10 ffc0883c: 7c 10 42 a6 mfsprg r0,0 ffc08840: 7d 40 00 78 andc r0,r10,r0 ffc08844: 7c 00 01 24 mtmsr r0 _ISR_Disable( level ); pending_events = api->pending_events; ffc08848: 81 2b 00 00 lwz r9,0(r11) event_condition = (rtems_event_set) the_thread->Wait.count; ffc0884c: 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 ) ) { ffc08850: 7c 08 48 39 and. r8,r0,r9 ffc08854: 41 82 00 b0 beq- ffc08904 <_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() && ffc08858: 3c e0 00 00 lis r7,0 ffc0885c: 38 e7 31 24 addi r7,r7,12580 ffc08860: 80 a7 00 08 lwz r5,8(r7) ffc08864: 2f 85 00 00 cmpwi cr7,r5,0 ffc08868: 41 9e 00 10 beq- cr7,ffc08878 <_Event_Surrender+0x5c> ffc0886c: 80 e7 00 0c lwz r7,12(r7) ffc08870: 7f 83 38 00 cmpw cr7,r3,r7 ffc08874: 41 9e 00 d0 beq- cr7,ffc08944 <_Event_Surrender+0x128> */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); ffc08878: 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 ) ) { ffc0887c: 70 e5 01 00 andi. r5,r7,256 ffc08880: 41 82 00 6c beq- ffc088ec <_Event_Surrender+0xd0> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { ffc08884: 7f 80 40 00 cmpw cr7,r0,r8 ffc08888: 41 9e 00 0c beq- cr7,ffc08894 <_Event_Surrender+0x78> ffc0888c: 70 c0 00 02 andi. r0,r6,2 ffc08890: 41 82 00 5c beq- ffc088ec <_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; ffc08894: 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) ); ffc08898: 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; ffc0889c: 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 ); ffc088a0: 91 2b 00 00 stw r9,0(r11) the_thread->Wait.count = 0; ffc088a4: 90 1f 00 24 stw r0,36(r31) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; ffc088a8: 91 07 00 00 stw r8,0(r7) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc088ac: 7c 00 00 a6 mfmsr r0 ffc088b0: 7d 40 01 24 mtmsr r10 ffc088b4: 7c 00 01 24 mtmsr r0 _ISR_Flash( level ); if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { ffc088b8: 80 1f 00 50 lwz r0,80(r31) ffc088bc: 2f 80 00 02 cmpwi cr7,r0,2 ffc088c0: 41 9e 00 5c beq- cr7,ffc0891c <_Event_Surrender+0x100> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc088c4: 7d 40 01 24 mtmsr r10 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc088c8: 3c 80 10 03 lis r4,4099 ffc088cc: 7f e3 fb 78 mr r3,r31 ffc088d0: 60 84 ff f8 ori r4,r4,65528 ffc088d4: 48 00 30 21 bl ffc0b8f4 <_Thread_Clear_state> } return; } } _ISR_Enable( level ); } ffc088d8: 80 01 00 14 lwz r0,20(r1) ffc088dc: 83 e1 00 0c lwz r31,12(r1) ffc088e0: 38 21 00 10 addi r1,r1,16 ffc088e4: 7c 08 03 a6 mtlr r0 ffc088e8: 4e 80 00 20 blr ffc088ec: 7d 40 01 24 mtmsr r10 ffc088f0: 80 01 00 14 lwz r0,20(r1) ffc088f4: 83 e1 00 0c lwz r31,12(r1) ffc088f8: 38 21 00 10 addi r1,r1,16 ffc088fc: 7c 08 03 a6 mtlr r0 ffc08900: 4e 80 00 20 blr ffc08904: 7d 40 01 24 mtmsr r10 ffc08908: 80 01 00 14 lwz r0,20(r1) ffc0890c: 83 e1 00 0c lwz r31,12(r1) ffc08910: 38 21 00 10 addi r1,r1,16 ffc08914: 7c 08 03 a6 mtlr r0 ffc08918: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; ffc0891c: 38 00 00 03 li r0,3 ffc08920: 90 1f 00 50 stw r0,80(r31) ffc08924: 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 ); ffc08928: 38 7f 00 48 addi r3,r31,72 ffc0892c: 48 00 4a 31 bl ffc0d35c <_Watchdog_Remove> ffc08930: 3c 80 10 03 lis r4,4099 ffc08934: 7f e3 fb 78 mr r3,r31 ffc08938: 60 84 ff f8 ori r4,r4,65528 ffc0893c: 48 00 2f b9 bl ffc0b8f4 <_Thread_Clear_state> ffc08940: 4b ff ff b0 b ffc088f0 <_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) || ffc08944: 3c e0 00 00 lis r7,0 ffc08948: 80 a7 28 38 lwz r5,10296(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 ) && ffc0894c: 2f 85 00 02 cmpwi cr7,r5,2 ffc08950: 41 9e 00 10 beq- cr7,ffc08960 <_Event_Surrender+0x144> <== NEVER TAKEN ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { ffc08954: 80 a7 28 38 lwz r5,10296(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) || ffc08958: 2f 85 00 01 cmpwi cr7,r5,1 ffc0895c: 40 9e ff 1c bne+ cr7,ffc08878 <_Event_Surrender+0x5c> (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { ffc08960: 7f 80 40 00 cmpw cr7,r0,r8 ffc08964: 41 9e 00 0c beq- cr7,ffc08970 <_Event_Surrender+0x154> ffc08968: 70 c0 00 02 andi. r0,r6,2 ffc0896c: 41 82 00 24 beq- ffc08990 <_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; ffc08970: 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; ffc08974: 38 00 00 00 li r0,0 ffc08978: 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 ); ffc0897c: 91 2b 00 00 stw r9,0(r11) the_thread->Wait.count = 0; ffc08980: 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; ffc08984: 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; ffc08988: 91 06 00 00 stw r8,0(r6) _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; ffc0898c: 90 07 28 38 stw r0,10296(r7) ffc08990: 7d 40 01 24 mtmsr r10 ffc08994: 4b ff ff 5c b ffc088f0 <_Event_Surrender+0xd4> =============================================================================== ffc08998 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { ffc08998: 94 21 ff e8 stwu r1,-24(r1) ffc0899c: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); ffc089a0: 38 81 00 08 addi r4,r1,8 void _Event_Timeout( Objects_Id id, void *ignored ) { ffc089a4: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); ffc089a8: 48 00 34 11 bl ffc0bdb8 <_Thread_Get> switch ( location ) { ffc089ac: 80 01 00 08 lwz r0,8(r1) ffc089b0: 2f 80 00 00 cmpwi cr7,r0,0 ffc089b4: 40 9e 00 50 bne- cr7,ffc08a04 <_Event_Timeout+0x6c> <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc089b8: 7d 20 00 a6 mfmsr r9 ffc089bc: 7d 70 42 a6 mfsprg r11,0 ffc089c0: 7d 2b 58 78 andc r11,r9,r11 ffc089c4: 7d 60 01 24 mtmsr r11 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc089c8: 3d 60 00 00 lis r11,0 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { ffc089cc: 81 6b 31 30 lwz r11,12592(r11) _ISR_Enable( level ); return; } #endif the_thread->Wait.count = 0; ffc089d0: 90 03 00 24 stw r0,36(r3) if ( _Thread_Is_executing( the_thread ) ) { ffc089d4: 7f 83 58 00 cmpw cr7,r3,r11 ffc089d8: 41 9e 00 3c beq- cr7,ffc08a14 <_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; ffc089dc: 38 00 00 06 li r0,6 ffc089e0: 90 03 00 34 stw r0,52(r3) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc089e4: 7d 20 01 24 mtmsr r9 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc089e8: 3c 80 10 03 lis r4,4099 ffc089ec: 60 84 ff f8 ori r4,r4,65528 ffc089f0: 48 00 2f 05 bl ffc0b8f4 <_Thread_Clear_state> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc089f4: 3d 20 00 00 lis r9,0 ffc089f8: 81 69 27 e8 lwz r11,10216(r9) ffc089fc: 38 0b ff ff addi r0,r11,-1 ffc08a00: 90 09 27 e8 stw r0,10216(r9) case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } ffc08a04: 80 01 00 1c lwz r0,28(r1) ffc08a08: 38 21 00 18 addi r1,r1,24 ffc08a0c: 7c 08 03 a6 mtlr r0 ffc08a10: 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 ) ffc08a14: 3d 60 00 00 lis r11,0 ffc08a18: 80 0b 28 38 lwz r0,10296(r11) ffc08a1c: 2f 80 00 01 cmpwi cr7,r0,1 ffc08a20: 40 9e ff bc bne+ cr7,ffc089dc <_Event_Timeout+0x44> _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; ffc08a24: 38 00 00 02 li r0,2 ffc08a28: 90 0b 28 38 stw r0,10296(r11) ffc08a2c: 4b ff ff b0 b ffc089dc <_Event_Timeout+0x44> =============================================================================== ffc106d4 <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc106d4: 94 21 ff e0 stwu r1,-32(r1) ffc106d8: 7c 08 02 a6 mflr r0 ffc106dc: 7d 80 00 26 mfcr r12 ffc106e0: 7c 89 23 78 mr r9,r4 ffc106e4: 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 ffc106e8: 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 ) { ffc106ec: 7f 84 00 40 cmplw cr7,r4,r0 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc106f0: 93 a1 00 14 stw r29,20(r1) ffc106f4: 7c 7d 1b 78 mr r29,r3 ffc106f8: 91 81 00 08 stw r12,8(r1) ffc106fc: 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; ffc10700: 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; ffc10704: 38 60 00 00 li r3,0 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc10708: 93 81 00 10 stw r28,16(r1) ffc1070c: 93 c1 00 18 stw r30,24(r1) ffc10710: 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 ) { ffc10714: 41 9d 01 60 bgt- cr7,ffc10874 <_Heap_Allocate_aligned_with_boundary+0x1a0> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { ffc10718: 2e 06 00 00 cmpwi cr4,r6,0 ffc1071c: 40 92 01 8c bne- cr4,ffc108a8 <_Heap_Allocate_aligned_with_boundary+0x1d4> if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } ffc10720: 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 ) { ffc10724: 38 60 00 00 li r3,0 ffc10728: 7f 9d 20 00 cmpw cr7,r29,r4 ffc1072c: 41 9e 01 48 beq- cr7,ffc10874 <_Heap_Allocate_aligned_with_boundary+0x1a0> ffc10730: 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 ) { ffc10734: 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 ffc10738: 3b 6c 00 07 addi r27,r12,7 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; ffc1073c: 23 89 00 04 subfic r28,r9,4 ffc10740: 48 00 00 24 b ffc10764 <_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; ffc10744: 3b e4 00 08 addi r31,r4,8 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { ffc10748: 2f 9f 00 00 cmpwi cr7,r31,0 ffc1074c: 40 9e 00 ec bne- cr7,ffc10838 <_Heap_Allocate_aligned_with_boundary+0x164><== ALWAYS TAKEN break; } block = block->next; ffc10750: 80 84 00 08 lwz r4,8(r4) ffc10754: 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 ) { ffc10758: 7f 9d 20 00 cmpw cr7,r29,r4 ffc1075c: 41 9e 01 44 beq- cr7,ffc108a0 <_Heap_Allocate_aligned_with_boundary+0x1cc> ffc10760: 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 ) { ffc10764: 81 64 00 04 lwz r11,4(r4) ffc10768: 7f 80 58 40 cmplw cr7,r0,r11 ffc1076c: 40 bc ff e4 bge- cr7,ffc10750 <_Heap_Allocate_aligned_with_boundary+0x7c> if ( alignment == 0 ) { ffc10770: 41 a2 ff d4 beq- ffc10744 <_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; ffc10774: 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; } ffc10778: 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; ffc1077c: 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; ffc10780: 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); ffc10784: 7f ff 2b 96 divwu r31,r31,r5 ffc10788: 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; ffc1078c: 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 ffc10790: 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 ) { ffc10794: 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; ffc10798: 38 64 00 08 addi r3,r4,8 ffc1079c: 40 9c 00 0c bge- cr7,ffc107a8 <_Heap_Allocate_aligned_with_boundary+0xd4> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc107a0: 7d 6b 2b 96 divwu r11,r11,r5 ffc107a4: 7f eb 29 d6 mullw r31,r11,r5 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { ffc107a8: 41 92 00 60 beq- cr4,ffc10808 <_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; ffc107ac: 7d 5f 4a 14 add r10,r31,r9 ffc107b0: 7d 6a 33 96 divwu r11,r10,r6 ffc107b4: 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 ) { ffc107b8: 7f 9f 58 40 cmplw cr7,r31,r11 ffc107bc: 40 9c 00 4c bge- cr7,ffc10808 <_Heap_Allocate_aligned_with_boundary+0x134> ffc107c0: 7f 8a 58 40 cmplw cr7,r10,r11 ffc107c4: 40 9d 00 44 ble- cr7,ffc10808 <_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; ffc107c8: 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 ) { ffc107cc: 7f 88 58 40 cmplw cr7,r8,r11 ffc107d0: 40 bd 00 10 ble+ cr7,ffc107e0 <_Heap_Allocate_aligned_with_boundary+0x10c> ffc107d4: 4b ff ff 7c b ffc10750 <_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 ) { ffc107d8: 40 99 00 30 ble- cr6,ffc10808 <_Heap_Allocate_aligned_with_boundary+0x134> if ( boundary_line < boundary_floor ) { ffc107dc: 41 a5 ff 74 bgt- cr1,ffc10750 <_Heap_Allocate_aligned_with_boundary+0x7c><== NEVER TAKEN return 0; } alloc_begin = boundary_line - alloc_size; ffc107e0: 7f e9 58 50 subf r31,r9,r11 ffc107e4: 7f ff 2b 96 divwu r31,r31,r5 ffc107e8: 7f ff 29 d6 mullw r31,r31,r5 alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; ffc107ec: 7d 5f 4a 14 add r10,r31,r9 ffc107f0: 7d 6a 33 96 divwu r11,r10,r6 ffc107f4: 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 ) { ffc107f8: 7f 9f 58 40 cmplw cr7,r31,r11 ffc107fc: 7f 0a 58 40 cmplw cr6,r10,r11 if ( boundary_line < boundary_floor ) { ffc10800: 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 ) { ffc10804: 41 9c ff d4 blt+ cr7,ffc107d8 <_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 ) { ffc10808: 7f 83 f8 40 cmplw cr7,r3,r31 ffc1080c: 41 bd ff 44 bgt- cr7,ffc10750 <_Heap_Allocate_aligned_with_boundary+0x7c> ffc10810: 7d 7f 63 96 divwu r11,r31,r12 ffc10814: 7d 6b 61 d6 mullw r11,r11,r12 ffc10818: 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; ffc1081c: 7d 6a 5a 14 add r11,r10,r11 if ( free_size >= min_block_size || free_size == 0 ) { ffc10820: 7f 87 58 40 cmplw cr7,r7,r11 ffc10824: 40 bd ff 24 ble- cr7,ffc10748 <_Heap_Allocate_aligned_with_boundary+0x74> ffc10828: 2f 8b 00 00 cmpwi cr7,r11,0 ffc1082c: 40 be ff 24 bne- cr7,ffc10750 <_Heap_Allocate_aligned_with_boundary+0x7c> } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { ffc10830: 2f 9f 00 00 cmpwi cr7,r31,0 ffc10834: 41 9e ff 1c beq+ cr7,ffc10750 <_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; ffc10838: 81 7d 00 48 lwz r11,72(r29) stats->searches += search_count; block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc1083c: 7f a3 eb 78 mr r3,r29 } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; ffc10840: 80 1d 00 4c lwz r0,76(r29) block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc10844: 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; ffc10848: 39 6b 00 01 addi r11,r11,1 stats->searches += search_count; ffc1084c: 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; ffc10850: 91 7d 00 48 stw r11,72(r29) stats->searches += search_count; block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc10854: 7d 26 4b 78 mr r6,r9 } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; ffc10858: 90 1d 00 4c stw r0,76(r29) block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc1085c: 4b ff 9d 51 bl ffc0a5ac <_Heap_Block_allocate> ffc10860: 7f e3 fb 78 mr r3,r31 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { ffc10864: 80 1d 00 44 lwz r0,68(r29) ffc10868: 7f 80 f0 40 cmplw cr7,r0,r30 ffc1086c: 40 9c 00 08 bge- cr7,ffc10874 <_Heap_Allocate_aligned_with_boundary+0x1a0> stats->max_search = search_count; ffc10870: 93 dd 00 44 stw r30,68(r29) } return (void *) alloc_begin; } ffc10874: 80 01 00 24 lwz r0,36(r1) ffc10878: 81 81 00 08 lwz r12,8(r1) ffc1087c: 7c 08 03 a6 mtlr r0 ffc10880: 83 61 00 0c lwz r27,12(r1) ffc10884: 83 81 00 10 lwz r28,16(r1) ffc10888: 7d 80 81 20 mtcrf 8,r12 ffc1088c: 83 a1 00 14 lwz r29,20(r1) ffc10890: 83 c1 00 18 lwz r30,24(r1) ffc10894: 83 e1 00 1c lwz r31,28(r1) ffc10898: 38 21 00 20 addi r1,r1,32 ffc1089c: 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 ) { ffc108a0: 38 60 00 00 li r3,0 ffc108a4: 4b ff ff c0 b ffc10864 <_Heap_Allocate_aligned_with_boundary+0x190> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { ffc108a8: 7f 84 30 40 cmplw cr7,r4,r6 ffc108ac: 41 bd ff c8 bgt- cr7,ffc10874 <_Heap_Allocate_aligned_with_boundary+0x1a0> return NULL; } if ( alignment == 0 ) { ffc108b0: 2f 85 00 00 cmpwi cr7,r5,0 ffc108b4: 40 be fe 6c bne- cr7,ffc10720 <_Heap_Allocate_aligned_with_boundary+0x4c> alignment = page_size; ffc108b8: 7d 85 63 78 mr r5,r12 ffc108bc: 4b ff fe 64 b ffc10720 <_Heap_Allocate_aligned_with_boundary+0x4c> =============================================================================== ffc10db0 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc10db0: 94 21 ff c0 stwu r1,-64(r1) ffc10db4: 7d 80 00 26 mfcr r12 ffc10db8: 7c 08 02 a6 mflr r0 ffc10dbc: 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; ffc10dc0: 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 ) { ffc10dc4: 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 ) { ffc10dc8: 90 01 00 44 stw r0,68(r1) ffc10dcc: 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; ffc10dd0: 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 ) { ffc10dd4: 93 c1 00 38 stw r30,56(r1) ffc10dd8: 7c 7e 1b 78 mr r30,r3 ffc10ddc: 93 01 00 20 stw r24,32(r1) ffc10de0: 93 21 00 24 stw r25,36(r1) ffc10de4: 7c d9 33 78 mr r25,r6 ffc10de8: 93 61 00 2c stw r27,44(r1) ffc10dec: 93 81 00 30 stw r28,48(r1) ffc10df0: 93 e1 00 3c stw r31,60(r1) ffc10df4: 7c 9f 23 78 mr r31,r4 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; ffc10df8: 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; ffc10dfc: 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 ) { ffc10e00: 92 e1 00 1c stw r23,28(r1) ffc10e04: 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; ffc10e08: 93 41 00 08 stw r26,8(r1) Heap_Block *extend_last_block = NULL; ffc10e0c: 93 41 00 0c stw r26,12(r1) uintptr_t const page_size = heap->page_size; ffc10e10: 83 9e 00 10 lwz r28,16(r30) uintptr_t const min_block_size = heap->min_block_size; ffc10e14: 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; ffc10e18: 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 ) { ffc10e1c: 40 9d 00 40 ble- cr7,ffc10e5c <_Heap_Extend+0xac> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } ffc10e20: 80 01 00 44 lwz r0,68(r1) ffc10e24: 81 81 00 18 lwz r12,24(r1) ffc10e28: 7c 08 03 a6 mtlr r0 ffc10e2c: 82 e1 00 1c lwz r23,28(r1) ffc10e30: 83 01 00 20 lwz r24,32(r1) ffc10e34: 7d 81 81 20 mtcrf 24,r12 ffc10e38: 83 21 00 24 lwz r25,36(r1) ffc10e3c: 83 41 00 28 lwz r26,40(r1) ffc10e40: 83 61 00 2c lwz r27,44(r1) ffc10e44: 83 81 00 30 lwz r28,48(r1) ffc10e48: 83 a1 00 34 lwz r29,52(r1) ffc10e4c: 83 c1 00 38 lwz r30,56(r1) ffc10e50: 83 e1 00 3c lwz r31,60(r1) ffc10e54: 38 21 00 40 addi r1,r1,64 ffc10e58: 4e 80 00 20 blr if ( extend_area_end < extend_area_begin ) { return false; } extend_area_ok = _Heap_Get_first_and_last_block( ffc10e5c: 7c 83 23 78 mr r3,r4 ffc10e60: 38 e1 00 08 addi r7,r1,8 ffc10e64: 7c a4 2b 78 mr r4,r5 ffc10e68: 39 01 00 0c addi r8,r1,12 ffc10e6c: 7f 85 e3 78 mr r5,r28 ffc10e70: 4b ff 99 75 bl ffc0a7e4 <_Heap_Get_first_and_last_block> page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { ffc10e74: 2f 83 00 00 cmpwi cr7,r3,0 /* For simplicity we reject extend areas that are too small */ return false; ffc10e78: 7f 43 d3 78 mr r3,r26 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { ffc10e7c: 41 be ff a4 beq- cr7,ffc10e20 <_Heap_Extend+0x70> ffc10e80: 7f 69 db 78 mr r9,r27 ffc10e84: 3a e0 00 00 li r23,0 ffc10e88: 38 00 00 00 li r0,0 ffc10e8c: 39 00 00 00 li r8,0 ffc10e90: 48 00 00 44 b ffc10ed4 <_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 ) { ffc10e94: 7f 9d 58 40 cmplw cr7,r29,r11 ffc10e98: 40 9c 00 08 bge- cr7,ffc10ea0 <_Heap_Extend+0xf0> ffc10e9c: 7d 20 4b 78 mr r0,r9 ffc10ea0: 7d 4b e3 96 divwu r10,r11,r28 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { ffc10ea4: 7f 8b f8 00 cmpw cr7,r11,r31 ffc10ea8: 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); ffc10eac: 39 4a ff f8 addi r10,r10,-8 ffc10eb0: 41 9e 00 64 beq- cr7,ffc10f14 <_Heap_Extend+0x164> start_block->prev_size = extend_area_end; merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { ffc10eb4: 7f 9f 58 40 cmplw cr7,r31,r11 ffc10eb8: 40 9d 00 08 ble- cr7,ffc10ec0 <_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 ) ffc10ebc: 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; ffc10ec0: 81 2a 00 04 lwz r9,4(r10) ffc10ec4: 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); ffc10ec8: 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 ); ffc10ecc: 7f 9b 48 00 cmpw cr7,r27,r9 ffc10ed0: 41 9e 00 60 beq- cr7,ffc10f30 <_Heap_Extend+0x180> return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; ffc10ed4: 7f 89 d8 00 cmpw cr7,r9,r27 ffc10ed8: 7d 2a 4b 78 mr r10,r9 ffc10edc: 41 9e 01 b8 beq- cr7,ffc11094 <_Heap_Extend+0x2e4> uintptr_t const sub_area_end = start_block->prev_size; ffc10ee0: 81 69 00 00 lwz r11,0(r9) Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( ffc10ee4: 7f 9f 58 40 cmplw cr7,r31,r11 ffc10ee8: 40 9c 00 0c bge- cr7,ffc10ef4 <_Heap_Extend+0x144> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ffc10eec: 7f 8a e8 40 cmplw cr7,r10,r29 ffc10ef0: 41 9c 02 28 blt- cr7,ffc11118 <_Heap_Extend+0x368> ) { return false; } if ( extend_area_end == sub_area_begin ) { ffc10ef4: 7f 8a e8 00 cmpw cr7,r10,r29 ffc10ef8: 40 9e ff 9c bne+ cr7,ffc10e94 <_Heap_Extend+0xe4> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10efc: 7d 4b e3 96 divwu r10,r11,r28 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { ffc10f00: 7f 8b f8 00 cmpw cr7,r11,r31 ffc10f04: 7d 4a e1 d6 mullw r10,r10,r28 sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { ffc10f08: 7d 28 4b 78 mr r8,r9 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc10f0c: 39 4a ff f8 addi r10,r10,-8 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { ffc10f10: 40 9e ff a4 bne+ cr7,ffc10eb4 <_Heap_Extend+0x104> <== ALWAYS TAKEN start_block->prev_size = extend_area_end; ffc10f14: 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 ) ffc10f18: 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; ffc10f1c: 81 2a 00 04 lwz r9,4(r10) ffc10f20: 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); ffc10f24: 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 ); ffc10f28: 7f 9b 48 00 cmpw cr7,r27,r9 ffc10f2c: 40 9e ff a8 bne+ cr7,ffc10ed4 <_Heap_Extend+0x124> <== NEVER TAKEN if ( extend_area_begin < heap->area_begin ) { ffc10f30: 81 3e 00 18 lwz r9,24(r30) ffc10f34: 7f 9f 48 40 cmplw cr7,r31,r9 ffc10f38: 41 9c 01 64 blt- cr7,ffc1109c <_Heap_Extend+0x2ec> heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { ffc10f3c: 81 3e 00 1c lwz r9,28(r30) ffc10f40: 7f 9d 48 40 cmplw cr7,r29,r9 ffc10f44: 40 9d 00 08 ble- cr7,ffc10f4c <_Heap_Extend+0x19c> heap->area_end = extend_area_end; ffc10f48: 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 ) { ffc10f4c: 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; ffc10f50: 81 21 00 08 lwz r9,8(r1) ffc10f54: 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 ) { ffc10f58: 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; ffc10f5c: 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 = ffc10f60: 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; ffc10f64: 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; ffc10f68: 91 4b 00 00 stw r10,0(r11) extend_last_block->size_and_flag = 0; ffc10f6c: 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 = ffc10f70: 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; ffc10f74: 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 ) { ffc10f78: 40 9d 01 58 ble- cr7,ffc110d0 <_Heap_Extend+0x320> <== ALWAYS TAKEN heap->first_block = extend_first_block; ffc10f7c: 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 ) { ffc10f80: 2e 08 00 00 cmpwi cr4,r8,0 ffc10f84: 41 92 01 b0 beq- cr4,ffc11134 <_Heap_Extend+0x384> Heap_Control *heap, uintptr_t extend_area_begin, Heap_Block *first_block ) { uintptr_t const page_size = heap->page_size; ffc10f88: 80 1e 00 10 lwz r0,16(r30) uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); ffc10f8c: 3b ff 00 08 addi r31,r31,8 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; ffc10f90: 7d 3f 03 96 divwu r9,r31,r0 ffc10f94: 7d 29 01 d6 mullw r9,r9,r0 if ( remainder != 0 ) { ffc10f98: 7d 29 f8 51 subf. r9,r9,r31 ffc10f9c: 41 82 00 0c beq- ffc10fa8 <_Heap_Extend+0x1f8> <== NEVER TAKEN return value - remainder + alignment; ffc10fa0: 7f ff 02 14 add r31,r31,r0 ffc10fa4: 7f e9 f8 50 subf r31,r9,r31 uintptr_t const new_first_block_begin = ffc10fa8: 38 9f ff f8 addi r4,r31,-8 uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; ffc10fac: 81 28 00 00 lwz r9,0(r8) uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = new_first_block_alloc_begin - HEAP_BLOCK_HEADER_SIZE; uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = ffc10fb0: 7c 04 40 50 subf r0,r4,r8 first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; ffc10fb4: 60 00 00 01 ori r0,r0,1 uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; ffc10fb8: 91 3f ff f8 stw r9,-8(r31) new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; _Heap_Free_block( heap, new_first_block ); ffc10fbc: 7f c3 f3 78 mr r3,r30 uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; ffc10fc0: 90 04 00 04 stw r0,4(r4) _Heap_Free_block( heap, new_first_block ); ffc10fc4: 4b ff fd b1 bl ffc10d74 <_Heap_Free_block> link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { ffc10fc8: 2d 9a 00 00 cmpwi cr3,r26,0 ffc10fcc: 41 8e 01 18 beq- cr3,ffc110e4 <_Heap_Extend+0x334> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10fd0: 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, ffc10fd4: 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( ffc10fd8: 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) ffc10fdc: 81 7a 00 04 lwz r11,4(r26) ffc10fe0: 7c 00 4b 96 divwu r0,r0,r9 ffc10fe4: 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 ); ffc10fe8: 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) ffc10fec: 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 = ffc10ff0: 7d 20 d2 14 add r9,r0,r26 (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; ffc10ff4: 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 = ffc10ff8: 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 ); ffc10ffc: 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; ffc11000: 81 3a 00 04 lwz r9,4(r26) ffc11004: 55 29 07 fe clrlwi r9,r9,31 block->size_and_flag = size | flag; ffc11008: 7c 00 4b 78 or r0,r0,r9 ffc1100c: 90 1a 00 04 stw r0,4(r26) ffc11010: 4b ff fd 65 bl ffc10d74 <_Heap_Free_block> extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { ffc11014: 41 92 01 0c beq- cr4,ffc11120 <_Heap_Extend+0x370> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } ffc11018: 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 ) ffc1101c: 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( ffc11020: 81 5e 00 20 lwz r10,32(r30) *extended_size_ptr = extended_size; return true; ffc11024: 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; ffc11028: 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; ffc1102c: 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( ffc11030: 7d 49 50 50 subf r10,r9,r10 /* Statistics */ stats->size += extended_size; ffc11034: 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; ffc11038: 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; ffc1103c: 7f 18 40 50 subf r24,r24,r8 block->size_and_flag = size | flag; ffc11040: 7d 4b 5b 78 or r11,r10,r11 /* Statistics */ stats->size += extended_size; ffc11044: 7c 00 c2 14 add r0,r0,r24 ffc11048: 91 69 00 04 stw r11,4(r9) ffc1104c: 90 1e 00 2c stw r0,44(r30) if ( extended_size_ptr != NULL ) ffc11050: 41 be fd d0 beq- cr7,ffc10e20 <_Heap_Extend+0x70> <== NEVER TAKEN *extended_size_ptr = extended_size; return true; } ffc11054: 80 01 00 44 lwz r0,68(r1) ffc11058: 81 81 00 18 lwz r12,24(r1) ffc1105c: 7c 08 03 a6 mtlr r0 /* Statistics */ stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; ffc11060: 93 19 00 00 stw r24,0(r25) return true; } ffc11064: 7d 81 81 20 mtcrf 24,r12 ffc11068: 82 e1 00 1c lwz r23,28(r1) ffc1106c: 83 01 00 20 lwz r24,32(r1) ffc11070: 83 21 00 24 lwz r25,36(r1) ffc11074: 83 41 00 28 lwz r26,40(r1) ffc11078: 83 61 00 2c lwz r27,44(r1) ffc1107c: 83 81 00 30 lwz r28,48(r1) ffc11080: 83 a1 00 34 lwz r29,52(r1) ffc11084: 83 c1 00 38 lwz r30,56(r1) ffc11088: 83 e1 00 3c lwz r31,60(r1) ffc1108c: 38 21 00 40 addi r1,r1,64 ffc11090: 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; ffc11094: 81 5e 00 18 lwz r10,24(r30) ffc11098: 4b ff fe 48 b ffc10ee0 <_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 ) { ffc1109c: 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; ffc110a0: 81 21 00 08 lwz r9,8(r1) ffc110a4: 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 ) { ffc110a8: 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; ffc110ac: 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 = ffc110b0: 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; ffc110b4: 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; ffc110b8: 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; ffc110bc: 91 4b 00 00 stw r10,0(r11) extend_last_block->size_and_flag = 0; ffc110c0: 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 = ffc110c4: 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; ffc110c8: 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 ) { ffc110cc: 41 bd fe b0 bgt- cr7,ffc10f7c <_Heap_Extend+0x1cc> <== ALWAYS TAKEN heap->first_block = extend_first_block; } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { ffc110d0: 81 3e 00 24 lwz r9,36(r30) ffc110d4: 7f 89 58 40 cmplw cr7,r9,r11 ffc110d8: 40 bc fe a8 bge- cr7,ffc10f80 <_Heap_Extend+0x1d0> heap->last_block = extend_last_block; ffc110dc: 91 7e 00 24 stw r11,36(r30) ffc110e0: 4b ff fe a0 b ffc10f80 <_Heap_Extend+0x1d0> ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { ffc110e4: 2f 97 00 00 cmpwi cr7,r23,0 ffc110e8: 41 be ff 2c beq- cr7,ffc11014 <_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; ffc110ec: 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 ); ffc110f0: 80 01 00 08 lwz r0,8(r1) ffc110f4: 55 29 07 fe clrlwi r9,r9,31 ffc110f8: 7c 17 00 50 subf r0,r23,r0 block->size_and_flag = size | flag; ffc110fc: 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( ffc11100: 81 21 00 0c lwz r9,12(r1) ffc11104: 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; ffc11108: 80 09 00 04 lwz r0,4(r9) ffc1110c: 60 00 00 01 ori r0,r0,1 ffc11110: 90 09 00 04 stw r0,4(r9) ffc11114: 4b ff ff 00 b ffc11014 <_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; ffc11118: 38 60 00 00 li r3,0 ffc1111c: 4b ff fd 04 b ffc10e20 <_Heap_Extend+0x70> extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { ffc11120: 40 8e fe f8 bne+ cr3,ffc11018 <_Heap_Extend+0x268> _Heap_Free_block( heap, extend_first_block ); ffc11124: 80 81 00 08 lwz r4,8(r1) ffc11128: 7f c3 f3 78 mr r3,r30 ffc1112c: 4b ff fc 49 bl ffc10d74 <_Heap_Free_block> ffc11130: 4b ff fe e8 b ffc11018 <_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 ) { ffc11134: 2f 80 00 00 cmpwi cr7,r0,0 ffc11138: 41 be fe 90 beq- cr7,ffc10fc8 <_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; ffc1113c: 7c 0b 00 50 subf r0,r11,r0 ffc11140: 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 = ffc11144: 90 0b 00 04 stw r0,4(r11) ffc11148: 4b ff fe 80 b ffc10fc8 <_Heap_Extend+0x218> =============================================================================== ffc108c0 <_Heap_Free>: /* * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { ffc108c0: 2c 04 00 00 cmpwi r4,0 return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { ffc108c4: 94 21 ff f0 stwu r1,-16(r1) ffc108c8: 7c 69 1b 78 mr r9,r3 ffc108cc: 93 e1 00 0c stw r31,12(r1) * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { return true; ffc108d0: 38 60 00 01 li r3,1 /* * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { ffc108d4: 41 82 01 44 beq- ffc10a18 <_Heap_Free+0x158> ffc108d8: 80 09 00 10 lwz r0,16(r9) alloc_begin = (uintptr_t) alloc_begin_ptr; block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { return false; ffc108dc: 38 60 00 00 li r3,0 RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in_heap( const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block ffc108e0: 81 69 00 20 lwz r11,32(r9) RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc108e4: 7c 84 03 96 divwu r4,r4,r0 ffc108e8: 7c 84 01 d6 mullw r4,r4,r0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc108ec: 38 84 ff f8 addi r4,r4,-8 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; ffc108f0: 7f 84 58 40 cmplw cr7,r4,r11 ffc108f4: 41 9c 01 24 blt- cr7,ffc10a18 <_Heap_Free+0x158> ffc108f8: 80 09 00 24 lwz r0,36(r9) ffc108fc: 7f 84 00 40 cmplw cr7,r4,r0 ffc10900: 41 9d 01 18 bgt- cr7,ffc10a18 <_Heap_Free+0x158> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc10904: 81 04 00 04 lwz r8,4(r4) - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; ffc10908: 55 07 00 3c rlwinm r7,r8,0,0,30 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); ffc1090c: 7d 44 3a 14 add r10,r4,r7 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; ffc10910: 7f 8b 50 40 cmplw cr7,r11,r10 ffc10914: 41 9d 01 04 bgt- cr7,ffc10a18 <_Heap_Free+0x158> <== NEVER TAKEN ffc10918: 7f 80 50 40 cmplw cr7,r0,r10 ffc1091c: 41 9c 00 fc blt- cr7,ffc10a18 <_Heap_Free+0x158> <== NEVER TAKEN ffc10920: 80 ca 00 04 lwz r6,4(r10) return false; } _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_prev_used( next_block ) ) { ffc10924: 70 c5 00 01 andi. r5,r6,1 ffc10928: 41 82 00 f0 beq- ffc10a18 <_Heap_Free+0x158> return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); ffc1092c: 7f 80 50 00 cmpw cr7,r0,r10 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; ffc10930: 54 c5 00 3c rlwinm r5,r6,0,0,30 ffc10934: 38 c0 00 00 li r6,0 ffc10938: 41 9e 00 18 beq- cr7,ffc10950 <_Heap_Free+0x90> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc1093c: 7c ca 2a 14 add r6,r10,r5 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; ffc10940: 80 c6 00 04 lwz r6,4(r6) return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) ffc10944: 70 c3 00 01 andi. r3,r6,1 ffc10948: 7c c0 00 26 mfcr r6 ffc1094c: 54 c6 1f fe rlwinm r6,r6,3,31,31 next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { ffc10950: 71 08 00 01 andi. r8,r8,1 ffc10954: 40 82 00 6c bne- ffc109c0 <_Heap_Free+0x100> uintptr_t const prev_size = block->prev_size; ffc10958: 83 e4 00 00 lwz r31,0(r4) Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { _HAssert( false ); return( false ); ffc1095c: 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); ffc10960: 7d 9f 20 50 subf r12,r31,r4 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; ffc10964: 7f 8b 60 40 cmplw cr7,r11,r12 ffc10968: 41 9d 00 b0 bgt- cr7,ffc10a18 <_Heap_Free+0x158> <== NEVER TAKEN ffc1096c: 7f 80 60 40 cmplw cr7,r0,r12 ffc10970: 7d 03 43 78 mr r3,r8 ffc10974: 41 9c 00 a4 blt- cr7,ffc10a18 <_Heap_Free+0x158> <== NEVER TAKEN block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; ffc10978: 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) ) { ffc1097c: 70 0b 00 01 andi. r11,r0,1 ffc10980: 41 82 00 98 beq- ffc10a18 <_Heap_Free+0x158> <== NEVER TAKEN _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ ffc10984: 2f 86 00 00 cmpwi cr7,r6,0 ffc10988: 41 9e 00 e8 beq- cr7,ffc10a70 <_Heap_Free+0x1b0> uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ffc1098c: 81 09 00 38 lwz r8,56(r9) _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; ffc10990: 7c a7 2a 14 add r5,r7,r5 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc10994: 81 6a 00 08 lwz r11,8(r10) _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; ffc10998: 7f e5 fa 14 add r31,r5,r31 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc1099c: 81 4a 00 0c lwz r10,12(r10) } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ffc109a0: 39 08 ff ff addi r8,r8,-1 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc109a4: 63 e0 00 01 ori r0,r31,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; ffc109a8: 91 6a 00 08 stw r11,8(r10) next->prev = prev; ffc109ac: 91 4b 00 0c stw r10,12(r11) } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ffc109b0: 91 09 00 38 stw r8,56(r9) prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc109b4: 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; ffc109b8: 7f ec f9 2e stwx r31,r12,r31 ffc109bc: 48 00 00 34 b ffc109f0 <_Heap_Free+0x130> uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ ffc109c0: 2f 86 00 00 cmpwi cr7,r6,0 ffc109c4: 41 9e 00 60 beq- cr7,ffc10a24 <_Heap_Free+0x164> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc109c8: 81 6a 00 08 lwz r11,8(r10) prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; ffc109cc: 7c a5 3a 14 add r5,r5,r7 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc109d0: 81 4a 00 0c lwz r10,12(r10) next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc109d4: 60 a0 00 01 ori r0,r5,1 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; ffc109d8: 91 64 00 08 stw r11,8(r4) new_block->prev = prev; ffc109dc: 91 44 00 0c stw r10,12(r4) next->prev = new_block; prev->next = new_block; ffc109e0: 90 8a 00 08 stw r4,8(r10) Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; ffc109e4: 90 8b 00 0c stw r4,12(r11) ffc109e8: 90 04 00 04 stw r0,4(r4) next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; ffc109ec: 7c a4 29 2e stwx r5,r4,r5 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc109f0: 81 69 00 40 lwz r11,64(r9) ++stats->frees; stats->free_size += block_size; return( true ); ffc109f4: 38 60 00 01 li r3,1 } } /* Statistics */ --stats->used_blocks; ++stats->frees; ffc109f8: 81 09 00 50 lwz r8,80(r9) stats->free_size += block_size; ffc109fc: 81 49 00 30 lwz r10,48(r9) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc10a00: 39 6b ff ff addi r11,r11,-1 ++stats->frees; ffc10a04: 38 08 00 01 addi r0,r8,1 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc10a08: 91 69 00 40 stw r11,64(r9) ++stats->frees; stats->free_size += block_size; ffc10a0c: 7c ea 3a 14 add r7,r10,r7 } } /* Statistics */ --stats->used_blocks; ++stats->frees; ffc10a10: 90 09 00 50 stw r0,80(r9) stats->free_size += block_size; ffc10a14: 90 e9 00 30 stw r7,48(r9) return( true ); } ffc10a18: 83 e1 00 0c lwz r31,12(r1) ffc10a1c: 38 21 00 10 addi r1,r1,16 ffc10a20: 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; ffc10a24: 81 09 00 38 lwz r8,56(r9) if ( stats->max_free_blocks < stats->free_blocks ) { ffc10a28: 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; ffc10a2c: 38 08 00 01 addi r0,r8,1 ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; ffc10a30: 91 24 00 0c stw r9,12(r4) next_block->prev_size = size; } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; ffc10a34: 60 e8 00 01 ori r8,r7,1 ffc10a38: 91 04 00 04 stw r8,4(r4) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { ffc10a3c: 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; ffc10a40: 81 0a 00 04 lwz r8,4(r10) RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; ffc10a44: 81 69 00 08 lwz r11,8(r9) ffc10a48: 55 08 00 3c rlwinm r8,r8,0,0,30 next_block->prev_size = block_size; ffc10a4c: 7c e4 39 2e stwx r7,r4,r7 new_block->next = next; ffc10a50: 91 64 00 08 stw r11,8(r4) } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; ffc10a54: 91 0a 00 04 stw r8,4(r10) new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; ffc10a58: 90 8b 00 0c stw r4,12(r11) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; ffc10a5c: 90 89 00 08 stw r4,8(r9) next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; ffc10a60: 90 09 00 38 stw r0,56(r9) if ( stats->max_free_blocks < stats->free_blocks ) { ffc10a64: 40 bd ff 8c ble- cr7,ffc109f0 <_Heap_Free+0x130> stats->max_free_blocks = stats->free_blocks; ffc10a68: 90 09 00 3c stw r0,60(r9) ffc10a6c: 4b ff ff 84 b ffc109f0 <_Heap_Free+0x130> prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; ffc10a70: 7f e7 fa 14 add r31,r7,r31 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc10a74: 63 e0 00 01 ori r0,r31,1 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; ffc10a78: 7f e4 39 2e stwx r31,r4,r7 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; ffc10a7c: 90 0c 00 04 stw r0,4(r12) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; ffc10a80: 80 0a 00 04 lwz r0,4(r10) ffc10a84: 54 00 00 3c rlwinm r0,r0,0,0,30 ffc10a88: 90 0a 00 04 stw r0,4(r10) ffc10a8c: 4b ff ff 64 b ffc109f0 <_Heap_Free+0x130> =============================================================================== ffc0b430 <_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; ffc0b430: 2f 85 00 00 cmpwi cr7,r5,0 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { ffc0b434: 94 21 ff 98 stwu r1,-104(r1) ffc0b438: 7c 08 02 a6 mflr r0 ffc0b43c: 92 e1 00 44 stw r23,68(r1) ffc0b440: 90 01 00 6c stw r0,108(r1) ffc0b444: 93 01 00 48 stw r24,72(r1) ffc0b448: 93 21 00 4c stw r25,76(r1) ffc0b44c: 7c 99 23 78 mr r25,r4 ffc0b450: 93 41 00 50 stw r26,80(r1) ffc0b454: 93 61 00 54 stw r27,84(r1) ffc0b458: 93 e1 00 64 stw r31,100(r1) ffc0b45c: 7c 7f 1b 78 mr r31,r3 ffc0b460: 91 c1 00 20 stw r14,32(r1) ffc0b464: 91 e1 00 24 stw r15,36(r1) ffc0b468: 92 01 00 28 stw r16,40(r1) ffc0b46c: 92 21 00 2c stw r17,44(r1) ffc0b470: 92 41 00 30 stw r18,48(r1) ffc0b474: 92 61 00 34 stw r19,52(r1) ffc0b478: 92 81 00 38 stw r20,56(r1) ffc0b47c: 92 a1 00 3c stw r21,60(r1) ffc0b480: 92 c1 00 40 stw r22,64(r1) ffc0b484: 93 81 00 58 stw r28,88(r1) ffc0b488: 93 a1 00 5c stw r29,92(r1) ffc0b48c: 93 c1 00 60 stw r30,96(r1) uintptr_t const page_size = heap->page_size; ffc0b490: 83 63 00 10 lwz r27,16(r3) uintptr_t const min_block_size = heap->min_block_size; ffc0b494: 83 03 00 14 lwz r24,20(r3) Heap_Block *const first_block = heap->first_block; ffc0b498: 83 43 00 20 lwz r26,32(r3) Heap_Block *const last_block = heap->last_block; ffc0b49c: 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; ffc0b4a0: 41 9e 00 7c beq- cr7,ffc0b51c <_Heap_Walk+0xec> ffc0b4a4: 3d 20 ff c1 lis r9,-63 ffc0b4a8: 39 29 b3 30 addi r9,r9,-19664 ffc0b4ac: 91 21 00 18 stw r9,24(r1) if ( !_System_state_Is_up( _System_state_Get() ) ) { ffc0b4b0: 3d 20 00 00 lis r9,0 return true; ffc0b4b4: 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() ) ) { ffc0b4b8: 80 09 28 2c lwz r0,10284(r9) ffc0b4bc: 2f 80 00 03 cmpwi cr7,r0,3 ffc0b4c0: 41 9e 00 7c beq- cr7,ffc0b53c <_Heap_Walk+0x10c> <== ALWAYS TAKEN block = next_block; } while ( block != first_block ); return true; } ffc0b4c4: 80 01 00 6c lwz r0,108(r1) ffc0b4c8: 81 c1 00 20 lwz r14,32(r1) ffc0b4cc: 7c 08 03 a6 mtlr r0 ffc0b4d0: 81 e1 00 24 lwz r15,36(r1) ffc0b4d4: 82 01 00 28 lwz r16,40(r1) ffc0b4d8: 82 21 00 2c lwz r17,44(r1) ffc0b4dc: 82 41 00 30 lwz r18,48(r1) ffc0b4e0: 82 61 00 34 lwz r19,52(r1) ffc0b4e4: 82 81 00 38 lwz r20,56(r1) ffc0b4e8: 82 a1 00 3c lwz r21,60(r1) ffc0b4ec: 82 c1 00 40 lwz r22,64(r1) ffc0b4f0: 82 e1 00 44 lwz r23,68(r1) ffc0b4f4: 83 01 00 48 lwz r24,72(r1) ffc0b4f8: 83 21 00 4c lwz r25,76(r1) ffc0b4fc: 83 41 00 50 lwz r26,80(r1) ffc0b500: 83 61 00 54 lwz r27,84(r1) ffc0b504: 83 81 00 58 lwz r28,88(r1) ffc0b508: 83 a1 00 5c lwz r29,92(r1) ffc0b50c: 83 c1 00 60 lwz r30,96(r1) ffc0b510: 83 e1 00 64 lwz r31,100(r1) ffc0b514: 38 21 00 68 addi r1,r1,104 ffc0b518: 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; ffc0b51c: 3d 20 ff c1 lis r9,-63 ffc0b520: 39 29 b3 2c addi r9,r9,-19668 ffc0b524: 91 21 00 18 stw r9,24(r1) if ( !_System_state_Is_up( _System_state_Get() ) ) { ffc0b528: 3d 20 00 00 lis r9,0 return true; ffc0b52c: 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() ) ) { ffc0b530: 80 09 28 2c lwz r0,10284(r9) ffc0b534: 2f 80 00 03 cmpwi cr7,r0,3 ffc0b538: 40 9e ff 8c bne+ cr7,ffc0b4c4 <_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)( ffc0b53c: 80 1f 00 0c lwz r0,12(r31) ffc0b540: 3c a0 ff c2 lis r5,-62 ffc0b544: 81 1f 00 18 lwz r8,24(r31) ffc0b548: 7f 23 cb 78 mr r3,r25 ffc0b54c: 81 3f 00 1c lwz r9,28(r31) ffc0b550: 38 80 00 00 li r4,0 ffc0b554: 81 7f 00 08 lwz r11,8(r31) ffc0b558: 38 a5 b7 0c addi r5,r5,-18676 ffc0b55c: 90 01 00 10 stw r0,16(r1) ffc0b560: 7f 66 db 78 mr r6,r27 ffc0b564: 7f 07 c3 78 mr r7,r24 ffc0b568: 80 01 00 18 lwz r0,24(r1) ffc0b56c: 7f 4a d3 78 mr r10,r26 ffc0b570: 92 e1 00 08 stw r23,8(r1) ffc0b574: 7c 09 03 a6 mtctr r0 ffc0b578: 91 61 00 0c stw r11,12(r1) ffc0b57c: 4c c6 31 82 crclr 4*cr1+eq ffc0b580: 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 ) { ffc0b584: 2f 9b 00 00 cmpwi cr7,r27,0 ffc0b588: 41 9e 00 ac beq- cr7,ffc0b634 <_Heap_Walk+0x204> (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { ffc0b58c: 73 67 00 07 andi. r7,r27,7 ffc0b590: 40 82 00 cc bne- ffc0b65c <_Heap_Walk+0x22c> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b594: 7c 18 db 96 divwu r0,r24,r27 ffc0b598: 7c 00 d9 d6 mullw r0,r0,r27 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { ffc0b59c: 7f 98 00 00 cmpw cr7,r24,r0 ffc0b5a0: 40 9e 00 e8 bne- cr7,ffc0b688 <_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; ffc0b5a4: 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; ffc0b5a8: 7d 20 db 96 divwu r9,r0,r27 ffc0b5ac: 7d 29 d9 d6 mullw r9,r9,r27 ); return false; } if ( ffc0b5b0: 7f 80 48 00 cmpw cr7,r0,r9 ffc0b5b4: 40 9e 01 00 bne- cr7,ffc0b6b4 <_Heap_Walk+0x284> block = next_block; } while ( block != first_block ); return true; } ffc0b5b8: 82 da 00 04 lwz r22,4(r26) ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { ffc0b5bc: 72 c7 00 01 andi. r7,r22,1 ffc0b5c0: 41 82 01 68 beq- ffc0b728 <_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; ffc0b5c4: 81 37 00 04 lwz r9,4(r23) ffc0b5c8: 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); ffc0b5cc: 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; ffc0b5d0: 80 09 00 04 lwz r0,4(r9) ); return false; } if ( _Heap_Is_free( last_block ) ) { ffc0b5d4: 70 07 00 01 andi. r7,r0,1 ffc0b5d8: 41 82 00 34 beq- ffc0b60c <_Heap_Walk+0x1dc> ); return false; } if ( ffc0b5dc: 7f 9a 48 00 cmpw cr7,r26,r9 ffc0b5e0: 41 9e 01 00 beq- cr7,ffc0b6e0 <_Heap_Walk+0x2b0> _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( ffc0b5e4: 80 01 00 18 lwz r0,24(r1) ffc0b5e8: 3c a0 ff c2 lis r5,-62 ffc0b5ec: 7f 23 cb 78 mr r3,r25 ffc0b5f0: 38 80 00 01 li r4,1 ffc0b5f4: 7c 09 03 a6 mtctr r0 ffc0b5f8: 38 a5 b8 74 addi r5,r5,-18316 ffc0b5fc: 4c c6 31 82 crclr 4*cr1+eq ffc0b600: 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; ffc0b604: 38 60 00 00 li r3,0 ffc0b608: 4b ff fe bc b ffc0b4c4 <_Heap_Walk+0x94> return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( ffc0b60c: 80 01 00 18 lwz r0,24(r1) ffc0b610: 3c a0 ff c2 lis r5,-62 ffc0b614: 7f 23 cb 78 mr r3,r25 ffc0b618: 38 80 00 01 li r4,1 ffc0b61c: 7c 09 03 a6 mtctr r0 ffc0b620: 38 a5 b8 5c addi r5,r5,-18340 ffc0b624: 4c c6 31 82 crclr 4*cr1+eq ffc0b628: 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; ffc0b62c: 38 60 00 00 li r3,0 ffc0b630: 4b ff fe 94 b ffc0b4c4 <_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" ); ffc0b634: 80 01 00 18 lwz r0,24(r1) ffc0b638: 3c a0 ff c2 lis r5,-62 ffc0b63c: 7f 23 cb 78 mr r3,r25 ffc0b640: 38 80 00 01 li r4,1 ffc0b644: 7c 09 03 a6 mtctr r0 ffc0b648: 38 a5 b7 a0 addi r5,r5,-18528 ffc0b64c: 4c c6 31 82 crclr 4*cr1+eq ffc0b650: 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; ffc0b654: 38 60 00 00 li r3,0 ffc0b658: 4b ff fe 6c b ffc0b4c4 <_Heap_Walk+0x94> return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( ffc0b65c: 80 01 00 18 lwz r0,24(r1) ffc0b660: 3c a0 ff c2 lis r5,-62 ffc0b664: 7f 23 cb 78 mr r3,r25 ffc0b668: 38 80 00 01 li r4,1 ffc0b66c: 7c 09 03 a6 mtctr r0 ffc0b670: 38 a5 b7 b4 addi r5,r5,-18508 ffc0b674: 7f 66 db 78 mr r6,r27 ffc0b678: 4c c6 31 82 crclr 4*cr1+eq ffc0b67c: 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; ffc0b680: 38 60 00 00 li r3,0 ffc0b684: 4b ff fe 40 b ffc0b4c4 <_Heap_Walk+0x94> return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( ffc0b688: 80 01 00 18 lwz r0,24(r1) ffc0b68c: 3c a0 ff c2 lis r5,-62 ffc0b690: 7f 23 cb 78 mr r3,r25 ffc0b694: 38 80 00 01 li r4,1 ffc0b698: 7c 09 03 a6 mtctr r0 ffc0b69c: 38 a5 b7 d4 addi r5,r5,-18476 ffc0b6a0: 7f 06 c3 78 mr r6,r24 ffc0b6a4: 4c c6 31 82 crclr 4*cr1+eq ffc0b6a8: 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; ffc0b6ac: 38 60 00 00 li r3,0 ffc0b6b0: 4b ff fe 14 b ffc0b4c4 <_Heap_Walk+0x94> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( ffc0b6b4: 80 01 00 18 lwz r0,24(r1) ffc0b6b8: 3c a0 ff c2 lis r5,-62 ffc0b6bc: 7f 23 cb 78 mr r3,r25 ffc0b6c0: 38 80 00 01 li r4,1 ffc0b6c4: 7c 09 03 a6 mtctr r0 ffc0b6c8: 38 a5 b7 f8 addi r5,r5,-18440 ffc0b6cc: 7f 46 d3 78 mr r6,r26 ffc0b6d0: 4c c6 31 82 crclr 4*cr1+eq ffc0b6d4: 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; ffc0b6d8: 38 60 00 00 li r3,0 ffc0b6dc: 4b ff fd e8 b ffc0b4c4 <_Heap_Walk+0x94> block = next_block; } while ( block != first_block ); return true; } ffc0b6e0: 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; ffc0b6e4: 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 ) { ffc0b6e8: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0b6ec: 41 9e 01 2c beq- cr7,ffc0b818 <_Heap_Walk+0x3e8> block = next_block; } while ( block != first_block ); return true; } ffc0b6f0: 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; ffc0b6f4: 7d 26 4b 78 mr r6,r9 ffc0b6f8: 7f 80 48 40 cmplw cr7,r0,r9 ffc0b6fc: 40 9d 00 54 ble- cr7,ffc0b750 <_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)( ffc0b700: 80 01 00 18 lwz r0,24(r1) ffc0b704: 3c a0 ff c2 lis r5,-62 ffc0b708: 7f 23 cb 78 mr r3,r25 ffc0b70c: 38 80 00 01 li r4,1 ffc0b710: 7c 09 03 a6 mtctr r0 ffc0b714: 38 a5 b8 a4 addi r5,r5,-18268 ffc0b718: 4c c6 31 82 crclr 4*cr1+eq ffc0b71c: 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; ffc0b720: 38 60 00 00 li r3,0 ffc0b724: 4b ff fd a0 b ffc0b4c4 <_Heap_Walk+0x94> return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( ffc0b728: 80 01 00 18 lwz r0,24(r1) ffc0b72c: 3c a0 ff c2 lis r5,-62 ffc0b730: 7f 23 cb 78 mr r3,r25 ffc0b734: 38 80 00 01 li r4,1 ffc0b738: 7c 09 03 a6 mtctr r0 ffc0b73c: 38 a5 b8 2c addi r5,r5,-18388 ffc0b740: 4c c6 31 82 crclr 4*cr1+eq ffc0b744: 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; ffc0b748: 38 60 00 00 li r3,0 ffc0b74c: 4b ff fd 78 b ffc0b4c4 <_Heap_Walk+0x94> ffc0b750: 81 1f 00 24 lwz r8,36(r31) ffc0b754: 7f 88 48 40 cmplw cr7,r8,r9 ffc0b758: 41 bc ff a8 blt- cr7,ffc0b700 <_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; ffc0b75c: 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; ffc0b760: 7d 4b 2b 96 divwu r10,r11,r5 ffc0b764: 7d 4a 29 d6 mullw r10,r10,r5 ); return false; } if ( ffc0b768: 7f 8b 50 00 cmpw cr7,r11,r10 ffc0b76c: 40 9e 03 a8 bne- cr7,ffc0bb14 <_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; ffc0b770: 81 69 00 04 lwz r11,4(r9) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b774: 7f ea fb 78 mr r10,r31 ffc0b778: 55 6b 00 3c rlwinm r11,r11,0,0,30 block = next_block; } while ( block != first_block ); return true; } ffc0b77c: 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; ffc0b780: 81 6b 00 04 lwz r11,4(r11) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b784: 71 67 00 01 andi. r7,r11,1 ffc0b788: 41 a2 00 58 beq+ ffc0b7e0 <_Heap_Walk+0x3b0> <== ALWAYS TAKEN ffc0b78c: 48 00 03 b0 b ffc0bb3c <_Heap_Walk+0x70c> <== NOT EXECUTED return false; } prev_block = free_block; free_block = free_block->next; ffc0b790: 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 ) { ffc0b794: 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; ffc0b798: 7f 00 30 40 cmplw cr6,r0,r6 ffc0b79c: 7c 86 40 40 cmplw cr1,r6,r8 ffc0b7a0: 41 9e 00 7c beq- cr7,ffc0b81c <_Heap_Walk+0x3ec> ffc0b7a4: 41 b9 ff 5c bgt- cr6,ffc0b700 <_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; ffc0b7a8: 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; ffc0b7ac: 41 a5 ff 54 bgt- cr1,ffc0b700 <_Heap_Walk+0x2d0> <== NEVER TAKEN RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b7b0: 7c eb 2b 96 divwu r7,r11,r5 ffc0b7b4: 7c e7 29 d6 mullw r7,r7,r5 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b7b8: 7d 2a 4b 78 mr r10,r9 ); return false; } if ( ffc0b7bc: 7f 8b 38 00 cmpw cr7,r11,r7 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b7c0: 7c c9 33 78 mr r9,r6 ); return false; } if ( ffc0b7c4: 40 9e 03 50 bne- cr7,ffc0bb14 <_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; ffc0b7c8: 81 66 00 04 lwz r11,4(r6) ffc0b7cc: 55 6b 00 3c rlwinm r11,r11,0,0,30 block = next_block; } while ( block != first_block ); return true; } ffc0b7d0: 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; ffc0b7d4: 81 6b 00 04 lwz r11,4(r11) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b7d8: 71 67 00 01 andi. r7,r11,1 ffc0b7dc: 40 82 03 60 bne- ffc0bb3c <_Heap_Walk+0x70c> ); return false; } if ( free_block->prev != prev_block ) { ffc0b7e0: 80 e9 00 0c lwz r7,12(r9) ffc0b7e4: 7f 87 50 00 cmpw cr7,r7,r10 ffc0b7e8: 41 9e ff a8 beq+ cr7,ffc0b790 <_Heap_Walk+0x360> (*printer)( ffc0b7ec: 80 01 00 18 lwz r0,24(r1) ffc0b7f0: 3c a0 ff c2 lis r5,-62 ffc0b7f4: 7f 23 cb 78 mr r3,r25 ffc0b7f8: 38 80 00 01 li r4,1 ffc0b7fc: 7c 09 03 a6 mtctr r0 ffc0b800: 38 a5 b9 10 addi r5,r5,-18160 ffc0b804: 7d 26 4b 78 mr r6,r9 ffc0b808: 4c c6 31 82 crclr 4*cr1+eq ffc0b80c: 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; ffc0b810: 38 60 00 00 li r3,0 ffc0b814: 4b ff fc b0 b ffc0b4c4 <_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 ) { ffc0b818: 80 1f 00 20 lwz r0,32(r31) "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b81c: 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)( ffc0b820: 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)( ffc0b824: 3e 40 ff c2 lis r18,-62 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b828: 7f 5d d3 78 mr r29,r26 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b82c: 3a 73 ba c0 addi r19,r19,-17728 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( ffc0b830: 3a 94 ba a8 addi r20,r20,-17752 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)( ffc0b834: 3a 52 ba 04 addi r18,r18,-17916 ffc0b838: 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)" : "") ffc0b83c: 3e a0 ff c2 lis r21,-62 ffc0b840: 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)( ffc0b844: 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)" : ""), ffc0b848: 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; ffc0b84c: 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); ffc0b850: 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; ffc0b854: 7f 80 f0 40 cmplw cr7,r0,r30 ffc0b858: 40 9d 00 34 ble- cr7,ffc0b88c <_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)( ffc0b85c: 3c a0 ff c2 lis r5,-62 ffc0b860: 7f 23 cb 78 mr r3,r25 ffc0b864: 38 80 00 01 li r4,1 ffc0b868: 38 a5 b9 44 addi r5,r5,-18108 return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( ffc0b86c: 80 01 00 18 lwz r0,24(r1) ffc0b870: 7f a6 eb 78 mr r6,r29 ffc0b874: 7f c7 f3 78 mr r7,r30 ffc0b878: 7c 09 03 a6 mtctr r0 ffc0b87c: 4c c6 31 82 crclr 4*cr1+eq ffc0b880: 4e 80 04 21 bctrl "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; ffc0b884: 38 60 00 00 li r3,0 ffc0b888: 4b ff fc 3c b ffc0b4c4 <_Heap_Walk+0x94> ffc0b88c: 80 1f 00 24 lwz r0,36(r31) ffc0b890: 7f 80 f0 40 cmplw cr7,r0,r30 ffc0b894: 41 bc ff c8 blt- cr7,ffc0b85c <_Heap_Walk+0x42c> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b898: 7d 3c db 96 divwu r9,r28,r27 ffc0b89c: 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; ffc0b8a0: 7f a0 ba 78 xor r0,r29,r23 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { ffc0b8a4: 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; ffc0b8a8: 7c 00 00 34 cntlzw r0,r0 ffc0b8ac: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0b8b0: 68 00 00 01 xori r0,r0,1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { ffc0b8b4: 41 9e 00 0c beq- cr7,ffc0b8c0 <_Heap_Walk+0x490> ffc0b8b8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b8bc: 40 9e 01 e0 bne- cr7,ffc0ba9c <_Heap_Walk+0x66c> ); return false; } if ( block_size < min_block_size && is_not_last_block ) { ffc0b8c0: 7f 98 e0 40 cmplw cr7,r24,r28 ffc0b8c4: 40 9d 00 0c ble- cr7,ffc0b8d0 <_Heap_Walk+0x4a0> ffc0b8c8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b8cc: 40 9e 02 00 bne- cr7,ffc0bacc <_Heap_Walk+0x69c> <== ALWAYS TAKEN ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { ffc0b8d0: 7f 9d f0 40 cmplw cr7,r29,r30 ffc0b8d4: 41 9c 00 0c blt- cr7,ffc0b8e0 <_Heap_Walk+0x4b0> ffc0b8d8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b8dc: 40 9e 02 24 bne- cr7,ffc0bb00 <_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; ffc0b8e0: 80 1e 00 04 lwz r0,4(r30) ffc0b8e4: 56 d6 07 fe clrlwi r22,r22,31 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { ffc0b8e8: 70 07 00 01 andi. r7,r0,1 ffc0b8ec: 41 82 00 74 beq- ffc0b960 <_Heap_Walk+0x530> if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { ffc0b8f0: 2f 96 00 00 cmpwi cr7,r22,0 ffc0b8f4: 41 9e 00 40 beq- cr7,ffc0b934 <_Heap_Walk+0x504> (*printer)( ffc0b8f8: 80 01 00 18 lwz r0,24(r1) ffc0b8fc: 7f 23 cb 78 mr r3,r25 ffc0b900: 38 80 00 00 li r4,0 ffc0b904: 7e 85 a3 78 mr r5,r20 ffc0b908: 7c 09 03 a6 mtctr r0 ffc0b90c: 7f a6 eb 78 mr r6,r29 ffc0b910: 7f 87 e3 78 mr r7,r28 ffc0b914: 4c c6 31 82 crclr 4*cr1+eq ffc0b918: 4e 80 04 21 bctrl block->prev_size ); } block = next_block; } while ( block != first_block ); ffc0b91c: 7f 9a f0 00 cmpw cr7,r26,r30 ffc0b920: 41 9e 01 0c beq- cr7,ffc0ba2c <_Heap_Walk+0x5fc> ffc0b924: 82 de 00 04 lwz r22,4(r30) ffc0b928: 7f dd f3 78 mr r29,r30 ffc0b92c: 80 1f 00 20 lwz r0,32(r31) ffc0b930: 4b ff ff 1c b ffc0b84c <_Heap_Walk+0x41c> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b934: 80 01 00 18 lwz r0,24(r1) ffc0b938: 7f a6 eb 78 mr r6,r29 ffc0b93c: 7f 23 cb 78 mr r3,r25 ffc0b940: 81 1d 00 00 lwz r8,0(r29) ffc0b944: 38 80 00 00 li r4,0 ffc0b948: 7c 09 03 a6 mtctr r0 ffc0b94c: 7e 65 9b 78 mr r5,r19 ffc0b950: 7f 87 e3 78 mr r7,r28 ffc0b954: 4c c6 31 82 crclr 4*cr1+eq ffc0b958: 4e 80 04 21 bctrl ffc0b95c: 4b ff ff c0 b ffc0b91c <_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 ? ffc0b960: 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)( ffc0b964: 81 3f 00 08 lwz r9,8(r31) block = next_block; } while ( block != first_block ); return true; } ffc0b968: 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)( ffc0b96c: 7f 89 40 00 cmpw cr7,r9,r8 ffc0b970: 41 9e 01 00 beq- cr7,ffc0ba70 <_Heap_Walk+0x640> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc0b974: 7f 9f 40 00 cmpw cr7,r31,r8 ffc0b978: 41 9e 01 08 beq- cr7,ffc0ba80 <_Heap_Walk+0x650> ffc0b97c: 39 35 ba 74 addi r9,r21,-17804 block->next, block->next == last_free_block ? ffc0b980: 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)( ffc0b984: 7f 80 50 00 cmpw cr7,r0,r10 ffc0b988: 41 9e 00 e0 beq- cr7,ffc0ba68 <_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)" : "") ffc0b98c: 7f 9f 50 00 cmpw cr7,r31,r10 ffc0b990: 41 9e 00 e8 beq- cr7,ffc0ba78 <_Heap_Walk+0x648> ffc0b994: 38 15 ba 74 addi r0,r21,-17804 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)( ffc0b998: 90 01 00 08 stw r0,8(r1) ffc0b99c: 7f 23 cb 78 mr r3,r25 ffc0b9a0: 38 80 00 00 li r4,0 ffc0b9a4: 80 01 00 18 lwz r0,24(r1) ffc0b9a8: 7e 45 93 78 mr r5,r18 ffc0b9ac: 7f a6 eb 78 mr r6,r29 ffc0b9b0: 7f 87 e3 78 mr r7,r28 ffc0b9b4: 7c 09 03 a6 mtctr r0 ffc0b9b8: 4c c6 31 82 crclr 4*cr1+eq ffc0b9bc: 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 ) { ffc0b9c0: 81 1e 00 00 lwz r8,0(r30) ffc0b9c4: 7f 9c 40 00 cmpw cr7,r28,r8 ffc0b9c8: 40 9e 00 6c bne- cr7,ffc0ba34 <_Heap_Walk+0x604> ); return false; } if ( !prev_used ) { ffc0b9cc: 2f 96 00 00 cmpwi cr7,r22,0 ffc0b9d0: 41 9e 00 b8 beq- cr7,ffc0ba88 <_Heap_Walk+0x658> block = next_block; } while ( block != first_block ); return true; } ffc0b9d4: 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 ) { ffc0b9d8: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0b9dc: 41 9e 00 24 beq- cr7,ffc0ba00 <_Heap_Walk+0x5d0> <== NEVER TAKEN if ( free_block == block ) { ffc0b9e0: 7f 9d 48 00 cmpw cr7,r29,r9 ffc0b9e4: 40 be 00 0c bne+ cr7,ffc0b9f0 <_Heap_Walk+0x5c0> ffc0b9e8: 4b ff ff 34 b ffc0b91c <_Heap_Walk+0x4ec> ffc0b9ec: 41 ba ff 30 beq- cr6,ffc0b91c <_Heap_Walk+0x4ec> return true; } free_block = free_block->next; ffc0b9f0: 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 ) { ffc0b9f4: 7f 9f 48 00 cmpw cr7,r31,r9 if ( free_block == block ) { ffc0b9f8: 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 ) { ffc0b9fc: 40 9e ff f0 bne+ cr7,ffc0b9ec <_Heap_Walk+0x5bc> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( ffc0ba00: 3c a0 ff c2 lis r5,-62 ffc0ba04: 7f 23 cb 78 mr r3,r25 ffc0ba08: 38 80 00 01 li r4,1 ffc0ba0c: 38 a5 ba e8 addi r5,r5,-17688 ffc0ba10: 80 01 00 18 lwz r0,24(r1) ffc0ba14: 7f a6 eb 78 mr r6,r29 ffc0ba18: 7c 09 03 a6 mtctr r0 ffc0ba1c: 4c c6 31 82 crclr 4*cr1+eq ffc0ba20: 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; ffc0ba24: 38 60 00 00 li r3,0 ffc0ba28: 4b ff fa 9c b ffc0b4c4 <_Heap_Walk+0x94> } block = next_block; } while ( block != first_block ); return true; ffc0ba2c: 38 60 00 01 li r3,1 ffc0ba30: 4b ff fa 94 b ffc0b4c4 <_Heap_Walk+0x94> " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( ffc0ba34: 80 01 00 18 lwz r0,24(r1) ffc0ba38: 3c a0 ff c2 lis r5,-62 ffc0ba3c: 7f 23 cb 78 mr r3,r25 ffc0ba40: 38 80 00 01 li r4,1 ffc0ba44: 7c 09 03 a6 mtctr r0 ffc0ba48: 38 a5 ba 3c addi r5,r5,-17860 ffc0ba4c: 7f a6 eb 78 mr r6,r29 ffc0ba50: 7f 87 e3 78 mr r7,r28 ffc0ba54: 7f c9 f3 78 mr r9,r30 ffc0ba58: 4c c6 31 82 crclr 4*cr1+eq ffc0ba5c: 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; ffc0ba60: 38 60 00 00 li r3,0 ffc0ba64: 4b ff fa 60 b ffc0b4c4 <_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)( ffc0ba68: 38 11 b6 f0 addi r0,r17,-18704 ffc0ba6c: 4b ff ff 2c b ffc0b998 <_Heap_Walk+0x568> ffc0ba70: 39 30 b6 d4 addi r9,r16,-18732 ffc0ba74: 4b ff ff 0c b ffc0b980 <_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)" : "") ffc0ba78: 38 0f b7 00 addi r0,r15,-18688 ffc0ba7c: 4b ff ff 1c b ffc0b998 <_Heap_Walk+0x568> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc0ba80: 39 2e b6 e4 addi r9,r14,-18716 ffc0ba84: 4b ff fe fc b ffc0b980 <_Heap_Walk+0x550> return false; } if ( !prev_used ) { (*printer)( ffc0ba88: 3c a0 ff c2 lis r5,-62 ffc0ba8c: 7f 23 cb 78 mr r3,r25 ffc0ba90: 38 80 00 01 li r4,1 ffc0ba94: 38 a5 ba 78 addi r5,r5,-17800 ffc0ba98: 4b ff ff 78 b ffc0ba10 <_Heap_Walk+0x5e0> return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*printer)( ffc0ba9c: 80 01 00 18 lwz r0,24(r1) ffc0baa0: 3c a0 ff c2 lis r5,-62 ffc0baa4: 7f 23 cb 78 mr r3,r25 ffc0baa8: 38 80 00 01 li r4,1 ffc0baac: 7c 09 03 a6 mtctr r0 ffc0bab0: 38 a5 b9 74 addi r5,r5,-18060 ffc0bab4: 7f a6 eb 78 mr r6,r29 ffc0bab8: 7f 87 e3 78 mr r7,r28 ffc0babc: 4c c6 31 82 crclr 4*cr1+eq ffc0bac0: 4e 80 04 21 bctrl "block 0x%08x: block size %u not page aligned\n", block, block_size ); return false; ffc0bac4: 38 60 00 00 li r3,0 ffc0bac8: 4b ff f9 fc b ffc0b4c4 <_Heap_Walk+0x94> } if ( block_size < min_block_size && is_not_last_block ) { (*printer)( ffc0bacc: 80 01 00 18 lwz r0,24(r1) ffc0bad0: 3c a0 ff c2 lis r5,-62 ffc0bad4: 7f 23 cb 78 mr r3,r25 ffc0bad8: 38 80 00 01 li r4,1 ffc0badc: 7c 09 03 a6 mtctr r0 ffc0bae0: 38 a5 b9 a4 addi r5,r5,-18012 ffc0bae4: 7f a6 eb 78 mr r6,r29 ffc0bae8: 7f 87 e3 78 mr r7,r28 ffc0baec: 7f 08 c3 78 mr r8,r24 ffc0baf0: 4c c6 31 82 crclr 4*cr1+eq ffc0baf4: 4e 80 04 21 bctrl block, block_size, min_block_size ); return false; ffc0baf8: 38 60 00 00 li r3,0 ffc0bafc: 4b ff f9 c8 b ffc0b4c4 <_Heap_Walk+0x94> } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( ffc0bb00: 3c a0 ff c2 lis r5,-62 ffc0bb04: 7f 23 cb 78 mr r3,r25 ffc0bb08: 38 80 00 01 li r4,1 ffc0bb0c: 38 a5 b9 d0 addi r5,r5,-17968 ffc0bb10: 4b ff fd 5c b ffc0b86c <_Heap_Walk+0x43c> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( ffc0bb14: 80 01 00 18 lwz r0,24(r1) ffc0bb18: 3c a0 ff c2 lis r5,-62 ffc0bb1c: 7f 23 cb 78 mr r3,r25 ffc0bb20: 38 80 00 01 li r4,1 ffc0bb24: 7c 09 03 a6 mtctr r0 ffc0bb28: 38 a5 b8 c4 addi r5,r5,-18236 ffc0bb2c: 4c c6 31 82 crclr 4*cr1+eq ffc0bb30: 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; ffc0bb34: 38 60 00 00 li r3,0 ffc0bb38: 4b ff f9 8c b ffc0b4c4 <_Heap_Walk+0x94> return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( ffc0bb3c: 80 01 00 18 lwz r0,24(r1) ffc0bb40: 3c a0 ff c2 lis r5,-62 ffc0bb44: 7f 23 cb 78 mr r3,r25 ffc0bb48: 38 80 00 01 li r4,1 ffc0bb4c: 7c 09 03 a6 mtctr r0 ffc0bb50: 38 a5 b8 f4 addi r5,r5,-18188 ffc0bb54: 4c c6 31 82 crclr 4*cr1+eq ffc0bb58: 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; ffc0bb5c: 38 60 00 00 li r3,0 ffc0bb60: 4b ff f9 64 b ffc0b4c4 <_Heap_Walk+0x94> =============================================================================== ffc0b330 <_Heap_Walk_print>: static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { ffc0b330: 94 21 ff 88 stwu r1,-120(r1) ffc0b334: 7c 08 02 a6 mflr r0 ffc0b338: 93 e1 00 74 stw r31,116(r1) ffc0b33c: 90 01 00 7c stw r0,124(r1) ffc0b340: 7c 60 1b 78 mr r0,r3 ffc0b344: 90 c1 00 1c stw r6,28(r1) ffc0b348: 90 e1 00 20 stw r7,32(r1) ffc0b34c: 91 01 00 24 stw r8,36(r1) ffc0b350: 91 21 00 28 stw r9,40(r1) ffc0b354: 91 41 00 2c stw r10,44(r1) ffc0b358: 40 86 00 24 bne- cr1,ffc0b37c <_Heap_Walk_print+0x4c> <== ALWAYS TAKEN ffc0b35c: d8 21 00 30 stfd f1,48(r1) <== NOT EXECUTED ffc0b360: d8 41 00 38 stfd f2,56(r1) <== NOT EXECUTED ffc0b364: d8 61 00 40 stfd f3,64(r1) <== NOT EXECUTED ffc0b368: d8 81 00 48 stfd f4,72(r1) <== NOT EXECUTED ffc0b36c: d8 a1 00 50 stfd f5,80(r1) <== NOT EXECUTED ffc0b370: d8 c1 00 58 stfd f6,88(r1) <== NOT EXECUTED ffc0b374: d8 e1 00 60 stfd f7,96(r1) <== NOT EXECUTED ffc0b378: d9 01 00 68 stfd f8,104(r1) <== NOT EXECUTED va_list ap; if ( error ) { ffc0b37c: 2f 84 00 00 cmpwi cr7,r4,0 { /* Do nothing */ } static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { ffc0b380: 7c bf 2b 78 mr r31,r5 va_list ap; if ( error ) { ffc0b384: 40 9e 00 58 bne- cr7,ffc0b3dc <_Heap_Walk_print+0xac> printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); ffc0b388: 3c 60 ff c2 lis r3,-62 ffc0b38c: 7c 04 03 78 mr r4,r0 ffc0b390: 38 63 b6 c8 addi r3,r3,-18744 ffc0b394: 4c c6 31 82 crclr 4*cr1+eq ffc0b398: 4b ff b1 3d bl ffc064d4 } va_start( ap, fmt ); ffc0b39c: 38 00 00 03 li r0,3 ffc0b3a0: 98 01 00 08 stb r0,8(r1) ffc0b3a4: 38 00 00 00 li r0,0 vprintk( fmt, ap ); ffc0b3a8: 7f e3 fb 78 mr r3,r31 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b3ac: 98 01 00 09 stb r0,9(r1) ffc0b3b0: 38 01 00 80 addi r0,r1,128 vprintk( fmt, ap ); ffc0b3b4: 38 81 00 08 addi r4,r1,8 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b3b8: 90 01 00 0c stw r0,12(r1) ffc0b3bc: 38 01 00 10 addi r0,r1,16 ffc0b3c0: 90 01 00 10 stw r0,16(r1) vprintk( fmt, ap ); ffc0b3c4: 4b ff d5 09 bl ffc088cc va_end( ap ); } ffc0b3c8: 80 01 00 7c lwz r0,124(r1) ffc0b3cc: 83 e1 00 74 lwz r31,116(r1) ffc0b3d0: 38 21 00 78 addi r1,r1,120 ffc0b3d4: 7c 08 03 a6 mtlr r0 ffc0b3d8: 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 ); ffc0b3dc: 3c 60 ff c2 lis r3,-62 ffc0b3e0: 7c 04 03 78 mr r4,r0 ffc0b3e4: 38 63 b6 bc addi r3,r3,-18756 ffc0b3e8: 4c c6 31 82 crclr 4*cr1+eq ffc0b3ec: 4b ff b0 e9 bl ffc064d4 } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b3f0: 38 00 00 03 li r0,3 ffc0b3f4: 98 01 00 08 stb r0,8(r1) ffc0b3f8: 38 00 00 00 li r0,0 vprintk( fmt, ap ); ffc0b3fc: 7f e3 fb 78 mr r3,r31 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b400: 98 01 00 09 stb r0,9(r1) ffc0b404: 38 01 00 80 addi r0,r1,128 vprintk( fmt, ap ); ffc0b408: 38 81 00 08 addi r4,r1,8 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b40c: 90 01 00 0c stw r0,12(r1) ffc0b410: 38 01 00 10 addi r0,r1,16 ffc0b414: 90 01 00 10 stw r0,16(r1) vprintk( fmt, ap ); ffc0b418: 4b ff d4 b5 bl ffc088cc va_end( ap ); } ffc0b41c: 80 01 00 7c lwz r0,124(r1) ffc0b420: 83 e1 00 74 lwz r31,116(r1) ffc0b424: 38 21 00 78 addi r1,r1,120 ffc0b428: 7c 08 03 a6 mtlr r0 ffc0b42c: 4e 80 00 20 blr =============================================================================== ffc097e8 <_IO_Initialize_all_drivers>: * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc097e8: 94 21 ff f0 stwu r1,-16(r1) ffc097ec: 7c 08 02 a6 mflr r0 ffc097f0: 93 c1 00 08 stw r30,8(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc097f4: 3f c0 00 00 lis r30,0 * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc097f8: 90 01 00 14 stw r0,20(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc097fc: 80 1e 28 3c lwz r0,10300(r30) * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc09800: 93 e1 00 0c stw r31,12(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc09804: 2f 80 00 00 cmpwi cr7,r0,0 ffc09808: 41 9e 00 2c beq- cr7,ffc09834 <_IO_Initialize_all_drivers+0x4c><== NEVER TAKEN ffc0980c: 3b e0 00 00 li r31,0 ffc09810: 3b de 28 3c addi r30,r30,10300 (void) rtems_io_initialize( major, 0, NULL ); ffc09814: 7f e3 fb 78 mr r3,r31 ffc09818: 38 80 00 00 li r4,0 ffc0981c: 38 a0 00 00 li r5,0 ffc09820: 48 00 6b f5 bl ffc10414 void _IO_Initialize_all_drivers( void ) { rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc09824: 80 1e 00 00 lwz r0,0(r30) ffc09828: 3b ff 00 01 addi r31,r31,1 ffc0982c: 7f 80 f8 40 cmplw cr7,r0,r31 ffc09830: 41 9d ff e4 bgt+ cr7,ffc09814 <_IO_Initialize_all_drivers+0x2c> (void) rtems_io_initialize( major, 0, NULL ); } ffc09834: 80 01 00 14 lwz r0,20(r1) ffc09838: 83 c1 00 08 lwz r30,8(r1) ffc0983c: 7c 08 03 a6 mtlr r0 ffc09840: 83 e1 00 0c lwz r31,12(r1) ffc09844: 38 21 00 10 addi r1,r1,16 ffc09848: 4e 80 00 20 blr =============================================================================== ffc096d8 <_IO_Manager_initialization>: * workspace. * */ void _IO_Manager_initialization(void) { ffc096d8: 94 21 ff e0 stwu r1,-32(r1) ffc096dc: 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; ffc096e0: 3d 20 00 00 lis r9,0 * workspace. * */ void _IO_Manager_initialization(void) { ffc096e4: 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; ffc096e8: 39 29 20 d0 addi r9,r9,8400 * workspace. * */ void _IO_Manager_initialization(void) { ffc096ec: 93 a1 00 14 stw r29,20(r1) ffc096f0: 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; ffc096f4: 83 a9 00 2c lwz r29,44(r9) rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; drivers_in_table = Configuration.number_of_device_drivers; ffc096f8: 83 c9 00 30 lwz r30,48(r9) * workspace. * */ void _IO_Manager_initialization(void) { ffc096fc: 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 ) ffc09700: 7f 9e e8 40 cmplw cr7,r30,r29 * workspace. * */ void _IO_Manager_initialization(void) { ffc09704: 93 61 00 0c stw r27,12(r1) ffc09708: 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; ffc0970c: 83 e9 00 34 lwz r31,52(r9) /* * If the user claims there are less drivers than are actually in * the table, then let's just go with the table's count. */ if ( number_of_drivers <= drivers_in_table ) ffc09710: 40 9c 00 a4 bge- cr7,ffc097b4 <_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 ) ffc09714: 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( ffc09718: 7f 63 db 78 mr r3,r27 ffc0971c: 48 00 3e dd bl ffc0d5f8 <_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 *) ffc09720: 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; ffc09724: 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 *) ffc09728: 90 7c 28 40 stw r3,10304(r28) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( ffc0972c: 38 80 00 00 li r4,0 ffc09730: 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; ffc09734: 93 a9 28 3c stw r29,10300(r9) memset( ffc09738: 48 00 a9 6d bl ffc140a4 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) ffc0973c: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09740: 41 9e 00 50 beq- cr7,ffc09790 <_IO_Manager_initialization+0xb8><== NEVER TAKEN ffc09744: 7f c9 03 a6 mtctr r30 ffc09748: 81 1c 28 40 lwz r8,10304(r28) ffc0974c: 39 40 00 00 li r10,0 _IO_Driver_address_table[index] = driver_table[index]; ffc09750: 7f e9 fb 78 mr r9,r31 ffc09754: 7c a9 50 6e lwzux r5,r9,r10 ffc09758: 7d 68 52 14 add r11,r8,r10 ffc0975c: 80 e9 00 08 lwz r7,8(r9) ffc09760: 80 09 00 0c lwz r0,12(r9) ffc09764: 80 c9 00 04 lwz r6,4(r9) ffc09768: 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++ ) ffc0976c: 39 4a 00 18 addi r10,r10,24 _IO_Driver_address_table[index] = driver_table[index]; ffc09770: 90 cb 00 04 stw r6,4(r11) ffc09774: 90 eb 00 08 stw r7,8(r11) ffc09778: 90 0b 00 0c stw r0,12(r11) ffc0977c: 80 e9 00 10 lwz r7,16(r9) ffc09780: 80 09 00 14 lwz r0,20(r9) ffc09784: 90 eb 00 10 stw r7,16(r11) ffc09788: 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++ ) ffc0978c: 42 00 ff c4 bdnz+ ffc09750 <_IO_Manager_initialization+0x78> _IO_Driver_address_table[index] = driver_table[index]; } ffc09790: 80 01 00 24 lwz r0,36(r1) ffc09794: 83 61 00 0c lwz r27,12(r1) ffc09798: 7c 08 03 a6 mtlr r0 ffc0979c: 83 81 00 10 lwz r28,16(r1) ffc097a0: 83 a1 00 14 lwz r29,20(r1) ffc097a4: 83 c1 00 18 lwz r30,24(r1) ffc097a8: 83 e1 00 1c lwz r31,28(r1) ffc097ac: 38 21 00 20 addi r1,r1,32 ffc097b0: 4e 80 00 20 blr ffc097b4: 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; ffc097b8: 3d 20 00 00 lis r9,0 ffc097bc: 93 e9 28 40 stw r31,10304(r9) _IO_Number_of_drivers = number_of_drivers; ffc097c0: 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]; } ffc097c4: 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; ffc097c8: 93 c9 28 3c stw r30,10300(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]; } ffc097cc: 83 61 00 0c lwz r27,12(r1) ffc097d0: 83 81 00 10 lwz r28,16(r1) ffc097d4: 83 a1 00 14 lwz r29,20(r1) ffc097d8: 83 c1 00 18 lwz r30,24(r1) ffc097dc: 83 e1 00 1c lwz r31,28(r1) ffc097e0: 38 21 00 20 addi r1,r1,32 ffc097e4: 4e 80 00 20 blr =============================================================================== ffc0a708 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0a708: 94 21 ff f0 stwu r1,-16(r1) ffc0a70c: 7c 08 02 a6 mflr r0 _Internal_errors_What_happened.the_source = the_source; ffc0a710: 3d 60 00 00 lis r11,0 ffc0a714: 39 2b 2d 30 addi r9,r11,11568 void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0a718: 90 01 00 14 stw r0,20(r1) ffc0a71c: 93 e1 00 0c stw r31,12(r1) ffc0a720: 7c bf 2b 78 mr r31,r5 _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; ffc0a724: 98 89 00 04 stb r4,4(r9) _Internal_errors_What_happened.the_error = the_error; ffc0a728: 90 a9 00 08 stw r5,8(r9) bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; ffc0a72c: 90 6b 2d 30 stw r3,11568(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 ); ffc0a730: 48 00 27 89 bl ffc0ceb8 <_User_extensions_Fatal> RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; ffc0a734: 38 00 00 05 li r0,5 ffc0a738: 3d 20 00 00 lis r9,0 _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); ffc0a73c: 7f e3 fb 78 mr r3,r31 ffc0a740: 90 09 28 2c stw r0,10284(r9) ffc0a744: 4b ff 92 81 bl ffc039c4 <_BSP_Fatal_error> ffc0a748: 48 00 00 00 b ffc0a748 <_Internal_error_Occurred+0x40><== NOT EXECUTED =============================================================================== ffc0a760 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0a760: 94 21 ff f0 stwu r1,-16(r1) ffc0a764: 7c 08 02 a6 mflr r0 ffc0a768: 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 ) ffc0a76c: 80 03 00 18 lwz r0,24(r3) */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0a770: 93 e1 00 0c stw r31,12(r1) ffc0a774: 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 ) ffc0a778: 2f 80 00 00 cmpwi cr7,r0,0 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0a77c: 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; ffc0a780: 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 ) ffc0a784: 40 9e 00 1c bne- cr7,ffc0a7a0 <_Objects_Allocate+0x40> <== ALWAYS TAKEN ); } #endif return the_object; } ffc0a788: 80 01 00 14 lwz r0,20(r1) ffc0a78c: 83 c1 00 08 lwz r30,8(r1) ffc0a790: 7c 08 03 a6 mtlr r0 ffc0a794: 83 e1 00 0c lwz r31,12(r1) ffc0a798: 38 21 00 10 addi r1,r1,16 ffc0a79c: 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 ); ffc0a7a0: 3b df 00 20 addi r30,r31,32 ffc0a7a4: 7f c3 f3 78 mr r3,r30 ffc0a7a8: 4b ff f4 15 bl ffc09bbc <_Chain_Get> if ( information->auto_extend ) { ffc0a7ac: 88 1f 00 12 lbz r0,18(r31) ffc0a7b0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a7b4: 41 be ff d4 beq- cr7,ffc0a788 <_Objects_Allocate+0x28> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { ffc0a7b8: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a7bc: 41 9e 00 50 beq- cr7,ffc0a80c <_Objects_Allocate+0xac> } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - ffc0a7c0: a1 63 00 0a lhz r11,10(r3) ffc0a7c4: a0 1f 00 0a lhz r0,10(r31) _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; ffc0a7c8: a1 3f 00 14 lhz r9,20(r31) } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - ffc0a7cc: 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--; ffc0a7d0: 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; ffc0a7d4: 7c 00 4b 96 divwu r0,r0,r9 information->inactive_per_block[ block ]--; ffc0a7d8: 81 3f 00 30 lwz r9,48(r31) ); } #endif return the_object; } ffc0a7dc: 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 ]--; ffc0a7e0: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0a7e4: 7d 49 00 2e lwzx r10,r9,r0 information->inactive--; ffc0a7e8: 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 ]--; ffc0a7ec: 39 4a ff ff addi r10,r10,-1 ffc0a7f0: 7d 49 01 2e stwx r10,r9,r0 ); } #endif return the_object; } ffc0a7f4: 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--; ffc0a7f8: b1 7f 00 2c sth r11,44(r31) ); } #endif return the_object; } ffc0a7fc: 7c 08 03 a6 mtlr r0 ffc0a800: 83 e1 00 0c lwz r31,12(r1) ffc0a804: 38 21 00 10 addi r1,r1,16 ffc0a808: 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 ); ffc0a80c: 7f e3 fb 78 mr r3,r31 ffc0a810: 48 00 00 4d bl ffc0a85c <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); ffc0a814: 7f c3 f3 78 mr r3,r30 ffc0a818: 4b ff f3 a5 bl ffc09bbc <_Chain_Get> } if ( the_object ) { ffc0a81c: 2c 03 00 00 cmpwi r3,0 ffc0a820: 41 82 ff 68 beq+ ffc0a788 <_Objects_Allocate+0x28> ffc0a824: 4b ff ff 9c b ffc0a7c0 <_Objects_Allocate+0x60> =============================================================================== ffc0a85c <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { ffc0a85c: 94 21 ff c0 stwu r1,-64(r1) ffc0a860: 7c 08 02 a6 mflr r0 ffc0a864: 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 ) ffc0a868: 81 23 00 34 lwz r9,52(r3) */ void _Objects_Extend_information( Objects_Information *information ) { ffc0a86c: 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 ) ffc0a870: 2f 89 00 00 cmpwi cr7,r9,0 */ void _Objects_Extend_information( Objects_Information *information ) { ffc0a874: 93 e1 00 3c stw r31,60(r1) ffc0a878: 7c 7f 1b 78 mr r31,r3 ffc0a87c: 92 c1 00 18 stw r22,24(r1) ffc0a880: 92 e1 00 1c stw r23,28(r1) ffc0a884: 93 01 00 20 stw r24,32(r1) ffc0a888: 93 21 00 24 stw r25,36(r1) ffc0a88c: 93 41 00 28 stw r26,40(r1) ffc0a890: 93 61 00 2c stw r27,44(r1) ffc0a894: 93 81 00 30 stw r28,48(r1) ffc0a898: 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 ); ffc0a89c: a3 a3 00 0a lhz r29,10(r3) index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc0a8a0: 41 9e 02 84 beq- cr7,ffc0ab24 <_Objects_Extend_information+0x2c8> block_count = 0; else { block_count = information->maximum / information->allocation_size; ffc0a8a4: a3 43 00 10 lhz r26,16(r3) ffc0a8a8: a1 63 00 14 lhz r11,20(r3) ffc0a8ac: 7e da 5b 96 divwu r22,r26,r11 for ( ; block < block_count; block++ ) { ffc0a8b0: 2f 96 00 00 cmpwi cr7,r22,0 ffc0a8b4: 41 9e 02 8c beq- cr7,ffc0ab40 <_Objects_Extend_information+0x2e4><== NEVER TAKEN if ( information->object_blocks[ block ] == NULL ) { ffc0a8b8: 80 09 00 00 lwz r0,0(r9) ffc0a8bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a8c0: 41 9e 02 94 beq- cr7,ffc0ab54 <_Objects_Extend_information+0x2f8><== NEVER TAKEN ffc0a8c4: 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; ffc0a8c8: 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 ); ffc0a8cc: 7f be eb 78 mr r30,r29 index_base = minimum_index; block = 0; ffc0a8d0: 3b 60 00 00 li r27,0 ffc0a8d4: 48 00 00 10 b ffc0a8e4 <_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 ) { ffc0a8d8: 84 09 00 04 lwzu r0,4(r9) ffc0a8dc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a8e0: 41 9e 01 f4 beq- cr7,ffc0aad4 <_Objects_Extend_information+0x278> do_extend = false; break; } else index_base += information->allocation_size; ffc0a8e4: 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++ ) { ffc0a8e8: 3b 7b 00 01 addi r27,r27,1 ffc0a8ec: 42 00 ff ec bdnz+ ffc0a8d8 <_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; ffc0a8f0: 3b 20 00 01 li r25,1 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; ffc0a8f4: 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 ) { ffc0a8f8: 2b 9a ff ff cmplwi cr7,r26,65535 ffc0a8fc: 41 9d 01 a0 bgt- cr7,ffc0aa9c <_Objects_Extend_information+0x240> /* * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; if ( information->auto_extend ) { ffc0a900: 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; ffc0a904: 80 7f 00 18 lwz r3,24(r31) if ( information->auto_extend ) { ffc0a908: 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; ffc0a90c: 7c 6a 19 d6 mullw r3,r10,r3 if ( information->auto_extend ) { ffc0a910: 41 9e 01 cc beq- cr7,ffc0aadc <_Objects_Extend_information+0x280> new_object_block = _Workspace_Allocate( block_size ); ffc0a914: 48 00 2c 85 bl ffc0d598 <_Workspace_Allocate> if ( !new_object_block ) ffc0a918: 7c 7c 1b 79 mr. r28,r3 ffc0a91c: 41 82 01 80 beq- ffc0aa9c <_Objects_Extend_information+0x240> } /* * Do we need to grow the tables? */ if ( do_extend ) { ffc0a920: 2f 99 00 00 cmpwi cr7,r25,0 ffc0a924: 41 9e 00 f4 beq- cr7,ffc0aa18 <_Objects_Extend_information+0x1bc> */ /* * Up the block count and maximum */ block_count++; ffc0a928: 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 *)) + ffc0a92c: 1c 77 00 03 mulli r3,r23,3 ((maximum + minimum_index) * sizeof(Objects_Control *)); ffc0a930: 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 *)) + ffc0a934: 7c 63 ea 14 add r3,r3,r29 ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); ffc0a938: 54 63 10 3a rlwinm r3,r3,2,0,29 ffc0a93c: 48 00 2c 5d bl ffc0d598 <_Workspace_Allocate> if ( !object_blocks ) { ffc0a940: 7c 78 1b 79 mr. r24,r3 ffc0a944: 41 82 02 24 beq- ffc0ab68 <_Objects_Extend_information+0x30c> * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { ffc0a948: a0 1f 00 10 lhz r0,16(r31) } /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( ffc0a94c: 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); ffc0a950: 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 ) { ffc0a954: 7f 9d 00 40 cmplw cr7,r29,r0 ffc0a958: 7e f9 ba 14 add r23,r25,r23 ffc0a95c: 41 9c 01 8c blt- cr7,ffc0aae8 <_Objects_Extend_information+0x28c> } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { ffc0a960: 2f 9d 00 00 cmpwi cr7,r29,0 local_table[ index ] = NULL; ffc0a964: 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, ffc0a968: 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; ffc0a96c: 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++ ) { ffc0a970: 41 9e 00 0c beq- cr7,ffc0a97c <_Objects_Extend_information+0x120><== NEVER TAKEN local_table[ index ] = NULL; ffc0a974: 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++ ) { ffc0a978: 42 00 ff fc bdnz+ ffc0a974 <_Objects_Extend_information+0x118> ffc0a97c: 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 ); ffc0a980: a1 7f 00 14 lhz r11,20(r31) } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; ffc0a984: 38 00 00 00 li r0,0 ffc0a988: 7c 18 b1 2e stwx r0,r24,r22 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); ffc0a98c: 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 ; ffc0a990: 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; ffc0a994: 7c 19 b1 2e stwx r0,r25,r22 for ( index=index_base ; ffc0a998: 40 9c 00 30 bge- cr7,ffc0a9c8 <_Objects_Extend_information+0x16c><== NEVER TAKEN ffc0a99c: 38 1e 00 01 addi r0,r30,1 ffc0a9a0: 7f 80 58 40 cmplw cr7,r0,r11 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( ffc0a9a4: 57 c9 10 3a rlwinm r9,r30,2,0,29 ffc0a9a8: 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; ffc0a9ac: 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 ; ffc0a9b0: 7d 29 ba 14 add r9,r9,r23 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; ffc0a9b4: 7d 69 03 a6 mtctr r11 ffc0a9b8: 38 00 00 00 li r0,0 ffc0a9bc: 41 9d 01 b8 bgt- cr7,ffc0ab74 <_Objects_Extend_information+0x318><== NEVER TAKEN ffc0a9c0: 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 ; ffc0a9c4: 42 00 ff fc bdnz+ ffc0a9c0 <_Objects_Extend_information+0x164> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a9c8: 7c 00 00 a6 mfmsr r0 ffc0a9cc: 7d 30 42 a6 mfsprg r9,0 ffc0a9d0: 7c 09 48 78 andc r9,r0,r9 ffc0a9d4: 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) | ffc0a9d8: 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; ffc0a9dc: 57 5a 04 3e clrlwi r26,r26,16 information->maximum_id = _Objects_Build_id( ffc0a9e0: a1 3f 00 04 lhz r9,4(r31) ffc0a9e4: 55 6b c0 0e rlwinm r11,r11,24,0,7 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; ffc0a9e8: 80 7f 00 34 lwz r3,52(r31) ffc0a9ec: 65 6b 00 01 oris r11,r11,1 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; ffc0a9f0: 93 3f 00 30 stw r25,48(r31) (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc0a9f4: 55 29 d8 08 rlwinm r9,r9,27,0,4 ffc0a9f8: 7d 69 4b 78 or r9,r11,r9 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; ffc0a9fc: 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) | ffc0aa00: 7d 29 d3 78 or r9,r9,r26 information->inactive_per_block = inactive_per_block; information->local_table = local_table; ffc0aa04: 92 ff 00 1c stw r23,28(r31) information->maximum = (Objects_Maximum) maximum; ffc0aa08: b3 5f 00 10 sth r26,16(r31) information->maximum_id = _Objects_Build_id( ffc0aa0c: 91 3f 00 0c stw r9,12(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0aa10: 7c 00 01 24 mtmsr r0 information->maximum ); _ISR_Enable( level ); _Workspace_Free( old_tables ); ffc0aa14: 48 00 2b b9 bl ffc0d5cc <_Workspace_Free> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; ffc0aa18: 81 3f 00 34 lwz r9,52(r31) ffc0aa1c: 57 7b 10 3a rlwinm r27,r27,2,0,29 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc0aa20: 3b a1 00 08 addi r29,r1,8 ffc0aa24: 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; ffc0aa28: 7f 89 d9 2e stwx r28,r9,r27 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc0aa2c: 7f 84 e3 78 mr r4,r28 ffc0aa30: 7f a3 eb 78 mr r3,r29 ffc0aa34: 80 df 00 18 lwz r6,24(r31) information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0aa38: 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( ffc0aa3c: 48 00 5a 35 bl ffc10470 <_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 ) { ffc0aa40: 48 00 00 2c b ffc0aa6c <_Objects_Extend_information+0x210> ffc0aa44: 81 7f 00 00 lwz r11,0(r31) the_object->id = _Objects_Build_id( ffc0aa48: a0 1f 00 04 lhz r0,4(r31) ffc0aa4c: 55 6b c0 0e rlwinm r11,r11,24,0,7 ffc0aa50: 65 6b 00 01 oris r11,r11,1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc0aa54: 54 00 d8 08 rlwinm r0,r0,27,0,4 ffc0aa58: 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) | ffc0aa5c: 7c 00 f3 78 or r0,r0,r30 ffc0aa60: 90 09 00 08 stw r0,8(r9) index ); _Chain_Append( &information->Inactive, &the_object->Node ); index++; ffc0aa64: 3b de 00 01 addi r30,r30,1 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0aa68: 4b ff f0 fd bl ffc09b64 <_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 ) { ffc0aa6c: 7f a3 eb 78 mr r3,r29 ffc0aa70: 4b ff f1 4d bl ffc09bbc <_Chain_Get> ffc0aa74: 7c 69 1b 79 mr. r9,r3 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0aa78: 7f 83 e3 78 mr r3,r28 ffc0aa7c: 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 ) { ffc0aa80: 40 82 ff c4 bne+ ffc0aa44 <_Objects_Extend_information+0x1e8> index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); ffc0aa84: a1 3f 00 2c lhz r9,44(r31) _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; ffc0aa88: a0 1f 00 14 lhz r0,20(r31) ffc0aa8c: 81 7f 00 30 lwz r11,48(r31) information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); ffc0aa90: 7d 20 4a 14 add r9,r0,r9 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; ffc0aa94: 7c 0b d9 2e stwx r0,r11,r27 information->inactive = ffc0aa98: b1 3f 00 2c sth r9,44(r31) (Objects_Maximum)(information->inactive + information->allocation_size); } ffc0aa9c: 80 01 00 44 lwz r0,68(r1) ffc0aaa0: 82 c1 00 18 lwz r22,24(r1) ffc0aaa4: 7c 08 03 a6 mtlr r0 ffc0aaa8: 82 e1 00 1c lwz r23,28(r1) ffc0aaac: 83 01 00 20 lwz r24,32(r1) ffc0aab0: 83 21 00 24 lwz r25,36(r1) ffc0aab4: 83 41 00 28 lwz r26,40(r1) ffc0aab8: 83 61 00 2c lwz r27,44(r1) ffc0aabc: 83 81 00 30 lwz r28,48(r1) ffc0aac0: 83 a1 00 34 lwz r29,52(r1) ffc0aac4: 83 c1 00 38 lwz r30,56(r1) ffc0aac8: 83 e1 00 3c lwz r31,60(r1) ffc0aacc: 38 21 00 40 addi r1,r1,64 ffc0aad0: 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; ffc0aad4: 3b 20 00 00 li r25,0 ffc0aad8: 4b ff fe 1c b ffc0a8f4 <_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 ); ffc0aadc: 48 00 2b 1d bl ffc0d5f8 <_Workspace_Allocate_or_fatal_error> ffc0aae0: 7c 7c 1b 78 mr r28,r3 ffc0aae4: 4b ff fe 3c b ffc0a920 <_Objects_Extend_information+0xc4> * separate parts as size of each block has changed. */ memcpy( object_blocks, information->object_blocks, block_count * sizeof(void*) ); ffc0aae8: 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, ffc0aaec: 80 9f 00 34 lwz r4,52(r31) ffc0aaf0: 7e c5 b3 78 mr r5,r22 ffc0aaf4: 48 00 94 d1 bl ffc13fc4 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, ffc0aaf8: 80 9f 00 30 lwz r4,48(r31) ffc0aafc: 7e c5 b3 78 mr r5,r22 ffc0ab00: 7f 23 cb 78 mr r3,r25 ffc0ab04: 48 00 94 c1 bl ffc13fc4 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); ffc0ab08: 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, ffc0ab0c: 80 9f 00 1c lwz r4,28(r31) ffc0ab10: 7e e3 bb 78 mr r3,r23 information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); ffc0ab14: 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, ffc0ab18: 54 a5 10 3a rlwinm r5,r5,2,0,29 ffc0ab1c: 48 00 94 a9 bl ffc13fc4 ffc0ab20: 4b ff fe 60 b ffc0a980 <_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 ) ffc0ab24: 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 ); ffc0ab28: 7f be eb 78 mr r30,r29 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc0ab2c: 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; ffc0ab30: 3b 20 00 01 li r25,1 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc0ab34: 3b 60 00 00 li r27,0 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; ffc0ab38: 3a c0 00 00 li r22,0 ffc0ab3c: 4b ff fd b8 b ffc0a8f4 <_Objects_Extend_information+0x98> else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { ffc0ab40: 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 ); ffc0ab44: 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; ffc0ab48: 3b 20 00 01 li r25,1 <== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc0ab4c: 3b 60 00 00 li r27,0 <== NOT EXECUTED ffc0ab50: 4b ff fd a4 b ffc0a8f4 <_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 ) { ffc0ab54: 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 ); ffc0ab58: 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; ffc0ab5c: 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; ffc0ab60: 3b 60 00 00 li r27,0 <== NOT EXECUTED ffc0ab64: 4b ff fd 90 b ffc0a8f4 <_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 ); ffc0ab68: 7f 83 e3 78 mr r3,r28 ffc0ab6c: 48 00 2a 61 bl ffc0d5cc <_Workspace_Free> return; ffc0ab70: 4b ff ff 2c b ffc0aa9c <_Objects_Extend_information+0x240> ffc0ab74: 39 60 00 01 li r11,1 <== NOT EXECUTED ffc0ab78: 7d 69 03 a6 mtctr r11 <== NOT EXECUTED ffc0ab7c: 4b ff fe 44 b ffc0a9c0 <_Objects_Extend_information+0x164><== NOT EXECUTED =============================================================================== ffc0ac6c <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0ac6c: 94 21 ff e8 stwu r1,-24(r1) ffc0ac70: 7c 08 02 a6 mflr r0 ffc0ac74: 93 c1 00 10 stw r30,16(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) ffc0ac78: 7c 9e 23 79 mr. r30,r4 Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0ac7c: 93 a1 00 0c stw r29,12(r1) ffc0ac80: 7c 7d 1b 78 mr r29,r3 ffc0ac84: 93 e1 00 14 stw r31,20(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) return NULL; ffc0ac88: 3b e0 00 00 li r31,0 Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0ac8c: 90 01 00 1c stw r0,28(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) ffc0ac90: 40 82 00 24 bne- ffc0acb4 <_Objects_Get_information+0x48> if ( info->maximum == 0 ) return NULL; #endif return info; } ffc0ac94: 80 01 00 1c lwz r0,28(r1) ffc0ac98: 7f e3 fb 78 mr r3,r31 ffc0ac9c: 83 a1 00 0c lwz r29,12(r1) ffc0aca0: 7c 08 03 a6 mtlr r0 ffc0aca4: 83 c1 00 10 lwz r30,16(r1) ffc0aca8: 83 e1 00 14 lwz r31,20(r1) ffc0acac: 38 21 00 18 addi r1,r1,24 ffc0acb0: 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 ); ffc0acb4: 48 00 5d dd bl ffc10a90 <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) ffc0acb8: 2c 03 00 00 cmpwi r3,0 ffc0acbc: 41 82 ff d8 beq+ ffc0ac94 <_Objects_Get_information+0x28> return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) ffc0acc0: 7f 83 f0 40 cmplw cr7,r3,r30 ffc0acc4: 41 9c ff d0 blt+ cr7,ffc0ac94 <_Objects_Get_information+0x28> return NULL; if ( !_Objects_Information_table[ the_api ] ) ffc0acc8: 3d 20 00 00 lis r9,0 ffc0accc: 57 bd 10 3a rlwinm r29,r29,2,0,29 ffc0acd0: 39 29 2c 40 addi r9,r9,11328 ffc0acd4: 7d 29 e8 2e lwzx r9,r9,r29 ffc0acd8: 2f 89 00 00 cmpwi cr7,r9,0 ffc0acdc: 41 9e ff b8 beq+ cr7,ffc0ac94 <_Objects_Get_information+0x28><== NEVER TAKEN return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; ffc0ace0: 57 de 10 3a rlwinm r30,r30,2,0,29 ffc0ace4: 7f e9 f0 2e lwzx r31,r9,r30 if ( !info ) ffc0ace8: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0acec: 41 9e ff a8 beq+ cr7,ffc0ac94 <_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 ) ffc0acf0: a0 1f 00 10 lhz r0,16(r31) ffc0acf4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0acf8: 40 9e ff 9c bne+ cr7,ffc0ac94 <_Objects_Get_information+0x28> return NULL; ffc0acfc: 3b e0 00 00 li r31,0 ffc0ad00: 4b ff ff 94 b ffc0ac94 <_Objects_Get_information+0x28> =============================================================================== ffc0cf80 <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { ffc0cf80: 94 21 ff d8 stwu r1,-40(r1) ffc0cf84: 7c 08 02 a6 mflr r0 ffc0cf88: 93 c1 00 20 stw r30,32(r1) char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) ffc0cf8c: 7c 9e 23 79 mr. r30,r4 char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { ffc0cf90: 93 e1 00 24 stw r31,36(r1) ffc0cf94: 7c bf 2b 78 mr r31,r5 ffc0cf98: 90 01 00 2c stw r0,44(r1) ffc0cf9c: 93 81 00 18 stw r28,24(r1) ffc0cfa0: 93 a1 00 1c stw r29,28(r1) char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) ffc0cfa4: 40 82 00 2c bne- ffc0cfd0 <_Objects_Get_name_as_string+0x50> #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* not supported */ #endif case OBJECTS_ERROR: return NULL; ffc0cfa8: 3b e0 00 00 li r31,0 _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } ffc0cfac: 80 01 00 2c lwz r0,44(r1) ffc0cfb0: 7f e3 fb 78 mr r3,r31 ffc0cfb4: 83 81 00 18 lwz r28,24(r1) ffc0cfb8: 7c 08 03 a6 mtlr r0 ffc0cfbc: 83 a1 00 1c lwz r29,28(r1) ffc0cfc0: 83 c1 00 20 lwz r30,32(r1) ffc0cfc4: 83 e1 00 24 lwz r31,36(r1) ffc0cfc8: 38 21 00 28 addi r1,r1,40 ffc0cfcc: 4e 80 00 20 blr Objects_Id tmpId; if ( length == 0 ) return NULL; if ( name == NULL ) ffc0cfd0: 2f 85 00 00 cmpwi cr7,r5,0 ffc0cfd4: 41 9e ff d8 beq+ cr7,ffc0cfac <_Objects_Get_name_as_string+0x2c> return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; ffc0cfd8: 2f 83 00 00 cmpwi cr7,r3,0 ffc0cfdc: 7c 7c 1b 78 mr r28,r3 ffc0cfe0: 40 9e 00 10 bne- cr7,ffc0cff0 <_Objects_Get_name_as_string+0x70> ffc0cfe4: 3d 20 00 00 lis r9,0 ffc0cfe8: 81 29 35 b0 lwz r9,13744(r9) ffc0cfec: 83 89 00 08 lwz r28,8(r9) information = _Objects_Get_information_id( tmpId ); ffc0cff0: 7f 83 e3 78 mr r3,r28 ffc0cff4: 4b ff fe 59 bl ffc0ce4c <_Objects_Get_information_id> if ( !information ) ffc0cff8: 7c 7d 1b 79 mr. r29,r3 ffc0cffc: 41 82 ff ac beq+ ffc0cfa8 <_Objects_Get_name_as_string+0x28> return NULL; the_object = _Objects_Get( information, tmpId, &location ); ffc0d000: 7f 84 e3 78 mr r4,r28 ffc0d004: 38 a1 00 08 addi r5,r1,8 ffc0d008: 48 00 00 cd bl ffc0d0d4 <_Objects_Get> switch ( location ) { ffc0d00c: 80 01 00 08 lwz r0,8(r1) ffc0d010: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d014: 40 be ff 94 bne- cr7,ffc0cfa8 <_Objects_Get_name_as_string+0x28> return NULL; case OBJECTS_LOCAL: #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { ffc0d018: 89 3d 00 38 lbz r9,56(r29) ffc0d01c: 2f 89 00 00 cmpwi cr7,r9,0 ffc0d020: 41 9e 00 88 beq- cr7,ffc0d0a8 <_Objects_Get_name_as_string+0x128> s = the_object->name.name_p; ffc0d024: 80 e3 00 0c lwz r7,12(r3) lname[ 4 ] = '\0'; s = lname; } d = name; if ( s ) { ffc0d028: 7f e9 fb 78 mr r9,r31 ffc0d02c: 2f 87 00 00 cmpwi cr7,r7,0 ffc0d030: 41 9e 00 68 beq- cr7,ffc0d098 <_Objects_Get_name_as_string+0x118> for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { ffc0d034: 34 1e ff ff addic. r0,r30,-1 ffc0d038: 7f e9 fb 78 mr r9,r31 ffc0d03c: 7c 09 03 a6 mtctr r0 ffc0d040: 41 82 00 58 beq- ffc0d098 <_Objects_Get_name_as_string+0x118><== NEVER TAKEN ffc0d044: 88 07 00 00 lbz r0,0(r7) ffc0d048: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d04c: 41 9e 00 4c beq- cr7,ffc0d098 <_Objects_Get_name_as_string+0x118> ffc0d050: 3c c0 00 00 lis r6,0 ffc0d054: 39 60 00 00 li r11,0 ffc0d058: 38 c6 27 ec addi r6,r6,10220 ffc0d05c: 48 00 00 10 b ffc0d06c <_Objects_Get_name_as_string+0xec> ffc0d060: 7c 07 58 ae lbzx r0,r7,r11 ffc0d064: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d068: 41 9e 00 30 beq- cr7,ffc0d098 <_Objects_Get_name_as_string+0x118> *d = (isprint((unsigned char)*s)) ? *s : '*'; ffc0d06c: 81 06 00 00 lwz r8,0(r6) ffc0d070: 7c 0a 03 78 mr r10,r0 s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { ffc0d074: 39 6b 00 01 addi r11,r11,1 *d = (isprint((unsigned char)*s)) ? *s : '*'; ffc0d078: 7d 08 02 14 add r8,r8,r0 ffc0d07c: 88 08 00 01 lbz r0,1(r8) ffc0d080: 70 08 00 97 andi. r8,r0,151 ffc0d084: 40 82 00 08 bne- ffc0d08c <_Objects_Get_name_as_string+0x10c> ffc0d088: 39 40 00 2a li r10,42 ffc0d08c: 99 49 00 00 stb r10,0(r9) s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { ffc0d090: 39 29 00 01 addi r9,r9,1 ffc0d094: 42 00 ff cc bdnz+ ffc0d060 <_Objects_Get_name_as_string+0xe0> *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; ffc0d098: 38 00 00 00 li r0,0 ffc0d09c: 98 09 00 00 stb r0,0(r9) _Thread_Enable_dispatch(); ffc0d0a0: 48 00 10 59 bl ffc0e0f8 <_Thread_Enable_dispatch> return name; ffc0d0a4: 4b ff ff 08 b ffc0cfac <_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; ffc0d0a8: 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; ffc0d0ac: 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'; ffc0d0b0: 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; ffc0d0b4: 54 0a 46 3e rlwinm r10,r0,8,24,31 lname[ 1 ] = (u32_name >> 16) & 0xff; ffc0d0b8: 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; ffc0d0bc: 99 41 00 0c stb r10,12(r1) lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; ffc0d0c0: 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; ffc0d0c4: 99 61 00 0d stb r11,13(r1) lname[ 2 ] = (u32_name >> 8) & 0xff; ffc0d0c8: 99 21 00 0e stb r9,14(r1) lname[ 3 ] = (u32_name >> 0) & 0xff; ffc0d0cc: 98 01 00 0f stb r0,15(r1) ffc0d0d0: 4b ff ff 64 b ffc0d034 <_Objects_Get_name_as_string+0xb4> =============================================================================== ffc1ecc4 <_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; ffc1ecc4: 81 23 00 08 lwz r9,8(r3) if ( information->maximum >= index ) { ffc1ecc8: 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; ffc1eccc: 21 29 00 01 subfic r9,r9,1 ffc1ecd0: 7d 29 22 14 add r9,r9,r4 if ( information->maximum >= index ) { ffc1ecd4: 7f 89 00 40 cmplw cr7,r9,r0 ffc1ecd8: 41 9d 00 24 bgt- cr7,ffc1ecfc <_Objects_Get_no_protection+0x38> if ( (the_object = information->local_table[ index ]) != NULL ) { ffc1ecdc: 81 63 00 1c lwz r11,28(r3) ffc1ece0: 55 29 10 3a rlwinm r9,r9,2,0,29 ffc1ece4: 7c 6b 48 2e lwzx r3,r11,r9 ffc1ece8: 2f 83 00 00 cmpwi cr7,r3,0 ffc1ecec: 41 9e 00 10 beq- cr7,ffc1ecfc <_Objects_Get_no_protection+0x38><== NEVER TAKEN *location = OBJECTS_LOCAL; ffc1ecf0: 38 00 00 00 li r0,0 ffc1ecf4: 90 05 00 00 stw r0,0(r5) return the_object; ffc1ecf8: 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; ffc1ecfc: 38 00 00 01 li r0,1 ffc1ed00: 90 05 00 00 stw r0,0(r5) return NULL; ffc1ed04: 38 60 00 00 li r3,0 } ffc1ed08: 4e 80 00 20 blr =============================================================================== ffc0c924 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { ffc0c924: 94 21 ff e0 stwu r1,-32(r1) ffc0c928: 7c 08 02 a6 mflr r0 ffc0c92c: 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; ffc0c930: 7c 60 1b 79 mr. r0,r3 */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { ffc0c934: 93 c1 00 18 stw r30,24(r1) ffc0c938: 7c 9e 23 78 mr r30,r4 ffc0c93c: 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; ffc0c940: 40 82 00 10 bne- ffc0c950 <_Objects_Id_to_name+0x2c> ffc0c944: 3d 20 00 00 lis r9,0 ffc0c948: 81 29 31 90 lwz r9,12688(r9) ffc0c94c: 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); ffc0c950: 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 ) ffc0c954: 39 69 ff ff addi r11,r9,-1 ffc0c958: 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; ffc0c95c: 3b e0 00 03 li r31,3 ffc0c960: 41 9d 00 38 bgt- cr7,ffc0c998 <_Objects_Id_to_name+0x74> if ( !_Objects_Information_table[ the_api ] ) ffc0c964: 3d 60 00 00 lis r11,0 ffc0c968: 55 29 10 3a rlwinm r9,r9,2,0,29 ffc0c96c: 39 6b 2c a0 addi r11,r11,11424 ffc0c970: 7d 2b 48 2e lwzx r9,r11,r9 ffc0c974: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c978: 41 9e 00 20 beq- cr7,ffc0c998 <_Objects_Id_to_name+0x74> return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; ffc0c97c: 54 0b 3e 7a rlwinm r11,r0,7,25,29 ffc0c980: 7c 69 58 2e lwzx r3,r9,r11 if ( !information ) ffc0c984: 2f 83 00 00 cmpwi cr7,r3,0 ffc0c988: 41 9e 00 10 beq- cr7,ffc0c998 <_Objects_Id_to_name+0x74><== NEVER TAKEN return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) ffc0c98c: 89 23 00 38 lbz r9,56(r3) ffc0c990: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c994: 41 9e 00 20 beq- cr7,ffc0c9b4 <_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; } ffc0c998: 80 01 00 24 lwz r0,36(r1) ffc0c99c: 7f e3 fb 78 mr r3,r31 ffc0c9a0: 83 c1 00 18 lwz r30,24(r1) ffc0c9a4: 7c 08 03 a6 mtlr r0 ffc0c9a8: 83 e1 00 1c lwz r31,28(r1) ffc0c9ac: 38 21 00 20 addi r1,r1,32 ffc0c9b0: 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 ); ffc0c9b4: 7c 04 03 78 mr r4,r0 ffc0c9b8: 38 a1 00 08 addi r5,r1,8 ffc0c9bc: 4b ff fe cd bl ffc0c888 <_Objects_Get> if ( !the_object ) ffc0c9c0: 2c 03 00 00 cmpwi r3,0 ffc0c9c4: 41 a2 ff d4 beq- ffc0c998 <_Objects_Id_to_name+0x74> return OBJECTS_INVALID_ID; *name = the_object->name; ffc0c9c8: 80 03 00 0c lwz r0,12(r3) _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; ffc0c9cc: 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; ffc0c9d0: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc0c9d4: 48 00 0f a9 bl ffc0d97c <_Thread_Enable_dispatch> return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } ffc0c9d8: 80 01 00 24 lwz r0,36(r1) ffc0c9dc: 7f e3 fb 78 mr r3,r31 ffc0c9e0: 83 c1 00 18 lwz r30,24(r1) ffc0c9e4: 7c 08 03 a6 mtlr r0 ffc0c9e8: 83 e1 00 1c lwz r31,28(r1) ffc0c9ec: 38 21 00 20 addi r1,r1,32 ffc0c9f0: 4e 80 00 20 blr =============================================================================== ffc0afd0 <_Objects_Shrink_information>: */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0afd0: 94 21 ff e8 stwu r1,-24(r1) ffc0afd4: 7c 08 02 a6 mflr r0 ffc0afd8: 90 01 00 1c stw r0,28(r1) ffc0afdc: 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) / ffc0afe0: 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 ); ffc0afe4: a3 e3 00 0a lhz r31,10(r3) block_count = (information->maximum - index_base) / ffc0afe8: a0 03 00 14 lhz r0,20(r3) ffc0afec: 7d 5f 50 50 subf r10,r31,r10 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0aff0: 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) / ffc0aff4: 7d 4a 03 96 divwu r10,r10,r0 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0aff8: 93 a1 00 0c stw r29,12(r1) ffc0affc: 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++ ) { ffc0b000: 2f 8a 00 00 cmpwi cr7,r10,0 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0b004: 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++ ) { ffc0b008: 41 9e 00 3c beq- cr7,ffc0b044 <_Objects_Shrink_information+0x74><== NEVER TAKEN if ( information->inactive_per_block[ block ] == ffc0b00c: 81 63 00 30 lwz r11,48(r3) ffc0b010: 81 2b 00 00 lwz r9,0(r11) ffc0b014: 7f 80 48 00 cmpw cr7,r0,r9 ffc0b018: 41 9e 00 4c beq- cr7,ffc0b064 <_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++ ) { ffc0b01c: 39 20 00 00 li r9,0 ffc0b020: 7d 49 03 a6 mtctr r10 ffc0b024: 48 00 00 18 b ffc0b03c <_Objects_Shrink_information+0x6c> if ( information->inactive_per_block[ block ] == ffc0b028: 85 4b 00 04 lwzu r10,4(r11) information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; ffc0b02c: 7f ff 02 14 add r31,r31,r0 ffc0b030: 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 ] == ffc0b034: 7f 80 50 00 cmpw cr7,r0,r10 ffc0b038: 41 9e 00 30 beq- cr7,ffc0b068 <_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++ ) { ffc0b03c: 39 29 00 01 addi r9,r9,1 ffc0b040: 42 00 ff e8 bdnz+ ffc0b028 <_Objects_Shrink_information+0x58> return; } index_base += information->allocation_size; } } ffc0b044: 80 01 00 1c lwz r0,28(r1) ffc0b048: 83 81 00 08 lwz r28,8(r1) ffc0b04c: 7c 08 03 a6 mtlr r0 ffc0b050: 83 a1 00 0c lwz r29,12(r1) ffc0b054: 83 c1 00 10 lwz r30,16(r1) ffc0b058: 83 e1 00 14 lwz r31,20(r1) ffc0b05c: 38 21 00 18 addi r1,r1,24 ffc0b060: 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 ] == ffc0b064: 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 ); ffc0b068: 80 7c 00 20 lwz r3,32(r28) ffc0b06c: 48 00 00 10 b ffc0b07c <_Objects_Shrink_information+0xac> if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); ffc0b070: 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; ffc0b074: 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 ); ffc0b078: 41 9e 00 34 beq- cr7,ffc0b0ac <_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 ); ffc0b07c: 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; ffc0b080: 83 c3 00 00 lwz r30,0(r3) if ((index >= index_base) && ffc0b084: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0b088: 41 bc ff e8 blt- cr7,ffc0b070 <_Objects_Shrink_information+0xa0> (index < (index_base + information->allocation_size))) { ffc0b08c: a1 3c 00 14 lhz r9,20(r28) ffc0b090: 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) && ffc0b094: 7f 80 48 40 cmplw cr7,r0,r9 ffc0b098: 40 9c ff d8 bge+ cr7,ffc0b070 <_Objects_Shrink_information+0xa0> (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); ffc0b09c: 4b ff ea f9 bl ffc09b94 <_Chain_Extract> } } while ( the_object ); ffc0b0a0: 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; ffc0b0a4: 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 ); ffc0b0a8: 40 9e ff d4 bne+ cr7,ffc0b07c <_Objects_Shrink_information+0xac><== ALWAYS TAKEN /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); ffc0b0ac: 81 3c 00 34 lwz r9,52(r28) ffc0b0b0: 7c 69 e8 2e lwzx r3,r9,r29 ffc0b0b4: 48 00 25 19 bl ffc0d5cc <_Workspace_Free> information->object_blocks[ block ] = NULL; information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; ffc0b0b8: a1 5c 00 2c lhz r10,44(r28) ffc0b0bc: 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; ffc0b0c0: 81 7c 00 34 lwz r11,52(r28) information->inactive_per_block[ block ] = 0; ffc0b0c4: 81 3c 00 30 lwz r9,48(r28) information->inactive -= information->allocation_size; ffc0b0c8: 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; ffc0b0cc: 7f cb e9 2e stwx r30,r11,r29 information->inactive_per_block[ block ] = 0; ffc0b0d0: 7f c9 e9 2e stwx r30,r9,r29 information->inactive -= information->allocation_size; ffc0b0d4: b0 1c 00 2c sth r0,44(r28) return; } index_base += information->allocation_size; } } ffc0b0d8: 80 01 00 1c lwz r0,28(r1) ffc0b0dc: 83 81 00 08 lwz r28,8(r1) ffc0b0e0: 7c 08 03 a6 mtlr r0 ffc0b0e4: 83 a1 00 0c lwz r29,12(r1) ffc0b0e8: 83 c1 00 10 lwz r30,16(r1) ffc0b0ec: 83 e1 00 14 lwz r31,20(r1) ffc0b0f0: 38 21 00 18 addi r1,r1,24 ffc0b0f4: 4e 80 00 20 blr =============================================================================== ffc0b760 <_POSIX_Absolute_timeout_to_ticks>: */ POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks( const struct timespec *abstime, Watchdog_Interval *ticks_out ) { ffc0b760: 94 21 ff d8 stwu r1,-40(r1) ffc0b764: 7c 08 02 a6 mflr r0 ffc0b768: 90 01 00 2c stw r0,44(r1) /* * Make sure there is always a value returned. */ *ticks_out = 0; ffc0b76c: 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 ) { ffc0b770: 93 81 00 18 stw r28,24(r1) ffc0b774: 7c 7c 1b 78 mr r28,r3 ffc0b778: 93 e1 00 24 stw r31,36(r1) ffc0b77c: 7c 9f 23 78 mr r31,r4 ffc0b780: 93 a1 00 1c stw r29,28(r1) ffc0b784: 93 c1 00 20 stw r30,32(r1) /* * Make sure there is always a value returned. */ *ticks_out = 0; ffc0b788: 90 04 00 00 stw r0,0(r4) /* * Is the absolute time even valid? */ if ( !_Timespec_Is_valid(abstime) ) ffc0b78c: 48 00 54 0d bl ffc10b98 <_Timespec_Is_valid> ffc0b790: 2f 83 00 00 cmpwi cr7,r3,0 return POSIX_ABSOLUTE_TIMEOUT_INVALID; ffc0b794: 38 60 00 00 li r3,0 *ticks_out = 0; /* * Is the absolute time even valid? */ if ( !_Timespec_Is_valid(abstime) ) ffc0b798: 40 9e 00 24 bne- cr7,ffc0b7bc <_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; } ffc0b79c: 80 01 00 2c lwz r0,44(r1) ffc0b7a0: 83 81 00 18 lwz r28,24(r1) ffc0b7a4: 7c 08 03 a6 mtlr r0 ffc0b7a8: 83 a1 00 1c lwz r29,28(r1) ffc0b7ac: 83 c1 00 20 lwz r30,32(r1) ffc0b7b0: 83 e1 00 24 lwz r31,36(r1) ffc0b7b4: 38 21 00 28 addi r1,r1,40 ffc0b7b8: 4e 80 00 20 blr return POSIX_ABSOLUTE_TIMEOUT_INVALID; /* * Is the absolute time in the past? */ _TOD_Get( ¤t_time ); ffc0b7bc: 3b c1 00 08 addi r30,r1,8 ffc0b7c0: 7f c3 f3 78 mr r3,r30 ffc0b7c4: 48 00 27 9d bl ffc0df60 <_TOD_Get> if ( _Timespec_Less_than( abstime, ¤t_time ) ) ffc0b7c8: 7f 83 e3 78 mr r3,r28 ffc0b7cc: 7f c4 f3 78 mr r4,r30 ffc0b7d0: 48 00 54 05 bl ffc10bd4 <_Timespec_Less_than> ffc0b7d4: 2f 83 00 00 cmpwi cr7,r3,0 return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST; ffc0b7d8: 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 ) ) ffc0b7dc: 40 be ff c0 bne- cr7,ffc0b79c <_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 ); ffc0b7e0: 3b a1 00 10 addi r29,r1,16 ffc0b7e4: 7f 84 e3 78 mr r4,r28 ffc0b7e8: 7f a5 eb 78 mr r5,r29 ffc0b7ec: 7f c3 f3 78 mr r3,r30 ffc0b7f0: 48 00 54 21 bl ffc10c10 <_Timespec_Subtract> /* * Internally the SuperCore uses ticks, so convert to them. */ *ticks_out = _Timespec_To_ticks( &difference ); ffc0b7f4: 7f a3 eb 78 mr r3,r29 ffc0b7f8: 48 00 54 6d bl ffc10c64 <_Timespec_To_ticks> /* * If the difference was 0, then the future is now. It is so bright * we better wear shades. */ if ( !*ticks_out ) ffc0b7fc: 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 ); ffc0b800: 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; ffc0b804: 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 ) ffc0b808: 40 9e ff 94 bne+ cr7,ffc0b79c <_POSIX_Absolute_timeout_to_ticks+0x3c><== ALWAYS TAKEN return POSIX_ABSOLUTE_TIMEOUT_IS_NOW; ffc0b80c: 38 60 00 02 li r3,2 <== NOT EXECUTED ffc0b810: 4b ff ff 8c b ffc0b79c <_POSIX_Absolute_timeout_to_ticks+0x3c><== NOT EXECUTED =============================================================================== ffc0eb78 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { ffc0eb78: 94 21 ff d0 stwu r1,-48(r1) ffc0eb7c: 7c 08 02 a6 mflr r0 ffc0eb80: 93 e1 00 2c stw r31,44(r1) ffc0eb84: 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( ffc0eb88: 3c 60 00 00 lis r3,0 ffc0eb8c: 93 81 00 20 stw r28,32(r1) ffc0eb90: 38 63 36 38 addi r3,r3,13880 ffc0eb94: 7c 9c 23 78 mr r28,r4 ffc0eb98: 93 c1 00 28 stw r30,40(r1) ffc0eb9c: 7f e4 fb 78 mr r4,r31 ffc0eba0: 7c be 2b 78 mr r30,r5 ffc0eba4: 38 a1 00 08 addi r5,r1,8 ffc0eba8: 90 01 00 34 stw r0,52(r1) ffc0ebac: 93 41 00 18 stw r26,24(r1) ffc0ebb0: 7c fa 3b 78 mr r26,r7 ffc0ebb4: 93 61 00 1c stw r27,28(r1) ffc0ebb8: 7d 1b 43 78 mr r27,r8 ffc0ebbc: 93 a1 00 24 stw r29,36(r1) ffc0ebc0: 7c dd 33 78 mr r29,r6 ffc0ebc4: 48 00 41 c9 bl ffc12d8c <_Objects_Get> Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { ffc0ebc8: 80 01 00 08 lwz r0,8(r1) ffc0ebcc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ebd0: 41 9e 00 3c beq- cr7,ffc0ec0c <_POSIX_Message_queue_Receive_support+0x94> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); ffc0ebd4: 48 00 d2 c9 bl ffc1be9c <__errno> ffc0ebd8: 38 00 00 09 li r0,9 ffc0ebdc: 90 03 00 00 stw r0,0(r3) ffc0ebe0: 38 60 ff ff li r3,-1 } ffc0ebe4: 80 01 00 34 lwz r0,52(r1) ffc0ebe8: 83 41 00 18 lwz r26,24(r1) ffc0ebec: 7c 08 03 a6 mtlr r0 ffc0ebf0: 83 61 00 1c lwz r27,28(r1) ffc0ebf4: 83 81 00 20 lwz r28,32(r1) ffc0ebf8: 83 a1 00 24 lwz r29,36(r1) ffc0ebfc: 83 c1 00 28 lwz r30,40(r1) ffc0ec00: 83 e1 00 2c lwz r31,44(r1) ffc0ec04: 38 21 00 30 addi r1,r1,48 ffc0ec08: 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 ) { ffc0ec0c: 80 03 00 14 lwz r0,20(r3) ffc0ec10: 54 09 07 be clrlwi r9,r0,30 ffc0ec14: 2f 89 00 01 cmpwi cr7,r9,1 ffc0ec18: 41 9e 00 e4 beq- cr7,ffc0ecfc <_POSIX_Message_queue_Receive_support+0x184> _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; ffc0ec1c: 80 63 00 10 lwz r3,16(r3) if ( msg_len < the_mq->Message_queue.maximum_message_size ) { ffc0ec20: 81 23 00 68 lwz r9,104(r3) ffc0ec24: 7f 89 f0 40 cmplw cr7,r9,r30 ffc0ec28: 41 9d 00 9c bgt- cr7,ffc0ecc4 <_POSIX_Message_queue_Receive_support+0x14c> length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0ec2c: 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; ffc0ec30: 39 20 ff ff li r9,-1 ffc0ec34: 91 21 00 0c stw r9,12(r1) /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0ec38: 38 e0 00 00 li r7,0 ffc0ec3c: 40 9e 00 78 bne- cr7,ffc0ecb4 <_POSIX_Message_queue_Receive_support+0x13c><== ALWAYS TAKEN do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0ec40: 7f e4 fb 78 mr r4,r31 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0ec44: 3f e0 00 00 lis r31,0 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0ec48: 38 63 00 1c addi r3,r3,28 ffc0ec4c: 7f 85 e3 78 mr r5,r28 ffc0ec50: 38 c1 00 0c addi r6,r1,12 ffc0ec54: 7f 68 db 78 mr r8,r27 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0ec58: 3b ff 36 a4 addi r31,r31,13988 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0ec5c: 48 00 2c 29 bl ffc11884 <_CORE_message_queue_Seize> &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); ffc0ec60: 48 00 52 11 bl ffc13e70 <_Thread_Enable_dispatch> *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0ec64: 81 3f 00 0c lwz r9,12(r31) if ( !_Thread_Executing->Wait.return_code ) ffc0ec68: 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); ffc0ec6c: 80 09 00 24 lwz r0,36(r9) ffc0ec70: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0ec74: 7c 09 fe 70 srawi r9,r0,31 ffc0ec78: 7d 20 02 78 xor r0,r9,r0 ffc0ec7c: 7c 09 00 50 subf r0,r9,r0 do_wait, timeout ); _Thread_Enable_dispatch(); *msg_prio = ffc0ec80: 90 1d 00 00 stw r0,0(r29) _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) ffc0ec84: 40 9e 00 58 bne- cr7,ffc0ecdc <_POSIX_Message_queue_Receive_support+0x164> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0ec88: 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; ffc0ec8c: 80 61 00 0c lwz r3,12(r1) case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0ec90: 7c 08 03 a6 mtlr r0 ffc0ec94: 83 41 00 18 lwz r26,24(r1) ffc0ec98: 83 61 00 1c lwz r27,28(r1) ffc0ec9c: 83 81 00 20 lwz r28,32(r1) ffc0eca0: 83 a1 00 24 lwz r29,36(r1) ffc0eca4: 83 c1 00 28 lwz r30,40(r1) ffc0eca8: 83 e1 00 2c lwz r31,44(r1) ffc0ecac: 38 21 00 30 addi r1,r1,48 ffc0ecb0: 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; ffc0ecb4: 70 09 40 00 andi. r9,r0,16384 ffc0ecb8: 7c e0 00 26 mfcr r7 ffc0ecbc: 54 e7 1f fe rlwinm r7,r7,3,31,31 ffc0ecc0: 4b ff ff 80 b ffc0ec40 <_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(); ffc0ecc4: 48 00 51 ad bl ffc13e70 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EMSGSIZE ); ffc0ecc8: 48 00 d1 d5 bl ffc1be9c <__errno> ffc0eccc: 38 00 00 7a li r0,122 ffc0ecd0: 90 03 00 00 stw r0,0(r3) ffc0ecd4: 38 60 ff ff li r3,-1 ffc0ecd8: 4b ff ff 0c b ffc0ebe4 <_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( ffc0ecdc: 48 00 d1 c1 bl ffc1be9c <__errno> ffc0ece0: 81 3f 00 0c lwz r9,12(r31) ffc0ece4: 7c 7e 1b 78 mr r30,r3 ffc0ece8: 80 69 00 34 lwz r3,52(r9) ffc0ecec: 48 00 03 71 bl ffc0f05c <_POSIX_Message_queue_Translate_core_message_queue_return_code> ffc0ecf0: 90 7e 00 00 stw r3,0(r30) ffc0ecf4: 38 60 ff ff li r3,-1 ffc0ecf8: 4b ff fe ec b ffc0ebe4 <_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(); ffc0ecfc: 48 00 51 75 bl ffc13e70 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EBADF ); ffc0ed00: 48 00 d1 9d bl ffc1be9c <__errno> ffc0ed04: 38 00 00 09 li r0,9 ffc0ed08: 90 03 00 00 stw r0,0(r3) ffc0ed0c: 38 60 ff ff li r3,-1 ffc0ed10: 4b ff fe d4 b ffc0ebe4 <_POSIX_Message_queue_Receive_support+0x6c> =============================================================================== ffc0ed3c <_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 ) ffc0ed3c: 2b 86 00 20 cmplwi cr7,r6,32 size_t msg_len, uint32_t msg_prio, bool wait, Watchdog_Interval timeout ) { ffc0ed40: 94 21 ff d0 stwu r1,-48(r1) ffc0ed44: 7c 08 02 a6 mflr r0 ffc0ed48: 93 41 00 18 stw r26,24(r1) ffc0ed4c: 7c fa 3b 78 mr r26,r7 ffc0ed50: 93 61 00 1c stw r27,28(r1) ffc0ed54: 7c 9b 23 78 mr r27,r4 ffc0ed58: 93 81 00 20 stw r28,32(r1) ffc0ed5c: 7c bc 2b 78 mr r28,r5 ffc0ed60: 93 a1 00 24 stw r29,36(r1) ffc0ed64: 7c 7d 1b 78 mr r29,r3 ffc0ed68: 93 c1 00 28 stw r30,40(r1) ffc0ed6c: 7c de 33 78 mr r30,r6 ffc0ed70: 93 e1 00 2c stw r31,44(r1) ffc0ed74: 7d 1f 43 78 mr r31,r8 ffc0ed78: 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 ) ffc0ed7c: 41 9d 01 04 bgt- cr7,ffc0ee80 <_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( ffc0ed80: 3c 60 00 00 lis r3,0 ffc0ed84: 38 63 36 38 addi r3,r3,13880 ffc0ed88: 7f a4 eb 78 mr r4,r29 ffc0ed8c: 38 a1 00 08 addi r5,r1,8 ffc0ed90: 48 00 3f fd bl ffc12d8c <_Objects_Get> rtems_set_errno_and_return_minus_one( EINVAL ); the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { ffc0ed94: 80 01 00 08 lwz r0,8(r1) ffc0ed98: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ed9c: 40 9e 00 d0 bne- cr7,ffc0ee6c <_POSIX_Message_queue_Send_support+0x130> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { ffc0eda0: 80 03 00 14 lwz r0,20(r3) ffc0eda4: 70 09 00 03 andi. r9,r0,3 ffc0eda8: 41 82 00 ec beq- ffc0ee94 <_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 ) ffc0edac: 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; ffc0edb0: 81 63 00 10 lwz r11,16(r3) /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0edb4: 39 20 00 00 li r9,0 ffc0edb8: 40 9e 00 68 bne- cr7,ffc0ee20 <_POSIX_Message_queue_Send_support+0xe4> do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( ffc0edbc: 7f ea fb 78 mr r10,r31 ffc0edc0: 7f 64 db 78 mr r4,r27 ffc0edc4: 7f 85 e3 78 mr r5,r28 ffc0edc8: 7f a6 eb 78 mr r6,r29 ffc0edcc: 38 e0 00 00 li r7,0 ffc0edd0: 7d 1e 00 d0 neg r8,r30 ffc0edd4: 38 6b 00 1c addi r3,r11,28 ffc0edd8: 48 00 2c 41 bl ffc11a18 <_CORE_message_queue_Submit> ffc0eddc: 7c 7f 1b 78 mr r31,r3 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); ffc0ede0: 48 00 50 91 bl ffc13e70 <_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 ) ffc0ede4: 2f 9f 00 07 cmpwi cr7,r31,7 ffc0ede8: 41 9e 00 74 beq- cr7,ffc0ee5c <_POSIX_Message_queue_Send_support+0x120><== NEVER TAKEN msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) ffc0edec: 2f 9f 00 00 cmpwi cr7,r31,0 return msg_status; ffc0edf0: 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 ) ffc0edf4: 40 9e 00 b8 bne- cr7,ffc0eeac <_POSIX_Message_queue_Send_support+0x170> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0edf8: 80 01 00 34 lwz r0,52(r1) ffc0edfc: 83 41 00 18 lwz r26,24(r1) ffc0ee00: 7c 08 03 a6 mtlr r0 ffc0ee04: 83 61 00 1c lwz r27,28(r1) ffc0ee08: 83 81 00 20 lwz r28,32(r1) ffc0ee0c: 83 a1 00 24 lwz r29,36(r1) ffc0ee10: 83 c1 00 28 lwz r30,40(r1) ffc0ee14: 83 e1 00 2c lwz r31,44(r1) ffc0ee18: 38 21 00 30 addi r1,r1,48 ffc0ee1c: 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; ffc0ee20: 70 09 40 00 andi. r9,r0,16384 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( ffc0ee24: 7f ea fb 78 mr r10,r31 ffc0ee28: 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; ffc0ee2c: 7d 20 00 26 mfcr r9 ffc0ee30: 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( ffc0ee34: 7f 85 e3 78 mr r5,r28 ffc0ee38: 7f a6 eb 78 mr r6,r29 ffc0ee3c: 38 e0 00 00 li r7,0 ffc0ee40: 7d 1e 00 d0 neg r8,r30 ffc0ee44: 38 6b 00 1c addi r3,r11,28 ffc0ee48: 48 00 2b d1 bl ffc11a18 <_CORE_message_queue_Submit> ffc0ee4c: 7c 7f 1b 78 mr r31,r3 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); ffc0ee50: 48 00 50 21 bl ffc13e70 <_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 ) ffc0ee54: 2f 9f 00 07 cmpwi cr7,r31,7 ffc0ee58: 40 9e ff 94 bne+ cr7,ffc0edec <_POSIX_Message_queue_Send_support+0xb0> msg_status = _Thread_Executing->Wait.return_code; ffc0ee5c: 3d 20 00 00 lis r9,0 ffc0ee60: 81 29 36 b0 lwz r9,14000(r9) ffc0ee64: 83 e9 00 34 lwz r31,52(r9) ffc0ee68: 4b ff ff 84 b ffc0edec <_POSIX_Message_queue_Send_support+0xb0> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); ffc0ee6c: 48 00 d0 31 bl ffc1be9c <__errno> ffc0ee70: 38 00 00 09 li r0,9 ffc0ee74: 90 03 00 00 stw r0,0(r3) ffc0ee78: 38 60 ff ff li r3,-1 ffc0ee7c: 4b ff ff 7c b ffc0edf8 <_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 ); ffc0ee80: 48 00 d0 1d bl ffc1be9c <__errno> ffc0ee84: 38 00 00 16 li r0,22 ffc0ee88: 90 03 00 00 stw r0,0(r3) ffc0ee8c: 38 60 ff ff li r3,-1 ffc0ee90: 4b ff ff 68 b ffc0edf8 <_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(); ffc0ee94: 48 00 4f dd bl ffc13e70 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EBADF ); ffc0ee98: 48 00 d0 05 bl ffc1be9c <__errno> ffc0ee9c: 38 00 00 09 li r0,9 ffc0eea0: 90 03 00 00 stw r0,0(r3) ffc0eea4: 38 60 ff ff li r3,-1 ffc0eea8: 4b ff ff 50 b ffc0edf8 <_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( ffc0eeac: 48 00 cf f1 bl ffc1be9c <__errno> ffc0eeb0: 7c 7e 1b 78 mr r30,r3 ffc0eeb4: 7f e3 fb 78 mr r3,r31 ffc0eeb8: 48 00 01 a5 bl ffc0f05c <_POSIX_Message_queue_Translate_core_message_queue_return_code> ffc0eebc: 90 7e 00 00 stw r3,0(r30) ffc0eec0: 38 60 ff ff li r3,-1 ffc0eec4: 4b ff ff 34 b ffc0edf8 <_POSIX_Message_queue_Send_support+0xbc> =============================================================================== ffc0f984 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>: #include void _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( Thread_Control *the_thread ) { ffc0f984: 7c 08 02 a6 mflr r0 ffc0f988: 94 21 ff f8 stwu r1,-8(r1) ffc0f98c: 90 01 00 0c stw r0,12(r1) POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0f990: 81 23 01 34 lwz r9,308(r3) if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc0f994: 80 09 00 d8 lwz r0,216(r9) ffc0f998: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f99c: 40 9e 00 10 bne- cr7,ffc0f9ac <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x28><== NEVER TAKEN ffc0f9a0: 80 09 00 dc lwz r0,220(r9) ffc0f9a4: 2f 80 00 01 cmpwi cr7,r0,1 ffc0f9a8: 41 9e 00 18 beq- cr7,ffc0f9c0 <_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(); ffc0f9ac: 4b ff c9 dd bl ffc0c388 <_Thread_Enable_dispatch> } ffc0f9b0: 80 01 00 0c lwz r0,12(r1) ffc0f9b4: 38 21 00 08 addi r1,r1,8 ffc0f9b8: 7c 08 03 a6 mtlr r0 ffc0f9bc: 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 && ffc0f9c0: 80 09 00 e0 lwz r0,224(r9) ffc0f9c4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f9c8: 41 9e ff e4 beq+ cr7,ffc0f9ac <_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; ffc0f9cc: 3d 20 00 00 lis r9,0 ffc0f9d0: 81 69 28 14 lwz r11,10260(r9) thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); ffc0f9d4: 38 80 ff ff li r4,-1 ffc0f9d8: 38 0b ff ff addi r0,r11,-1 ffc0f9dc: 90 09 28 14 stw r0,10260(r9) ffc0f9e0: 48 00 09 69 bl ffc10348 <_POSIX_Thread_Exit> ffc0f9e4: 4b ff ff cc b ffc0f9b0 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x2c> =============================================================================== ffc112fc <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { ffc112fc: 94 21 ff e0 stwu r1,-32(r1) ffc11300: 7c 08 02 a6 mflr r0 ffc11304: 93 e1 00 1c stw r31,28(r1) ffc11308: 7c 7f 1b 78 mr r31,r3 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) ffc1130c: 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 ) { ffc11310: 93 61 00 0c stw r27,12(r1) ffc11314: 7c db 33 78 mr r27,r6 ffc11318: 93 81 00 10 stw r28,16(r1) if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) return EINVAL; ffc1131c: 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 ) { ffc11320: 93 a1 00 14 stw r29,20(r1) ffc11324: 7c bd 2b 78 mr r29,r5 ffc11328: 93 c1 00 18 stw r30,24(r1) ffc1132c: 7c 9e 23 78 mr r30,r4 ffc11330: 90 01 00 24 stw r0,36(r1) if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) ffc11334: 4b ff ff a5 bl ffc112d8 <_POSIX_Priority_Is_valid> ffc11338: 2f 83 00 00 cmpwi cr7,r3,0 ffc1133c: 41 9e 00 38 beq- cr7,ffc11374 <_POSIX_Thread_Translate_sched_param+0x78><== NEVER TAKEN return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { ffc11340: 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; ffc11344: 38 00 00 00 li r0,0 ffc11348: 90 1d 00 00 stw r0,0(r29) *budget_callout = NULL; ffc1134c: 90 1b 00 00 stw r0,0(r27) if ( policy == SCHED_OTHER ) { ffc11350: 41 9e 00 4c beq- cr7,ffc1139c <_POSIX_Thread_Translate_sched_param+0xa0> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; return 0; } if ( policy == SCHED_FIFO ) { ffc11354: 2f 9f 00 01 cmpwi cr7,r31,1 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; ffc11358: 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 ) { ffc1135c: 41 9e 00 18 beq- cr7,ffc11374 <_POSIX_Thread_Translate_sched_param+0x78> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { ffc11360: 2f 9f 00 02 cmpwi cr7,r31,2 ffc11364: 41 9e 00 ec beq- cr7,ffc11450 <_POSIX_Thread_Translate_sched_param+0x154> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { ffc11368: 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; ffc1136c: 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 ) { ffc11370: 41 9e 00 60 beq- cr7,ffc113d0 <_POSIX_Thread_Translate_sched_param+0xd4> *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc11374: 80 01 00 24 lwz r0,36(r1) ffc11378: 7f 83 e3 78 mr r3,r28 ffc1137c: 83 61 00 0c lwz r27,12(r1) ffc11380: 7c 08 03 a6 mtlr r0 ffc11384: 83 81 00 10 lwz r28,16(r1) ffc11388: 83 a1 00 14 lwz r29,20(r1) ffc1138c: 83 c1 00 18 lwz r30,24(r1) ffc11390: 83 e1 00 1c lwz r31,28(r1) ffc11394: 38 21 00 20 addi r1,r1,32 ffc11398: 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; ffc1139c: 38 00 00 01 li r0,1 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc113a0: 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; ffc113a4: 90 1d 00 00 stw r0,0(r29) return 0; ffc113a8: 3b 80 00 00 li r28,0 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc113ac: 7f 83 e3 78 mr r3,r28 ffc113b0: 80 01 00 24 lwz r0,36(r1) ffc113b4: 83 81 00 10 lwz r28,16(r1) ffc113b8: 7c 08 03 a6 mtlr r0 ffc113bc: 83 a1 00 14 lwz r29,20(r1) ffc113c0: 83 c1 00 18 lwz r30,24(r1) ffc113c4: 83 e1 00 1c lwz r31,28(r1) ffc113c8: 38 21 00 20 addi r1,r1,32 ffc113cc: 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) && ffc113d0: 80 1e 00 08 lwz r0,8(r30) ffc113d4: 2f 80 00 00 cmpwi cr7,r0,0 ffc113d8: 40 9e 00 10 bne- cr7,ffc113e8 <_POSIX_Thread_Translate_sched_param+0xec> ffc113dc: 80 1e 00 0c lwz r0,12(r30) ffc113e0: 2f 80 00 00 cmpwi cr7,r0,0 ffc113e4: 41 be ff 90 beq- cr7,ffc11374 <_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) && ffc113e8: 80 1e 00 10 lwz r0,16(r30) ffc113ec: 2f 80 00 00 cmpwi cr7,r0,0 ffc113f0: 40 9e 00 14 bne- cr7,ffc11404 <_POSIX_Thread_Translate_sched_param+0x108> ffc113f4: 80 1e 00 14 lwz r0,20(r30) (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; ffc113f8: 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) && ffc113fc: 2f 80 00 00 cmpwi cr7,r0,0 ffc11400: 41 be ff 74 beq- cr7,ffc11374 <_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 ) < ffc11404: 38 7e 00 08 addi r3,r30,8 ffc11408: 4b ff d0 09 bl ffc0e410 <_Timespec_To_ticks> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; ffc1140c: 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 ) < ffc11410: 7c 7f 1b 78 mr r31,r3 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) ffc11414: 38 7e 00 10 addi r3,r30,16 ffc11418: 4b ff cf f9 bl ffc0e410 <_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 ) < ffc1141c: 7f 9f 18 40 cmplw cr7,r31,r3 ffc11420: 41 bc ff 54 blt- cr7,ffc11374 <_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 ) ) ffc11424: 80 7e 00 04 lwz r3,4(r30) ffc11428: 4b ff fe b1 bl ffc112d8 <_POSIX_Priority_Is_valid> ffc1142c: 2f 83 00 00 cmpwi cr7,r3,0 ffc11430: 41 be ff 44 beq- cr7,ffc11374 <_POSIX_Thread_Translate_sched_param+0x78> return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; ffc11434: 38 00 00 03 li r0,3 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc11438: 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; ffc1143c: 90 1d 00 00 stw r0,0(r29) *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc11440: 38 09 97 78 addi r0,r9,-26760 return 0; ffc11444: 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; ffc11448: 90 1b 00 00 stw r0,0(r27) return 0; ffc1144c: 4b ff ff 28 b ffc11374 <_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; ffc11450: 93 fd 00 00 stw r31,0(r29) return 0; ffc11454: 4b ff ff 20 b ffc11374 <_POSIX_Thread_Translate_sched_param+0x78> =============================================================================== ffc0f964 <_POSIX_Threads_Exitted_extension>: * This method is invoked each time a thread exits. */ void _POSIX_Threads_Exitted_extension( Thread_Control *executing ) { ffc0f964: 7c 08 02 a6 mflr r0 ffc0f968: 94 21 ff f8 stwu r1,-8(r1) ffc0f96c: 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); ffc0f970: 88 03 00 08 lbz r0,8(r3) ffc0f974: 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 ) ffc0f978: 2f 80 00 03 cmpwi cr7,r0,3 ffc0f97c: 41 9e 00 14 beq- cr7,ffc0f990 <_POSIX_Threads_Exitted_extension+0x2c> pthread_exit( executing->Wait.return_argument ); } ffc0f980: 80 01 00 0c lwz r0,12(r1) ffc0f984: 38 21 00 08 addi r1,r1,8 ffc0f988: 7c 08 03 a6 mtlr r0 ffc0f98c: 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 ); ffc0f990: 80 63 00 28 lwz r3,40(r3) ffc0f994: 48 00 33 49 bl ffc12cdc } ffc0f998: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc0f99c: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc0f9a0: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0f9a4: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc09344 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09344: 94 21 ff 90 stwu r1,-112(r1) ffc09348: 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; ffc0934c: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09350: 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; ffc09354: 39 29 20 b4 addi r9,r9,8372 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09358: 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; ffc0935c: 83 c9 00 34 lwz r30,52(r9) * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09360: 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 ) ffc09364: 2f 9e 00 00 cmpwi cr7,r30,0 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09368: 93 61 00 5c stw r27,92(r1) ffc0936c: 93 a1 00 64 stw r29,100(r1) ffc09370: 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; ffc09374: 83 89 00 30 lwz r28,48(r9) if ( !user_threads || maximum == 0 ) ffc09378: 41 9e 00 64 beq- cr7,ffc093dc <_POSIX_Threads_Initialize_user_threads_body+0x98><== NEVER TAKEN ffc0937c: 2f 9c 00 00 cmpwi cr7,r28,0 ffc09380: 41 9e 00 5c beq- cr7,ffc093dc <_POSIX_Threads_Initialize_user_threads_body+0x98><== NEVER TAKEN ffc09384: 3b a0 00 00 li r29,0 ffc09388: 3b e1 00 0c addi r31,r1,12 ffc0938c: 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 ); ffc09390: 7f e3 fb 78 mr r3,r31 ffc09394: 48 00 80 c5 bl ffc11458 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); ffc09398: 38 80 00 02 li r4,2 ffc0939c: 7f e3 fb 78 mr r3,r31 ffc093a0: 48 00 80 f9 bl ffc11498 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); ffc093a4: 80 9e 00 04 lwz r4,4(r30) ffc093a8: 7f e3 fb 78 mr r3,r31 ffc093ac: 48 00 81 21 bl ffc114cc status = pthread_create( ffc093b0: 80 be 00 00 lwz r5,0(r30) ffc093b4: 7f 63 db 78 mr r3,r27 ffc093b8: 7f e4 fb 78 mr r4,r31 ffc093bc: 38 c0 00 00 li r6,0 ffc093c0: 4b ff fb c1 bl ffc08f80 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) ffc093c4: 7c 65 1b 79 mr. r5,r3 ffc093c8: 40 82 00 38 bne- ffc09400 <_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++ ) { ffc093cc: 3b bd 00 01 addi r29,r29,1 ffc093d0: 7f 9c e8 40 cmplw cr7,r28,r29 ffc093d4: 3b de 00 08 addi r30,r30,8 ffc093d8: 41 9d ff b8 bgt+ cr7,ffc09390 <_POSIX_Threads_Initialize_user_threads_body+0x4c><== NEVER TAKEN NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); } } ffc093dc: 80 01 00 74 lwz r0,116(r1) ffc093e0: 83 61 00 5c lwz r27,92(r1) ffc093e4: 7c 08 03 a6 mtlr r0 ffc093e8: 83 81 00 60 lwz r28,96(r1) ffc093ec: 83 a1 00 64 lwz r29,100(r1) ffc093f0: 83 c1 00 68 lwz r30,104(r1) ffc093f4: 83 e1 00 6c lwz r31,108(r1) ffc093f8: 38 21 00 70 addi r1,r1,112 ffc093fc: 4e 80 00 20 blr &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); ffc09400: 38 60 00 02 li r3,2 ffc09404: 38 80 00 01 li r4,1 ffc09408: 48 00 2a 01 bl ffc0be08 <_Internal_error_Occurred> =============================================================================== ffc0fbd4 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { ffc0fbd4: 94 21 ff f0 stwu r1,-16(r1) ffc0fbd8: 7c 08 02 a6 mflr r0 ffc0fbdc: 90 01 00 14 stw r0,20(r1) ffc0fbe0: 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 ]; ffc0fbe4: 83 e4 01 34 lwz r31,308(r4) */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { ffc0fbe8: 93 c1 00 08 stw r30,8(r1) ffc0fbec: 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 ); ffc0fbf0: 38 7f 00 98 addi r3,r31,152 ffc0fbf4: 48 00 12 79 bl ffc10e6c <_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 ) { ffc0fbf8: 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); ffc0fbfc: 3d 20 00 00 lis r9,0 ffc0fc00: 2f 80 00 00 cmpwi cr7,r0,0 ffc0fc04: 88 89 27 24 lbz r4,10020(r9) ffc0fc08: 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; ffc0fc0c: 90 7e 00 78 stw r3,120(r30) ffc0fc10: 7c 80 20 50 subf r4,r0,r4 new_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); the_thread->real_priority = new_priority; ffc0fc14: 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 ) { ffc0fc18: 40 9e 00 10 bne- cr7,ffc0fc28 <_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 ) { ffc0fc1c: 80 1e 00 14 lwz r0,20(r30) ffc0fc20: 7f 80 20 40 cmplw cr7,r0,r4 ffc0fc24: 41 9d 00 38 bgt- cr7,ffc0fc5c <_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 ); ffc0fc28: 38 7f 00 90 addi r3,r31,144 ffc0fc2c: 48 00 12 41 bl ffc10e6c <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0fc30: 38 9f 00 a8 addi r4,r31,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0fc34: 90 7f 00 b4 stw r3,180(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0fc38: 3c 60 00 00 lis r3,0 ffc0fc3c: 38 63 2d 48 addi r3,r3,11592 ffc0fc40: 4b ff d5 4d bl ffc0d18c <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } ffc0fc44: 80 01 00 14 lwz r0,20(r1) ffc0fc48: 83 c1 00 08 lwz r30,8(r1) ffc0fc4c: 7c 08 03 a6 mtlr r0 ffc0fc50: 83 e1 00 0c lwz r31,12(r1) ffc0fc54: 38 21 00 10 addi r1,r1,16 ffc0fc58: 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 ); ffc0fc5c: 7f c3 f3 78 mr r3,r30 ffc0fc60: 38 a0 00 01 li r5,1 ffc0fc64: 4b ff ba ed bl ffc0b750 <_Thread_Change_priority> #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); ffc0fc68: 38 7f 00 90 addi r3,r31,144 ffc0fc6c: 48 00 12 01 bl ffc10e6c <_Timespec_To_ticks> ffc0fc70: 38 9f 00 a8 addi r4,r31,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0fc74: 90 7f 00 b4 stw r3,180(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0fc78: 3c 60 00 00 lis r3,0 ffc0fc7c: 38 63 2d 48 addi r3,r3,11592 ffc0fc80: 4b ff d5 0d bl ffc0d18c <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } ffc0fc84: 80 01 00 14 lwz r0,20(r1) ffc0fc88: 83 c1 00 08 lwz r30,8(r1) ffc0fc8c: 7c 08 03 a6 mtlr r0 ffc0fc90: 83 e1 00 0c lwz r31,12(r1) ffc0fc94: 38 21 00 10 addi r1,r1,16 ffc0fc98: 4e 80 00 20 blr =============================================================================== ffc0fc9c <_POSIX_Threads_Sporadic_budget_callout>: * _POSIX_Threads_Sporadic_budget_callout */ void _POSIX_Threads_Sporadic_budget_callout( Thread_Control *the_thread ) { ffc0fc9c: 7c 08 02 a6 mflr r0 ffc0fca0: 94 21 ff f8 stwu r1,-8(r1) ffc0fca4: 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 ) { ffc0fca8: 80 03 00 1c lwz r0,28(r3) ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0fcac: 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 ) { ffc0fcb0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0fcb4: 80 0b 00 8c lwz r0,140(r11) ffc0fcb8: 3d 60 00 00 lis r11,0 ffc0fcbc: 88 8b 27 24 lbz r4,10020(r11) ffc0fcc0: 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 */ ffc0fcc4: 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; ffc0fcc8: 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 */ ffc0fccc: 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 ) { ffc0fcd0: 40 9e 00 10 bne- cr7,ffc0fce0 <_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 ) { ffc0fcd4: 80 03 00 14 lwz r0,20(r3) ffc0fcd8: 7f 80 20 40 cmplw cr7,r0,r4 ffc0fcdc: 41 9c 00 14 blt- cr7,ffc0fcf0 <_POSIX_Threads_Sporadic_budget_callout+0x54><== ALWAYS TAKEN #if 0 printk( "lower priority\n" ); #endif } } } ffc0fce0: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc0fce4: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc0fce8: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0fcec: 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 ); ffc0fcf0: 38 a0 00 01 li r5,1 ffc0fcf4: 4b ff ba 5d bl ffc0b750 <_Thread_Change_priority> #if 0 printk( "lower priority\n" ); #endif } } } ffc0fcf8: 80 01 00 0c lwz r0,12(r1) ffc0fcfc: 38 21 00 08 addi r1,r1,8 ffc0fd00: 7c 08 03 a6 mtlr r0 ffc0fd04: 4e 80 00 20 blr =============================================================================== ffc12830 <_POSIX_Threads_cancel_run>: #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { ffc12830: 94 21 ff e8 stwu r1,-24(r1) ffc12834: 7c 08 02 a6 mflr r0 ffc12838: 90 01 00 1c stw r0,28(r1) ffc1283c: 93 a1 00 0c stw r29,12(r1) ffc12840: 93 c1 00 10 stw r30,16(r1) ffc12844: 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 ]; ffc12848: 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 ) ) { ffc1284c: 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 ); ffc12850: 3b be 00 e8 addi r29,r30,232 ffc12854: 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; ffc12858: 38 00 00 01 li r0,1 ffc1285c: 90 1e 00 d8 stw r0,216(r30) while ( !_Chain_Is_empty( handler_stack ) ) { ffc12860: 41 9e 00 50 beq- cr7,ffc128b0 <_POSIX_Threads_cancel_run+0x80> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc12864: 7c 00 00 a6 mfmsr r0 ffc12868: 7d 30 42 a6 mfsprg r9,0 ffc1286c: 7c 09 48 78 andc r9,r0,r9 ffc12870: 7d 20 01 24 mtmsr r9 _ISR_Disable( level ); handler = (POSIX_Cancel_Handler_control *) ffc12874: 83 fe 00 ec lwz r31,236(r30) ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc12878: 81 7f 00 00 lwz r11,0(r31) previous = the_node->previous; ffc1287c: 81 3f 00 04 lwz r9,4(r31) next->previous = previous; ffc12880: 91 2b 00 04 stw r9,4(r11) previous->next = next; ffc12884: 91 69 00 00 stw r11,0(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc12888: 7c 00 01 24 mtmsr r0 _Chain_Tail( handler_stack )->previous; _Chain_Extract_unprotected( &handler->Node ); _ISR_Enable( level ); (*handler->routine)( handler->arg ); ffc1288c: 80 1f 00 08 lwz r0,8(r31) ffc12890: 80 7f 00 0c lwz r3,12(r31) ffc12894: 7c 09 03 a6 mtctr r0 ffc12898: 4e 80 04 21 bctrl _Workspace_Free( handler ); ffc1289c: 7f e3 fb 78 mr r3,r31 ffc128a0: 4b ff ad 2d bl ffc0d5cc <_Workspace_Free> handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { ffc128a4: 80 1e 00 e4 lwz r0,228(r30) ffc128a8: 7f 80 e8 00 cmpw cr7,r0,r29 ffc128ac: 40 9e ff b8 bne+ cr7,ffc12864 <_POSIX_Threads_cancel_run+0x34><== NEVER TAKEN (*handler->routine)( handler->arg ); _Workspace_Free( handler ); } } ffc128b0: 80 01 00 1c lwz r0,28(r1) ffc128b4: 83 a1 00 0c lwz r29,12(r1) ffc128b8: 7c 08 03 a6 mtlr r0 ffc128bc: 83 c1 00 10 lwz r30,16(r1) ffc128c0: 83 e1 00 14 lwz r31,20(r1) ffc128c4: 38 21 00 18 addi r1,r1,24 ffc128c8: 4e 80 00 20 blr =============================================================================== ffc090d0 <_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) { ffc090d0: 94 21 ff f0 stwu r1,-16(r1) ffc090d4: 7c 08 02 a6 mflr r0 ffc090d8: 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 ) || ffc090dc: 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; ffc090e0: 81 24 00 68 lwz r9,104(r4) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ffc090e4: 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) { ffc090e8: 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; ffc090ec: 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) { ffc090f0: 7c 9f 23 78 mr r31,r4 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; ffc090f4: 90 04 00 68 stw r0,104(r4) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ffc090f8: 40 9e 00 40 bne- cr7,ffc09138 <_POSIX_Timer_TSR+0x68> ffc090fc: 80 04 00 58 lwz r0,88(r4) ffc09100: 2f 80 00 00 cmpwi cr7,r0,0 ffc09104: 40 9e 00 34 bne- cr7,ffc09138 <_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; ffc09108: 38 00 00 04 li r0,4 <== NOT EXECUTED ffc0910c: 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 ) ) { ffc09110: 80 7f 00 38 lwz r3,56(r31) ffc09114: 80 9f 00 44 lwz r4,68(r31) ffc09118: 48 00 78 fd bl ffc10a14 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; ffc0911c: 38 00 00 00 li r0,0 ffc09120: 90 1f 00 68 stw r0,104(r31) } ffc09124: 80 01 00 14 lwz r0,20(r1) ffc09128: 83 e1 00 0c lwz r31,12(r1) ffc0912c: 38 21 00 10 addi r1,r1,16 ffc09130: 7c 08 03 a6 mtlr r0 ffc09134: 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( ffc09138: 80 9f 00 64 lwz r4,100(r31) ffc0913c: 3c c0 ff c1 lis r6,-63 ffc09140: 80 bf 00 08 lwz r5,8(r31) ffc09144: 38 7f 00 10 addi r3,r31,16 ffc09148: 38 c6 90 d0 addi r6,r6,-28464 ffc0914c: 7f e7 fb 78 mr r7,r31 ffc09150: 48 00 7e cd bl ffc1101c <_POSIX_Timer_Insert_helper> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) ffc09154: 2f 83 00 00 cmpwi cr7,r3,0 ffc09158: 41 9e ff cc beq+ cr7,ffc09124 <_POSIX_Timer_TSR+0x54> <== NEVER TAKEN return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); ffc0915c: 38 7f 00 6c addi r3,r31,108 ffc09160: 48 00 1e 69 bl ffc0afc8 <_TOD_Get> /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc09164: 38 00 00 03 li r0,3 ffc09168: 98 1f 00 3c stb r0,60(r31) ffc0916c: 4b ff ff a4 b ffc09110 <_POSIX_Timer_TSR+0x40> =============================================================================== ffc129a8 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc129a8: 94 21 ff 90 stwu r1,-112(r1) ffc129ac: 7c 08 02 a6 mflr r0 ffc129b0: 7c a6 2b 78 mr r6,r5 ffc129b4: 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, ffc129b8: 3b c1 00 08 addi r30,r1,8 ffc129bc: 7f c5 f3 78 mr r5,r30 ffc129c0: 38 e0 00 01 li r7,1 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc129c4: 93 a1 00 64 stw r29,100(r1) ffc129c8: 7c 9d 23 78 mr r29,r4 ffc129cc: 93 e1 00 6c stw r31,108(r1) ffc129d0: 7c 7f 1b 78 mr r31,r3 ffc129d4: 90 01 00 74 stw r0,116(r1) ffc129d8: 92 e1 00 4c stw r23,76(r1) ffc129dc: 93 01 00 50 stw r24,80(r1) ffc129e0: 93 21 00 54 stw r25,84(r1) ffc129e4: 93 41 00 58 stw r26,88(r1) ffc129e8: 93 61 00 5c stw r27,92(r1) ffc129ec: 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, ffc129f0: 48 00 00 e1 bl ffc12ad0 <_POSIX_signals_Clear_signals> ffc129f4: 2f 83 00 00 cmpwi cr7,r3,0 is_global, true ) ) return false; ffc129f8: 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, ffc129fc: 41 9e 00 88 beq- cr7,ffc12a84 <_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 ) ffc12a00: 1f 7d 00 0c mulli r27,r29,12 ffc12a04: 3f 40 00 00 lis r26,0 ffc12a08: 3b 5a 31 80 addi r26,r26,12672 ffc12a0c: 7d 3a da 14 add r9,r26,r27 ffc12a10: 83 89 00 08 lwz r28,8(r9) ffc12a14: 2f 9c 00 01 cmpwi cr7,r28,1 ffc12a18: 41 9e 00 6c beq- cr7,ffc12a84 <_POSIX_signals_Check_signal+0xdc><== NEVER TAKEN return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; ffc12a1c: 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, ffc12a20: 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; ffc12a24: 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, ffc12a28: 3a f7 31 24 addi r23,r23,12580 ffc12a2c: 80 97 00 0c lwz r4,12(r23) ffc12a30: 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; ffc12a34: 7c 00 cb 78 or r0,r0,r25 ffc12a38: 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, ffc12a3c: 7f 03 c3 78 mr r3,r24 ffc12a40: 38 84 00 20 addi r4,r4,32 ffc12a44: 38 a0 00 28 li r5,40 ffc12a48: 48 00 15 7d bl ffc13fc4 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { ffc12a4c: 7c 1a d8 2e lwzx r0,r26,r27 ffc12a50: 2f 80 00 02 cmpwi cr7,r0,2 ffc12a54: 41 9e 00 64 beq- cr7,ffc12ab8 <_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 ); ffc12a58: 7f a3 eb 78 mr r3,r29 ffc12a5c: 7f 89 03 a6 mtctr r28 ffc12a60: 4c c6 31 82 crclr 4*cr1+eq ffc12a64: 4e 80 04 21 bctrl } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, ffc12a68: 80 77 00 0c lwz r3,12(r23) ffc12a6c: 7f 04 c3 78 mr r4,r24 ffc12a70: 38 a0 00 28 li r5,40 ffc12a74: 38 63 00 20 addi r3,r3,32 ffc12a78: 48 00 15 4d bl ffc13fc4 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; ffc12a7c: 93 3f 00 d0 stw r25,208(r31) return true; ffc12a80: 38 60 00 01 li r3,1 } ffc12a84: 80 01 00 74 lwz r0,116(r1) ffc12a88: 82 e1 00 4c lwz r23,76(r1) ffc12a8c: 7c 08 03 a6 mtlr r0 ffc12a90: 83 01 00 50 lwz r24,80(r1) ffc12a94: 83 21 00 54 lwz r25,84(r1) ffc12a98: 83 41 00 58 lwz r26,88(r1) ffc12a9c: 83 61 00 5c lwz r27,92(r1) ffc12aa0: 83 81 00 60 lwz r28,96(r1) ffc12aa4: 83 a1 00 64 lwz r29,100(r1) ffc12aa8: 83 c1 00 68 lwz r30,104(r1) ffc12aac: 83 e1 00 6c lwz r31,108(r1) ffc12ab0: 38 21 00 70 addi r1,r1,112 ffc12ab4: 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)( ffc12ab8: 7f a3 eb 78 mr r3,r29 ffc12abc: 7f 89 03 a6 mtctr r28 ffc12ac0: 7f c4 f3 78 mr r4,r30 ffc12ac4: 38 a0 00 00 li r5,0 ffc12ac8: 4e 80 04 21 bctrl signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; ffc12acc: 4b ff ff 9c b ffc12a68 <_POSIX_signals_Check_signal+0xc0> =============================================================================== ffc132f4 <_POSIX_signals_Clear_process_signals>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc132f4: 7d 60 00 a6 mfmsr r11 ffc132f8: 7c 10 42 a6 mfsprg r0,0 ffc132fc: 7d 60 00 78 andc r0,r11,r0 ffc13300: 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 ) { ffc13304: 3d 20 00 00 lis r9,0 ffc13308: 1c 03 00 0c mulli r0,r3,12 ffc1330c: 39 29 31 80 addi r9,r9,12672 ffc13310: 7d 29 00 2e lwzx r9,r9,r0 ffc13314: 2f 89 00 02 cmpwi cr7,r9,2 ffc13318: 41 9e 00 28 beq- cr7,ffc13340 <_POSIX_signals_Clear_process_signals+0x4c> if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; ffc1331c: 3d 20 00 00 lis r9,0 ffc13320: 80 09 28 34 lwz r0,10292(r9) ffc13324: 39 40 ff fe li r10,-2 ffc13328: 38 63 ff ff addi r3,r3,-1 ffc1332c: 5d 43 18 3e rotlw r3,r10,r3 ffc13330: 7c 63 00 38 and r3,r3,r0 ffc13334: 90 69 28 34 stw r3,10292(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc13338: 7d 60 01 24 mtmsr r11 } _ISR_Enable( level ); } ffc1333c: 4e 80 00 20 blr ffc13340: 3d 20 00 00 lis r9,0 ffc13344: 39 29 33 74 addi r9,r9,13172 ffc13348: 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 ] ) ) ffc1334c: 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 ); ffc13350: 38 0a 00 04 addi r0,r10,4 ffc13354: 7f 89 00 00 cmpw cr7,r9,r0 ffc13358: 41 be ff c4 beq- cr7,ffc1331c <_POSIX_signals_Clear_process_signals+0x28><== ALWAYS TAKEN ffc1335c: 7d 60 01 24 mtmsr r11 <== NOT EXECUTED } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } ffc13360: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc09d6c <_POSIX_signals_Get_lowest>: ffc09d6c: 38 00 00 05 li r0,5 ffc09d70: 7c 09 03 a6 mtctr r0 sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc09d74: 39 20 00 1b li r9,27 ffc09d78: 39 60 00 01 li r11,1 #include #include #include #include int _POSIX_signals_Get_lowest( ffc09d7c: 38 09 ff ff addi r0,r9,-1 ffc09d80: 7d 60 00 30 slw r0,r11,r0 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { ffc09d84: 7c 0a 18 39 and. r10,r0,r3 ffc09d88: 40 82 00 38 bne- ffc09dc0 <_POSIX_signals_Get_lowest+0x54><== NEVER TAKEN sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc09d8c: 39 29 00 01 addi r9,r9,1 ffc09d90: 42 00 ff ec bdnz+ ffc09d7c <_POSIX_signals_Get_lowest+0x10> ffc09d94: 38 00 00 1a li r0,26 ffc09d98: 39 20 00 01 li r9,1 ffc09d9c: 7c 09 03 a6 mtctr r0 ffc09da0: 39 60 00 01 li r11,1 ffc09da4: 48 00 00 0c b ffc09db0 <_POSIX_signals_Get_lowest+0x44> */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { ffc09da8: 39 29 00 01 addi r9,r9,1 ffc09dac: 42 40 00 14 bdz- ffc09dc0 <_POSIX_signals_Get_lowest+0x54> #include #include #include #include int _POSIX_signals_Get_lowest( ffc09db0: 38 09 ff ff addi r0,r9,-1 ffc09db4: 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 ) ) { ffc09db8: 7c 0a 18 39 and. r10,r0,r3 ffc09dbc: 41 82 ff ec beq+ ffc09da8 <_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; } ffc09dc0: 7d 23 4b 78 mr r3,r9 ffc09dc4: 4e 80 00 20 blr =============================================================================== ffc0f5b0 <_POSIX_signals_Post_switch_extension>: */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0f5b0: 94 21 ff e8 stwu r1,-24(r1) ffc0f5b4: 7c 08 02 a6 mflr r0 ffc0f5b8: 90 01 00 1c stw r0,28(r1) ffc0f5bc: 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 ]; ffc0f5c0: 83 c3 01 34 lwz r30,308(r3) */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0f5c4: 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 ) ffc0f5c8: 2f 9e 00 00 cmpwi cr7,r30,0 */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0f5cc: 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 ) ffc0f5d0: 41 9e 00 c4 beq- cr7,ffc0f694 <_POSIX_signals_Post_switch_extension+0xe4> ffc0f5d4: 3f a0 00 00 lis r29,0 ffc0f5d8: 3b bd 28 34 addi r29,r29,10292 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0f5dc: 7c 00 00 a6 mfmsr r0 ffc0f5e0: 7d 30 42 a6 mfsprg r9,0 ffc0f5e4: 7c 09 48 78 andc r9,r0,r9 ffc0f5e8: 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)) ) { ffc0f5ec: 81 5d 00 00 lwz r10,0(r29) ffc0f5f0: 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 & ffc0f5f4: 81 7e 00 d0 lwz r11,208(r30) (api->signals_pending | _POSIX_signals_Pending)) ) { ffc0f5f8: 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 & ffc0f5fc: 7d 2a 58 79 andc. r10,r9,r11 ffc0f600: 41 82 00 90 beq- ffc0f690 <_POSIX_signals_Post_switch_extension+0xe0> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0f604: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc0f608: 3b e0 00 1b li r31,27 _POSIX_signals_Check_signal( api, signo, false ); ffc0f60c: 7f e4 fb 78 mr r4,r31 ffc0f610: 38 a0 00 00 li r5,0 ffc0f614: 7f c3 f3 78 mr r3,r30 ffc0f618: 48 00 33 91 bl ffc129a8 <_POSIX_signals_Check_signal> _POSIX_signals_Check_signal( api, signo, true ); ffc0f61c: 7f e4 fb 78 mr r4,r31 ffc0f620: 7f c3 f3 78 mr r3,r30 ffc0f624: 38 a0 00 01 li r5,1 ffc0f628: 48 00 33 81 bl ffc129a8 <_POSIX_signals_Check_signal> _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc0f62c: 2f 9f 00 1f cmpwi cr7,r31,31 ffc0f630: 3b ff 00 01 addi r31,r31,1 ffc0f634: 40 9e ff d8 bne+ cr7,ffc0f60c <_POSIX_signals_Post_switch_extension+0x5c> ffc0f638: 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 ); ffc0f63c: 7f e4 fb 78 mr r4,r31 ffc0f640: 38 a0 00 00 li r5,0 ffc0f644: 7f c3 f3 78 mr r3,r30 ffc0f648: 48 00 33 61 bl ffc129a8 <_POSIX_signals_Check_signal> _POSIX_signals_Check_signal( api, signo, true ); ffc0f64c: 7f e4 fb 78 mr r4,r31 ffc0f650: 7f c3 f3 78 mr r3,r30 ffc0f654: 38 a0 00 01 li r5,1 ffc0f658: 48 00 33 51 bl ffc129a8 <_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++ ) { ffc0f65c: 2f 9f 00 1a cmpwi cr7,r31,26 ffc0f660: 3b ff 00 01 addi r31,r31,1 ffc0f664: 40 9e ff d8 bne+ cr7,ffc0f63c <_POSIX_signals_Post_switch_extension+0x8c> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0f668: 7c 00 00 a6 mfmsr r0 ffc0f66c: 7d 30 42 a6 mfsprg r9,0 ffc0f670: 7c 09 48 78 andc r9,r0,r9 ffc0f674: 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)) ) { ffc0f678: 81 5d 00 00 lwz r10,0(r29) ffc0f67c: 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 & ffc0f680: 81 7e 00 d0 lwz r11,208(r30) (api->signals_pending | _POSIX_signals_Pending)) ) { ffc0f684: 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 & ffc0f688: 7d 2a 58 79 andc. r10,r9,r11 ffc0f68c: 40 82 ff 78 bne+ ffc0f604 <_POSIX_signals_Post_switch_extension+0x54><== NEVER TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0f690: 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 ); } } } ffc0f694: 80 01 00 1c lwz r0,28(r1) ffc0f698: 83 a1 00 0c lwz r29,12(r1) ffc0f69c: 7c 08 03 a6 mtlr r0 ffc0f6a0: 83 c1 00 10 lwz r30,16(r1) ffc0f6a4: 83 e1 00 14 lwz r31,20(r1) ffc0f6a8: 38 21 00 18 addi r1,r1,24 ffc0f6ac: 4e 80 00 20 blr =============================================================================== ffc2a210 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc2a210: 94 21 ff f0 stwu r1,-16(r1) ffc2a214: 7c 08 02 a6 mflr r0 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc2a218: 3d 20 10 00 lis r9,4096 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc2a21c: 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 ) ) { ffc2a220: 61 29 80 00 ori r9,r9,32768 ffc2a224: 80 03 00 10 lwz r0,16(r3) bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc2a228: 93 e1 00 0c stw r31,12(r1) ffc2a22c: 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 ) ) { ffc2a230: 7c 0b 48 38 and r11,r0,r9 ffc2a234: 7f 8b 48 00 cmpw cr7,r11,r9 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc2a238: 93 c1 00 08 stw r30,8(r1) ffc2a23c: 39 64 ff ff addi r11,r4,-1 ffc2a240: 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 ]; ffc2a244: 81 43 01 34 lwz r10,308(r3) ffc2a248: 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 ) ) { ffc2a24c: 41 9e 00 70 beq- cr7,ffc2a2bc <_POSIX_signals_Unblock_thread+0xac> } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { ffc2a250: 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; ffc2a254: 3b c0 00 00 li r30,0 } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { ffc2a258: 7d 68 50 79 andc. r8,r11,r10 ffc2a25c: 41 82 00 44 beq- ffc2a2a0 <_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 ) ) { ffc2a260: 74 0b 10 00 andis. r11,r0,4096 ffc2a264: 41 82 00 b8 beq- ffc2a31c <_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); ffc2a268: 3d 20 00 03 lis r9,3 ffc2a26c: 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) ) ffc2a270: 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; ffc2a274: 39 20 00 04 li r9,4 ffc2a278: 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) ) ffc2a27c: 40 82 00 e4 bne- ffc2a360 <_POSIX_signals_Unblock_thread+0x150> _Thread_queue_Extract_with_proxy( the_thread ); else if ( _States_Is_delaying(the_thread->current_state) ) { ffc2a280: 70 09 00 08 andi. r9,r0,8 ffc2a284: 41 a2 00 1c beq+ ffc2a2a0 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN (void) _Watchdog_Remove( &the_thread->Timer ); ffc2a288: 38 63 00 48 addi r3,r3,72 ffc2a28c: 4b fe a2 1d bl ffc144a8 <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc2a290: 3c 80 10 03 lis r4,4099 ffc2a294: 7f e3 fb 78 mr r3,r31 ffc2a298: 60 84 ff f8 ori r4,r4,65528 ffc2a29c: 4b fe 87 a5 bl ffc12a40 <_Thread_Clear_state> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc2a2a0: 80 01 00 14 lwz r0,20(r1) ffc2a2a4: 7f c3 f3 78 mr r3,r30 ffc2a2a8: 83 e1 00 0c lwz r31,12(r1) ffc2a2ac: 7c 08 03 a6 mtlr r0 ffc2a2b0: 83 c1 00 08 lwz r30,8(r1) ffc2a2b4: 38 21 00 10 addi r1,r1,16 ffc2a2b8: 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) ) { ffc2a2bc: 80 03 00 30 lwz r0,48(r3) ffc2a2c0: 7d 68 00 39 and. r8,r11,r0 ffc2a2c4: 41 82 00 88 beq- ffc2a34c <_POSIX_signals_Unblock_thread+0x13c> the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { ffc2a2c8: 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; ffc2a2cc: 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; ffc2a2d0: 38 00 00 04 li r0,4 ffc2a2d4: 90 1f 00 34 stw r0,52(r31) the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { ffc2a2d8: 41 9e 00 90 beq- cr7,ffc2a368 <_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; ffc2a2dc: 81 45 00 00 lwz r10,0(r5) ffc2a2e0: 81 65 00 04 lwz r11,4(r5) ffc2a2e4: 80 05 00 08 lwz r0,8(r5) ffc2a2e8: 91 49 00 00 stw r10,0(r9) ffc2a2ec: 91 69 00 04 stw r11,4(r9) ffc2a2f0: 90 09 00 08 stw r0,8(r9) } _Thread_queue_Extract_with_proxy( the_thread ); ffc2a2f4: 7f e3 fb 78 mr r3,r31 ffc2a2f8: 4b fe 94 e1 bl ffc137d8 <_Thread_queue_Extract_with_proxy> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc2a2fc: 80 01 00 14 lwz r0,20(r1) } else { *the_info = *info; } _Thread_queue_Extract_with_proxy( the_thread ); return true; ffc2a300: 3b c0 00 01 li r30,1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc2a304: 83 e1 00 0c lwz r31,12(r1) ffc2a308: 7c 08 03 a6 mtlr r0 ffc2a30c: 7f c3 f3 78 mr r3,r30 ffc2a310: 83 c1 00 08 lwz r30,8(r1) ffc2a314: 38 21 00 10 addi r1,r1,16 ffc2a318: 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 ) { ffc2a31c: 2f 80 00 00 cmpwi cr7,r0,0 ffc2a320: 40 be ff 80 bne- cr7,ffc2a2a0 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc2a324: 3d 60 00 00 lis r11,0 ffc2a328: 39 6b 32 84 addi r11,r11,12932 ffc2a32c: 80 0b 00 08 lwz r0,8(r11) ffc2a330: 2f 80 00 00 cmpwi cr7,r0,0 ffc2a334: 41 be ff 6c beq- cr7,ffc2a2a0 <_POSIX_signals_Unblock_thread+0x90> ffc2a338: 80 0b 00 0c lwz r0,12(r11) ffc2a33c: 7f 83 00 00 cmpw cr7,r3,r0 ffc2a340: 40 9e ff 60 bne+ cr7,ffc2a2a0 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc2a344: 99 2b 00 18 stb r9,24(r11) ffc2a348: 4b ff ff 58 b ffc2a2a0 <_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) ) { ffc2a34c: 80 0a 00 d0 lwz r0,208(r10) /* * This should only be reached via pthread_kill(). */ return false; ffc2a350: 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) ) { ffc2a354: 7d 69 00 79 andc. r9,r11,r0 ffc2a358: 40 82 ff 70 bne+ ffc2a2c8 <_POSIX_signals_Unblock_thread+0xb8> ffc2a35c: 4b ff ff 44 b ffc2a2a0 <_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 ); ffc2a360: 4b fe 94 79 bl ffc137d8 <_Thread_queue_Extract_with_proxy> ffc2a364: 4b ff ff 3c b ffc2a2a0 <_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; ffc2a368: 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; ffc2a36c: 90 89 00 00 stw r4,0(r9) the_info->si_code = SI_USER; ffc2a370: 90 09 00 04 stw r0,4(r9) the_info->si_value.sival_int = 0; ffc2a374: 90 a9 00 08 stw r5,8(r9) ffc2a378: 4b ff ff 7c b ffc2a2f4 <_POSIX_signals_Unblock_thread+0xe4> =============================================================================== ffc09298 <_RTEMS_tasks_Initialize_user_tasks_body>: * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc09298: 94 21 ff d8 stwu r1,-40(r1) ffc0929c: 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; ffc092a0: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc092a4: 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; ffc092a8: 39 29 20 a0 addi r9,r9,8352 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc092ac: 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; ffc092b0: 83 e9 00 2c lwz r31,44(r9) * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc092b4: 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 ) ffc092b8: 2f 9f 00 00 cmpwi cr7,r31,0 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc092bc: 93 81 00 18 stw r28,24(r1) ffc092c0: 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; ffc092c4: 83 a9 00 28 lwz r29,40(r9) /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) ffc092c8: 41 9e 00 60 beq- cr7,ffc09328 <_RTEMS_tasks_Initialize_user_tasks_body+0x90> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { ffc092cc: 2f 9d 00 00 cmpwi cr7,r29,0 ffc092d0: 41 9e 00 58 beq- cr7,ffc09328 <_RTEMS_tasks_Initialize_user_tasks_body+0x90><== NEVER TAKEN ffc092d4: 3b c0 00 00 li r30,0 ffc092d8: 3b 81 00 08 addi r28,r1,8 return_value = rtems_task_create( ffc092dc: 80 bf 00 04 lwz r5,4(r31) ffc092e0: 7f 88 e3 78 mr r8,r28 ffc092e4: 80 7f 00 00 lwz r3,0(r31) ffc092e8: 80 9f 00 08 lwz r4,8(r31) ffc092ec: 80 df 00 14 lwz r6,20(r31) ffc092f0: 80 ff 00 0c lwz r7,12(r31) ffc092f4: 4b ff fc b1 bl ffc08fa4 user_tasks[ index ].stack_size, user_tasks[ index ].mode_set, user_tasks[ index ].attribute_set, &id ); if ( !rtems_is_status_successful( return_value ) ) ffc092f8: 7c 65 1b 79 mr. r5,r3 ffc092fc: 40 82 00 4c bne- ffc09348 <_RTEMS_tasks_Initialize_user_tasks_body+0xb0> _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); return_value = rtems_task_start( ffc09300: 80 bf 00 18 lwz r5,24(r31) ffc09304: 80 61 00 08 lwz r3,8(r1) ffc09308: 80 9f 00 10 lwz r4,16(r31) ffc0930c: 48 00 00 49 bl ffc09354 id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) ffc09310: 7c 65 1b 79 mr. r5,r3 ffc09314: 40 82 00 34 bne- ffc09348 <_RTEMS_tasks_Initialize_user_tasks_body+0xb0> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { ffc09318: 3b de 00 01 addi r30,r30,1 ffc0931c: 7f 9d f0 40 cmplw cr7,r29,r30 ffc09320: 3b ff 00 1c addi r31,r31,28 ffc09324: 41 9d ff b8 bgt+ cr7,ffc092dc <_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 ); } } ffc09328: 80 01 00 2c lwz r0,44(r1) ffc0932c: 83 81 00 18 lwz r28,24(r1) ffc09330: 7c 08 03 a6 mtlr r0 ffc09334: 83 a1 00 1c lwz r29,28(r1) ffc09338: 83 c1 00 20 lwz r30,32(r1) ffc0933c: 83 e1 00 24 lwz r31,36(r1) ffc09340: 38 21 00 28 addi r1,r1,40 ffc09344: 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 ); ffc09348: 38 60 00 01 li r3,1 ffc0934c: 38 80 00 01 li r4,1 ffc09350: 48 00 13 b9 bl ffc0a708 <_Internal_error_Occurred> =============================================================================== ffc10088 <_RTEMS_tasks_Switch_extension>: /* * Per Task Variables */ tvp = executing->task_variables; ffc10088: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc1008c: 2f 89 00 00 cmpwi cr7,r9,0 ffc10090: 41 9e 00 24 beq- cr7,ffc100b4 <_RTEMS_tasks_Switch_extension+0x2c> tvp->tval = *tvp->ptr; ffc10094: 81 69 00 04 lwz r11,4(r9) *tvp->ptr = tvp->gval; ffc10098: 80 09 00 08 lwz r0,8(r9) * Per Task Variables */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; ffc1009c: 81 4b 00 00 lwz r10,0(r11) ffc100a0: 91 49 00 0c stw r10,12(r9) *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; ffc100a4: 81 29 00 00 lwz r9,0(r9) */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; ffc100a8: 90 0b 00 00 stw r0,0(r11) /* * Per Task Variables */ tvp = executing->task_variables; while (tvp) { ffc100ac: 2f 89 00 00 cmpwi cr7,r9,0 ffc100b0: 40 9e ff e4 bne+ cr7,ffc10094 <_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; ffc100b4: 81 24 01 3c lwz r9,316(r4) while (tvp) { ffc100b8: 2f 89 00 00 cmpwi cr7,r9,0 ffc100bc: 4d 9e 00 20 beqlr cr7 tvp->gval = *tvp->ptr; ffc100c0: 81 69 00 04 lwz r11,4(r9) *tvp->ptr = tvp->tval; ffc100c4: 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; ffc100c8: 81 4b 00 00 lwz r10,0(r11) ffc100cc: 91 49 00 08 stw r10,8(r9) *tvp->ptr = tvp->tval; tvp = (rtems_task_variable_t *)tvp->next; ffc100d0: 81 29 00 00 lwz r9,0(r9) } tvp = heir->task_variables; while (tvp) { tvp->gval = *tvp->ptr; *tvp->ptr = tvp->tval; ffc100d4: 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) { ffc100d8: 2f 89 00 00 cmpwi cr7,r9,0 ffc100dc: 40 9e ff e4 bne+ cr7,ffc100c0 <_RTEMS_tasks_Switch_extension+0x38><== NEVER TAKEN ffc100e0: 4e 80 00 20 blr =============================================================================== ffc0a86c <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { ffc0a86c: 94 21 ff e0 stwu r1,-32(r1) ffc0a870: 7c 08 02 a6 mflr r0 ffc0a874: 7c 64 1b 78 mr r4,r3 ffc0a878: 3c 60 00 00 lis r3,0 ffc0a87c: 90 01 00 24 stw r0,36(r1) ffc0a880: 38 63 2c 78 addi r3,r3,11384 ffc0a884: 38 a1 00 08 addi r5,r1,8 ffc0a888: 93 e1 00 1c stw r31,28(r1) ffc0a88c: 48 00 28 45 bl ffc0d0d0 <_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 ) { ffc0a890: 80 01 00 08 lwz r0,8(r1) ffc0a894: 7c 7f 1b 78 mr r31,r3 ffc0a898: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a89c: 40 9e 00 48 bne- cr7,ffc0a8e4 <_Rate_monotonic_Timeout+0x78><== NEVER TAKEN case OBJECTS_LOCAL: the_thread = the_period->owner; ffc0a8a0: 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); ffc0a8a4: 80 03 00 10 lwz r0,16(r3) if ( _States_Is_waiting_for_period( the_thread->current_state ) && ffc0a8a8: 70 09 40 00 andi. r9,r0,16384 ffc0a8ac: 41 82 00 14 beq- ffc0a8c0 <_Rate_monotonic_Timeout+0x54> ffc0a8b0: 81 23 00 20 lwz r9,32(r3) ffc0a8b4: 80 1f 00 08 lwz r0,8(r31) ffc0a8b8: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a8bc: 41 9e 00 68 beq- cr7,ffc0a924 <_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 ) { ffc0a8c0: 80 1f 00 38 lwz r0,56(r31) ffc0a8c4: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a8c8: 41 9e 00 30 beq- cr7,ffc0a8f8 <_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; ffc0a8cc: 38 00 00 04 li r0,4 ffc0a8d0: 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; ffc0a8d4: 3d 20 00 00 lis r9,0 ffc0a8d8: 81 69 28 4c lwz r11,10316(r9) ffc0a8dc: 38 0b ff ff addi r0,r11,-1 ffc0a8e0: 90 09 28 4c stw r0,10316(r9) case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } ffc0a8e4: 80 01 00 24 lwz r0,36(r1) ffc0a8e8: 83 e1 00 1c lwz r31,28(r1) ffc0a8ec: 38 21 00 20 addi r1,r1,32 ffc0a8f0: 7c 08 03 a6 mtlr r0 ffc0a8f4: 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; ffc0a8f8: 38 00 00 03 li r0,3 ffc0a8fc: 90 1f 00 38 stw r0,56(r31) _Rate_monotonic_Initiate_statistics( the_period ); ffc0a900: 7f e3 fb 78 mr r3,r31 ffc0a904: 4b ff f7 55 bl ffc0a058 <_Rate_monotonic_Initiate_statistics> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a908: 80 1f 00 3c lwz r0,60(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a90c: 3c 60 00 00 lis r3,0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a910: 90 1f 00 1c stw r0,28(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a914: 38 63 2e 48 addi r3,r3,11848 ffc0a918: 38 9f 00 10 addi r4,r31,16 ffc0a91c: 48 00 4c f1 bl ffc0f60c <_Watchdog_Insert> ffc0a920: 4b ff ff b4 b ffc0a8d4 <_Rate_monotonic_Timeout+0x68> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc0a924: 3c 80 10 03 lis r4,4099 ffc0a928: 60 84 ff f8 ori r4,r4,65528 ffc0a92c: 48 00 33 25 bl ffc0dc50 <_Thread_Clear_state> ffc0a930: 4b ff ff d0 b ffc0a900 <_Rate_monotonic_Timeout+0x94> =============================================================================== ffc0b228 <_Scheduler_priority_Block>: ) { Scheduler_priority_Per_thread *sched_info; Chain_Control *ready; sched_info = (Scheduler_priority_Per_thread *) the_thread->scheduler_info; ffc0b228: 81 63 00 8c lwz r11,140(r3) ready = sched_info->ready_chain; ffc0b22c: 81 2b 00 00 lwz r9,0(r11) if ( _Chain_Has_only_one_node( ready ) ) { ffc0b230: 81 49 00 00 lwz r10,0(r9) ffc0b234: 80 09 00 08 lwz r0,8(r9) ffc0b238: 7f 8a 00 00 cmpw cr7,r10,r0 ffc0b23c: 41 9e 00 ac beq- cr7,ffc0b2e8 <_Scheduler_priority_Block+0xc0> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc0b240: 81 63 00 00 lwz r11,0(r3) previous = the_node->previous; ffc0b244: 81 23 00 04 lwz r9,4(r3) next->previous = previous; ffc0b248: 91 2b 00 04 stw r9,4(r11) previous->next = next; ffc0b24c: 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 ); ffc0b250: 3d 20 00 00 lis r9,0 ffc0b254: 39 29 31 24 addi r9,r9,12580 { _Scheduler_priority_Ready_queue_extract( the_thread ); /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) ffc0b258: 80 09 00 10 lwz r0,16(r9) ffc0b25c: 7f 83 00 00 cmpw cr7,r3,r0 ffc0b260: 41 9e 00 1c beq- cr7,ffc0b27c <_Scheduler_priority_Block+0x54> _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) ffc0b264: 80 09 00 0c lwz r0,12(r9) ffc0b268: 7f 83 00 00 cmpw cr7,r3,r0 ffc0b26c: 4c be 00 20 bnelr+ cr7 _Thread_Dispatch_necessary = true; ffc0b270: 38 00 00 01 li r0,1 ffc0b274: 98 09 00 18 stb r0,24(r9) ffc0b278: 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 ); ffc0b27c: 3c a0 00 00 lis r5,0 * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( (Chain_Control *) _Scheduler.information ffc0b280: 3d 40 00 00 lis r10,0 ffc0b284: 81 65 28 30 lwz r11,10288(r5) * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0b288: 81 4a 20 04 lwz r10,8196(r10) ffc0b28c: 7d 66 00 34 cntlzw r6,r11 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b290: 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 ); ffc0b294: 91 65 28 30 stw r11,10288(r5) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b298: 38 e7 31 40 addi r7,r7,12608 ffc0b29c: 54 c8 10 3a rlwinm r8,r6,2,0,29 ffc0b2a0: 7c 07 40 2e lwzx r0,r7,r8 ffc0b2a4: 7c 0b 00 34 cntlzw r11,r0 return (_Priority_Bits_index( major ) << 4) + ffc0b2a8: 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 ); ffc0b2ac: 7c 07 41 2e stwx r0,r7,r8 return (_Priority_Bits_index( major ) << 4) + ffc0b2b0: 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 ] ) ) ffc0b2b4: 1d 6b 00 0c mulli r11,r11,12 ffc0b2b8: 7d 0a 5a 14 add r8,r10,r11 } ffc0b2bc: 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 ); ffc0b2c0: 38 08 00 04 addi r0,r8,4 ffc0b2c4: 7f 8b 00 00 cmpw cr7,r11,r0 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; ffc0b2c8: 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 ] ) ) ffc0b2cc: 41 9e 00 08 beq- cr7,ffc0b2d4 <_Scheduler_priority_Block+0xac><== NEVER TAKEN return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); ffc0b2d0: 7d 60 5b 78 mr r0,r11 * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0b2d4: 90 09 00 10 stw r0,16(r9) /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) ffc0b2d8: 80 09 00 0c lwz r0,12(r9) ffc0b2dc: 7f 83 00 00 cmpw cr7,r3,r0 ffc0b2e0: 4c be 00 20 bnelr+ cr7 ffc0b2e4: 4b ff ff 8c b ffc0b270 <_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 ); ffc0b2e8: 38 09 00 04 addi r0,r9,4 head->next = tail; head->previous = NULL; tail->previous = head; ffc0b2ec: 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; ffc0b2f0: 90 09 00 00 stw r0,0(r9) head->previous = NULL; ffc0b2f4: 38 00 00 00 li r0,0 ffc0b2f8: 90 09 00 04 stw r0,4(r9) RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; ffc0b2fc: 81 2b 00 04 lwz r9,4(r11) ffc0b300: 80 0b 00 14 lwz r0,20(r11) ffc0b304: 81 49 00 00 lwz r10,0(r9) ffc0b308: 7d 40 00 38 and r0,r10,r0 if ( *the_priority_map->minor == 0 ) ffc0b30c: 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; ffc0b310: 90 09 00 00 stw r0,0(r9) if ( *the_priority_map->minor == 0 ) ffc0b314: 40 be ff 3c bne- cr7,ffc0b250 <_Scheduler_priority_Block+0x28> _Priority_Major_bit_map &= the_priority_map->block_major; ffc0b318: 3d 20 00 00 lis r9,0 ffc0b31c: 80 0b 00 10 lwz r0,16(r11) ffc0b320: 81 49 28 30 lwz r10,10288(r9) ffc0b324: 7d 40 00 38 and r0,r10,r0 ffc0b328: 90 09 28 30 stw r0,10288(r9) ffc0b32c: 4b ff ff 24 b ffc0b250 <_Scheduler_priority_Block+0x28> =============================================================================== ffc0b4f0 <_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 ); ffc0b4f0: 3c c0 00 00 lis r6,0 * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( (Chain_Control *) _Scheduler.information ffc0b4f4: 3d 60 00 00 lis r11,0 ffc0b4f8: 81 26 28 30 lwz r9,10288(r6) * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0b4fc: 81 6b 20 04 lwz r11,8196(r11) ffc0b500: 7d 27 00 34 cntlzw r7,r9 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b504: 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 ); ffc0b508: 91 26 28 30 stw r9,10288(r6) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b50c: 39 08 31 40 addi r8,r8,12608 ffc0b510: 54 ea 10 3a rlwinm r10,r7,2,0,29 ffc0b514: 7c 08 50 2e lwzx r0,r8,r10 ffc0b518: 7c 06 00 34 cntlzw r6,r0 return (_Priority_Bits_index( major ) << 4) + ffc0b51c: 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 ); ffc0b520: 7c 08 51 2e stwx r0,r8,r10 return (_Priority_Bits_index( major ) << 4) + ffc0b524: 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 ] ) ) ffc0b528: 1d 29 00 0c mulli r9,r9,12 ffc0b52c: 7d 4b 4a 14 add r10,r11,r9 #include void _Scheduler_priority_Schedule(void) { _Scheduler_priority_Schedule_body(); } ffc0b530: 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 ); ffc0b534: 38 0a 00 04 addi r0,r10,4 ffc0b538: 7f 89 00 00 cmpw cr7,r9,r0 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; ffc0b53c: 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 ] ) ) ffc0b540: 41 9e 00 08 beq- cr7,ffc0b548 <_Scheduler_priority_Schedule+0x58><== NEVER TAKEN return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); ffc0b544: 7d 20 4b 78 mr r0,r9 * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0b548: 3d 20 00 00 lis r9,0 ffc0b54c: 90 09 31 34 stw r0,12596(r9) ffc0b550: 4e 80 00 20 blr =============================================================================== ffc0bad4 <_Scheduler_simple_Ready_queue_Enqueue_first>: { Chain_Control *ready; Chain_Node *the_node; Thread_Control *current; ready = (Chain_Control *)_Scheduler.information; ffc0bad4: 3d 20 00 00 lis r9,0 */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { ffc0bad8: 81 63 00 14 lwz r11,20(r3) } } /* enqueue */ _Chain_Insert_unprotected( (Chain_Node *)current, &the_thread->Object.Node ); } ffc0badc: 81 29 20 04 lwz r9,8196(r9) ffc0bae0: 81 29 00 00 lwz r9,0(r9) */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { ffc0bae4: 80 09 00 14 lwz r0,20(r9) ffc0bae8: 7f 8b 00 40 cmplw cr7,r11,r0 ffc0baec: 40 9d 00 14 ble- cr7,ffc0bb00 <_Scheduler_simple_Ready_queue_Enqueue_first+0x2c> * Do NOT need to check for end of chain because there is always * at least one task on the ready chain -- the IDLE task. It can * never block, should never attempt to obtain a semaphore or mutex, * and thus will always be there. */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { ffc0baf0: 81 29 00 00 lwz r9,0(r9) current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { ffc0baf4: 80 09 00 14 lwz r0,20(r9) ffc0baf8: 7f 80 58 40 cmplw cr7,r0,r11 ffc0bafc: 41 9c ff f4 blt+ cr7,ffc0baf0 <_Scheduler_simple_Ready_queue_Enqueue_first+0x1c><== NEVER TAKEN current = (Thread_Control *)current->Object.Node.previous; ffc0bb00: 81 29 00 04 lwz r9,4(r9) ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0bb04: 81 69 00 00 lwz r11,0(r9) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0bb08: 91 23 00 04 stw r9,4(r3) before_node = after_node->next; after_node->next = the_node; ffc0bb0c: 90 69 00 00 stw r3,0(r9) the_node->next = before_node; before_node->previous = the_node; ffc0bb10: 90 6b 00 04 stw r3,4(r11) Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; ffc0bb14: 91 63 00 00 stw r11,0(r3) } } /* enqueue */ _Chain_Insert_unprotected( (Chain_Node *)current, &the_thread->Object.Node ); } ffc0bb18: 4e 80 00 20 blr =============================================================================== ffc0b750 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { ffc0b750: 94 21 ff e8 stwu r1,-24(r1) ffc0b754: 7c 08 02 a6 mflr r0 ffc0b758: 90 01 00 1c stw r0,28(r1) ffc0b75c: 93 e1 00 14 stw r31,20(r1) ffc0b760: 7c 7f 1b 78 mr r31,r3 ffc0b764: 93 81 00 08 stw r28,8(r1) ffc0b768: 7c bc 2b 78 mr r28,r5 ffc0b76c: 93 a1 00 0c stw r29,12(r1) ffc0b770: 93 c1 00 10 stw r30,16(r1) ffc0b774: 7c 9e 23 78 mr r30,r4 States_Control state, original_state; /* * Save original state */ original_state = the_thread->current_state; ffc0b778: 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 ); ffc0b77c: 48 00 11 ad bl ffc0c928 <_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 ) ffc0b780: 80 1f 00 14 lwz r0,20(r31) ffc0b784: 7f 80 f0 00 cmpw cr7,r0,r30 ffc0b788: 41 9e 00 10 beq- cr7,ffc0b798 <_Thread_Change_priority+0x48> _Thread_Set_priority( the_thread, new_priority ); ffc0b78c: 7f e3 fb 78 mr r3,r31 ffc0b790: 7f c4 f3 78 mr r4,r30 ffc0b794: 48 00 10 ed bl ffc0c880 <_Thread_Set_priority> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0b798: 7f c0 00 a6 mfmsr r30 ffc0b79c: 7c 10 42 a6 mfsprg r0,0 ffc0b7a0: 7f c0 00 78 andc r0,r30,r0 ffc0b7a4: 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; ffc0b7a8: 80 1f 00 10 lwz r0,16(r31) if ( state != STATES_TRANSIENT ) { ffc0b7ac: 2f 80 00 04 cmpwi cr7,r0,4 ffc0b7b0: 41 9e 00 88 beq- cr7,ffc0b838 <_Thread_Change_priority+0xe8> /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) ffc0b7b4: 73 a9 00 04 andi. r9,r29,4 ffc0b7b8: 41 82 00 38 beq- ffc0b7f0 <_Thread_Change_priority+0xa0><== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0b7bc: 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); ffc0b7c0: 3d 20 00 03 lis r9,3 <== NOT EXECUTED ffc0b7c4: 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 ) ) { ffc0b7c8: 7c 0b 48 39 and. r11,r0,r9 <== NOT EXECUTED ffc0b7cc: 40 82 00 40 bne- ffc0b80c <_Thread_Change_priority+0xbc><== NOT EXECUTED if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; _ISR_Enable( level ); } ffc0b7d0: 80 01 00 1c lwz r0,28(r1) ffc0b7d4: 83 81 00 08 lwz r28,8(r1) ffc0b7d8: 7c 08 03 a6 mtlr r0 ffc0b7dc: 83 a1 00 0c lwz r29,12(r1) ffc0b7e0: 83 c1 00 10 lwz r30,16(r1) ffc0b7e4: 83 e1 00 14 lwz r31,20(r1) ffc0b7e8: 38 21 00 18 addi r1,r1,24 ffc0b7ec: 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); ffc0b7f0: 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 ); ffc0b7f4: 91 3f 00 10 stw r9,16(r31) ffc0b7f8: 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); ffc0b7fc: 3d 20 00 03 lis r9,3 ffc0b800: 61 29 be e0 ori r9,r9,48864 _ISR_Enable( level ); if ( _States_Is_waiting_on_thread_queue( state ) ) { ffc0b804: 7c 0b 48 39 and. r11,r0,r9 ffc0b808: 41 82 ff c8 beq+ ffc0b7d0 <_Thread_Change_priority+0x80> _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); ffc0b80c: 80 7f 00 44 lwz r3,68(r31) ffc0b810: 7f e4 fb 78 mr r4,r31 ffc0b814: 48 00 0f 75 bl ffc0c788 <_Thread_queue_Requeue> if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; _ISR_Enable( level ); } ffc0b818: 80 01 00 1c lwz r0,28(r1) ffc0b81c: 83 81 00 08 lwz r28,8(r1) ffc0b820: 7c 08 03 a6 mtlr r0 ffc0b824: 83 a1 00 0c lwz r29,12(r1) ffc0b828: 83 c1 00 10 lwz r30,16(r1) ffc0b82c: 83 e1 00 14 lwz r31,20(r1) ffc0b830: 38 21 00 18 addi r1,r1,24 ffc0b834: 4e 80 00 20 blr } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { ffc0b838: 73 bd 00 04 andi. r29,r29,4 ffc0b83c: 41 82 00 74 beq- ffc0b8b0 <_Thread_Change_priority+0x160><== ALWAYS TAKEN ffc0b840: 3f a0 00 00 lis r29,0 <== NOT EXECUTED ffc0b844: 3b bd 20 04 addi r29,r29,8196 <== NOT EXECUTED static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0b848: 7c 00 00 a6 mfmsr r0 ffc0b84c: 7f c0 01 24 mtmsr r30 ffc0b850: 7c 00 01 24 mtmsr r0 * This kernel routine implements the scheduling decision logic for * the scheduler. It does NOT dispatch. */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( void ) { _Scheduler.Operations.schedule(); ffc0b854: 80 1d 00 08 lwz r0,8(r29) ffc0b858: 7c 09 03 a6 mtctr r0 ffc0b85c: 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 ); ffc0b860: 3d 20 00 00 lis r9,0 ffc0b864: 39 29 31 24 addi r9,r9,12580 ffc0b868: 81 69 00 0c lwz r11,12(r9) * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Scheduler_Schedule(); if ( !_Thread_Is_executing_also_the_heir() && ffc0b86c: 80 09 00 10 lwz r0,16(r9) ffc0b870: 7f 8b 00 00 cmpw cr7,r11,r0 ffc0b874: 41 9e 00 18 beq- cr7,ffc0b88c <_Thread_Change_priority+0x13c> ffc0b878: 88 0b 00 74 lbz r0,116(r11) ffc0b87c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b880: 41 9e 00 0c beq- cr7,ffc0b88c <_Thread_Change_priority+0x13c> _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; ffc0b884: 38 00 00 01 li r0,1 ffc0b888: 98 09 00 18 stb r0,24(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0b88c: 7f c0 01 24 mtmsr r30 _ISR_Enable( level ); } ffc0b890: 80 01 00 1c lwz r0,28(r1) ffc0b894: 83 81 00 08 lwz r28,8(r1) ffc0b898: 7c 08 03 a6 mtlr r0 ffc0b89c: 83 a1 00 0c lwz r29,12(r1) ffc0b8a0: 83 c1 00 10 lwz r30,16(r1) ffc0b8a4: 83 e1 00 14 lwz r31,20(r1) ffc0b8a8: 38 21 00 18 addi r1,r1,24 ffc0b8ac: 4e 80 00 20 blr * the TRANSIENT state. So we have to place it on the appropriate * Ready Queue with interrupts off. */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); if ( prepend_it ) ffc0b8b0: 2f 9c 00 00 cmpwi cr7,r28,0 * Interrupts are STILL disabled. * We now know the thread will be in the READY state when we remove * the TRANSIENT state. So we have to place it on the appropriate * Ready Queue with interrupts off. */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); ffc0b8b4: 93 bf 00 10 stw r29,16(r31) if ( prepend_it ) ffc0b8b8: 41 9e 00 20 beq- cr7,ffc0b8d8 <_Thread_Change_priority+0x188> */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue_first( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue_first( the_thread ); ffc0b8bc: 3f a0 00 00 lis r29,0 ffc0b8c0: 3b bd 20 04 addi r29,r29,8196 ffc0b8c4: 80 1d 00 28 lwz r0,40(r29) ffc0b8c8: 7f e3 fb 78 mr r3,r31 ffc0b8cc: 7c 09 03 a6 mtctr r0 ffc0b8d0: 4e 80 04 21 bctrl ffc0b8d4: 4b ff ff 74 b ffc0b848 <_Thread_Change_priority+0xf8> */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue( the_thread ); ffc0b8d8: 3f a0 00 00 lis r29,0 ffc0b8dc: 3b bd 20 04 addi r29,r29,8196 ffc0b8e0: 80 1d 00 24 lwz r0,36(r29) ffc0b8e4: 7f e3 fb 78 mr r3,r31 ffc0b8e8: 7c 09 03 a6 mtctr r0 ffc0b8ec: 4e 80 04 21 bctrl ffc0b8f0: 4b ff ff 58 b ffc0b848 <_Thread_Change_priority+0xf8> =============================================================================== ffc0bb5c <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0bb5c: 94 21 ff e8 stwu r1,-24(r1) ffc0bb60: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0bb64: 38 81 00 08 addi r4,r1,8 void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0bb68: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0bb6c: 48 00 02 4d bl ffc0bdb8 <_Thread_Get> switch ( location ) { ffc0bb70: 80 01 00 08 lwz r0,8(r1) ffc0bb74: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bb78: 40 9e 00 20 bne- cr7,ffc0bb98 <_Thread_Delay_ended+0x3c><== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( ffc0bb7c: 3c 80 10 00 lis r4,4096 ffc0bb80: 60 84 00 18 ori r4,r4,24 ffc0bb84: 4b ff fd 71 bl ffc0b8f4 <_Thread_Clear_state> ffc0bb88: 3d 20 00 00 lis r9,0 ffc0bb8c: 81 69 27 e8 lwz r11,10216(r9) ffc0bb90: 38 0b ff ff addi r0,r11,-1 ffc0bb94: 90 09 27 e8 stw r0,10216(r9) | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Thread_Unnest_dispatch(); break; } } ffc0bb98: 80 01 00 1c lwz r0,28(r1) ffc0bb9c: 38 21 00 18 addi r1,r1,24 ffc0bba0: 7c 08 03 a6 mtlr r0 ffc0bba4: 4e 80 00 20 blr =============================================================================== ffc0bba8 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { ffc0bba8: 94 21 ff b8 stwu r1,-72(r1) ffc0bbac: 7c 08 02 a6 mflr r0 ffc0bbb0: 93 a1 00 3c stw r29,60(r1) Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; ffc0bbb4: 3f a0 00 00 lis r29,0 ffc0bbb8: 3b bd 31 24 addi r29,r29,12580 * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { ffc0bbbc: 93 e1 00 44 stw r31,68(r1) ffc0bbc0: 90 01 00 4c stw r0,76(r1) ffc0bbc4: 92 a1 00 1c stw r21,28(r1) ffc0bbc8: 92 c1 00 20 stw r22,32(r1) ffc0bbcc: 92 e1 00 24 stw r23,36(r1) ffc0bbd0: 93 01 00 28 stw r24,40(r1) ffc0bbd4: 93 21 00 2c stw r25,44(r1) ffc0bbd8: 93 41 00 30 stw r26,48(r1) ffc0bbdc: 93 61 00 34 stw r27,52(r1) ffc0bbe0: 93 81 00 38 stw r28,56(r1) ffc0bbe4: 93 c1 00 40 stw r30,64(r1) Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; ffc0bbe8: 83 fd 00 0c lwz r31,12(r29) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0bbec: 7d 20 00 a6 mfmsr r9 ffc0bbf0: 7c 10 42 a6 mfsprg r0,0 ffc0bbf4: 7d 20 00 78 andc r0,r9,r0 ffc0bbf8: 7c 00 01 24 mtmsr r0 _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { ffc0bbfc: 88 1d 00 18 lbz r0,24(r29) ffc0bc00: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bc04: 41 9e 01 88 beq- cr7,ffc0bd8c <_Thread_Dispatch+0x1e4> heir = _Thread_Heir; ffc0bc08: 83 dd 00 10 lwz r30,16(r29) _Thread_Dispatch_disable_level = 1; ffc0bc0c: 38 00 00 01 li r0,1 ffc0bc10: 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 ) ffc0bc14: 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; ffc0bc18: 90 19 27 e8 stw r0,10216(r25) _Thread_Dispatch_necessary = false; ffc0bc1c: 39 60 00 00 li r11,0 Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); ffc0bc20: 7d 20 4b 78 mr r0,r9 while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; ffc0bc24: 99 7d 00 18 stb r11,24(r29) _Thread_Executing = heir; ffc0bc28: 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 ) ffc0bc2c: 41 9e 01 14 beq- cr7,ffc0bd40 <_Thread_Dispatch+0x198> ffc0bc30: 3f 60 00 00 lis r27,0 ffc0bc34: 3f 00 00 00 lis r24,0 ffc0bc38: 3b 41 00 08 addi r26,r1,8 ffc0bc3c: 3b 7b 28 18 addi r27,r27,10264 ffc0bc40: 3b 81 00 10 addi r28,r1,16 ffc0bc44: 3b 18 27 fc addi r24,r24,10236 #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; ffc0bc48: 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; ffc0bc4c: 3a c0 00 01 li r22,1 _Thread_Dispatch_necessary = false; ffc0bc50: 3a e0 00 00 li r23,0 ffc0bc54: 48 00 00 d0 b ffc0bd24 <_Thread_Dispatch+0x17c> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0bc58: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); ffc0bc5c: 7f 43 d3 78 mr r3,r26 ffc0bc60: 48 00 49 dd bl ffc1063c <_TOD_Get_uptime> _Timestamp_Subtract( ffc0bc64: 7f 63 db 78 mr r3,r27 ffc0bc68: 7f 44 d3 78 mr r4,r26 ffc0bc6c: 7f 85 e3 78 mr r5,r28 ffc0bc70: 48 00 10 01 bl ffc0cc70 <_Timespec_Subtract> &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); ffc0bc74: 38 7f 00 84 addi r3,r31,132 ffc0bc78: 7f 84 e3 78 mr r4,r28 ffc0bc7c: 48 00 0f 99 bl ffc0cc14 <_Timespec_Add_to> #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0bc80: 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; ffc0bc84: 81 21 00 08 lwz r9,8(r1) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0bc88: 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; ffc0bc8c: 81 41 00 0c lwz r10,12(r1) ffc0bc90: 91 3b 00 00 stw r9,0(r27) ffc0bc94: 91 5b 00 04 stw r10,4(r27) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0bc98: 41 9e 00 14 beq- cr7,ffc0bcac <_Thread_Dispatch+0x104> <== NEVER TAKEN executing->libc_reent = *_Thread_libc_reent; ffc0bc9c: 80 0b 00 00 lwz r0,0(r11) ffc0bca0: 90 1f 01 2c stw r0,300(r31) *_Thread_libc_reent = heir->libc_reent; ffc0bca4: 80 1e 01 2c lwz r0,300(r30) ffc0bca8: 90 0b 00 00 stw r0,0(r11) } _User_extensions_Thread_switch( executing, heir ); ffc0bcac: 7f e3 fb 78 mr r3,r31 ffc0bcb0: 7f c4 f3 78 mr r4,r30 ffc0bcb4: 48 00 14 5d bl ffc0d110 <_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 ) ffc0bcb8: 80 1f 01 28 lwz r0,296(r31) ffc0bcbc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bcc0: 41 9e 00 0c beq- cr7,ffc0bccc <_Thread_Dispatch+0x124> _Context_Save_fp( &executing->fp_context ); ffc0bcc4: 38 7f 01 28 addi r3,r31,296 ffc0bcc8: 48 00 c6 b9 bl ffc18380 <_CPU_Context_save_fp> #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); ffc0bccc: 38 7f 00 c8 addi r3,r31,200 ffc0bcd0: 38 9e 00 c8 addi r4,r30,200 ffc0bcd4: 48 00 c8 2d bl ffc18500 <_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 ) ffc0bcd8: 80 1f 01 28 lwz r0,296(r31) ffc0bcdc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bce0: 41 9e 00 0c beq- cr7,ffc0bcec <_Thread_Dispatch+0x144> _Context_Restore_fp( &executing->fp_context ); ffc0bce4: 38 7f 01 28 addi r3,r31,296 ffc0bce8: 48 00 c7 59 bl ffc18440 <_CPU_Context_restore_fp> #endif #endif executing = _Thread_Executing; ffc0bcec: 83 fd 00 0c lwz r31,12(r29) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0bcf0: 7d 20 00 a6 mfmsr r9 ffc0bcf4: 7c 10 42 a6 mfsprg r0,0 ffc0bcf8: 7d 20 00 78 andc r0,r9,r0 ffc0bcfc: 7c 00 01 24 mtmsr r0 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { ffc0bd00: 88 1d 00 18 lbz r0,24(r29) ffc0bd04: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bd08: 41 9e 00 34 beq- cr7,ffc0bd3c <_Thread_Dispatch+0x194> heir = _Thread_Heir; ffc0bd0c: 83 dd 00 10 lwz r30,16(r29) _Thread_Dispatch_disable_level = 1; ffc0bd10: 92 d9 27 e8 stw r22,10216(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 ) ffc0bd14: 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; ffc0bd18: 9a fd 00 18 stb r23,24(r29) _Thread_Executing = heir; ffc0bd1c: 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 ) ffc0bd20: 41 9e 00 1c beq- cr7,ffc0bd3c <_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 ) ffc0bd24: 80 1e 00 7c lwz r0,124(r30) ffc0bd28: 2f 80 00 01 cmpwi cr7,r0,1 ffc0bd2c: 40 9e ff 2c bne+ cr7,ffc0bc58 <_Thread_Dispatch+0xb0> heir->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0bd30: 80 15 27 e4 lwz r0,10212(r21) ffc0bd34: 90 1e 00 78 stw r0,120(r30) ffc0bd38: 4b ff ff 20 b ffc0bc58 <_Thread_Dispatch+0xb0> ffc0bd3c: 7d 20 4b 78 mr r0,r9 _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; ffc0bd40: 39 20 00 00 li r9,0 ffc0bd44: 91 39 27 e8 stw r9,10216(r25) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0bd48: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); _API_extensions_Run_postswitch(); ffc0bd4c: 4b ff dc 59 bl ffc099a4 <_API_extensions_Run_postswitch> } ffc0bd50: 80 01 00 4c lwz r0,76(r1) ffc0bd54: 82 a1 00 1c lwz r21,28(r1) ffc0bd58: 7c 08 03 a6 mtlr r0 ffc0bd5c: 82 c1 00 20 lwz r22,32(r1) ffc0bd60: 82 e1 00 24 lwz r23,36(r1) ffc0bd64: 83 01 00 28 lwz r24,40(r1) ffc0bd68: 83 21 00 2c lwz r25,44(r1) ffc0bd6c: 83 41 00 30 lwz r26,48(r1) ffc0bd70: 83 61 00 34 lwz r27,52(r1) ffc0bd74: 83 81 00 38 lwz r28,56(r1) ffc0bd78: 83 a1 00 3c lwz r29,60(r1) ffc0bd7c: 83 c1 00 40 lwz r30,64(r1) ffc0bd80: 83 e1 00 44 lwz r31,68(r1) ffc0bd84: 38 21 00 48 addi r1,r1,72 ffc0bd88: 4e 80 00 20 blr Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); ffc0bd8c: 7d 20 4b 78 mr r0,r9 ffc0bd90: 3f 20 00 00 lis r25,0 ffc0bd94: 4b ff ff ac b ffc0bd40 <_Thread_Dispatch+0x198> =============================================================================== ffc130f0 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc130f0: 94 21 ff f0 stwu r1,-16(r1) ffc130f4: 7c 08 02 a6 mflr r0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; ffc130f8: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc130fc: 90 01 00 14 stw r0,20(r1) ffc13100: 93 e1 00 0c stw r31,12(r1) #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; ffc13104: 83 e9 31 30 lwz r31,12592(r9) * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc13108: 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; ffc1310c: 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); ffc13110: 38 00 00 00 li r0,0 ffc13114: 7c 00 00 a6 mfmsr r0 if (!(level & CPU_MODES_INTERRUPT_MASK)) { ffc13118: 71 2b 00 01 andi. r11,r9,1 ffc1311c: 40 82 00 60 bne- ffc1317c <_Thread_Handler+0x8c> static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; __asm__ volatile ( ffc13120: 7d 30 42 a6 mfsprg r9,0 msr |= ppc_interrupt_get_disable_mask(); ffc13124: 7d 20 03 78 or r0,r9,r0 } else { msr &= ~ppc_interrupt_get_disable_mask(); } _CPU_MSR_SET(msr); ffc13128: 7c 00 01 24 mtmsr r0 _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; ffc1312c: 3d 20 00 00 lis r9,0 ffc13130: 8b c9 29 d8 lbz r30,10712(r9) doneConstructors = 1; ffc13134: 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 ); ffc13138: 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; ffc1313c: 98 09 29 d8 stb r0,10712(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 ); ffc13140: 4b ff 9c 95 bl ffc0cdd4 <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); ffc13144: 4b ff 8c 55 bl ffc0bd98 <_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) */ { ffc13148: 2f 9e 00 00 cmpwi cr7,r30,0 ffc1314c: 41 9e 00 60 beq- cr7,ffc131ac <_Thread_Handler+0xbc> INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { ffc13150: 80 1f 00 94 lwz r0,148(r31) ffc13154: 2f 80 00 00 cmpwi cr7,r0,0 ffc13158: 41 9e 00 64 beq- cr7,ffc131bc <_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 ) { ffc1315c: 2f 80 00 01 cmpwi cr7,r0,1 ffc13160: 41 9e 00 74 beq- cr7,ffc131d4 <_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 ); ffc13164: 7f e3 fb 78 mr r3,r31 ffc13168: 4b ff 9c e1 bl ffc0ce48 <_User_extensions_Thread_exitted> _Internal_error_Occurred( ffc1316c: 38 60 00 00 li r3,0 ffc13170: 38 80 00 01 li r4,1 ffc13174: 38 a0 00 05 li r5,5 ffc13178: 4b ff 75 91 bl ffc0a708 <_Internal_error_Occurred> ffc1317c: 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(); ffc13180: 7c 00 48 78 andc r0,r0,r9 } _CPU_MSR_SET(msr); ffc13184: 7c 00 01 24 mtmsr r0 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; ffc13188: 3d 20 00 00 lis r9,0 ffc1318c: 8b c9 29 d8 lbz r30,10712(r9) doneConstructors = 1; ffc13190: 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 ); ffc13194: 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; ffc13198: 98 09 29 d8 stb r0,10712(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 ); ffc1319c: 4b ff 9c 39 bl ffc0cdd4 <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); ffc131a0: 4b ff 8b f9 bl ffc0bd98 <_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) */ { ffc131a4: 2f 9e 00 00 cmpwi cr7,r30,0 ffc131a8: 40 9e ff a8 bne+ cr7,ffc13150 <_Thread_Handler+0x60> <== ALWAYS TAKEN INIT_NAME (); ffc131ac: 48 00 62 91 bl ffc1943c <_init> } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { ffc131b0: 80 1f 00 94 lwz r0,148(r31) ffc131b4: 2f 80 00 00 cmpwi cr7,r0,0 ffc131b8: 40 9e ff a4 bne+ cr7,ffc1315c <_Thread_Handler+0x6c> executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( ffc131bc: 80 1f 00 90 lwz r0,144(r31) ffc131c0: 80 7f 00 9c lwz r3,156(r31) ffc131c4: 7c 09 03 a6 mtctr r0 ffc131c8: 4e 80 04 21 bctrl INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = ffc131cc: 90 7f 00 28 stw r3,40(r31) ffc131d0: 4b ff ff 94 b ffc13164 <_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)( ffc131d4: 80 1f 00 90 lwz r0,144(r31) ffc131d8: 80 7f 00 98 lwz r3,152(r31) ffc131dc: 7c 09 03 a6 mtctr r0 ffc131e0: 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 = ffc131e4: 90 7f 00 28 stw r3,40(r31) ffc131e8: 4b ff ff 7c b ffc13164 <_Thread_Handler+0x74> =============================================================================== ffc0be84 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { ffc0be84: 94 21 ff c8 stwu r1,-56(r1) ffc0be88: 7c 08 02 a6 mflr r0 ffc0be8c: 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 ) { ffc0be90: 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 ) { ffc0be94: 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; ffc0be98: 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 ) { ffc0be9c: 93 61 00 24 stw r27,36(r1) ffc0bea0: 7d 3b 4b 78 mr r27,r9 ffc0bea4: 81 21 00 48 lwz r9,72(r1) ffc0bea8: 93 01 00 18 stw r24,24(r1) ffc0beac: 93 41 00 20 stw r26,32(r1) ffc0beb0: 7d 5a 53 78 mr r26,r10 ffc0beb4: 93 81 00 28 stw r28,40(r1) ffc0beb8: 7d 1c 43 78 mr r28,r8 ffc0bebc: 93 a1 00 2c stw r29,44(r1) ffc0bec0: 7c 7d 1b 78 mr r29,r3 ffc0bec4: 93 e1 00 34 stw r31,52(r1) ffc0bec8: 7c 9f 23 78 mr r31,r4 ffc0becc: 92 e1 00 14 stw r23,20(r1) ffc0bed0: 93 21 00 1c stw r25,28(r1) ffc0bed4: 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; ffc0bed8: 90 04 01 30 stw r0,304(r4) ffc0bedc: 90 04 01 34 stw r0,308(r4) extensions_area = NULL; the_thread->libc_reent = NULL; ffc0bee0: 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 ) { ffc0bee4: 41 82 01 ec beq- ffc0c0d0 <_Thread_Initialize+0x24c> 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; ffc0bee8: 98 04 00 b4 stb r0,180(r4) ffc0beec: 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 ) { ffc0bef0: 2f 87 00 00 cmpwi cr7,r7,0 Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; ffc0bef4: 93 df 00 bc stw r30,188(r31) ffc0bef8: 39 20 00 00 li r9,0 the_stack->size = size; ffc0befc: 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; ffc0bf00: 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 ) { ffc0bf04: 40 9e 01 48 bne- cr7,ffc0c04c <_Thread_Initialize+0x1c8> #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bf08: 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; ffc0bf0c: 91 3f 01 28 stw r9,296(r31) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0bf10: 38 00 00 00 li r0,0 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bf14: 81 77 28 08 lwz r11,10248(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; ffc0bf18: 91 3f 00 c0 stw r9,192(r31) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0bf1c: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0bf20: 90 1f 00 50 stw r0,80(r31) the_watchdog->routine = routine; ffc0bf24: 90 1f 00 64 stw r0,100(r31) the_watchdog->id = id; ffc0bf28: 90 1f 00 68 stw r0,104(r31) the_watchdog->user_data = user_data; ffc0bf2c: 90 1f 00 6c stw r0,108(r31) ffc0bf30: 40 9e 01 5c bne- cr7,ffc0c08c <_Thread_Initialize+0x208> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; ffc0bf34: 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; ffc0bf38: 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 ) { ffc0bf3c: 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; ffc0bf40: 80 01 00 40 lwz r0,64(r1) /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; ffc0bf44: 9b 7f 00 a0 stb r27,160(r31) the_thread->Start.budget_algorithm = budget_algorithm; ffc0bf48: 93 5f 00 a4 stw r26,164(r31) the_thread->Start.budget_callout = budget_callout; ffc0bf4c: 90 1f 00 a8 stw r0,168(r31) switch ( budget_algorithm ) { ffc0bf50: 40 be 00 10 bne+ cr7,ffc0bf60 <_Thread_Initialize+0xdc> 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; ffc0bf54: 3d 20 00 00 lis r9,0 ffc0bf58: 80 09 27 e4 lwz r0,10212(r9) ffc0bf5c: 90 1f 00 78 stw r0,120(r31) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; ffc0bf60: 80 01 00 44 lwz r0,68(r1) */ RTEMS_INLINE_ROUTINE void* _Scheduler_Allocate( Thread_Control *the_thread ) { return _Scheduler.Operations.allocate( the_thread ); ffc0bf64: 3d 20 00 00 lis r9,0 the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; ffc0bf68: 3b 60 00 00 li r27,0 the_thread->resource_count = 0; the_thread->real_priority = priority; ffc0bf6c: 93 9f 00 18 stw r28,24(r31) ffc0bf70: 7f e3 fb 78 mr r3,r31 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; ffc0bf74: 90 1f 00 ac stw r0,172(r31) the_thread->current_state = STATES_DORMANT; ffc0bf78: 38 00 00 01 li r0,1 ffc0bf7c: 90 1f 00 10 stw r0,16(r31) ffc0bf80: 80 09 20 1c lwz r0,8220(r9) the_thread->Wait.queue = NULL; ffc0bf84: 93 7f 00 44 stw r27,68(r31) ffc0bf88: 7c 09 03 a6 mtctr r0 the_thread->resource_count = 0; ffc0bf8c: 93 7f 00 1c stw r27,28(r31) the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; ffc0bf90: 93 9f 00 b0 stw r28,176(r31) ffc0bf94: 4e 80 04 21 bctrl sched =_Scheduler_Allocate( the_thread ); if ( !sched ) ffc0bf98: 7c 7a 1b 79 mr. r26,r3 ffc0bf9c: 41 82 00 40 beq- ffc0bfdc <_Thread_Initialize+0x158> goto failed; _Thread_Set_priority( the_thread, priority ); ffc0bfa0: 7f e3 fb 78 mr r3,r31 ffc0bfa4: 7f 84 e3 78 mr r4,r28 ffc0bfa8: 48 00 08 d9 bl ffc0c880 <_Thread_Set_priority> Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( ffc0bfac: a0 1f 00 0a lhz r0,10(r31) _Workspace_Free( sched ); _Thread_Stack_Free( the_thread ); return false; } ffc0bfb0: 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 ); ffc0bfb4: 7f e3 fb 78 mr r3,r31 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0bfb8: 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 ); ffc0bfbc: 93 7f 00 84 stw r27,132(r31) ffc0bfc0: 93 7f 00 88 stw r27,136(r31) ffc0bfc4: 7f e9 01 2e stwx r31,r9,r0 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc0bfc8: 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 ); ffc0bfcc: 48 00 0f 7d bl ffc0cf48 <_User_extensions_Thread_create> if ( extension_status ) ffc0bfd0: 2f 83 00 00 cmpwi cr7,r3,0 return true; ffc0bfd4: 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 ) ffc0bfd8: 40 9e 00 40 bne- cr7,ffc0c018 <_Thread_Initialize+0x194> return true; failed: _Workspace_Free( the_thread->libc_reent ); ffc0bfdc: 80 7f 01 2c lwz r3,300(r31) ffc0bfe0: 48 00 15 ed bl ffc0d5cc <_Workspace_Free> for ( i=0 ; i <= THREAD_API_LAST ; i++ ) _Workspace_Free( the_thread->API_Extensions[i] ); ffc0bfe4: 80 7f 01 30 lwz r3,304(r31) ffc0bfe8: 48 00 15 e5 bl ffc0d5cc <_Workspace_Free> ffc0bfec: 80 7f 01 34 lwz r3,308(r31) ffc0bff0: 48 00 15 dd bl ffc0d5cc <_Workspace_Free> _Workspace_Free( extensions_area ); ffc0bff4: 7f c3 f3 78 mr r3,r30 ffc0bff8: 48 00 15 d5 bl ffc0d5cc <_Workspace_Free> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Workspace_Free( fp_area ); ffc0bffc: 7f 23 cb 78 mr r3,r25 ffc0c000: 48 00 15 cd bl ffc0d5cc <_Workspace_Free> #endif _Workspace_Free( sched ); ffc0c004: 7f 43 d3 78 mr r3,r26 ffc0c008: 48 00 15 c5 bl ffc0d5cc <_Workspace_Free> _Thread_Stack_Free( the_thread ); ffc0c00c: 7f e3 fb 78 mr r3,r31 ffc0c010: 48 00 0a 1d bl ffc0ca2c <_Thread_Stack_Free> return false; ffc0c014: 38 60 00 00 li r3,0 } ffc0c018: 80 01 00 3c lwz r0,60(r1) ffc0c01c: 82 e1 00 14 lwz r23,20(r1) ffc0c020: 7c 08 03 a6 mtlr r0 ffc0c024: 83 01 00 18 lwz r24,24(r1) ffc0c028: 83 21 00 1c lwz r25,28(r1) ffc0c02c: 83 41 00 20 lwz r26,32(r1) ffc0c030: 83 61 00 24 lwz r27,36(r1) ffc0c034: 83 81 00 28 lwz r28,40(r1) ffc0c038: 83 a1 00 2c lwz r29,44(r1) ffc0c03c: 83 c1 00 30 lwz r30,48(r1) ffc0c040: 83 e1 00 34 lwz r31,52(r1) ffc0c044: 38 21 00 38 addi r1,r1,56 ffc0c048: 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 ); ffc0c04c: 38 60 01 08 li r3,264 ffc0c050: 48 00 15 49 bl ffc0d598 <_Workspace_Allocate> if ( !fp_area ) ffc0c054: 7c 79 1b 79 mr. r25,r3 ffc0c058: 41 82 00 bc beq- ffc0c114 <_Thread_Initialize+0x290> #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0c05c: 3e e0 00 00 lis r23,0 ffc0c060: 81 77 28 08 lwz r11,10248(r23) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0c064: 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 ) ffc0c068: 7f 29 cb 78 mr r9,r25 ffc0c06c: 90 1f 00 50 stw r0,80(r31) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0c070: 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; ffc0c074: 91 3f 01 28 stw r9,296(r31) the_thread->Start.fp_context = fp_area; ffc0c078: 91 3f 00 c0 stw r9,192(r31) the_watchdog->routine = routine; ffc0c07c: 90 1f 00 64 stw r0,100(r31) the_watchdog->id = id; ffc0c080: 90 1f 00 68 stw r0,104(r31) the_watchdog->user_data = user_data; ffc0c084: 90 1f 00 6c stw r0,108(r31) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0c088: 41 9e fe ac beq+ cr7,ffc0bf34 <_Thread_Initialize+0xb0> extensions_area = _Workspace_Allocate( ffc0c08c: 39 6b 00 01 addi r11,r11,1 ffc0c090: 55 63 10 3a rlwinm r3,r11,2,0,29 ffc0c094: 48 00 15 05 bl ffc0d598 <_Workspace_Allocate> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) ffc0c098: 7c 7e 1b 79 mr. r30,r3 ffc0c09c: 41 82 00 84 beq- ffc0c120 <_Thread_Initialize+0x29c> goto failed; } the_thread->extensions = (void **) extensions_area; ffc0c0a0: 93 df 01 38 stw r30,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++ ) ffc0c0a4: 38 00 00 00 li r0,0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; ffc0c0a8: 39 20 00 00 li r9,0 ffc0c0ac: 81 57 28 08 lwz r10,10248(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; ffc0c0b0: 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++ ) ffc0c0b4: 39 29 00 01 addi r9,r9,1 ffc0c0b8: 7f 8a 48 40 cmplw cr7,r10,r9 the_thread->extensions[i] = NULL; ffc0c0bc: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0c0c0: 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++ ) ffc0c0c4: 7d 20 4b 78 mr r0,r9 ffc0c0c8: 40 9c ff ec bge+ cr7,ffc0c0b4 <_Thread_Initialize+0x230> ffc0c0cc: 4b ff fe 70 b ffc0bf3c <_Thread_Initialize+0xb8> return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); ffc0c0d0: 7c 83 23 78 mr r3,r4 ffc0c0d4: 90 c1 00 08 stw r6,8(r1) ffc0c0d8: 7c c4 33 78 mr r4,r6 ffc0c0dc: 90 e1 00 0c stw r7,12(r1) ffc0c0e0: 48 00 08 a5 bl ffc0c984 <_Thread_Stack_Allocate> if ( !actual_stack_size || actual_stack_size < stack_size ) ffc0c0e4: 7c 60 1b 79 mr. r0,r3 ffc0c0e8: 80 c1 00 08 lwz r6,8(r1) return false; /* stack allocation failed */ ffc0c0ec: 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 ) ffc0c0f0: 80 e1 00 0c lwz r7,12(r1) ffc0c0f4: 41 a2 ff 24 beq- ffc0c018 <_Thread_Initialize+0x194> ffc0c0f8: 7f 86 00 40 cmplw cr7,r6,r0 return false; /* stack allocation failed */ ffc0c0fc: 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 ) ffc0c100: 41 bd ff 18 bgt- cr7,ffc0c018 <_Thread_Initialize+0x194><== NEVER TAKEN return false; /* stack allocation failed */ stack = the_thread->Start.stack; the_thread->Start.core_allocated_stack = true; ffc0c104: 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; ffc0c108: 83 df 00 c4 lwz r30,196(r31) the_thread->Start.core_allocated_stack = true; ffc0c10c: 99 3f 00 b4 stb r9,180(r31) ffc0c110: 4b ff fd e0 b ffc0bef0 <_Thread_Initialize+0x6c> * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; ffc0c114: 3b c0 00 00 li r30,0 size_t actual_stack_size = 0; void *stack = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) void *fp_area; #endif void *sched = NULL; ffc0c118: 3b 40 00 00 li r26,0 ffc0c11c: 4b ff fe c0 b ffc0bfdc <_Thread_Initialize+0x158> ffc0c120: 3b 40 00 00 li r26,0 ffc0c124: 4b ff fe b8 b ffc0bfdc <_Thread_Initialize+0x158> =============================================================================== ffc0d934 <_Thread_Restart>: bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { ffc0d934: 94 21 ff e8 stwu r1,-24(r1) ffc0d938: 7c 08 02 a6 mflr r0 ffc0d93c: 90 01 00 1c stw r0,28(r1) */ RTEMS_INLINE_ROUTINE bool _States_Is_dormant ( States_Control the_states ) { return (the_states & STATES_DORMANT); ffc0d940: 80 03 00 10 lwz r0,16(r3) ffc0d944: 93 e1 00 14 stw r31,20(r1) ffc0d948: 7c 7f 1b 78 mr r31,r3 if ( !_States_Is_dormant( the_thread->current_state ) ) { ffc0d94c: 70 09 00 01 andi. r9,r0,1 bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { ffc0d950: 93 c1 00 10 stw r30,16(r1) _Thread_Restart_self(); return true; } return false; ffc0d954: 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 ) ) { ffc0d958: 41 82 00 20 beq- ffc0d978 <_Thread_Restart+0x44> return true; } return false; } ffc0d95c: 7c 03 03 78 mr r3,r0 ffc0d960: 80 01 00 1c lwz r0,28(r1) ffc0d964: 83 c1 00 10 lwz r30,16(r1) ffc0d968: 7c 08 03 a6 mtlr r0 ffc0d96c: 83 e1 00 14 lwz r31,20(r1) ffc0d970: 38 21 00 18 addi r1,r1,24 ffc0d974: 4e 80 00 20 blr Thread_Entry_numeric_type numeric_argument ) { if ( !_States_Is_dormant( the_thread->current_state ) ) { _Thread_Set_transient( the_thread ); ffc0d978: 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 ); ffc0d97c: 3f c0 00 00 lis r30,0 ffc0d980: 3b de 31 84 addi r30,r30,12676 ffc0d984: 90 a1 00 0c stw r5,12(r1) ffc0d988: 48 00 01 05 bl ffc0da8c <_Thread_Set_transient> _Thread_Reset( the_thread, pointer_argument, numeric_argument ); ffc0d98c: 7f e3 fb 78 mr r3,r31 ffc0d990: 80 81 00 08 lwz r4,8(r1) ffc0d994: 80 a1 00 0c lwz r5,12(r1) ffc0d998: 48 00 47 ed bl ffc12184 <_Thread_Reset> _Thread_Load_environment( the_thread ); ffc0d99c: 7f e3 fb 78 mr r3,r31 ffc0d9a0: 48 00 44 2d bl ffc11dcc <_Thread_Load_environment> _Thread_Ready( the_thread ); ffc0d9a4: 7f e3 fb 78 mr r3,r31 ffc0d9a8: 48 00 47 8d bl ffc12134 <_Thread_Ready> _User_extensions_Thread_restart( the_thread ); ffc0d9ac: 7f e3 fb 78 mr r3,r31 ffc0d9b0: 48 00 08 3d bl ffc0e1ec <_User_extensions_Thread_restart> if ( _Thread_Is_executing ( the_thread ) ) ffc0d9b4: 81 3e 00 0c lwz r9,12(r30) _Thread_Restart_self(); return true; ffc0d9b8: 38 00 00 01 li r0,1 _Thread_Ready( the_thread ); _User_extensions_Thread_restart( the_thread ); if ( _Thread_Is_executing ( the_thread ) ) ffc0d9bc: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0d9c0: 40 9e ff 9c bne+ cr7,ffc0d95c <_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 ) ffc0d9c4: 80 1f 01 28 lwz r0,296(r31) ffc0d9c8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d9cc: 41 9e 00 0c beq- cr7,ffc0d9d8 <_Thread_Restart+0xa4> <== NEVER TAKEN _Context_Restore_fp( &_Thread_Executing->fp_context ); ffc0d9d0: 38 7f 01 28 addi r3,r31,296 ffc0d9d4: 48 01 17 ed bl ffc1f1c0 <_CPU_Context_restore_fp> #endif _CPU_Context_Restart_self( &_Thread_Executing->Registers ); ffc0d9d8: 80 7e 00 0c lwz r3,12(r30) ffc0d9dc: 38 63 00 c8 addi r3,r3,200 ffc0d9e0: 48 01 19 a1 bl ffc1f380 <_CPU_Context_restore> =============================================================================== ffc0cb5c <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { ffc0cb5c: 7c 08 02 a6 mflr r0 ffc0cb60: 94 21 ff f0 stwu r1,-16(r1) Thread_Control *executing; executing = _Thread_Executing; ffc0cb64: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { ffc0cb68: 90 01 00 14 stw r0,20(r1) Thread_Control *executing; executing = _Thread_Executing; ffc0cb6c: 80 69 31 30 lwz r3,12592(r9) /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) ffc0cb70: 88 03 00 74 lbz r0,116(r3) ffc0cb74: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cb78: 41 9e 00 2c beq- cr7,ffc0cba4 <_Thread_Tickle_timeslice+0x48> return; if ( !_States_Is_ready( executing->current_state ) ) ffc0cb7c: 80 03 00 10 lwz r0,16(r3) ffc0cb80: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cb84: 40 9e 00 20 bne- cr7,ffc0cba4 <_Thread_Tickle_timeslice+0x48> /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { ffc0cb88: 80 03 00 7c lwz r0,124(r3) ffc0cb8c: 2b 80 00 01 cmplwi cr7,r0,1 ffc0cb90: 41 9c 00 14 blt- cr7,ffc0cba4 <_Thread_Tickle_timeslice+0x48> ffc0cb94: 2b 80 00 02 cmplwi cr7,r0,2 ffc0cb98: 40 9d 00 40 ble- cr7,ffc0cbd8 <_Thread_Tickle_timeslice+0x7c> ffc0cb9c: 2f 80 00 03 cmpwi cr7,r0,3 ffc0cba0: 41 9e 00 14 beq- cr7,ffc0cbb4 <_Thread_Tickle_timeslice+0x58><== ALWAYS TAKEN if ( --executing->cpu_time_budget == 0 ) (*executing->budget_callout)( executing ); break; #endif } } ffc0cba4: 80 01 00 14 lwz r0,20(r1) ffc0cba8: 38 21 00 10 addi r1,r1,16 ffc0cbac: 7c 08 03 a6 mtlr r0 ffc0cbb0: 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 ) ffc0cbb4: 81 23 00 78 lwz r9,120(r3) ffc0cbb8: 38 09 ff ff addi r0,r9,-1 ffc0cbbc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cbc0: 90 03 00 78 stw r0,120(r3) ffc0cbc4: 40 9e ff e0 bne+ cr7,ffc0cba4 <_Thread_Tickle_timeslice+0x48> (*executing->budget_callout)( executing ); ffc0cbc8: 80 03 00 80 lwz r0,128(r3) ffc0cbcc: 7c 09 03 a6 mtctr r0 ffc0cbd0: 4e 80 04 21 bctrl ffc0cbd4: 4b ff ff d0 b ffc0cba4 <_Thread_Tickle_timeslice+0x48> case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE: #if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE) case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE: #endif if ( (int)(--executing->cpu_time_budget) <= 0 ) { ffc0cbd8: 81 23 00 78 lwz r9,120(r3) ffc0cbdc: 38 09 ff ff addi r0,r9,-1 ffc0cbe0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cbe4: 90 03 00 78 stw r0,120(r3) ffc0cbe8: 41 9d ff bc bgt+ cr7,ffc0cba4 <_Thread_Tickle_timeslice+0x48> * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield(); ffc0cbec: 3d 20 00 00 lis r9,0 ffc0cbf0: 90 61 00 08 stw r3,8(r1) ffc0cbf4: 80 09 20 10 lwz r0,8208(r9) ffc0cbf8: 7c 09 03 a6 mtctr r0 ffc0cbfc: 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; ffc0cc00: 3d 20 00 00 lis r9,0 ffc0cc04: 80 09 27 e4 lwz r0,10212(r9) ffc0cc08: 80 61 00 08 lwz r3,8(r1) ffc0cc0c: 90 03 00 78 stw r0,120(r3) ffc0cc10: 4b ff ff 94 b ffc0cba4 <_Thread_Tickle_timeslice+0x48> =============================================================================== ffc0c4b0 <_Thread_queue_Enqueue_priority>: Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; ffc0c4b0: 80 04 00 14 lwz r0,20(r4) 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 ); ffc0c4b4: 39 44 00 3c addi r10,r4,60 Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { ffc0c4b8: 94 21 ff f0 stwu r1,-16(r1) ffc0c4bc: 7c 69 1b 78 mr r9,r3 priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; block_state = the_thread_queue->state; if ( _Thread_queue_Is_reverse_search( priority ) ) ffc0c4c0: 70 0b 00 20 andi. r11,r0,32 head->next = tail; ffc0c4c4: 91 44 00 38 stw r10,56(r4) */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); ffc0c4c8: 39 64 00 38 addi r11,r4,56 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; ffc0c4cc: 39 40 00 00 li r10,0 Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { ffc0c4d0: 93 e1 00 0c stw r31,12(r1) RTEMS_INLINE_ROUTINE uint32_t _Thread_queue_Header_number ( Priority_Control the_priority ) { return (the_priority / TASK_QUEUE_DATA_PRIORITIES_PER_HEADER); ffc0c4d4: 54 06 d1 be rlwinm r6,r0,26,6,31 ffc0c4d8: 91 44 00 3c stw r10,60(r4) tail->previous = head; ffc0c4dc: 91 64 00 40 stw r11,64(r4) _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; block_state = the_thread_queue->state; ffc0c4e0: 81 03 00 38 lwz r8,56(r3) if ( _Thread_queue_Is_reverse_search( priority ) ) ffc0c4e4: 40 82 00 80 bne- ffc0c564 <_Thread_queue_Enqueue_priority+0xb4> ffc0c4e8: 1c c6 00 0c mulli r6,r6,12 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } ffc0c4ec: 7c c3 32 14 add r6,r3,r6 RTEMS_INLINE_ROUTINE bool _Chain_Is_tail( Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Tail(the_chain)); ffc0c4f0: 38 66 00 04 addi r3,r6,4 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0c4f4: 7d 80 00 a6 mfmsr r12 ffc0c4f8: 7d 70 42 a6 mfsprg r11,0 ffc0c4fc: 7d 8b 58 78 andc r11,r12,r11 ffc0c500: 7d 60 01 24 mtmsr r11 ffc0c504: 81 66 00 00 lwz r11,0(r6) restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { ffc0c508: 7f 8b 18 00 cmpw cr7,r11,r3 ffc0c50c: 40 be 00 2c bne+ cr7,ffc0c538 <_Thread_queue_Enqueue_priority+0x88> ffc0c510: 48 00 01 74 b ffc0c684 <_Thread_queue_Enqueue_priority+0x1d4> static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0c514: 7c e0 00 a6 mfmsr r7 ffc0c518: 7d 80 01 24 mtmsr r12 ffc0c51c: 7c e0 01 24 mtmsr r7 RTEMS_INLINE_ROUTINE bool _States_Are_set ( States_Control the_states, States_Control mask ) { return ( (the_states & mask) != STATES_READY); ffc0c520: 80 eb 00 10 lwz r7,16(r11) search_priority = search_thread->current_priority; if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); if ( !_States_Are_set( search_thread->current_state, block_state) ) { ffc0c524: 7d 1f 38 39 and. r31,r8,r7 ffc0c528: 41 82 00 f4 beq- ffc0c61c <_Thread_queue_Enqueue_priority+0x16c><== NEVER TAKEN _ISR_Enable( level ); goto restart_forward_search; } search_thread = (Thread_Control *)search_thread->Object.Node.next; ffc0c52c: 81 6b 00 00 lwz r11,0(r11) restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { ffc0c530: 7f 8b 18 00 cmpw cr7,r11,r3 ffc0c534: 41 9e 00 10 beq- cr7,ffc0c544 <_Thread_queue_Enqueue_priority+0x94> search_priority = search_thread->current_priority; ffc0c538: 81 4b 00 14 lwz r10,20(r11) if ( priority <= search_priority ) ffc0c53c: 7f 80 50 40 cmplw cr7,r0,r10 ffc0c540: 41 9d ff d4 bgt+ cr7,ffc0c514 <_Thread_queue_Enqueue_priority+0x64> } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != ffc0c544: 80 69 00 30 lwz r3,48(r9) ffc0c548: 7d 88 63 78 mr r8,r12 ffc0c54c: 2f 83 00 01 cmpwi cr7,r3,1 ffc0c550: 41 9e 00 d4 beq- cr7,ffc0c624 <_Thread_queue_Enqueue_priority+0x174> * For example, the blocking thread could have been given * the mutex by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ *level_p = level; ffc0c554: 91 05 00 00 stw r8,0(r5) return the_thread_queue->sync_state; } ffc0c558: 83 e1 00 0c lwz r31,12(r1) ffc0c55c: 38 21 00 10 addi r1,r1,16 ffc0c560: 4e 80 00 20 blr ffc0c564: 1c c6 00 0c mulli r6,r6,12 ffc0c568: 3c 60 00 00 lis r3,0 ffc0c56c: 38 63 27 24 addi r3,r3,10020 ffc0c570: 7c c9 32 14 add r6,r9,r6 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; ffc0c574: 89 43 00 00 lbz r10,0(r3) ffc0c578: 39 4a 00 01 addi r10,r10,1 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0c57c: 7d 80 00 a6 mfmsr r12 ffc0c580: 7d 70 42 a6 mfsprg r11,0 ffc0c584: 7d 8b 58 78 andc r11,r12,r11 ffc0c588: 7d 60 01 24 mtmsr r11 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } ffc0c58c: 81 66 00 08 lwz r11,8(r6) restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { ffc0c590: 7f 8b 30 00 cmpw cr7,r11,r6 ffc0c594: 40 be 00 2c bne+ cr7,ffc0c5c0 <_Thread_queue_Enqueue_priority+0x110> ffc0c598: 48 00 00 34 b ffc0c5cc <_Thread_queue_Enqueue_priority+0x11c> static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0c59c: 7c e0 00 a6 mfmsr r7 ffc0c5a0: 7d 80 01 24 mtmsr r12 ffc0c5a4: 7c e0 01 24 mtmsr r7 ffc0c5a8: 80 eb 00 10 lwz r7,16(r11) search_priority = search_thread->current_priority; if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); if ( !_States_Are_set( search_thread->current_state, block_state) ) { ffc0c5ac: 7d 1f 38 39 and. r31,r8,r7 ffc0c5b0: 41 82 00 64 beq- ffc0c614 <_Thread_queue_Enqueue_priority+0x164> _ISR_Enable( level ); goto restart_reverse_search; } search_thread = (Thread_Control *) search_thread->Object.Node.previous; ffc0c5b4: 81 6b 00 04 lwz r11,4(r11) restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { ffc0c5b8: 7f 8b 30 00 cmpw cr7,r11,r6 ffc0c5bc: 41 9e 00 10 beq- cr7,ffc0c5cc <_Thread_queue_Enqueue_priority+0x11c> search_priority = search_thread->current_priority; ffc0c5c0: 81 4b 00 14 lwz r10,20(r11) if ( priority >= search_priority ) ffc0c5c4: 7f 80 50 40 cmplw cr7,r0,r10 ffc0c5c8: 41 9c ff d4 blt+ cr7,ffc0c59c <_Thread_queue_Enqueue_priority+0xec> } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != ffc0c5cc: 80 69 00 30 lwz r3,48(r9) ffc0c5d0: 7d 88 63 78 mr r8,r12 ffc0c5d4: 2f 83 00 01 cmpwi cr7,r3,1 ffc0c5d8: 40 9e ff 7c bne+ cr7,ffc0c554 <_Thread_queue_Enqueue_priority+0xa4> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( priority == search_priority ) ffc0c5dc: 7f 80 50 00 cmpw cr7,r0,r10 if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; ffc0c5e0: 38 00 00 00 li r0,0 ffc0c5e4: 90 09 00 30 stw r0,48(r9) if ( priority == search_priority ) ffc0c5e8: 41 9e 00 74 beq- cr7,ffc0c65c <_Thread_queue_Enqueue_priority+0x1ac> goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; ffc0c5ec: 81 4b 00 00 lwz r10,0(r11) the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; ffc0c5f0: 91 64 00 04 stw r11,4(r4) search_node = (Chain_Node *) search_thread; next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; ffc0c5f4: 91 44 00 00 stw r10,0(r4) the_node->previous = search_node; search_node->next = the_node; next_node->previous = the_node; ffc0c5f8: 90 8a 00 04 stw r4,4(r10) next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; search_node->next = the_node; ffc0c5fc: 90 8b 00 00 stw r4,0(r11) next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; ffc0c600: 91 24 00 44 stw r9,68(r4) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0c604: 7d 80 01 24 mtmsr r12 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } ffc0c608: 83 e1 00 0c lwz r31,12(r1) ffc0c60c: 38 21 00 10 addi r1,r1,16 ffc0c610: 4e 80 00 20 blr ffc0c614: 7d 80 01 24 mtmsr r12 ffc0c618: 4b ff ff 5c b ffc0c574 <_Thread_queue_Enqueue_priority+0xc4> ffc0c61c: 7d 80 01 24 mtmsr r12 <== NOT EXECUTED ffc0c620: 4b ff fe d4 b ffc0c4f4 <_Thread_queue_Enqueue_priority+0x44><== NOT EXECUTED THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( priority == search_priority ) ffc0c624: 7f 80 50 00 cmpw cr7,r0,r10 if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; ffc0c628: 38 00 00 00 li r0,0 ffc0c62c: 90 09 00 30 stw r0,48(r9) if ( priority == search_priority ) ffc0c630: 41 9e 00 2c beq- cr7,ffc0c65c <_Thread_queue_Enqueue_priority+0x1ac> goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; ffc0c634: 81 4b 00 04 lwz r10,4(r11) the_node = (Chain_Node *) the_thread; the_node->next = search_node; ffc0c638: 91 64 00 00 stw r11,0(r4) the_node->previous = previous_node; ffc0c63c: 91 44 00 04 stw r10,4(r4) previous_node->next = the_node; ffc0c640: 90 8a 00 00 stw r4,0(r10) search_node->previous = the_node; ffc0c644: 90 8b 00 04 stw r4,4(r11) the_thread->Wait.queue = the_thread_queue; ffc0c648: 91 24 00 44 stw r9,68(r4) ffc0c64c: 7d 80 01 24 mtmsr r12 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } ffc0c650: 83 e1 00 0c lwz r31,12(r1) ffc0c654: 38 21 00 10 addi r1,r1,16 ffc0c658: 4e 80 00 20 blr _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); previous_node = search_node->previous; ffc0c65c: 81 4b 00 40 lwz r10,64(r11) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); ffc0c660: 38 0b 00 3c addi r0,r11,60 previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; ffc0c664: 90 04 00 00 stw r0,0(r4) the_node->previous = previous_node; ffc0c668: 91 44 00 04 stw r10,4(r4) previous_node->next = the_node; ffc0c66c: 90 8a 00 00 stw r4,0(r10) search_node->previous = the_node; ffc0c670: 90 8b 00 40 stw r4,64(r11) the_thread->Wait.queue = the_thread_queue; ffc0c674: 91 24 00 44 stw r9,68(r4) ffc0c678: 7d 80 01 24 mtmsr r12 _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; ffc0c67c: 38 60 00 01 li r3,1 ffc0c680: 4b ff fe d8 b ffc0c558 <_Thread_queue_Enqueue_priority+0xa8> if ( _Thread_queue_Is_reverse_search( priority ) ) goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; ffc0c684: 39 40 ff ff li r10,-1 ffc0c688: 4b ff fe bc b ffc0c544 <_Thread_queue_Enqueue_priority+0x94> =============================================================================== ffc0c788 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { ffc0c788: 94 21 ff d8 stwu r1,-40(r1) ffc0c78c: 7c 08 02 a6 mflr r0 ffc0c790: 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 ) ffc0c794: 7c 7f 1b 79 mr. r31,r3 void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { ffc0c798: 93 c1 00 20 stw r30,32(r1) ffc0c79c: 7c 9e 23 78 mr r30,r4 ffc0c7a0: 90 01 00 2c stw r0,44(r1) ffc0c7a4: 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 ) ffc0c7a8: 41 82 00 10 beq- ffc0c7b8 <_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 ) { ffc0c7ac: 80 1f 00 34 lwz r0,52(r31) ffc0c7b0: 2f 80 00 01 cmpwi cr7,r0,1 ffc0c7b4: 41 9e 00 20 beq- cr7,ffc0c7d4 <_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 ); } } ffc0c7b8: 80 01 00 2c lwz r0,44(r1) <== NOT EXECUTED ffc0c7bc: 83 a1 00 1c lwz r29,28(r1) <== NOT EXECUTED ffc0c7c0: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0c7c4: 83 c1 00 20 lwz r30,32(r1) <== NOT EXECUTED ffc0c7c8: 83 e1 00 24 lwz r31,36(r1) <== NOT EXECUTED ffc0c7cc: 38 21 00 28 addi r1,r1,40 <== NOT EXECUTED ffc0c7d0: 4e 80 00 20 blr <== NOT EXECUTED static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0c7d4: 7f a0 00 a6 mfmsr r29 ffc0c7d8: 7d 30 42 a6 mfsprg r9,0 ffc0c7dc: 7f a9 48 78 andc r9,r29,r9 ffc0c7e0: 7d 20 01 24 mtmsr r9 ffc0c7e4: 3d 60 00 03 lis r11,3 ffc0c7e8: 81 24 00 10 lwz r9,16(r4) ffc0c7ec: 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 ) ) { ffc0c7f0: 7d 6a 48 39 and. r10,r11,r9 ffc0c7f4: 40 82 00 24 bne- ffc0c818 <_Thread_queue_Requeue+0x90> <== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0c7f8: 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 ); } } ffc0c7fc: 80 01 00 2c lwz r0,44(r1) ffc0c800: 83 a1 00 1c lwz r29,28(r1) ffc0c804: 7c 08 03 a6 mtlr r0 ffc0c808: 83 c1 00 20 lwz r30,32(r1) ffc0c80c: 83 e1 00 24 lwz r31,36(r1) ffc0c810: 38 21 00 28 addi r1,r1,40 ffc0c814: 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; ffc0c818: 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 ); ffc0c81c: 38 a0 00 01 li r5,1 ffc0c820: 48 00 44 81 bl ffc10ca0 <_Thread_queue_Extract_priority_helper> (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); ffc0c824: 7f e3 fb 78 mr r3,r31 ffc0c828: 7f c4 f3 78 mr r4,r30 ffc0c82c: 38 a1 00 08 addi r5,r1,8 ffc0c830: 4b ff fc 81 bl ffc0c4b0 <_Thread_queue_Enqueue_priority> ffc0c834: 7f a0 01 24 mtmsr r29 ffc0c838: 4b ff ff c4 b ffc0c7fc <_Thread_queue_Requeue+0x74> =============================================================================== ffc0c83c <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0c83c: 94 21 ff e8 stwu r1,-24(r1) ffc0c840: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0c844: 38 81 00 08 addi r4,r1,8 void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0c848: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0c84c: 4b ff f5 6d bl ffc0bdb8 <_Thread_Get> switch ( location ) { ffc0c850: 80 01 00 08 lwz r0,8(r1) ffc0c854: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c858: 40 9e 00 18 bne- cr7,ffc0c870 <_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 ); ffc0c85c: 48 00 45 59 bl ffc10db4 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; ffc0c860: 3d 20 00 00 lis r9,0 ffc0c864: 81 69 27 e8 lwz r11,10216(r9) ffc0c868: 38 0b ff ff addi r0,r11,-1 ffc0c86c: 90 09 27 e8 stw r0,10216(r9) _Thread_Unnest_dispatch(); break; } } ffc0c870: 80 01 00 1c lwz r0,28(r1) ffc0c874: 38 21 00 18 addi r1,r1,24 ffc0c878: 7c 08 03 a6 mtlr r0 ffc0c87c: 4e 80 00 20 blr =============================================================================== ffc1b9f0 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { ffc1b9f0: 94 21 ff 98 stwu r1,-104(r1) ffc1b9f4: 7c 08 02 a6 mflr r0 ffc1b9f8: 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; ffc1b9fc: 3a a1 00 08 addi r21,r1,8 ffc1ba00: 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; ffc1ba04: 38 00 00 00 li r0,0 ffc1ba08: 92 e1 00 44 stw r23,68(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc1ba0c: 3a e1 00 18 addi r23,r1,24 ffc1ba10: 93 41 00 50 stw r26,80(r1) ffc1ba14: 3b 41 00 0c addi r26,r1,12 ffc1ba18: 93 81 00 58 stw r28,88(r1) ffc1ba1c: 3b 81 00 14 addi r28,r1,20 ffc1ba20: 92 81 00 38 stw r20,56(r1) ffc1ba24: 3e 80 00 00 lis r20,0 ffc1ba28: 3a 94 28 e0 addi r20,r20,10464 ffc1ba2c: 93 01 00 48 stw r24,72(r1) ffc1ba30: 3f 00 00 00 lis r24,0 ffc1ba34: 3b 18 29 1c addi r24,r24,10524 ffc1ba38: 93 21 00 4c stw r25,76(r1) ffc1ba3c: 3f 20 00 00 lis r25,0 ffc1ba40: 3b 39 28 f8 addi r25,r25,10488 ffc1ba44: 93 c1 00 60 stw r30,96(r1) ffc1ba48: 93 41 00 08 stw r26,8(r1) head->previous = NULL; ffc1ba4c: 90 01 00 0c stw r0,12(r1) tail->previous = head; ffc1ba50: 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; ffc1ba54: 92 e1 00 14 stw r23,20(r1) head->previous = NULL; ffc1ba58: 90 01 00 18 stw r0,24(r1) tail->previous = head; ffc1ba5c: 93 81 00 1c stw r28,28(r1) ffc1ba60: 92 01 00 28 stw r16,40(r1) ffc1ba64: 3a 03 00 08 addi r16,r3,8 ffc1ba68: 92 21 00 2c stw r17,44(r1) ffc1ba6c: 3a 23 00 40 addi r17,r3,64 ffc1ba70: 92 41 00 30 stw r18,48(r1) * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; ffc1ba74: 3a 40 00 00 li r18,0 * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { ffc1ba78: 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; ffc1ba7c: 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 ) { ffc1ba80: 92 c1 00 40 stw r22,64(r1) * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; ffc1ba84: 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 ) { ffc1ba88: 93 61 00 54 stw r27,84(r1) ffc1ba8c: 3b 63 00 68 addi r27,r3,104 ffc1ba90: 93 a1 00 5c stw r29,92(r1) ffc1ba94: 3b a3 00 30 addi r29,r3,48 ffc1ba98: 93 e1 00 64 stw r31,100(r1) ffc1ba9c: 7c 7f 1b 78 mr r31,r3 { /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; ffc1baa0: 92 bf 00 78 stw r21,120(r31) */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1baa4: 7f 85 e3 78 mr r5,r28 ffc1baa8: 7f a3 eb 78 mr r3,r29 static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; ffc1baac: 80 18 00 00 lwz r0,0(r24) /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; ffc1bab0: 80 9f 00 3c lwz r4,60(r31) watchdogs->last_snapshot = snapshot; ffc1bab4: 90 1f 00 3c stw r0,60(r31) _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1bab8: 7c 84 00 50 subf r4,r4,r0 ffc1babc: 48 00 59 45 bl ffc21400 <_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(); ffc1bac0: 83 d9 00 00 lwz r30,0(r25) Watchdog_Interval last_snapshot = watchdogs->last_snapshot; ffc1bac4: 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 ) { ffc1bac8: 7f 9e 28 40 cmplw cr7,r30,r5 ffc1bacc: 41 9d 00 98 bgt- cr7,ffc1bb64 <_Timer_server_Body+0x174> * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { ffc1bad0: 41 9c 00 a8 blt- cr7,ffc1bb78 <_Timer_server_Body+0x188> */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; ffc1bad4: 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 ); ffc1bad8: 80 7f 00 78 lwz r3,120(r31) ffc1badc: 48 00 0d c5 bl ffc1c8a0 <_Chain_Get> if ( timer == NULL ) { ffc1bae0: 7c 64 1b 79 mr. r4,r3 ffc1bae4: 41 82 00 34 beq- ffc1bb18 <_Timer_server_Body+0x128> static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1bae8: 80 04 00 38 lwz r0,56(r4) ffc1baec: 2f 80 00 01 cmpwi cr7,r0,1 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc1baf0: 2f 00 00 03 cmpwi cr6,r0,3 static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1baf4: 41 9e 00 98 beq- cr7,ffc1bb8c <_Timer_server_Body+0x19c> _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc1baf8: 40 9a ff e0 bne+ cr6,ffc1bad8 <_Timer_server_Body+0xe8> <== NEVER TAKEN _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); ffc1bafc: 38 84 00 10 addi r4,r4,16 ffc1bb00: 7f 63 db 78 mr r3,r27 ffc1bb04: 48 00 59 b5 bl ffc214b8 <_Watchdog_Insert> } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); ffc1bb08: 80 7f 00 78 lwz r3,120(r31) ffc1bb0c: 48 00 0d 95 bl ffc1c8a0 <_Chain_Get> if ( timer == NULL ) { ffc1bb10: 7c 64 1b 79 mr. r4,r3 ffc1bb14: 40 82 ff d4 bne+ ffc1bae8 <_Timer_server_Body+0xf8> <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1bb18: 7d 20 00 a6 mfmsr r9 ffc1bb1c: 7c 10 42 a6 mfsprg r0,0 ffc1bb20: 7d 20 00 78 andc r0,r9,r0 ffc1bb24: 7c 00 01 24 mtmsr r0 * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { ffc1bb28: 80 01 00 08 lwz r0,8(r1) ffc1bb2c: 7f 80 d0 00 cmpw cr7,r0,r26 ffc1bb30: 41 9e 00 6c beq- cr7,ffc1bb9c <_Timer_server_Body+0x1ac><== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1bb34: 7d 20 01 24 mtmsr r9 <== NOT EXECUTED static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; ffc1bb38: 80 18 00 00 lwz r0,0(r24) <== NOT EXECUTED */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1bb3c: 7f 85 e3 78 mr r5,r28 <== NOT EXECUTED Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; ffc1bb40: 80 9f 00 3c lwz r4,60(r31) <== NOT EXECUTED watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1bb44: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; ffc1bb48: 90 1f 00 3c stw r0,60(r31) <== NOT EXECUTED _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1bb4c: 7c 84 00 50 subf r4,r4,r0 <== NOT EXECUTED ffc1bb50: 48 00 58 b1 bl ffc21400 <_Watchdog_Adjust_to_chain> <== NOT EXECUTED static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); ffc1bb54: 83 d9 00 00 lwz r30,0(r25) <== NOT EXECUTED Watchdog_Interval last_snapshot = watchdogs->last_snapshot; ffc1bb58: 80 bf 00 74 lwz r5,116(r31) <== NOT EXECUTED /* * Process the seconds chain. Start by checking that the Time * of Day (TOD) has not been set backwards. If it has then * we want to adjust the watchdogs->Chain to indicate this. */ if ( snapshot > last_snapshot ) { ffc1bb5c: 7f 9e 28 40 cmplw cr7,r30,r5 <== NOT EXECUTED ffc1bb60: 40 9d ff 70 ble+ cr7,ffc1bad0 <_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 ); ffc1bb64: 7c 85 f0 50 subf r4,r5,r30 ffc1bb68: 7f 63 db 78 mr r3,r27 ffc1bb6c: 7f 85 e3 78 mr r5,r28 ffc1bb70: 48 00 58 91 bl ffc21400 <_Watchdog_Adjust_to_chain> ffc1bb74: 4b ff ff 60 b ffc1bad4 <_Timer_server_Body+0xe4> /* * The current TOD is before the last TOD which indicates that * TOD has been set backwards. */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); ffc1bb78: 7f 63 db 78 mr r3,r27 ffc1bb7c: 38 80 00 01 li r4,1 ffc1bb80: 7c be 28 50 subf r5,r30,r5 ffc1bb84: 48 00 57 51 bl ffc212d4 <_Watchdog_Adjust> ffc1bb88: 4b ff ff 4c b ffc1bad4 <_Timer_server_Body+0xe4> Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); ffc1bb8c: 7f a3 eb 78 mr r3,r29 ffc1bb90: 38 84 00 10 addi r4,r4,16 ffc1bb94: 48 00 59 25 bl ffc214b8 <_Watchdog_Insert> ffc1bb98: 4b ff ff 40 b ffc1bad8 <_Timer_server_Body+0xe8> */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; ffc1bb9c: 90 9f 00 78 stw r4,120(r31) ffc1bba0: 7d 20 01 24 mtmsr r9 _Chain_Initialize_empty( &fire_chain ); while ( true ) { _Timer_server_Get_watchdogs_that_fire_now( ts, &insert_chain, &fire_chain ); if ( !_Chain_Is_empty( &fire_chain ) ) { ffc1bba4: 80 01 00 14 lwz r0,20(r1) ffc1bba8: 7f 80 b8 00 cmpw cr7,r0,r23 ffc1bbac: 40 be 00 30 bne+ cr7,ffc1bbdc <_Timer_server_Body+0x1ec> ffc1bbb0: 48 00 00 50 b ffc1bc00 <_Timer_server_Body+0x210> Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; ffc1bbb4: 81 69 00 00 lwz r11,0(r9) head->next = new_first; new_first->previous = head; ffc1bbb8: 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; ffc1bbbc: 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; ffc1bbc0: 92 c9 00 08 stw r22,8(r9) ffc1bbc4: 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 ); ffc1bbc8: 80 09 00 1c lwz r0,28(r9) ffc1bbcc: 80 69 00 20 lwz r3,32(r9) ffc1bbd0: 80 89 00 24 lwz r4,36(r9) ffc1bbd4: 7c 09 03 a6 mtctr r0 ffc1bbd8: 4e 80 04 21 bctrl static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1bbdc: 7c 00 00 a6 mfmsr r0 ffc1bbe0: 7d 30 42 a6 mfsprg r9,0 ffc1bbe4: 7c 09 48 78 andc r9,r0,r9 ffc1bbe8: 7d 20 01 24 mtmsr r9 initialized = false; } #endif return status; } ffc1bbec: 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)) ffc1bbf0: 7f 89 b8 00 cmpw cr7,r9,r23 ffc1bbf4: 40 9e ff c0 bne+ cr7,ffc1bbb4 <_Timer_server_Body+0x1c4> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1bbf8: 7c 00 01 24 mtmsr r0 ffc1bbfc: 4b ff fe a4 b ffc1baa0 <_Timer_server_Body+0xb0> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; ffc1bc00: 9a 5f 00 7c stb r18,124(r31) ffc1bc04: 80 14 00 00 lwz r0,0(r20) ffc1bc08: 30 00 00 01 addic r0,r0,1 ffc1bc0c: 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 ); ffc1bc10: 80 7f 00 00 lwz r3,0(r31) ffc1bc14: 38 80 00 08 li r4,8 ffc1bc18: 48 00 4c e1 bl ffc208f8 <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); ffc1bc1c: 7f e3 fb 78 mr r3,r31 ffc1bc20: 4b ff fc a9 bl ffc1b8c8 <_Timer_server_Reset_interval_system_watchdog> _Timer_server_Reset_tod_system_watchdog( ts ); ffc1bc24: 7f e3 fb 78 mr r3,r31 ffc1bc28: 4b ff fd 35 bl ffc1b95c <_Timer_server_Reset_tod_system_watchdog> _Thread_Enable_dispatch(); ffc1bc2c: 48 00 41 05 bl ffc1fd30 <_Thread_Enable_dispatch> ts->active = true; ffc1bc30: 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 ); ffc1bc34: 7e 03 83 78 mr r3,r16 ffc1bc38: 48 00 5a 51 bl ffc21688 <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); ffc1bc3c: 7e 23 8b 78 mr r3,r17 ffc1bc40: 48 00 5a 49 bl ffc21688 <_Watchdog_Remove> ffc1bc44: 4b ff fe 5c b ffc1baa0 <_Timer_server_Body+0xb0> =============================================================================== ffc1bc48 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc1bc48: 94 21 ff f0 stwu r1,-16(r1) ffc1bc4c: 7c 08 02 a6 mflr r0 ffc1bc50: 7c 89 23 78 mr r9,r4 ffc1bc54: 90 01 00 14 stw r0,20(r1) if ( ts->insert_chain == NULL ) { ffc1bc58: 80 03 00 78 lwz r0,120(r3) static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc1bc5c: 93 e1 00 0c stw r31,12(r1) ffc1bc60: 7c 7f 1b 78 mr r31,r3 if ( ts->insert_chain == NULL ) { ffc1bc64: 2f 80 00 00 cmpwi cr7,r0,0 ffc1bc68: 41 9e 00 20 beq- cr7,ffc1bc88 <_Timer_server_Schedule_operation_method+0x40> * server is not preemptible, so we must be in interrupt context here. No * thread dispatch will happen until the timer server finishes its * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); ffc1bc6c: 80 63 00 78 lwz r3,120(r3) ffc1bc70: 48 00 0b d9 bl ffc1c848 <_Chain_Append> } } ffc1bc74: 80 01 00 14 lwz r0,20(r1) ffc1bc78: 83 e1 00 0c lwz r31,12(r1) ffc1bc7c: 38 21 00 10 addi r1,r1,16 ffc1bc80: 7c 08 03 a6 mtlr r0 ffc1bc84: 4e 80 00 20 blr ffc1bc88: 3d 60 00 00 lis r11,0 ffc1bc8c: 81 4b 28 e0 lwz r10,10464(r11) ffc1bc90: 38 0a 00 01 addi r0,r10,1 ffc1bc94: 90 0b 28 e0 stw r0,10464(r11) * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1bc98: 80 04 00 38 lwz r0,56(r4) ffc1bc9c: 2f 80 00 01 cmpwi cr7,r0,1 ffc1bca0: 41 9e 00 ac beq- cr7,ffc1bd4c <_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 ) { ffc1bca4: 2f 80 00 03 cmpwi cr7,r0,3 ffc1bca8: 41 9e 00 1c beq- cr7,ffc1bcc4 <_Timer_server_Schedule_operation_method+0x7c> if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); ffc1bcac: 48 00 40 85 bl ffc1fd30 <_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 ); } } ffc1bcb0: 80 01 00 14 lwz r0,20(r1) ffc1bcb4: 83 e1 00 0c lwz r31,12(r1) ffc1bcb8: 38 21 00 10 addi r1,r1,16 ffc1bcbc: 7c 08 03 a6 mtlr r0 ffc1bcc0: 4e 80 00 20 blr static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1bcc4: 7c c0 00 a6 mfmsr r6 ffc1bcc8: 7c 10 42 a6 mfsprg r0,0 ffc1bccc: 7c c0 00 78 andc r0,r6,r0 ffc1bcd0: 7c 00 01 24 mtmsr r0 initialized = false; } #endif return status; } ffc1bcd4: 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 ); ffc1bcd8: 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(); ffc1bcdc: 3d 40 00 00 lis r10,0 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { ffc1bce0: 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(); ffc1bce4: 80 0a 28 f8 lwz r0,10488(r10) last_snapshot = ts->TOD_watchdogs.last_snapshot; ffc1bce8: 81 43 00 74 lwz r10,116(r3) if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { ffc1bcec: 41 9e 00 30 beq- cr7,ffc1bd1c <_Timer_server_Schedule_operation_method+0xd4> first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { ffc1bcf0: 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; ffc1bcf4: 80 eb 00 10 lwz r7,16(r11) } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; ffc1bcf8: 7d 07 52 14 add r8,r7,r10 delta_interval += delta; ffc1bcfc: 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 ) { ffc1bd00: 40 9d 00 18 ble- cr7,ffc1bd18 <_Timer_server_Schedule_operation_method+0xd0> /* * We advanced in time. */ delta = snapshot - last_snapshot; ffc1bd04: 7d 4a 00 50 subf r10,r10,r0 if (delta_interval > delta) { ffc1bd08: 7f 87 50 40 cmplw cr7,r7,r10 delta_interval -= delta; } else { delta_interval = 0; ffc1bd0c: 39 00 00 00 li r8,0 if ( snapshot > last_snapshot ) { /* * We advanced in time. */ delta = snapshot - last_snapshot; if (delta_interval > delta) { ffc1bd10: 40 9d 00 08 ble- cr7,ffc1bd18 <_Timer_server_Schedule_operation_method+0xd0><== NEVER TAKEN delta_interval -= delta; ffc1bd14: 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; ffc1bd18: 91 0b 00 10 stw r8,16(r11) } ts->TOD_watchdogs.last_snapshot = snapshot; ffc1bd1c: 90 1f 00 74 stw r0,116(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1bd20: 7c c0 01 24 mtmsr r6 _ISR_Enable( level ); _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); ffc1bd24: 38 7f 00 68 addi r3,r31,104 ffc1bd28: 38 89 00 10 addi r4,r9,16 ffc1bd2c: 48 00 57 8d bl ffc214b8 <_Watchdog_Insert> if ( !ts->active ) { ffc1bd30: 88 1f 00 7c lbz r0,124(r31) ffc1bd34: 2f 80 00 00 cmpwi cr7,r0,0 ffc1bd38: 40 9e ff 74 bne+ cr7,ffc1bcac <_Timer_server_Schedule_operation_method+0x64> _Timer_server_Reset_tod_system_watchdog( ts ); ffc1bd3c: 7f e3 fb 78 mr r3,r31 ffc1bd40: 4b ff fc 1d bl ffc1b95c <_Timer_server_Reset_tod_system_watchdog> } } _Thread_Enable_dispatch(); ffc1bd44: 48 00 3f ed bl ffc1fd30 <_Thread_Enable_dispatch> ffc1bd48: 4b ff ff 68 b ffc1bcb0 <_Timer_server_Schedule_operation_method+0x68> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1bd4c: 7c c0 00 a6 mfmsr r6 ffc1bd50: 7c 10 42 a6 mfsprg r0,0 ffc1bd54: 7c c0 00 78 andc r0,r6,r0 ffc1bd58: 7c 00 01 24 mtmsr r0 initialized = false; } #endif return status; } ffc1bd5c: 81 63 00 30 lwz r11,48(r3) ffc1bd60: 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; ffc1bd64: 3d 40 00 00 lis r10,0 last_snapshot = ts->Interval_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { ffc1bd68: 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; ffc1bd6c: 80 0a 29 1c lwz r0,10524(r10) last_snapshot = ts->Interval_watchdogs.last_snapshot; ffc1bd70: 81 03 00 3c lwz r8,60(r3) if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { ffc1bd74: 41 9e 00 20 beq- cr7,ffc1bd94 <_Timer_server_Schedule_operation_method+0x14c> /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; ffc1bd78: 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; ffc1bd7c: 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; ffc1bd80: 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) { ffc1bd84: 7f 88 38 40 cmplw cr7,r8,r7 ffc1bd88: 40 9c 00 08 bge- cr7,ffc1bd90 <_Timer_server_Schedule_operation_method+0x148> delta_interval -= delta; ffc1bd8c: 7d 48 38 50 subf r10,r8,r7 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; ffc1bd90: 91 4b 00 10 stw r10,16(r11) } ts->Interval_watchdogs.last_snapshot = snapshot; ffc1bd94: 90 1f 00 3c stw r0,60(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1bd98: 7c c0 01 24 mtmsr r6 _ISR_Enable( level ); _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); ffc1bd9c: 38 7f 00 30 addi r3,r31,48 ffc1bda0: 38 89 00 10 addi r4,r9,16 ffc1bda4: 48 00 57 15 bl ffc214b8 <_Watchdog_Insert> if ( !ts->active ) { ffc1bda8: 88 1f 00 7c lbz r0,124(r31) ffc1bdac: 2f 80 00 00 cmpwi cr7,r0,0 ffc1bdb0: 40 9e fe fc bne+ cr7,ffc1bcac <_Timer_server_Schedule_operation_method+0x64> _Timer_server_Reset_interval_system_watchdog( ts ); ffc1bdb4: 7f e3 fb 78 mr r3,r31 ffc1bdb8: 4b ff fb 11 bl ffc1b8c8 <_Timer_server_Reset_interval_system_watchdog> if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); ffc1bdbc: 48 00 3f 75 bl ffc1fd30 <_Thread_Enable_dispatch> ffc1bdc0: 4b ff fe f0 b ffc1bcb0 <_Timer_server_Schedule_operation_method+0x68> =============================================================================== ffc0ceb8 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0ceb8: 94 21 ff e0 stwu r1,-32(r1) ffc0cebc: 7c 08 02 a6 mflr r0 ffc0cec0: 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 ); } } ffc0cec4: 3f c0 00 00 lis r30,0 ffc0cec8: 3b de 2d d4 addi r30,r30,11732 void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0cecc: 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 ); } } ffc0ced0: 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 ) { ffc0ced4: 93 61 00 0c stw r27,12(r1) ffc0ced8: 7c 7b 1b 78 mr r27,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0cedc: 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 ) { ffc0cee0: 93 81 00 10 stw r28,16(r1) ffc0cee4: 7c 9c 23 78 mr r28,r4 ffc0cee8: 93 a1 00 14 stw r29,20(r1) ffc0ceec: 7c bd 2b 78 mr r29,r5 ffc0cef0: 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 ); ffc0cef4: 41 9e 00 30 beq- cr7,ffc0cf24 <_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 ) ffc0cef8: 80 1f 00 30 lwz r0,48(r31) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0cefc: 7f 63 db 78 mr r3,r27 ffc0cf00: 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 ) ffc0cf04: 2f 80 00 00 cmpwi cr7,r0,0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0cf08: 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 ) ffc0cf0c: 41 9e 00 0c beq- cr7,ffc0cf18 <_User_extensions_Fatal+0x60> (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0cf10: 7c 09 03 a6 mtctr r0 ffc0cf14: 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 ) { ffc0cf18: 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 ); ffc0cf1c: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0cf20: 40 9e ff d8 bne+ cr7,ffc0cef8 <_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 ); } } ffc0cf24: 80 01 00 24 lwz r0,36(r1) ffc0cf28: 83 61 00 0c lwz r27,12(r1) ffc0cf2c: 7c 08 03 a6 mtlr r0 ffc0cf30: 83 81 00 10 lwz r28,16(r1) ffc0cf34: 83 a1 00 14 lwz r29,20(r1) ffc0cf38: 83 c1 00 18 lwz r30,24(r1) ffc0cf3c: 83 e1 00 1c lwz r31,28(r1) ffc0cf40: 38 21 00 20 addi r1,r1,32 ffc0cf44: 4e 80 00 20 blr =============================================================================== ffc0ccc4 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { ffc0ccc4: 94 21 ff e8 stwu r1,-24(r1) ffc0ccc8: 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; ffc0cccc: 3c e0 00 00 lis r7,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0ccd0: 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; ffc0ccd4: 38 e7 20 d0 addi r7,r7,8400 ffc0ccd8: 3d 00 00 00 lis r8,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0ccdc: 93 a1 00 0c stw r29,12(r1) ffc0cce0: 3d 40 00 00 lis r10,0 ffc0cce4: 39 68 2d d4 addi r11,r8,11732 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; ffc0cce8: 83 a7 00 3c lwz r29,60(r7) ffc0ccec: 39 2a 2c b0 addi r9,r10,11440 head->previous = NULL; ffc0ccf0: 38 00 00 00 li r0,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0ccf4: 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 ) { ffc0ccf8: 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; ffc0ccfc: 38 ab 00 04 addi r5,r11,4 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0cd00: 93 81 00 08 stw r28,8(r1) ffc0cd04: 38 c9 00 04 addi r6,r9,4 ffc0cd08: 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; ffc0cd0c: 83 c7 00 38 lwz r30,56(r7) ffc0cd10: 90 a8 2d d4 stw r5,11732(r8) head->previous = NULL; ffc0cd14: 90 0b 00 04 stw r0,4(r11) tail->previous = head; ffc0cd18: 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; ffc0cd1c: 90 ca 2c b0 stw r6,11440(r10) head->previous = NULL; ffc0cd20: 90 09 00 04 stw r0,4(r9) tail->previous = head; ffc0cd24: 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 ) { ffc0cd28: 41 9e 00 8c beq- cr7,ffc0cdb4 <_User_extensions_Handler_initialization+0xf0><== NEVER TAKEN extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ffc0cd2c: 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( ffc0cd30: 7f 83 e3 78 mr r3,r28 ffc0cd34: 48 00 08 c5 bl ffc0d5f8 <_Workspace_Allocate_or_fatal_error> number_of_extensions * sizeof( User_extensions_Control ) ); memset ( ffc0cd38: 38 80 00 00 li r4,0 ffc0cd3c: 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( ffc0cd40: 7c 7f 1b 78 mr r31,r3 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( ffc0cd44: 48 00 73 61 bl ffc140a4 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0cd48: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0cd4c: 41 9e 00 68 beq- cr7,ffc0cdb4 <_User_extensions_Handler_initialization+0xf0><== NEVER TAKEN ffc0cd50: 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; ffc0cd54: 7f a9 eb 78 mr r9,r29 #include #include #include #include void _User_extensions_Handler_initialization(void) ffc0cd58: 57 80 28 34 rlwinm r0,r28,5,0,26 ffc0cd5c: 7d 09 00 6e lwzux r8,r9,r0 _User_extensions_Add_set( extension ); ffc0cd60: 7f e3 fb 78 mr r3,r31 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0cd64: 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; ffc0cd68: 81 49 00 04 lwz r10,4(r9) ffc0cd6c: 81 69 00 08 lwz r11,8(r9) ffc0cd70: 80 09 00 0c lwz r0,12(r9) ffc0cd74: 91 1f 00 14 stw r8,20(r31) ffc0cd78: 91 5f 00 18 stw r10,24(r31) ffc0cd7c: 91 7f 00 1c stw r11,28(r31) ffc0cd80: 90 1f 00 20 stw r0,32(r31) ffc0cd84: 81 09 00 10 lwz r8,16(r9) ffc0cd88: 81 49 00 14 lwz r10,20(r9) ffc0cd8c: 81 69 00 18 lwz r11,24(r9) ffc0cd90: 80 09 00 1c lwz r0,28(r9) ffc0cd94: 91 1f 00 24 stw r8,36(r31) ffc0cd98: 91 5f 00 28 stw r10,40(r31) ffc0cd9c: 91 7f 00 2c stw r11,44(r31) ffc0cda0: 90 1f 00 30 stw r0,48(r31) _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; ffc0cda4: 3b ff 00 34 addi r31,r31,52 _User_extensions_Add_set( extension ); ffc0cda8: 48 00 41 51 bl ffc10ef8 <_User_extensions_Add_set> extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0cdac: 7f 9e e0 40 cmplw cr7,r30,r28 ffc0cdb0: 41 9d ff a4 bgt+ cr7,ffc0cd54 <_User_extensions_Handler_initialization+0x90> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; } } } ffc0cdb4: 80 01 00 1c lwz r0,28(r1) ffc0cdb8: 83 81 00 08 lwz r28,8(r1) ffc0cdbc: 7c 08 03 a6 mtlr r0 ffc0cdc0: 83 a1 00 0c lwz r29,12(r1) ffc0cdc4: 83 c1 00 10 lwz r30,16(r1) ffc0cdc8: 83 e1 00 14 lwz r31,20(r1) ffc0cdcc: 38 21 00 18 addi r1,r1,24 ffc0cdd0: 4e 80 00 20 blr =============================================================================== ffc0cdd4 <_User_extensions_Thread_begin>: #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cdd4: 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 ); } } ffc0cdd8: 3d 20 00 00 lis r9,0 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cddc: 7c 08 02 a6 mflr r0 ffc0cde0: 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 ); } } ffc0cde4: 3b c9 2d d4 addi r30,r9,11732 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0cde8: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cdec: 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 ); } } ffc0cdf0: 83 e9 2d d4 lwz r31,11732(r9) #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0cdf4: 93 a1 00 0c stw r29,12(r1) ffc0cdf8: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0cdfc: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0ce00: 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 ); ffc0ce04: 41 9e 00 28 beq- cr7,ffc0ce2c <_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 ) ffc0ce08: 80 1f 00 28 lwz r0,40(r31) (*the_extension->Callouts.thread_begin)( executing ); ffc0ce0c: 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 ) ffc0ce10: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ce14: 41 9e 00 0c beq- cr7,ffc0ce20 <_User_extensions_Thread_begin+0x4c> (*the_extension->Callouts.thread_begin)( executing ); ffc0ce18: 7c 09 03 a6 mtctr r0 ffc0ce1c: 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 ) { ffc0ce20: 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 ); ffc0ce24: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0ce28: 40 9e ff e0 bne+ cr7,ffc0ce08 <_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 ); } } ffc0ce2c: 80 01 00 1c lwz r0,28(r1) ffc0ce30: 83 a1 00 0c lwz r29,12(r1) ffc0ce34: 7c 08 03 a6 mtlr r0 ffc0ce38: 83 c1 00 10 lwz r30,16(r1) ffc0ce3c: 83 e1 00 14 lwz r31,20(r1) ffc0ce40: 38 21 00 18 addi r1,r1,24 ffc0ce44: 4e 80 00 20 blr =============================================================================== ffc0cf48 <_User_extensions_Thread_create>: #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf48: 94 21 ff e8 stwu r1,-24(r1) return false; } } return true; } ffc0cf4c: 3d 20 00 00 lis r9,0 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf50: 7c 08 02 a6 mflr r0 ffc0cf54: 93 c1 00 10 stw r30,16(r1) return false; } } return true; } ffc0cf58: 3b c9 2d d4 addi r30,r9,11732 { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0cf5c: 3b de 00 04 addi r30,r30,4 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf60: 93 e1 00 14 stw r31,20(r1) return false; } } return true; } ffc0cf64: 83 e9 2d d4 lwz r31,11732(r9) #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf68: 93 a1 00 0c stw r29,12(r1) ffc0cf6c: 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 ); ffc0cf70: 7f 9f f0 00 cmpw cr7,r31,r30 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf74: 90 01 00 1c stw r0,28(r1) if ( !status ) return false; } } return true; ffc0cf78: 38 60 00 01 li r3,1 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0cf7c: 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 ); ffc0cf80: 41 9e 00 40 beq- cr7,ffc0cfc0 <_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)( ffc0cf84: 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 ) { ffc0cf88: 80 1f 00 14 lwz r0,20(r31) status = (*the_extension->Callouts.thread_create)( ffc0cf8c: 39 3c 31 24 addi r9,r28,12580 ffc0cf90: 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 ) { ffc0cf94: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cf98: 41 9e 00 18 beq- cr7,ffc0cfb0 <_User_extensions_Thread_create+0x68> status = (*the_extension->Callouts.thread_create)( ffc0cf9c: 80 69 00 0c lwz r3,12(r9) ffc0cfa0: 7c 09 03 a6 mtctr r0 ffc0cfa4: 4e 80 04 21 bctrl _Thread_Executing, the_thread ); if ( !status ) ffc0cfa8: 2f 83 00 00 cmpwi cr7,r3,0 ffc0cfac: 41 9e 00 34 beq- cr7,ffc0cfe0 <_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 ) { ffc0cfb0: 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 ); ffc0cfb4: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0cfb8: 40 9e ff d0 bne+ cr7,ffc0cf88 <_User_extensions_Thread_create+0x40> if ( !status ) return false; } } return true; ffc0cfbc: 38 60 00 01 li r3,1 } ffc0cfc0: 80 01 00 1c lwz r0,28(r1) ffc0cfc4: 83 81 00 08 lwz r28,8(r1) ffc0cfc8: 7c 08 03 a6 mtlr r0 ffc0cfcc: 83 a1 00 0c lwz r29,12(r1) ffc0cfd0: 83 c1 00 10 lwz r30,16(r1) ffc0cfd4: 83 e1 00 14 lwz r31,20(r1) ffc0cfd8: 38 21 00 18 addi r1,r1,24 ffc0cfdc: 4e 80 00 20 blr ffc0cfe0: 80 01 00 1c lwz r0,28(r1) status = (*the_extension->Callouts.thread_create)( _Thread_Executing, the_thread ); if ( !status ) return false; ffc0cfe4: 38 60 00 00 li r3,0 } } return true; } ffc0cfe8: 83 81 00 08 lwz r28,8(r1) ffc0cfec: 7c 08 03 a6 mtlr r0 ffc0cff0: 83 a1 00 0c lwz r29,12(r1) ffc0cff4: 83 c1 00 10 lwz r30,16(r1) ffc0cff8: 83 e1 00 14 lwz r31,20(r1) ffc0cffc: 38 21 00 18 addi r1,r1,24 ffc0d000: 4e 80 00 20 blr =============================================================================== ffc0d004 <_User_extensions_Thread_delete>: #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0d004: 94 21 ff e8 stwu r1,-24(r1) ffc0d008: 7c 08 02 a6 mflr r0 ffc0d00c: 93 c1 00 10 stw r30,16(r1) (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } ffc0d010: 3f c0 00 00 lis r30,0 ffc0d014: 3b de 2d d4 addi r30,r30,11732 #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0d018: 93 e1 00 14 stw r31,20(r1) (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } ffc0d01c: 83 fe 00 08 lwz r31,8(r30) #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0d020: 93 a1 00 0c stw r29,12(r1) ffc0d024: 7c 7d 1b 78 mr r29,r3 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 #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0d02c: 90 01 00 1c stw r0,28(r1) ffc0d030: 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 ); ffc0d034: 41 9e 00 34 beq- cr7,ffc0d068 <_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)( ffc0d038: 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 ) ffc0d03c: 80 1f 00 20 lwz r0,32(r31) (*the_extension->Callouts.thread_delete)( ffc0d040: 39 3c 31 24 addi r9,r28,12580 ffc0d044: 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 ) ffc0d048: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d04c: 41 9e 00 10 beq- cr7,ffc0d05c <_User_extensions_Thread_delete+0x58> (*the_extension->Callouts.thread_delete)( ffc0d050: 80 69 00 0c lwz r3,12(r9) ffc0d054: 7c 09 03 a6 mtctr r0 ffc0d058: 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 ) { ffc0d05c: 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 ); ffc0d060: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d064: 40 9e ff d8 bne+ cr7,ffc0d03c <_User_extensions_Thread_delete+0x38> (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } ffc0d068: 80 01 00 1c lwz r0,28(r1) ffc0d06c: 83 81 00 08 lwz r28,8(r1) ffc0d070: 7c 08 03 a6 mtlr r0 ffc0d074: 83 a1 00 0c lwz r29,12(r1) ffc0d078: 83 c1 00 10 lwz r30,16(r1) ffc0d07c: 83 e1 00 14 lwz r31,20(r1) ffc0d080: 38 21 00 18 addi r1,r1,24 ffc0d084: 4e 80 00 20 blr =============================================================================== ffc0ce48 <_User_extensions_Thread_exitted>: void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0ce48: 94 21 ff e8 stwu r1,-24(r1) ffc0ce4c: 7c 08 02 a6 mflr r0 ffc0ce50: 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 ); } } ffc0ce54: 3f c0 00 00 lis r30,0 ffc0ce58: 3b de 2d d4 addi r30,r30,11732 } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0ce5c: 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 ); } } ffc0ce60: 83 fe 00 08 lwz r31,8(r30) } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0ce64: 93 a1 00 0c stw r29,12(r1) ffc0ce68: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0ce6c: 7f 9f f0 00 cmpw cr7,r31,r30 } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0ce70: 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 ); ffc0ce74: 41 9e 00 28 beq- cr7,ffc0ce9c <_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 ) ffc0ce78: 80 1f 00 2c lwz r0,44(r31) (*the_extension->Callouts.thread_exitted)( executing ); ffc0ce7c: 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 ) ffc0ce80: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ce84: 41 9e 00 0c beq- cr7,ffc0ce90 <_User_extensions_Thread_exitted+0x48> (*the_extension->Callouts.thread_exitted)( executing ); ffc0ce88: 7c 09 03 a6 mtctr r0 ffc0ce8c: 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 ) { ffc0ce90: 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 ); ffc0ce94: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0ce98: 40 9e ff e0 bne+ cr7,ffc0ce78 <_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 ); } } ffc0ce9c: 80 01 00 1c lwz r0,28(r1) ffc0cea0: 83 a1 00 0c lwz r29,12(r1) ffc0cea4: 7c 08 03 a6 mtlr r0 ffc0cea8: 83 c1 00 10 lwz r30,16(r1) ffc0ceac: 83 e1 00 14 lwz r31,20(r1) ffc0ceb0: 38 21 00 18 addi r1,r1,24 ffc0ceb4: 4e 80 00 20 blr =============================================================================== ffc0e1ec <_User_extensions_Thread_restart>: #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1ec: 94 21 ff e8 stwu r1,-24(r1) (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e1f0: 3d 20 00 00 lis r9,0 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1f4: 7c 08 02 a6 mflr r0 ffc0e1f8: 93 c1 00 10 stw r30,16(r1) (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e1fc: 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 ); ffc0e200: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e204: 93 e1 00 14 stw r31,20(r1) (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e208: 83 e9 2e 34 lwz r31,11828(r9) #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e20c: 93 a1 00 0c stw r29,12(r1) ffc0e210: 7c 7d 1b 78 mr r29,r3 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 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e218: 90 01 00 1c stw r0,28(r1) ffc0e21c: 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 ); ffc0e220: 41 9e 00 34 beq- cr7,ffc0e254 <_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)( ffc0e224: 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 ) ffc0e228: 80 1f 00 1c lwz r0,28(r31) (*the_extension->Callouts.thread_restart)( ffc0e22c: 39 3c 31 84 addi r9,r28,12676 ffc0e230: 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 ) ffc0e234: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e238: 41 9e 00 10 beq- cr7,ffc0e248 <_User_extensions_Thread_restart+0x5c> (*the_extension->Callouts.thread_restart)( ffc0e23c: 80 69 00 0c lwz r3,12(r9) ffc0e240: 7c 09 03 a6 mtctr r0 ffc0e244: 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 ) { ffc0e248: 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 ); ffc0e24c: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0e250: 40 9e ff d8 bne+ cr7,ffc0e228 <_User_extensions_Thread_restart+0x3c> (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e254: 80 01 00 1c lwz r0,28(r1) ffc0e258: 83 81 00 08 lwz r28,8(r1) ffc0e25c: 7c 08 03 a6 mtlr r0 ffc0e260: 83 a1 00 0c lwz r29,12(r1) ffc0e264: 83 c1 00 10 lwz r30,16(r1) ffc0e268: 83 e1 00 14 lwz r31,20(r1) ffc0e26c: 38 21 00 18 addi r1,r1,24 ffc0e270: 4e 80 00 20 blr =============================================================================== ffc0d088 <_User_extensions_Thread_start>: #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d088: 94 21 ff e8 stwu r1,-24(r1) (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d08c: 3d 20 00 00 lis r9,0 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d090: 7c 08 02 a6 mflr r0 ffc0d094: 93 c1 00 10 stw r30,16(r1) (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d098: 3b c9 2d d4 addi r30,r9,11732 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d09c: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d0a0: 93 e1 00 14 stw r31,20(r1) (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d0a4: 83 e9 2d d4 lwz r31,11732(r9) #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d0a8: 93 a1 00 0c stw r29,12(r1) ffc0d0ac: 7c 7d 1b 78 mr r29,r3 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 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d0b4: 90 01 00 1c stw r0,28(r1) ffc0d0b8: 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 ); ffc0d0bc: 41 9e 00 34 beq- cr7,ffc0d0f0 <_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)( ffc0d0c0: 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 ) ffc0d0c4: 80 1f 00 18 lwz r0,24(r31) (*the_extension->Callouts.thread_start)( ffc0d0c8: 39 3c 31 24 addi r9,r28,12580 ffc0d0cc: 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 ) ffc0d0d0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d0d4: 41 9e 00 10 beq- cr7,ffc0d0e4 <_User_extensions_Thread_start+0x5c> (*the_extension->Callouts.thread_start)( ffc0d0d8: 80 69 00 0c lwz r3,12(r9) ffc0d0dc: 7c 09 03 a6 mtctr r0 ffc0d0e0: 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 ) { ffc0d0e4: 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 ); ffc0d0e8: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d0ec: 40 9e ff d8 bne+ cr7,ffc0d0c4 <_User_extensions_Thread_start+0x3c> (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d0f0: 80 01 00 1c lwz r0,28(r1) ffc0d0f4: 83 81 00 08 lwz r28,8(r1) ffc0d0f8: 7c 08 03 a6 mtlr r0 ffc0d0fc: 83 a1 00 0c lwz r29,12(r1) ffc0d100: 83 c1 00 10 lwz r30,16(r1) ffc0d104: 83 e1 00 14 lwz r31,20(r1) ffc0d108: 38 21 00 18 addi r1,r1,24 ffc0d10c: 4e 80 00 20 blr =============================================================================== ffc0d110 <_User_extensions_Thread_switch>: void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d110: 94 21 ff e8 stwu r1,-24(r1) the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d114: 3d 20 00 00 lis r9,0 void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d118: 7c 08 02 a6 mflr r0 ffc0d11c: 93 c1 00 10 stw r30,16(r1) the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d120: 3b c9 2c b0 addi r30,r9,11440 ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); ffc0d124: 3b de 00 04 addi r30,r30,4 void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d128: 93 e1 00 14 stw r31,20(r1) the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d12c: 83 e9 2c b0 lwz r31,11440(r9) void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d130: 93 81 00 08 stw r28,8(r1) ffc0d134: 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 ); ffc0d138: 7f 9f f0 00 cmpw cr7,r31,r30 void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d13c: 93 a1 00 0c stw r29,12(r1) ffc0d140: 7c 9d 23 78 mr r29,r4 ffc0d144: 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 ); ffc0d148: 41 9e 00 24 beq- cr7,ffc0d16c <_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 ); ffc0d14c: 80 1f 00 08 lwz r0,8(r31) ffc0d150: 7f 83 e3 78 mr r3,r28 ffc0d154: 7f a4 eb 78 mr r4,r29 ffc0d158: 7c 09 03 a6 mtctr r0 ffc0d15c: 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 ) { ffc0d160: 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 ); ffc0d164: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d168: 40 9e ff e4 bne+ cr7,ffc0d14c <_User_extensions_Thread_switch+0x3c> the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d16c: 80 01 00 1c lwz r0,28(r1) ffc0d170: 83 81 00 08 lwz r28,8(r1) ffc0d174: 7c 08 03 a6 mtlr r0 ffc0d178: 83 a1 00 0c lwz r29,12(r1) ffc0d17c: 83 c1 00 10 lwz r30,16(r1) ffc0d180: 83 e1 00 14 lwz r31,20(r1) ffc0d184: 38 21 00 18 addi r1,r1,24 ffc0d188: 4e 80 00 20 blr =============================================================================== ffc0f650 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { ffc0f650: 94 21 ff e0 stwu r1,-32(r1) ffc0f654: 7c 08 02 a6 mflr r0 ffc0f658: 93 c1 00 18 stw r30,24(r1) ffc0f65c: 7c be 2b 78 mr r30,r5 ffc0f660: 93 e1 00 1c stw r31,28(r1) ffc0f664: 7c 7f 1b 78 mr r31,r3 ffc0f668: 90 01 00 24 stw r0,36(r1) ffc0f66c: 93 61 00 0c stw r27,12(r1) ffc0f670: 93 81 00 10 stw r28,16(r1) ffc0f674: 93 a1 00 14 stw r29,20(r1) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0f678: 7c 00 00 a6 mfmsr r0 ffc0f67c: 7d 30 42 a6 mfsprg r9,0 ffc0f680: 7c 09 48 78 andc r9,r0,r9 ffc0f684: 7d 20 01 24 mtmsr r9 } } _ISR_Enable( level ); } ffc0f688: 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 ); ffc0f68c: 3b 83 00 04 addi r28,r3,4 Watchdog_Interval units ) { ISR_Level level; _ISR_Disable( level ); ffc0f690: 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 ) ) { ffc0f694: 7f 89 e0 00 cmpw cr7,r9,r28 ffc0f698: 41 9e 00 74 beq- cr7,ffc0f70c <_Watchdog_Adjust+0xbc> switch ( direction ) { ffc0f69c: 2f 84 00 00 cmpwi cr7,r4,0 ffc0f6a0: 40 9e 00 94 bne- cr7,ffc0f734 <_Watchdog_Adjust+0xe4> case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0f6a4: 2f 85 00 00 cmpwi cr7,r5,0 ffc0f6a8: 7c 0b 03 78 mr r11,r0 ffc0f6ac: 41 9e 00 60 beq- cr7,ffc0f70c <_Watchdog_Adjust+0xbc> <== NEVER TAKEN if ( units < _Watchdog_First( header )->delta_interval ) { ffc0f6b0: 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; ffc0f6b4: 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 ) { ffc0f6b8: 7f 85 e8 40 cmplw cr7,r5,r29 ffc0f6bc: 40 bc 00 18 bge+ cr7,ffc0f6d4 <_Watchdog_Adjust+0x84> <== ALWAYS TAKEN ffc0f6c0: 48 00 00 b0 b ffc0f770 <_Watchdog_Adjust+0x120> <== NOT EXECUTED switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0f6c4: 41 82 00 48 beq- ffc0f70c <_Watchdog_Adjust+0xbc> <== NEVER TAKEN if ( units < _Watchdog_First( header )->delta_interval ) { ffc0f6c8: 83 a9 00 10 lwz r29,16(r9) ffc0f6cc: 7f 9d f0 40 cmplw cr7,r29,r30 ffc0f6d0: 41 9d 00 a0 bgt- cr7,ffc0f770 <_Watchdog_Adjust+0x120> _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; ffc0f6d4: 93 69 00 10 stw r27,16(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0f6d8: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); _Watchdog_Tickle( header ); ffc0f6dc: 7f e3 fb 78 mr r3,r31 ffc0f6e0: 48 00 03 3d bl ffc0fa1c <_Watchdog_Tickle> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0f6e4: 7d 60 00 a6 mfmsr r11 ffc0f6e8: 7c 10 42 a6 mfsprg r0,0 ffc0f6ec: 7d 60 00 78 andc r0,r11,r0 ffc0f6f0: 7c 00 01 24 mtmsr r0 } } _ISR_Enable( level ); } ffc0f6f4: 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 ) { ffc0f6f8: 7f dd f0 51 subf. r30,r29,r30 _Watchdog_Tickle( header ); _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) ffc0f6fc: 7f 9c 00 00 cmpw cr7,r28,r0 RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); ffc0f700: 7c 09 03 78 mr r9,r0 ffc0f704: 7d 60 5b 78 mr r0,r11 ffc0f708: 40 9e ff bc bne+ cr7,ffc0f6c4 <_Watchdog_Adjust+0x74> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0f70c: 7d 60 01 24 mtmsr r11 } } _ISR_Enable( level ); } ffc0f710: 80 01 00 24 lwz r0,36(r1) ffc0f714: 83 61 00 0c lwz r27,12(r1) ffc0f718: 7c 08 03 a6 mtlr r0 ffc0f71c: 83 81 00 10 lwz r28,16(r1) ffc0f720: 83 a1 00 14 lwz r29,20(r1) ffc0f724: 83 c1 00 18 lwz r30,24(r1) ffc0f728: 83 e1 00 1c lwz r31,28(r1) ffc0f72c: 38 21 00 20 addi r1,r1,32 ffc0f730: 4e 80 00 20 blr * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { ffc0f734: 2f 84 00 01 cmpwi cr7,r4,1 ffc0f738: 40 9e ff d4 bne+ cr7,ffc0f70c <_Watchdog_Adjust+0xbc> <== NEVER TAKEN case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; ffc0f73c: 80 09 00 10 lwz r0,16(r9) ffc0f740: 7f c0 2a 14 add r30,r0,r5 ffc0f744: 93 c9 00 10 stw r30,16(r9) ffc0f748: 7d 60 01 24 mtmsr r11 } } _ISR_Enable( level ); } ffc0f74c: 80 01 00 24 lwz r0,36(r1) ffc0f750: 83 61 00 0c lwz r27,12(r1) ffc0f754: 7c 08 03 a6 mtlr r0 ffc0f758: 83 81 00 10 lwz r28,16(r1) ffc0f75c: 83 a1 00 14 lwz r29,20(r1) ffc0f760: 83 c1 00 18 lwz r30,24(r1) ffc0f764: 83 e1 00 1c lwz r31,28(r1) ffc0f768: 38 21 00 20 addi r1,r1,32 ffc0f76c: 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; ffc0f770: 7f de e8 50 subf r30,r30,r29 ffc0f774: 93 c9 00 10 stw r30,16(r9) break; ffc0f778: 4b ff ff 94 b ffc0f70c <_Watchdog_Adjust+0xbc> =============================================================================== ffc21400 <_Watchdog_Adjust_to_chain>: { Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; if ( units <= 0 ) { ffc21400: 2c 04 00 00 cmpwi r4,0 Chain_Control *header, Watchdog_Interval units_arg, Chain_Control *to_fire ) { ffc21404: 94 21 ff f0 stwu r1,-16(r1) ffc21408: 93 e1 00 0c stw r31,12(r1) Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; if ( units <= 0 ) { ffc2140c: 41 82 00 94 beq- ffc214a0 <_Watchdog_Adjust_to_chain+0xa0> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc21410: 7c c0 00 a6 mfmsr r6 ffc21414: 7c 10 42 a6 mfsprg r0,0 ffc21418: 7c c0 00 78 andc r0,r6,r0 ffc2141c: 7c 00 01 24 mtmsr r0 return; } _ISR_Disable( level ); ffc21420: 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; ffc21424: 3b e0 00 00 li r31,0 ffc21428: 38 e3 00 04 addi r7,r3,4 ffc2142c: 39 85 00 04 addi r12,r5,4 while ( 1 ) { if ( units <= 0 ) { break; } if ( _Chain_Is_empty( header ) ) { ffc21430: 7f 89 38 00 cmpw cr7,r9,r7 ffc21434: 41 9e 00 68 beq- cr7,ffc2149c <_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 ) { ffc21438: 80 09 00 10 lwz r0,16(r9) ffc2143c: 7f 80 20 40 cmplw cr7,r0,r4 ffc21440: 41 9d 00 6c bgt- cr7,ffc214ac <_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; ffc21444: 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; ffc21448: 7c 80 20 50 subf r4,r0,r4 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc2144c: 81 09 00 00 lwz r8,0(r9) previous = the_node->previous; ffc21450: 81 49 00 04 lwz r10,4(r9) next->previous = previous; ffc21454: 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; ffc21458: 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; ffc2145c: 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; ffc21460: 91 89 00 00 stw r12,0(r9) tail->previous = the_node; old_last->next = the_node; ffc21464: 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; ffc21468: 91 25 00 08 stw r9,8(r5) old_last->next = the_node; the_node->previous = old_last; ffc2146c: 91 69 00 04 stw r11,4(r9) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc21470: 7c 00 00 a6 mfmsr r0 ffc21474: 7c c0 01 24 mtmsr r6 ffc21478: 7c 00 01 24 mtmsr r0 break; } } _ISR_Enable( level ); } ffc2147c: 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 ) ) ffc21480: 7f 87 48 00 cmpw cr7,r7,r9 ffc21484: 41 9e 00 10 beq- cr7,ffc21494 <_Watchdog_Adjust_to_chain+0x94> break; first = _Watchdog_First( header ); if ( first->delta_interval != 0 ) ffc21488: 80 09 00 10 lwz r0,16(r9) ffc2148c: 2f 80 00 00 cmpwi cr7,r0,0 ffc21490: 41 9e ff bc beq+ cr7,ffc2144c <_Watchdog_Adjust_to_chain+0x4c><== NEVER TAKEN } _ISR_Disable( level ); while ( 1 ) { if ( units <= 0 ) { ffc21494: 2f 84 00 00 cmpwi cr7,r4,0 ffc21498: 40 9e ff 98 bne+ cr7,ffc21430 <_Watchdog_Adjust_to_chain+0x30> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc2149c: 7c c0 01 24 mtmsr r6 break; } } _ISR_Enable( level ); } ffc214a0: 83 e1 00 0c lwz r31,12(r1) ffc214a4: 38 21 00 10 addi r1,r1,16 ffc214a8: 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; ffc214ac: 7c 04 00 50 subf r0,r4,r0 ffc214b0: 90 09 00 10 stw r0,16(r9) break; ffc214b4: 4b ff ff e8 b ffc2149c <_Watchdog_Adjust_to_chain+0x9c> =============================================================================== ffc0d18c <_Watchdog_Insert>: Watchdog_Control *after; uint32_t insert_isr_nest_level; Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; ffc0d18c: 3d 20 00 00 lis r9,0 ffc0d190: 80 09 31 2c lwz r0,12588(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0d194: 7c e0 00 a6 mfmsr r7 ffc0d198: 7d 30 42 a6 mfsprg r9,0 ffc0d19c: 7c e9 48 78 andc r9,r7,r9 ffc0d1a0: 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 ) { ffc0d1a4: 81 24 00 08 lwz r9,8(r4) ffc0d1a8: 2f 89 00 00 cmpwi cr7,r9,0 ffc0d1ac: 40 9e 01 0c bne- cr7,ffc0d2b8 <_Watchdog_Insert+0x12c> _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; _Watchdog_Sync_count++; ffc0d1b0: 3c a0 00 00 lis r5,0 ffc0d1b4: 81 25 28 20 lwz r9,10272(r5) if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; ffc0d1b8: 39 60 00 01 li r11,1 ffc0d1bc: 91 64 00 08 stw r11,8(r4) ffc0d1c0: 3d 80 00 00 lis r12,0 _Watchdog_Sync_count++; ffc0d1c4: 39 29 00 01 addi r9,r9,1 ffc0d1c8: 91 25 28 20 stw r9,10272(r5) restart: delta_interval = the_watchdog->initial; ffc0d1cc: 81 24 00 0c lwz r9,12(r4) RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); ffc0d1d0: 81 63 00 00 lwz r11,0(r3) for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d1d4: 2f 89 00 00 cmpwi cr7,r9,0 ffc0d1d8: 41 9e 00 98 beq- cr7,ffc0d270 <_Watchdog_Insert+0xe4> ffc0d1dc: 81 4b 00 00 lwz r10,0(r11) ffc0d1e0: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d1e4: 41 9e 00 8c beq- cr7,ffc0d270 <_Watchdog_Insert+0xe4> break; if ( delta_interval < after->delta_interval ) { ffc0d1e8: 81 4b 00 10 lwz r10,16(r11) ffc0d1ec: 7f 89 50 40 cmplw cr7,r9,r10 ffc0d1f0: 41 9c 00 d0 blt- cr7,ffc0d2c0 <_Watchdog_Insert+0x134> static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0d1f4: 7d 00 00 a6 mfmsr r8 ffc0d1f8: 7c e0 01 24 mtmsr r7 ffc0d1fc: 7d 00 01 24 mtmsr r8 delta_interval -= after->delta_interval; _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { ffc0d200: 81 04 00 08 lwz r8,8(r4) ffc0d204: 2f 88 00 01 cmpwi cr7,r8,1 ffc0d208: 40 9e 00 98 bne- cr7,ffc0d2a0 <_Watchdog_Insert+0x114> goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { ffc0d20c: 81 0c 28 10 lwz r8,10256(r12) ffc0d210: 38 cc 28 10 addi r6,r12,10256 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 if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { ffc0d218: 7f 80 40 40 cmplw cr7,r0,r8 ffc0d21c: 40 bc 00 48 bge+ cr7,ffc0d264 <_Watchdog_Insert+0xd8> ffc0d220: 48 00 00 dc b ffc0d2fc <_Watchdog_Insert+0x170> for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d224: 81 4b 00 00 lwz r10,0(r11) ffc0d228: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d22c: 41 9e 00 44 beq- cr7,ffc0d270 <_Watchdog_Insert+0xe4> break; if ( delta_interval < after->delta_interval ) { ffc0d230: 81 4b 00 10 lwz r10,16(r11) ffc0d234: 7f 8a 48 40 cmplw cr7,r10,r9 ffc0d238: 41 9d 00 88 bgt- cr7,ffc0d2c0 <_Watchdog_Insert+0x134> ffc0d23c: 7d 00 00 a6 mfmsr r8 ffc0d240: 7c e0 01 24 mtmsr r7 ffc0d244: 7d 00 01 24 mtmsr r8 delta_interval -= after->delta_interval; _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { ffc0d248: 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; ffc0d24c: 7d 2a 48 50 subf r9,r10,r9 _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { ffc0d250: 2f 88 00 01 cmpwi cr7,r8,1 ffc0d254: 40 9e 00 4c bne- cr7,ffc0d2a0 <_Watchdog_Insert+0x114> <== NEVER TAKEN goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { ffc0d258: 81 46 00 00 lwz r10,0(r6) ffc0d25c: 7f 80 50 40 cmplw cr7,r0,r10 ffc0d260: 41 9c 00 9c blt- cr7,ffc0d2fc <_Watchdog_Insert+0x170> <== NEVER TAKEN for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d264: 2f 89 00 00 cmpwi cr7,r9,0 exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; _Watchdog_Sync_count--; _ISR_Enable( level ); } ffc0d268: 81 6b 00 00 lwz r11,0(r11) for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d26c: 40 9e ff b8 bne+ cr7,ffc0d224 <_Watchdog_Insert+0x98> _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); ffc0d270: 81 6b 00 04 lwz r11,4(r11) the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d274: 3d 00 00 00 lis r8,0 ffc0d278: 81 08 28 24 lwz r8,10276(r8) RTEMS_INLINE_ROUTINE void _Watchdog_Activate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_ACTIVE; ffc0d27c: 38 c0 00 02 li r6,2 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0d280: 81 4b 00 00 lwz r10,0(r11) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0d284: 91 64 00 04 stw r11,4(r4) ffc0d288: 90 c4 00 08 stw r6,8(r4) } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; ffc0d28c: 91 24 00 10 stw r9,16(r4) before_node = after_node->next; after_node->next = the_node; ffc0d290: 90 8b 00 00 stw r4,0(r11) the_node->next = before_node; before_node->previous = the_node; ffc0d294: 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; ffc0d298: 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; ffc0d29c: 91 04 00 14 stw r8,20(r4) exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; ffc0d2a0: 90 0c 28 10 stw r0,10256(r12) _Watchdog_Sync_count--; ffc0d2a4: 81 25 28 20 lwz r9,10272(r5) ffc0d2a8: 38 09 ff ff addi r0,r9,-1 ffc0d2ac: 90 05 28 20 stw r0,10272(r5) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0d2b0: 7c e0 01 24 mtmsr r7 ffc0d2b4: 4e 80 00 20 blr ffc0d2b8: 7c e0 01 24 mtmsr r7 ffc0d2bc: 4e 80 00 20 blr if ( delta_interval == 0 || !_Watchdog_Next( after ) ) break; if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; ffc0d2c0: 7d 49 50 50 subf r10,r9,r10 ffc0d2c4: 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; ffc0d2c8: 3d 00 00 00 lis r8,0 ffc0d2cc: 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 ); ffc0d2d0: 81 6b 00 04 lwz r11,4(r11) the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d2d4: 81 08 28 24 lwz r8,10276(r8) ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0d2d8: 81 4b 00 00 lwz r10,0(r11) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0d2dc: 91 64 00 04 stw r11,4(r4) ffc0d2e0: 90 c4 00 08 stw r6,8(r4) } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; ffc0d2e4: 91 24 00 10 stw r9,16(r4) before_node = after_node->next; after_node->next = the_node; ffc0d2e8: 90 8b 00 00 stw r4,0(r11) the_node->next = before_node; before_node->previous = the_node; ffc0d2ec: 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; ffc0d2f0: 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; ffc0d2f4: 91 04 00 14 stw r8,20(r4) ffc0d2f8: 4b ff ff a8 b ffc0d2a0 <_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; ffc0d2fc: 90 0c 28 10 stw r0,10256(r12) goto restart; ffc0d300: 4b ff fe cc b ffc0d1cc <_Watchdog_Insert+0x40> =============================================================================== ffc0d35c <_Watchdog_Remove>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0d35c: 7d 20 00 a6 mfmsr r9 ffc0d360: 7c 10 42 a6 mfsprg r0,0 ffc0d364: 7d 20 00 78 andc r0,r9,r0 ffc0d368: 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; ffc0d36c: 80 03 00 08 lwz r0,8(r3) switch ( previous_state ) { ffc0d370: 2f 80 00 01 cmpwi cr7,r0,1 ffc0d374: 41 9e 00 98 beq- cr7,ffc0d40c <_Watchdog_Remove+0xb0> ffc0d378: 2b 80 00 01 cmplwi cr7,r0,1 ffc0d37c: 40 9c 00 1c bge- cr7,ffc0d398 <_Watchdog_Remove+0x3c> _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; ffc0d380: 3d 60 00 00 lis r11,0 ffc0d384: 81 6b 28 24 lwz r11,10276(r11) ffc0d388: 91 63 00 18 stw r11,24(r3) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0d38c: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d390: 7c 03 03 78 mr r3,r0 ffc0d394: 4e 80 00 20 blr Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; switch ( previous_state ) { ffc0d398: 2b 80 00 03 cmplwi cr7,r0,3 ffc0d39c: 41 bd ff e4 bgt- cr7,ffc0d380 <_Watchdog_Remove+0x24> <== NEVER TAKEN } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; _ISR_Enable( level ); return( previous_state ); } ffc0d3a0: 81 63 00 00 lwz r11,0(r3) break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; ffc0d3a4: 39 00 00 00 li r8,0 ffc0d3a8: 91 03 00 08 stw r8,8(r3) next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) ffc0d3ac: 81 4b 00 00 lwz r10,0(r11) ffc0d3b0: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d3b4: 41 9e 00 14 beq- cr7,ffc0d3c8 <_Watchdog_Remove+0x6c> next_watchdog->delta_interval += the_watchdog->delta_interval; ffc0d3b8: 81 0b 00 10 lwz r8,16(r11) ffc0d3bc: 81 43 00 10 lwz r10,16(r3) ffc0d3c0: 7d 48 52 14 add r10,r8,r10 ffc0d3c4: 91 4b 00 10 stw r10,16(r11) if ( _Watchdog_Sync_count ) ffc0d3c8: 3d 40 00 00 lis r10,0 ffc0d3cc: 81 4a 28 20 lwz r10,10272(r10) ffc0d3d0: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d3d4: 41 9e 00 14 beq- cr7,ffc0d3e8 <_Watchdog_Remove+0x8c> _Watchdog_Sync_level = _ISR_Nest_level; ffc0d3d8: 3d 40 00 00 lis r10,0 ffc0d3dc: 81 0a 31 2c lwz r8,12588(r10) ffc0d3e0: 3d 40 00 00 lis r10,0 ffc0d3e4: 91 0a 28 10 stw r8,10256(r10) { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; ffc0d3e8: 81 43 00 04 lwz r10,4(r3) next->previous = previous; ffc0d3ec: 91 4b 00 04 stw r10,4(r11) previous->next = next; ffc0d3f0: 91 6a 00 00 stw r11,0(r10) _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; ffc0d3f4: 3d 60 00 00 lis r11,0 ffc0d3f8: 81 6b 28 24 lwz r11,10276(r11) ffc0d3fc: 91 63 00 18 stw r11,24(r3) ffc0d400: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d404: 7c 03 03 78 mr r3,r0 ffc0d408: 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; ffc0d40c: 39 60 00 00 li r11,0 ffc0d410: 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; ffc0d414: 3d 60 00 00 lis r11,0 ffc0d418: 81 6b 28 24 lwz r11,10276(r11) ffc0d41c: 91 63 00 18 stw r11,24(r3) ffc0d420: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d424: 7c 03 03 78 mr r3,r0 ffc0d428: 4e 80 00 20 blr =============================================================================== ffc0ed5c <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { ffc0ed5c: 94 21 ff e8 stwu r1,-24(r1) ffc0ed60: 7c 08 02 a6 mflr r0 ffc0ed64: 93 c1 00 10 stw r30,16(r1) ffc0ed68: 7c 7e 1b 78 mr r30,r3 ffc0ed6c: 93 e1 00 14 stw r31,20(r1) ffc0ed70: 7c 9f 23 78 mr r31,r4 ffc0ed74: 90 01 00 1c stw r0,28(r1) ffc0ed78: 93 81 00 08 stw r28,8(r1) ffc0ed7c: 93 a1 00 0c stw r29,12(r1) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0ed80: 7f a0 00 a6 mfmsr r29 ffc0ed84: 7c 10 42 a6 mfsprg r0,0 ffc0ed88: 7f a0 00 78 andc r0,r29,r0 ffc0ed8c: 7c 00 01 24 mtmsr r0 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); ffc0ed90: 3c 60 ff c2 lis r3,-62 ffc0ed94: 7f e5 fb 78 mr r5,r31 ffc0ed98: 38 63 2c 60 addi r3,r3,11360 ffc0ed9c: 7f c4 f3 78 mr r4,r30 ffc0eda0: 4c c6 31 82 crclr 4*cr1+eq ffc0eda4: 4b ff 7e f1 bl ffc06c94 printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } ffc0eda8: 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 ); ffc0edac: 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 ) ) { ffc0edb0: 7f 9c f8 00 cmpw cr7,r28,r31 ffc0edb4: 41 9e 00 54 beq- cr7,ffc0ee08 <_Watchdog_Report_chain+0xac> node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); ffc0edb8: 7f 84 e3 78 mr r4,r28 ffc0edbc: 38 60 00 00 li r3,0 ffc0edc0: 48 00 00 5d bl ffc0ee1c <_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 ) ffc0edc4: 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 ) ; ffc0edc8: 7f 9c f8 00 cmpw cr7,r28,r31 ffc0edcc: 40 9e ff ec bne+ cr7,ffc0edb8 <_Watchdog_Report_chain+0x5c><== NEVER TAKEN { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); ffc0edd0: 3c 60 ff c2 lis r3,-62 ffc0edd4: 38 63 2c 78 addi r3,r3,11384 ffc0edd8: 7f c4 f3 78 mr r4,r30 ffc0eddc: 4c c6 31 82 crclr 4*cr1+eq ffc0ede0: 4b ff 7e b5 bl ffc06c94 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0ede4: 7f a0 01 24 mtmsr r29 } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } ffc0ede8: 80 01 00 1c lwz r0,28(r1) ffc0edec: 83 81 00 08 lwz r28,8(r1) ffc0edf0: 7c 08 03 a6 mtlr r0 ffc0edf4: 83 a1 00 0c lwz r29,12(r1) ffc0edf8: 83 c1 00 10 lwz r30,16(r1) ffc0edfc: 83 e1 00 14 lwz r31,20(r1) ffc0ee00: 38 21 00 18 addi r1,r1,24 ffc0ee04: 4e 80 00 20 blr _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); ffc0ee08: 3c 60 ff c2 lis r3,-62 ffc0ee0c: 38 63 2c 88 addi r3,r3,11400 ffc0ee10: 4c c6 31 82 crclr 4*cr1+eq ffc0ee14: 4b ff 7e 81 bl ffc06c94 ffc0ee18: 4b ff ff cc b ffc0ede4 <_Watchdog_Report_chain+0x88> =============================================================================== ffc08e20 : int adjtime( struct timeval *delta, struct timeval *olddelta ) { ffc08e20: 94 21 ff d8 stwu r1,-40(r1) ffc08e24: 7d 80 00 26 mfcr r12 ffc08e28: 7c 08 02 a6 mflr r0 ffc08e2c: 93 e1 00 24 stw r31,36(r1) long adjustment; /* * Simple validations */ if ( !delta ) ffc08e30: 7c 7f 1b 79 mr. r31,r3 int adjtime( struct timeval *delta, struct timeval *olddelta ) { ffc08e34: 93 c1 00 20 stw r30,32(r1) ffc08e38: 7c 9e 23 78 mr r30,r4 ffc08e3c: 90 01 00 2c stw r0,44(r1) ffc08e40: 93 a1 00 1c stw r29,28(r1) ffc08e44: 91 81 00 18 stw r12,24(r1) long adjustment; /* * Simple validations */ if ( !delta ) ffc08e48: 41 82 01 78 beq- ffc08fc0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) ffc08e4c: 81 3f 00 04 lwz r9,4(r31) ffc08e50: 3c 00 00 0f lis r0,15 ffc08e54: 60 00 42 3f ori r0,r0,16959 ffc08e58: 7f 89 00 40 cmplw cr7,r9,r0 ffc08e5c: 41 9d 01 64 bgt- cr7,ffc08fc0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { ffc08e60: 2e 04 00 00 cmpwi cr4,r4,0 ffc08e64: 41 92 00 14 beq- cr4,ffc08e78 olddelta->tv_sec = 0; ffc08e68: 38 00 00 00 li r0,0 olddelta->tv_usec = 0; ffc08e6c: 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; ffc08e70: 90 04 00 00 stw r0,0(r4) olddelta->tv_usec = 0; ffc08e74: 81 3f 00 04 lwz r9,4(r31) } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); ffc08e78: 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; ffc08e7c: 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); ffc08e80: 54 0a 40 2e rlwinm r10,r0,8,0,23 ffc08e84: 54 0b 18 38 rlwinm r11,r0,3,0,28 ffc08e88: 7d 6b 50 50 subf r11,r11,r10 ffc08e8c: 55 6a 30 32 rlwinm r10,r11,6,0,25 ffc08e90: 7d 6b 50 50 subf r11,r11,r10 ffc08e94: 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() ) ffc08e98: 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); ffc08e9c: 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() ) ffc08ea0: 81 4b 20 dc lwz r10,8412(r11) olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); adjustment += delta->tv_usec; ffc08ea4: 7d 29 02 14 add r9,r9,r0 /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) ffc08ea8: 7f 89 50 40 cmplw cr7,r9,r10 ffc08eac: 40 9c 00 28 bge- cr7,ffc08ed4 /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; } ffc08eb0: 80 01 00 2c lwz r0,44(r1) ffc08eb4: 81 81 00 18 lwz r12,24(r1) ffc08eb8: 7c 08 03 a6 mtlr r0 ffc08ebc: 83 a1 00 1c lwz r29,28(r1) ffc08ec0: 83 c1 00 20 lwz r30,32(r1) ffc08ec4: 7d 80 81 20 mtcrf 8,r12 ffc08ec8: 83 e1 00 24 lwz r31,36(r1) ffc08ecc: 38 21 00 28 addi r1,r1,40 ffc08ed0: 4e 80 00 20 blr rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc08ed4: 3d 20 00 00 lis r9,0 ffc08ed8: 81 69 29 28 lwz r11,10536(r9) ffc08edc: 38 0b 00 01 addi r0,r11,1 ffc08ee0: 90 09 29 28 stw r0,10536(r9) * This prevents context switches while we are adjusting the TOD */ _Thread_Disable_dispatch(); _TOD_Get( &ts ); ffc08ee4: 3b a1 00 08 addi r29,r1,8 ffc08ee8: 7f a3 eb 78 mr r3,r29 ffc08eec: 48 00 1f e9 bl ffc0aed4 <_TOD_Get> ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; ffc08ef0: 81 3f 00 04 lwz r9,4(r31) ffc08ef4: 80 01 00 0c lwz r0,12(r1) ffc08ef8: 1d 29 03 e8 mulli r9,r9,1000 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ffc08efc: 81 41 00 08 lwz r10,8(r1) ffc08f00: 81 7f 00 00 lwz r11,0(r31) ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; ffc08f04: 7d 29 02 14 add r9,r9,r0 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08f08: 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; ffc08f0c: 91 21 00 0c stw r9,12(r1) /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08f10: 60 00 c9 ff ori r0,r0,51711 ffc08f14: 7f 89 00 40 cmplw cr7,r9,r0 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ffc08f18: 7d 6a 5a 14 add r11,r10,r11 ffc08f1c: 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 ) { ffc08f20: 40 9d 00 20 ble- cr7,ffc08f40 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ffc08f24: 3d 29 c4 65 addis r9,r9,-15259 ffc08f28: 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 ) { ffc08f2c: 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( ffc08f30: 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 ) { ffc08f34: 41 9d ff f0 bgt+ cr7,ffc08f24 <== NEVER TAKEN ffc08f38: 91 21 00 0c stw r9,12(r1) ffc08f3c: 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) ) { ffc08f40: 3c 00 c4 65 lis r0,-15259 ffc08f44: 60 00 36 00 ori r0,r0,13824 ffc08f48: 7f 89 00 40 cmplw cr7,r9,r0 ffc08f4c: 41 9d 00 24 bgt- cr7,ffc08f70 <== NEVER TAKEN ffc08f50: 81 61 00 08 lwz r11,8(r1) ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ffc08f54: 3d 29 3b 9b addis r9,r9,15259 ffc08f58: 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) ) { ffc08f5c: 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( ffc08f60: 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) ) { ffc08f64: 40 9d ff f0 ble+ cr7,ffc08f54 ffc08f68: 91 21 00 0c stw r9,12(r1) ffc08f6c: 91 61 00 08 stw r11,8(r1) ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ts.tv_sec--; } _TOD_Set( &ts ); ffc08f70: 7f a3 eb 78 mr r3,r29 ffc08f74: 48 00 20 31 bl ffc0afa4 <_TOD_Set> _Thread_Enable_dispatch(); ffc08f78: 48 00 3c bd bl ffc0cc34 <_Thread_Enable_dispatch> /* set the user's output */ if ( olddelta ) ffc08f7c: 41 92 00 3c beq- cr4,ffc08fb8 *olddelta = *delta; return 0; } ffc08f80: 80 01 00 2c lwz r0,44(r1) /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; ffc08f84: 38 60 00 00 li r3,0 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08f88: 81 3f 00 00 lwz r9,0(r31) return 0; } ffc08f8c: 7c 08 03 a6 mtlr r0 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08f90: 81 5f 00 04 lwz r10,4(r31) return 0; } ffc08f94: 81 81 00 18 lwz r12,24(r1) _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08f98: 91 3e 00 00 stw r9,0(r30) return 0; } ffc08f9c: 7d 80 81 20 mtcrf 8,r12 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08fa0: 91 5e 00 04 stw r10,4(r30) return 0; } ffc08fa4: 83 a1 00 1c lwz r29,28(r1) ffc08fa8: 83 c1 00 20 lwz r30,32(r1) ffc08fac: 83 e1 00 24 lwz r31,36(r1) ffc08fb0: 38 21 00 28 addi r1,r1,40 ffc08fb4: 4e 80 00 20 blr /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; ffc08fb8: 38 60 00 00 li r3,0 ffc08fbc: 4b ff fe f4 b ffc08eb0 */ 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 ); ffc08fc0: 48 00 b4 3d bl ffc143fc <__errno> ffc08fc4: 38 00 00 16 li r0,22 ffc08fc8: 90 03 00 00 stw r0,0(r3) ffc08fcc: 38 60 ff ff li r3,-1 ffc08fd0: 4b ff fe e0 b ffc08eb0 =============================================================================== ffc098b4 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc098b4: 94 21 ff e8 stwu r1,-24(r1) ffc098b8: 7c 08 02 a6 mflr r0 ffc098bc: 93 e1 00 14 stw r31,20(r1) rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc098c0: 3f e0 00 00 lis r31,0 ffc098c4: 3b ff 2c 70 addi r31,r31,11376 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc098c8: 93 a1 00 0c stw r29,12(r1) ffc098cc: 7c 7d 1b 78 mr r29,r3 rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc098d0: 7f e3 fb 78 mr r3,r31 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc098d4: 90 01 00 1c stw r0,28(r1) ffc098d8: 93 c1 00 10 stw r30,16(r1) ffc098dc: 7c 9e 23 78 mr r30,r4 ffc098e0: 93 81 00 08 stw r28,8(r1) rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc098e4: 48 00 16 ad bl ffc0af90 if (fcntl (fildes, F_GETFD) < 0) { ffc098e8: 7f a3 eb 78 mr r3,r29 ffc098ec: 38 80 00 01 li r4,1 ffc098f0: 4c c6 31 82 crclr 4*cr1+eq ffc098f4: 48 00 8e b5 bl ffc127a8 ffc098f8: 2f 83 00 00 cmpwi cr7,r3,0 ffc098fc: 41 9c 01 bc blt- cr7,ffc09ab8 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) { ffc09900: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09904: 41 9e 01 08 beq- cr7,ffc09a0c pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { ffc09908: 83 9e 00 00 lwz r28,0(r30) ffc0990c: 7f 9c e8 00 cmpw cr7,r28,r29 ffc09910: 40 9e 00 e0 bne- cr7,ffc099f0 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); ffc09914: 38 7f 00 48 addi r3,r31,72 ffc09918: 7f 84 e3 78 mr r4,r28 ffc0991c: 38 a0 00 00 li r5,0 ffc09920: 48 00 03 c1 bl ffc09ce0 if (r_chain == NULL) { ffc09924: 7c 7d 1b 79 mr. r29,r3 ffc09928: 41 82 00 54 beq- ffc0997c return AIO_ALLDONE; } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); ffc0992c: 3b 9d 00 1c addi r28,r29,28 ffc09930: 7f 83 e3 78 mr r3,r28 ffc09934: 48 00 16 5d bl ffc0af90 result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); ffc09938: 7f c4 f3 78 mr r4,r30 ffc0993c: 38 7d 00 08 addi r3,r29,8 ffc09940: 48 00 09 25 bl ffc0a264 ffc09944: 7c 7e 1b 78 mr r30,r3 pthread_mutex_unlock (&r_chain->mutex); ffc09948: 7f 83 e3 78 mr r3,r28 ffc0994c: 48 00 17 11 bl ffc0b05c pthread_mutex_unlock (&aio_request_queue.mutex); ffc09950: 7f e3 fb 78 mr r3,r31 ffc09954: 48 00 17 09 bl ffc0b05c return result; } return AIO_ALLDONE; } ffc09958: 80 01 00 1c lwz r0,28(r1) ffc0995c: 7f c3 f3 78 mr r3,r30 ffc09960: 83 81 00 08 lwz r28,8(r1) ffc09964: 7c 08 03 a6 mtlr r0 ffc09968: 83 a1 00 0c lwz r29,12(r1) ffc0996c: 83 c1 00 10 lwz r30,16(r1) ffc09970: 83 e1 00 14 lwz r31,20(r1) ffc09974: 38 21 00 18 addi r1,r1,24 ffc09978: 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)) { ffc0997c: 81 3f 00 54 lwz r9,84(r31) ffc09980: 38 1f 00 58 addi r0,r31,88 ffc09984: 7f 89 00 00 cmpw cr7,r9,r0 ffc09988: 41 9e 00 58 beq- cr7,ffc099e0 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); ffc0998c: 38 7f 00 54 addi r3,r31,84 ffc09990: 7f 84 e3 78 mr r4,r28 ffc09994: 38 a0 00 00 li r5,0 ffc09998: 48 00 03 49 bl ffc09ce0 if (r_chain == NULL) { ffc0999c: 2c 03 00 00 cmpwi r3,0 ffc099a0: 41 82 00 50 beq- ffc099f0 rtems_set_errno_and_return_minus_one (EINVAL); } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); ffc099a4: 7f c4 f3 78 mr r4,r30 ffc099a8: 38 63 00 08 addi r3,r3,8 ffc099ac: 48 00 08 b9 bl ffc0a264 ffc099b0: 7c 7e 1b 78 mr r30,r3 pthread_mutex_unlock (&aio_request_queue.mutex); ffc099b4: 7f e3 fb 78 mr r3,r31 ffc099b8: 48 00 16 a5 bl ffc0b05c pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_unlock (&aio_request_queue.mutex); return result; } return AIO_ALLDONE; } ffc099bc: 80 01 00 1c lwz r0,28(r1) ffc099c0: 7f c3 f3 78 mr r3,r30 ffc099c4: 83 81 00 08 lwz r28,8(r1) ffc099c8: 7c 08 03 a6 mtlr r0 ffc099cc: 83 a1 00 0c lwz r29,12(r1) ffc099d0: 83 c1 00 10 lwz r30,16(r1) ffc099d4: 83 e1 00 14 lwz r31,20(r1) ffc099d8: 38 21 00 18 addi r1,r1,24 ffc099dc: 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); ffc099e0: 7f e3 fb 78 mr r3,r31 ffc099e4: 48 00 16 79 bl ffc0b05c return AIO_ALLDONE; ffc099e8: 3b c0 00 02 li r30,2 ffc099ec: 4b ff ff 6c b ffc09958 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); ffc099f0: 7f e3 fb 78 mr r3,r31 ffc099f4: 48 00 16 69 bl ffc0b05c rtems_set_errno_and_return_minus_one (EINVAL); ffc099f8: 3b c0 ff ff li r30,-1 ffc099fc: 48 00 d1 c5 bl ffc16bc0 <__errno> ffc09a00: 38 00 00 16 li r0,22 ffc09a04: 90 03 00 00 stw r0,0(r3) ffc09a08: 4b ff ff 50 b ffc09958 /* 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); ffc09a0c: 38 7f 00 48 addi r3,r31,72 ffc09a10: 7f a4 eb 78 mr r4,r29 ffc09a14: 38 a0 00 00 li r5,0 ffc09a18: 48 00 02 c9 bl ffc09ce0 if (r_chain == NULL) { ffc09a1c: 7c 7e 1b 79 mr. r30,r3 ffc09a20: 41 82 00 38 beq- ffc09a58 return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); ffc09a24: 3b be 00 1c addi r29,r30,28 ffc09a28: 7f a3 eb 78 mr r3,r29 ffc09a2c: 48 00 15 65 bl ffc0af90 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc09a30: 7f c3 f3 78 mr r3,r30 ffc09a34: 48 00 38 b9 bl ffc0d2ec <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); ffc09a38: 7f c3 f3 78 mr r3,r30 ffc09a3c: 48 00 07 a1 bl ffc0a1dc pthread_mutex_unlock (&r_chain->mutex); ffc09a40: 7f a3 eb 78 mr r3,r29 ffc09a44: 48 00 16 19 bl ffc0b05c pthread_mutex_unlock (&aio_request_queue.mutex); ffc09a48: 7f e3 fb 78 mr r3,r31 ffc09a4c: 48 00 16 11 bl ffc0b05c return AIO_CANCELED; ffc09a50: 3b c0 00 00 li r30,0 ffc09a54: 4b ff ff 04 b ffc09958 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)) { ffc09a58: 81 3f 00 54 lwz r9,84(r31) ffc09a5c: 38 1f 00 58 addi r0,r31,88 ffc09a60: 7f 89 00 00 cmpw cr7,r9,r0 ffc09a64: 41 be ff 7c beq- cr7,ffc099e0 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); ffc09a68: 38 7f 00 54 addi r3,r31,84 ffc09a6c: 7f a4 eb 78 mr r4,r29 ffc09a70: 38 a0 00 00 li r5,0 ffc09a74: 48 00 02 6d bl ffc09ce0 if (r_chain == NULL) { ffc09a78: 7c 7e 1b 79 mr. r30,r3 ffc09a7c: 41 a2 ff 64 beq- ffc099e0 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); ffc09a80: 3b be 00 1c addi r29,r30,28 ffc09a84: 48 00 38 69 bl ffc0d2ec <_Chain_Extract> } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); ffc09a88: 7f c3 f3 78 mr r3,r30 ffc09a8c: 48 00 07 51 bl ffc0a1dc pthread_mutex_destroy (&r_chain->mutex); ffc09a90: 7f a3 eb 78 mr r3,r29 ffc09a94: 48 00 11 a9 bl ffc0ac3c pthread_cond_destroy (&r_chain->mutex); ffc09a98: 7f a3 eb 78 mr r3,r29 ffc09a9c: 48 00 0c b5 bl ffc0a750 free (r_chain); ffc09aa0: 7f c3 f3 78 mr r3,r30 ffc09aa4: 4b ff be f9 bl ffc0599c pthread_mutex_unlock (&aio_request_queue.mutex); ffc09aa8: 7f e3 fb 78 mr r3,r31 ffc09aac: 48 00 15 b1 bl ffc0b05c return AIO_CANCELED; ffc09ab0: 3b c0 00 00 li r30,0 ffc09ab4: 4b ff fe a4 b ffc09958 int result; pthread_mutex_lock (&aio_request_queue.mutex); if (fcntl (fildes, F_GETFD) < 0) { pthread_mutex_unlock(&aio_request_queue.mutex); ffc09ab8: 7f e3 fb 78 mr r3,r31 ffc09abc: 48 00 15 a1 bl ffc0b05c rtems_set_errno_and_return_minus_one (EBADF); ffc09ac0: 3b c0 ff ff li r30,-1 ffc09ac4: 48 00 d0 fd bl ffc16bc0 <__errno> ffc09ac8: 38 00 00 09 li r0,9 ffc09acc: 90 03 00 00 stw r0,0(r3) ffc09ad0: 4b ff fe 88 b ffc09958 =============================================================================== ffc09adc : ) { rtems_aio_request *req; int mode; if (op != O_SYNC) ffc09adc: 2f 83 20 00 cmpwi cr7,r3,8192 int aio_fsync( int op, struct aiocb *aiocbp ) { ffc09ae0: 94 21 ff f0 stwu r1,-16(r1) ffc09ae4: 7c 08 02 a6 mflr r0 ffc09ae8: 93 e1 00 0c stw r31,12(r1) ffc09aec: 7c 9f 23 78 mr r31,r4 ffc09af0: 90 01 00 14 stw r0,20(r1) ffc09af4: 93 c1 00 08 stw r30,8(r1) rtems_aio_request *req; int mode; if (op != O_SYNC) ffc09af8: 40 9e 00 94 bne- cr7,ffc09b8c rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc09afc: 80 64 00 00 lwz r3,0(r4) ffc09b00: 38 80 00 03 li r4,3 ffc09b04: 4c c6 31 82 crclr 4*cr1+eq ffc09b08: 48 00 8c a1 bl ffc127a8 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc09b0c: 54 63 07 be clrlwi r3,r3,30 ffc09b10: 38 63 ff ff addi r3,r3,-1 ffc09b14: 2b 83 00 01 cmplwi cr7,r3,1 ffc09b18: 41 9d 00 40 bgt- cr7,ffc09b58 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc09b1c: 38 60 00 18 li r3,24 ffc09b20: 4b ff c6 2d bl ffc0614c if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc09b24: 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) ffc09b28: 7c 69 1b 79 mr. r9,r3 ffc09b2c: 41 82 00 30 beq- ffc09b5c <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; ffc09b30: 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; ffc09b34: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_SYNC; ffc09b38: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc09b3c: 48 00 07 d5 bl ffc0a310 } ffc09b40: 80 01 00 14 lwz r0,20(r1) ffc09b44: 83 c1 00 08 lwz r30,8(r1) ffc09b48: 7c 08 03 a6 mtlr r0 ffc09b4c: 83 e1 00 0c lwz r31,12(r1) ffc09b50: 38 21 00 10 addi r1,r1,16 ffc09b54: 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); ffc09b58: 3b c0 00 09 li r30,9 ffc09b5c: 38 00 ff ff li r0,-1 ffc09b60: 93 df 00 34 stw r30,52(r31) ffc09b64: 90 1f 00 38 stw r0,56(r31) ffc09b68: 48 00 d0 59 bl ffc16bc0 <__errno> req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } ffc09b6c: 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); ffc09b70: 93 c3 00 00 stw r30,0(r3) ffc09b74: 38 60 ff ff li r3,-1 req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } ffc09b78: 7c 08 03 a6 mtlr r0 ffc09b7c: 83 c1 00 08 lwz r30,8(r1) ffc09b80: 83 e1 00 0c lwz r31,12(r1) ffc09b84: 38 21 00 10 addi r1,r1,16 ffc09b88: 4e 80 00 20 blr { rtems_aio_request *req; int mode; if (op != O_SYNC) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); ffc09b8c: 3b c0 00 16 li r30,22 ffc09b90: 4b ff ff cc b ffc09b5c =============================================================================== ffc0a548 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a548: 94 21 ff f0 stwu r1,-16(r1) ffc0a54c: 7c 08 02 a6 mflr r0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a550: 38 80 00 03 li r4,3 * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a554: 90 01 00 14 stw r0,20(r1) ffc0a558: 93 e1 00 0c stw r31,12(r1) ffc0a55c: 7c 7f 1b 78 mr r31,r3 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a560: 80 63 00 00 lwz r3,0(r3) * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a564: 93 c1 00 08 stw r30,8(r1) rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a568: 4c c6 31 82 crclr 4*cr1+eq ffc0a56c: 48 00 82 3d bl ffc127a8 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc0a570: 70 63 00 03 andi. r3,r3,3 ffc0a574: 41 82 00 10 beq- ffc0a584 <== NEVER TAKEN ffc0a578: 2f 83 00 02 cmpwi cr7,r3,2 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); ffc0a57c: 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))) ffc0a580: 40 9e 00 5c bne- cr7,ffc0a5dc rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) ffc0a584: 80 1f 00 18 lwz r0,24(r31) ffc0a588: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a58c: 40 9e 00 4c bne- cr7,ffc0a5d8 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) ffc0a590: 80 1f 00 08 lwz r0,8(r31) ffc0a594: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a598: 41 9c 00 40 blt- cr7,ffc0a5d8 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc0a59c: 38 60 00 18 li r3,24 ffc0a5a0: 4b ff bb ad bl ffc0614c if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc0a5a4: 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) ffc0a5a8: 7c 69 1b 79 mr. r9,r3 ffc0a5ac: 41 82 00 30 beq- ffc0a5dc <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; ffc0a5b0: 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; ffc0a5b4: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_READ; ffc0a5b8: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc0a5bc: 4b ff fd 55 bl ffc0a310 } ffc0a5c0: 80 01 00 14 lwz r0,20(r1) ffc0a5c4: 83 c1 00 08 lwz r30,8(r1) ffc0a5c8: 7c 08 03 a6 mtlr r0 ffc0a5cc: 83 e1 00 0c lwz r31,12(r1) ffc0a5d0: 38 21 00 10 addi r1,r1,16 ffc0a5d4: 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); ffc0a5d8: 3b c0 00 16 li r30,22 ffc0a5dc: 38 00 ff ff li r0,-1 ffc0a5e0: 93 df 00 34 stw r30,52(r31) ffc0a5e4: 90 1f 00 38 stw r0,56(r31) ffc0a5e8: 48 00 c5 d9 bl ffc16bc0 <__errno> ffc0a5ec: 93 c3 00 00 stw r30,0(r3) ffc0a5f0: 38 60 ff ff li r3,-1 ffc0a5f4: 4b ff ff cc b ffc0a5c0 =============================================================================== ffc0a600 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a600: 94 21 ff f0 stwu r1,-16(r1) ffc0a604: 7c 08 02 a6 mflr r0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a608: 38 80 00 03 li r4,3 * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a60c: 90 01 00 14 stw r0,20(r1) ffc0a610: 93 e1 00 0c stw r31,12(r1) ffc0a614: 7c 7f 1b 78 mr r31,r3 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a618: 80 63 00 00 lwz r3,0(r3) * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a61c: 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); ffc0a620: 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); ffc0a624: 4c c6 31 82 crclr 4*cr1+eq ffc0a628: 48 00 81 81 bl ffc127a8 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc0a62c: 54 63 07 be clrlwi r3,r3,30 ffc0a630: 38 63 ff ff addi r3,r3,-1 ffc0a634: 2b 83 00 01 cmplwi cr7,r3,1 ffc0a638: 41 9d 00 5c bgt- cr7,ffc0a694 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) ffc0a63c: 80 1f 00 18 lwz r0,24(r31) ffc0a640: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a644: 40 9e 00 4c bne- cr7,ffc0a690 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) ffc0a648: 80 1f 00 08 lwz r0,8(r31) ffc0a64c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a650: 41 9c 00 40 blt- cr7,ffc0a690 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc0a654: 38 60 00 18 li r3,24 ffc0a658: 4b ff ba f5 bl ffc0614c if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc0a65c: 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) ffc0a660: 7c 69 1b 79 mr. r9,r3 ffc0a664: 41 82 00 30 beq- ffc0a694 <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; ffc0a668: 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; ffc0a66c: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_WRITE; ffc0a670: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc0a674: 4b ff fc 9d bl ffc0a310 } ffc0a678: 80 01 00 14 lwz r0,20(r1) ffc0a67c: 83 c1 00 08 lwz r30,8(r1) ffc0a680: 7c 08 03 a6 mtlr r0 ffc0a684: 83 e1 00 0c lwz r31,12(r1) ffc0a688: 38 21 00 10 addi r1,r1,16 ffc0a68c: 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); ffc0a690: 3b c0 00 16 li r30,22 ffc0a694: 38 00 ff ff li r0,-1 ffc0a698: 93 df 00 34 stw r30,52(r31) ffc0a69c: 90 1f 00 38 stw r0,56(r31) ffc0a6a0: 48 00 c5 21 bl ffc16bc0 <__errno> ffc0a6a4: 93 c3 00 00 stw r30,0(r3) ffc0a6a8: 38 60 ff ff li r3,-1 ffc0a6ac: 4b ff ff cc b ffc0a678 =============================================================================== ffc08c20 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { if ( !tp ) ffc08c20: 2c 04 00 00 cmpwi r4,0 int clock_gettime( clockid_t clock_id, struct timespec *tp ) { ffc08c24: 94 21 ff f8 stwu r1,-8(r1) ffc08c28: 7c 08 02 a6 mflr r0 ffc08c2c: 90 01 00 0c stw r0,12(r1) if ( !tp ) ffc08c30: 41 82 00 24 beq- ffc08c54 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { ffc08c34: 2f 83 00 01 cmpwi cr7,r3,1 ffc08c38: 41 9e 00 78 beq- cr7,ffc08cb0 _TOD_Get(tp); return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { ffc08c3c: 2f 83 00 04 cmpwi cr7,r3,4 ffc08c40: 41 9e 00 54 beq- cr7,ffc08c94 <== NEVER TAKEN return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { ffc08c44: 2f 83 00 02 cmpwi cr7,r3,2 ffc08c48: 41 9e 00 4c beq- cr7,ffc08c94 return 0; } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) ffc08c4c: 2f 83 00 03 cmpwi cr7,r3,3 ffc08c50: 41 9e 00 24 beq- cr7,ffc08c74 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif rtems_set_errno_and_return_minus_one( EINVAL ); ffc08c54: 48 00 bf 09 bl ffc14b5c <__errno> ffc08c58: 38 00 00 16 li r0,22 ffc08c5c: 90 03 00 00 stw r0,0(r3) ffc08c60: 38 60 ff ff li r3,-1 return 0; } ffc08c64: 80 01 00 0c lwz r0,12(r1) ffc08c68: 38 21 00 08 addi r1,r1,8 ffc08c6c: 7c 08 03 a6 mtlr r0 ffc08c70: 4e 80 00 20 blr } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); ffc08c74: 48 00 be e9 bl ffc14b5c <__errno> ffc08c78: 38 00 00 58 li r0,88 ffc08c7c: 90 03 00 00 stw r0,0(r3) ffc08c80: 38 60 ff ff li r3,-1 #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08c84: 80 01 00 0c lwz r0,12(r1) ffc08c88: 38 21 00 08 addi r1,r1,8 ffc08c8c: 7c 08 03 a6 mtlr r0 ffc08c90: 4e 80 00 20 blr } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { _TOD_Get_uptime_as_timespec( tp ); ffc08c94: 7c 83 23 78 mr r3,r4 ffc08c98: 48 00 29 d9 bl ffc0b670 <_TOD_Get_uptime_as_timespec> #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08c9c: 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; ffc08ca0: 38 60 00 00 li r3,0 #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08ca4: 7c 08 03 a6 mtlr r0 ffc08ca8: 38 21 00 08 addi r1,r1,8 ffc08cac: 4e 80 00 20 blr { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { _TOD_Get(tp); ffc08cb0: 7c 83 23 78 mr r3,r4 ffc08cb4: 48 00 29 25 bl ffc0b5d8 <_TOD_Get> return 0; ffc08cb8: 38 60 00 00 li r3,0 ffc08cbc: 4b ff ff a8 b ffc08c64 =============================================================================== ffc08cc0 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { if ( !tp ) ffc08cc0: 2c 04 00 00 cmpwi r4,0 int clock_settime( clockid_t clock_id, const struct timespec *tp ) { ffc08cc4: 94 21 ff f8 stwu r1,-8(r1) ffc08cc8: 7c 08 02 a6 mflr r0 ffc08ccc: 90 01 00 0c stw r0,12(r1) if ( !tp ) ffc08cd0: 41 82 00 1c beq- ffc08cec <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { ffc08cd4: 2f 83 00 01 cmpwi cr7,r3,1 ffc08cd8: 41 9e 00 34 beq- cr7,ffc08d0c _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) ffc08cdc: 2f 83 00 02 cmpwi cr7,r3,2 ffc08ce0: 41 9e 00 70 beq- cr7,ffc08d50 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) ffc08ce4: 2f 83 00 03 cmpwi cr7,r3,3 ffc08ce8: 41 9e 00 68 beq- cr7,ffc08d50 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); ffc08cec: 48 00 be 71 bl ffc14b5c <__errno> ffc08cf0: 38 00 00 16 li r0,22 ffc08cf4: 90 03 00 00 stw r0,0(r3) ffc08cf8: 38 60 ff ff li r3,-1 return 0; } ffc08cfc: 80 01 00 0c lwz r0,12(r1) ffc08d00: 38 21 00 08 addi r1,r1,8 ffc08d04: 7c 08 03 a6 mtlr r0 ffc08d08: 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 ) ffc08d0c: 81 24 00 00 lwz r9,0(r4) ffc08d10: 3c 00 21 da lis r0,8666 ffc08d14: 60 00 e4 ff ori r0,r0,58623 ffc08d18: 7f 89 00 40 cmplw cr7,r9,r0 ffc08d1c: 40 bd ff d0 ble- cr7,ffc08cec rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc08d20: 3d 20 00 00 lis r9,0 ffc08d24: 81 69 28 78 lwz r11,10360(r9) ffc08d28: 38 0b 00 01 addi r0,r11,1 ffc08d2c: 90 09 28 78 stw r0,10360(r9) rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); ffc08d30: 7c 83 23 78 mr r3,r4 ffc08d34: 48 00 29 b5 bl ffc0b6e8 <_TOD_Set> _Thread_Enable_dispatch(); ffc08d38: 48 00 46 41 bl ffc0d378 <_Thread_Enable_dispatch> #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08d3c: 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; ffc08d40: 38 60 00 00 li r3,0 } ffc08d44: 7c 08 03 a6 mtlr r0 ffc08d48: 38 21 00 08 addi r1,r1,8 ffc08d4c: 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 ); ffc08d50: 48 00 be 0d bl ffc14b5c <__errno> ffc08d54: 38 00 00 58 li r0,88 ffc08d58: 90 03 00 00 stw r0,0(r3) ffc08d5c: 38 60 ff ff li r3,-1 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08d60: 80 01 00 0c lwz r0,12(r1) ffc08d64: 38 21 00 08 addi r1,r1,8 ffc08d68: 7c 08 03 a6 mtlr r0 ffc08d6c: 4e 80 00 20 blr =============================================================================== ffc29ed4 : int killinfo( pid_t pid, int sig, const union sigval *value ) { ffc29ed4: 94 21 ff d0 stwu r1,-48(r1) ffc29ed8: 7c 08 02 a6 mflr r0 ffc29edc: 93 61 00 1c stw r27,28(r1) ffc29ee0: 7c bb 2b 78 mr r27,r5 ffc29ee4: 93 81 00 20 stw r28,32(r1) ffc29ee8: 7c 9c 23 78 mr r28,r4 ffc29eec: 93 e1 00 2c stw r31,44(r1) ffc29ef0: 7c 7f 1b 78 mr r31,r3 ffc29ef4: 90 01 00 34 stw r0,52(r1) ffc29ef8: 93 41 00 18 stw r26,24(r1) ffc29efc: 93 a1 00 24 stw r29,36(r1) ffc29f00: 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() ) ffc29f04: 4b ff fb b9 bl ffc29abc ffc29f08: 7f 83 f8 00 cmpw cr7,r3,r31 ffc29f0c: 40 9e 02 9c bne- cr7,ffc2a1a8 rtems_set_errno_and_return_minus_one( ESRCH ); /* * Validate the signal passed. */ if ( !sig ) ffc29f10: 2f 9c 00 00 cmpwi cr7,r28,0 ffc29f14: 41 9e 02 a8 beq- cr7,ffc2a1bc static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc29f18: 3b fc ff ff addi r31,r28,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc29f1c: 2b 9f 00 1f cmplwi cr7,r31,31 ffc29f20: 41 9d 02 9c bgt- cr7,ffc2a1bc 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 ) ffc29f24: 1f dc 00 0c mulli r30,r28,12 ffc29f28: 3f a0 00 00 lis r29,0 ffc29f2c: 3b bd 32 e0 addi r29,r29,13024 ffc29f30: 7d 3d f2 14 add r9,r29,r30 ffc29f34: 80 09 00 08 lwz r0,8(r9) return 0; ffc29f38: 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 ) ffc29f3c: 2f 80 00 01 cmpwi cr7,r0,1 ffc29f40: 41 9e 01 ac beq- cr7,ffc2a0ec /* * 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 ) ) ffc29f44: 2f 9c 00 08 cmpwi cr7,r28,8 ffc29f48: 41 9e 01 cc beq- cr7,ffc2a114 ffc29f4c: 2f 9c 00 04 cmpwi cr7,r28,4 ffc29f50: 41 9e 01 c4 beq- cr7,ffc2a114 ffc29f54: 2f 9c 00 0b cmpwi cr7,r28,11 ffc29f58: 41 9e 01 bc beq- cr7,ffc2a114 * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { ffc29f5c: 2f 9b 00 00 cmpwi cr7,r27,0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; ffc29f60: 93 81 00 08 stw r28,8(r1) static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); ffc29f64: 38 00 00 01 li r0,1 ffc29f68: 7c 1f f8 30 slw r31,r0,r31 siginfo->si_code = SI_USER; ffc29f6c: 90 01 00 0c stw r0,12(r1) if ( !value ) { ffc29f70: 41 9e 02 1c beq- cr7,ffc2a18c siginfo->si_value.sival_int = 0; } else { siginfo->si_value = *value; ffc29f74: 80 1b 00 00 lwz r0,0(r27) ffc29f78: 90 01 00 10 stw r0,16(r1) ffc29f7c: 3d 20 00 00 lis r9,0 ffc29f80: 81 69 28 4c lwz r11,10316(r9) ffc29f84: 38 0b 00 01 addi r0,r11,1 ffc29f88: 90 09 28 4c stw r0,10316(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; ffc29f8c: 3d 20 00 00 lis r9,0 ffc29f90: 80 69 32 90 lwz r3,12944(r9) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { ffc29f94: 81 23 01 34 lwz r9,308(r3) ffc29f98: 80 09 00 d0 lwz r0,208(r9) ffc29f9c: 7f e6 00 79 andc. r6,r31,r0 ffc29fa0: 40 82 01 1c bne- ffc2a0bc } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } ffc29fa4: 3d 20 00 00 lis r9,0 ffc29fa8: 39 49 34 6c addi r10,r9,13420 ffc29fac: 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 ); ffc29fb0: 39 4a 00 04 addi r10,r10,4 ffc29fb4: 7f 89 50 00 cmpw cr7,r9,r10 ffc29fb8: 41 9e 00 54 beq- cr7,ffc2a00c #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc29fbc: 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; ffc29fc0: 7d 23 4b 78 mr r3,r9 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc29fc4: 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) ffc29fc8: 7f e8 00 39 and. r8,r31,r0 ffc29fcc: 40 82 00 f0 bne- ffc2a0bc /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) ffc29fd0: 80 0b 00 d0 lwz r0,208(r11) ffc29fd4: 7f eb 00 79 andc. r11,r31,r0 ffc29fd8: 41 a2 00 24 beq+ ffc29ffc ffc29fdc: 48 00 00 e0 b ffc2a0bc #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc29fe0: 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 ]; ffc29fe4: 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) ffc29fe8: 7f fa 00 39 and. r26,r31,r0 <== NOT EXECUTED ffc29fec: 40 82 00 d0 bne- ffc2a0bc <== NOT EXECUTED /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) ffc29ff0: 80 0b 00 d0 lwz r0,208(r11) <== NOT EXECUTED ffc29ff4: 7f fb 00 79 andc. r27,r31,r0 <== NOT EXECUTED ffc29ff8: 40 82 00 c4 bne- ffc2a0bc <== 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 ) { ffc29ffc: 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 ); ffc2a000: 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; ffc2a004: 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 ); ffc2a008: 40 9e ff d8 bne+ cr7,ffc29fe0 <== NEVER TAKEN * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; ffc2a00c: 3d 20 00 00 lis r9,0 ffc2a010: 88 e9 27 84 lbz r7,10116(r9) ffc2a014: 3c a0 00 00 lis r5,0 ffc2a018: 38 a5 2d a4 addi r5,r5,11684 ffc2a01c: 38 e7 00 01 addi r7,r7,1 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( ffc2a020: 38 85 00 08 addi r4,r5,8 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; ffc2a024: 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 ] ) ffc2a028: 85 25 00 04 lwzu r9,4(r5) ffc2a02c: 2f 89 00 00 cmpwi cr7,r9,0 ffc2a030: 41 9e 00 7c beq- cr7,ffc2a0ac <== NEVER TAKEN continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; ffc2a034: 81 29 00 04 lwz r9,4(r9) */ if ( !the_info ) continue; #endif maximum = the_info->maximum; ffc2a038: a1 09 00 10 lhz r8,16(r9) object_table = the_info->local_table; ffc2a03c: 81 49 00 1c lwz r10,28(r9) for ( index = 1 ; index <= maximum ; index++ ) { ffc2a040: 2f 88 00 00 cmpwi cr7,r8,0 ffc2a044: 41 9e 00 68 beq- cr7,ffc2a0ac ffc2a048: 39 60 00 01 li r11,1 the_thread = (Thread_Control *) object_table[ index ]; ffc2a04c: 85 2a 00 04 lwzu r9,4(r10) if ( !the_thread ) ffc2a050: 2f 89 00 00 cmpwi cr7,r9,0 ffc2a054: 41 9e 00 4c beq- cr7,ffc2a0a0 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) ffc2a058: 80 09 00 14 lwz r0,20(r9) ffc2a05c: 7f 80 38 40 cmplw cr7,r0,r7 ffc2a060: 41 9d 00 40 bgt- cr7,ffc2a0a0 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) ffc2a064: 80 c9 01 34 lwz r6,308(r9) ffc2a068: 80 c6 00 d0 lwz r6,208(r6) ffc2a06c: 7f fa 30 79 andc. r26,r31,r6 ffc2a070: 41 82 00 30 beq- ffc2a0a0 * * 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 ) { ffc2a074: 41 9c 00 24 blt- cr7,ffc2a098 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { ffc2a078: 2f 83 00 00 cmpwi cr7,r3,0 ffc2a07c: 41 9e 00 24 beq- cr7,ffc2a0a0 <== NEVER TAKEN ffc2a080: 80 c3 00 10 lwz r6,16(r3) ffc2a084: 2f 86 00 00 cmpwi cr7,r6,0 ffc2a088: 41 9e 00 18 beq- cr7,ffc2a0a0 <== NEVER TAKEN /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { ffc2a08c: 83 69 00 10 lwz r27,16(r9) ffc2a090: 2f 9b 00 00 cmpwi cr7,r27,0 ffc2a094: 40 9e 01 00 bne- cr7,ffc2a194 ffc2a098: 7c 07 03 78 mr r7,r0 ffc2a09c: 7d 23 4b 78 mr r3,r9 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { ffc2a0a0: 39 6b 00 01 addi r11,r11,1 ffc2a0a4: 7f 88 58 40 cmplw cr7,r8,r11 ffc2a0a8: 40 9c ff a4 bge+ cr7,ffc2a04c * + 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++) { ffc2a0ac: 7f 85 20 00 cmpw cr7,r5,r4 ffc2a0b0: 40 be ff 78 bne- cr7,ffc2a028 } } } } if ( interested ) { ffc2a0b4: 2f 83 00 00 cmpwi cr7,r3,0 ffc2a0b8: 41 9e 00 18 beq- cr7,ffc2a0d0 /* * 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 ) ) { ffc2a0bc: 7f 84 e3 78 mr r4,r28 ffc2a0c0: 38 a1 00 08 addi r5,r1,8 ffc2a0c4: 48 00 01 4d bl ffc2a210 <_POSIX_signals_Unblock_thread> ffc2a0c8: 2f 83 00 00 cmpwi cr7,r3,0 ffc2a0cc: 40 9e 00 18 bne- cr7,ffc2a0e4 /* * 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 ); ffc2a0d0: 7f e3 fb 78 mr r3,r31 ffc2a0d4: 48 00 01 15 bl ffc2a1e8 <_POSIX_signals_Set_process_signals> if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { ffc2a0d8: 7c 1d f0 2e lwzx r0,r29,r30 ffc2a0dc: 2f 80 00 02 cmpwi cr7,r0,2 ffc2a0e0: 41 9e 00 68 beq- cr7,ffc2a148 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); ffc2a0e4: 4b fe 8e 01 bl ffc12ee4 <_Thread_Enable_dispatch> return 0; ffc2a0e8: 38 60 00 00 li r3,0 } ffc2a0ec: 80 01 00 34 lwz r0,52(r1) ffc2a0f0: 83 41 00 18 lwz r26,24(r1) ffc2a0f4: 7c 08 03 a6 mtlr r0 ffc2a0f8: 83 61 00 1c lwz r27,28(r1) ffc2a0fc: 83 81 00 20 lwz r28,32(r1) ffc2a100: 83 a1 00 24 lwz r29,36(r1) ffc2a104: 83 c1 00 28 lwz r30,40(r1) ffc2a108: 83 e1 00 2c lwz r31,44(r1) ffc2a10c: 38 21 00 30 addi r1,r1,48 ffc2a110: 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 ); ffc2a114: 48 00 03 69 bl ffc2a47c ffc2a118: 7f 84 e3 78 mr r4,r28 ffc2a11c: 48 00 02 61 bl ffc2a37c } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } ffc2a120: 80 01 00 34 lwz r0,52(r1) ffc2a124: 83 41 00 18 lwz r26,24(r1) ffc2a128: 7c 08 03 a6 mtlr r0 ffc2a12c: 83 61 00 1c lwz r27,28(r1) ffc2a130: 83 81 00 20 lwz r28,32(r1) ffc2a134: 83 a1 00 24 lwz r29,36(r1) ffc2a138: 83 c1 00 28 lwz r30,40(r1) ffc2a13c: 83 e1 00 2c lwz r31,44(r1) ffc2a140: 38 21 00 30 addi r1,r1,48 ffc2a144: 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 ); ffc2a148: 3c 60 00 00 lis r3,0 ffc2a14c: 38 63 34 60 addi r3,r3,13408 ffc2a150: 4b fe 6a a9 bl ffc10bf8 <_Chain_Get> if ( !psiginfo ) { ffc2a154: 7c 69 1b 79 mr. r9,r3 ffc2a158: 41 82 00 78 beq- ffc2a1d0 _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc2a15c: 80 01 00 08 lwz r0,8(r1) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc2a160: 3c 60 00 00 lis r3,0 ffc2a164: 38 63 34 d4 addi r3,r3,13524 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc2a168: 90 09 00 08 stw r0,8(r9) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc2a16c: 7c 63 f2 14 add r3,r3,r30 ffc2a170: 7d 24 4b 78 mr r4,r9 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc2a174: 80 01 00 0c lwz r0,12(r1) ffc2a178: 90 09 00 0c stw r0,12(r9) ffc2a17c: 80 01 00 10 lwz r0,16(r1) ffc2a180: 90 09 00 10 stw r0,16(r9) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc2a184: 4b fe 6a 1d bl ffc10ba0 <_Chain_Append> ffc2a188: 4b ff ff 5c b ffc2a0e4 */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { siginfo->si_value.sival_int = 0; ffc2a18c: 93 61 00 10 stw r27,16(r1) ffc2a190: 4b ff fd ec b ffc29f7c continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { ffc2a194: 74 da 10 00 andis. r26,r6,4096 ffc2a198: 40 a2 ff 08 bne- ffc2a0a0 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { ffc2a19c: 77 66 10 00 andis. r6,r27,4096 ffc2a1a0: 41 a2 ff 00 beq- ffc2a0a0 ffc2a1a4: 4b ff fe f4 b ffc2a098 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) rtems_set_errno_and_return_minus_one( ESRCH ); ffc2a1a8: 4b ff 04 09 bl ffc1a5b0 <__errno> ffc2a1ac: 38 00 00 03 li r0,3 ffc2a1b0: 90 03 00 00 stw r0,0(r3) ffc2a1b4: 38 60 ff ff li r3,-1 ffc2a1b8: 4b ff ff 34 b ffc2a0ec */ if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc2a1bc: 4b ff 03 f5 bl ffc1a5b0 <__errno> ffc2a1c0: 38 00 00 16 li r0,22 ffc2a1c4: 90 03 00 00 stw r0,0(r3) ffc2a1c8: 38 60 ff ff li r3,-1 ffc2a1cc: 4b ff ff 20 b ffc2a0ec 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(); ffc2a1d0: 4b fe 8d 15 bl ffc12ee4 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); ffc2a1d4: 4b ff 03 dd bl ffc1a5b0 <__errno> ffc2a1d8: 38 00 00 0b li r0,11 ffc2a1dc: 90 03 00 00 stw r0,0(r3) ffc2a1e0: 38 60 ff ff li r3,-1 ffc2a1e4: 4b ff ff 08 b ffc2a0ec =============================================================================== ffc0e8c0 : rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0e8c0: 3d 20 00 00 lis r9,0 int oflag, ... /* mode_t mode, */ /* struct mq_attr attr */ ) { ffc0e8c4: 94 21 ff b0 stwu r1,-80(r1) ffc0e8c8: 7c 08 02 a6 mflr r0 ffc0e8cc: 81 69 2a 70 lwz r11,10864(r9) ffc0e8d0: 7d 80 00 26 mfcr r12 ffc0e8d4: 93 81 00 40 stw r28,64(r1) ffc0e8d8: 7c 9c 23 78 mr r28,r4 ffc0e8dc: 39 6b 00 01 addi r11,r11,1 ffc0e8e0: 93 a1 00 44 stw r29,68(r1) ffc0e8e4: 7c 7d 1b 78 mr r29,r3 ffc0e8e8: 90 01 00 54 stw r0,84(r1) ffc0e8ec: 93 41 00 38 stw r26,56(r1) ffc0e8f0: 93 61 00 3c stw r27,60(r1) ffc0e8f4: 93 c1 00 48 stw r30,72(r1) ffc0e8f8: 93 e1 00 4c stw r31,76(r1) ffc0e8fc: 91 81 00 34 stw r12,52(r1) ffc0e900: 90 a1 00 28 stw r5,40(r1) ffc0e904: 90 c1 00 2c stw r6,44(r1) ffc0e908: 91 69 2a 70 stw r11,10864(r9) POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0e90c: 54 80 bf fe rlwinm r0,r4,23,31,31 ffc0e910: 2e 00 00 00 cmpwi cr4,r0,0 ffc0e914: 40 92 01 10 bne- cr4,ffc0ea24 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 ); ffc0e918: 3f c0 00 00 lis r30,0 ffc0e91c: 3b de 36 38 addi r30,r30,13880 ffc0e920: 7f c3 f3 78 mr r3,r30 ffc0e924: 48 00 3e 55 bl ffc12778 <_Objects_Allocate> /* struct mq_attr attr */ ) { va_list arg; mode_t mode; struct mq_attr *attr = NULL; ffc0e928: 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 ) { ffc0e92c: 7c 7f 1b 79 mr. r31,r3 ffc0e930: 41 82 01 28 beq- ffc0ea58 <== NEVER TAKEN _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( ENFILE ); } the_mq_fd->oflag = oflag; ffc0e934: 93 9f 00 14 stw r28,20(r31) status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); ffc0e938: 7f a3 eb 78 mr r3,r29 ffc0e93c: 38 81 00 08 addi r4,r1,8 ffc0e940: 48 00 90 85 bl ffc179c4 <_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 ) { ffc0e944: 7c 7b 1b 79 mr. r27,r3 ffc0e948: 40 82 00 88 bne- ffc0e9d0 } else { /* name -> ID translation succeeded */ /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { ffc0e94c: 73 9c 0a 00 andi. r28,r28,2560 ffc0e950: 2f 9c 0a 00 cmpwi cr7,r28,2560 ffc0e954: 41 9e 01 48 beq- cr7,ffc0ea9c Objects_Id id, Objects_Locations *location ) { return (POSIX_Message_queue_Control *) _Objects_Get( &_POSIX_Message_queue_Information, id, location ); ffc0e958: 80 81 00 08 lwz r4,8(r1) ffc0e95c: 3c 60 00 00 lis r3,0 ffc0e960: 38 a1 00 10 addi r5,r1,16 ffc0e964: 38 63 34 ac addi r3,r3,13484 ffc0e968: 48 00 44 25 bl ffc12d8c <_Objects_Get> Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( ffc0e96c: 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; ffc0e970: 81 63 00 18 lwz r11,24(r3) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0e974: 81 3e 00 1c lwz r9,28(r30) ffc0e978: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0e97c: 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 ); ffc0e980: 90 61 00 0c stw r3,12(r1) the_mq->open_count += 1; ffc0e984: 91 63 00 18 stw r11,24(r3) the_mq_fd->Queue = the_mq; ffc0e988: 90 7f 00 10 stw r3,16(r31) ffc0e98c: 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; ffc0e990: 93 7f 00 0c stw r27,12(r31) _Objects_Open_string( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); ffc0e994: 48 00 54 dd bl ffc13e70 <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); ffc0e998: 48 00 54 d9 bl ffc13e70 <_Thread_Enable_dispatch> return (mqd_t)the_mq_fd->Object.id; ffc0e99c: 80 7f 00 08 lwz r3,8(r31) ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0e9a0: 80 01 00 54 lwz r0,84(r1) ffc0e9a4: 81 81 00 34 lwz r12,52(r1) ffc0e9a8: 7c 08 03 a6 mtlr r0 ffc0e9ac: 83 41 00 38 lwz r26,56(r1) ffc0e9b0: 83 61 00 3c lwz r27,60(r1) ffc0e9b4: 7d 80 81 20 mtcrf 8,r12 ffc0e9b8: 83 81 00 40 lwz r28,64(r1) ffc0e9bc: 83 a1 00 44 lwz r29,68(r1) ffc0e9c0: 83 c1 00 48 lwz r30,72(r1) ffc0e9c4: 83 e1 00 4c lwz r31,76(r1) ffc0e9c8: 38 21 00 50 addi r1,r1,80 ffc0e9cc: 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) ) ) { ffc0e9d0: 2f 9b 00 02 cmpwi cr7,r27,2 ffc0e9d4: 41 9e 01 18 beq- cr7,ffc0eaec 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 ); ffc0e9d8: 7f c3 f3 78 mr r3,r30 ffc0e9dc: 7f e4 fb 78 mr r4,r31 ffc0e9e0: 48 00 41 b9 bl ffc12b98 <_Objects_Free> _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); ffc0e9e4: 48 00 54 8d bl ffc13e70 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); ffc0e9e8: 48 00 d4 b5 bl ffc1be9c <__errno> ); _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 * 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 ); ffc0e9f8: 93 63 00 00 stw r27,0(r3) ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0e9fc: 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 ); ffc0ea00: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ea04: 83 41 00 38 lwz r26,56(r1) ffc0ea08: 83 61 00 3c lwz r27,60(r1) ffc0ea0c: 83 81 00 40 lwz r28,64(r1) ffc0ea10: 83 a1 00 44 lwz r29,68(r1) ffc0ea14: 83 c1 00 48 lwz r30,72(r1) ffc0ea18: 83 e1 00 4c lwz r31,76(r1) ffc0ea1c: 38 21 00 50 addi r1,r1,80 ffc0ea20: 4e 80 00 20 blr Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0ea24: 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 * ); ffc0ea28: 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 ); ffc0ea2c: 3f c0 00 00 lis r30,0 Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0ea30: 90 01 00 18 stw r0,24(r1) ffc0ea34: 3b de 36 38 addi r30,r30,13880 ffc0ea38: 38 01 00 20 addi r0,r1,32 ffc0ea3c: 90 01 00 1c stw r0,28(r1) ffc0ea40: 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 * ); ffc0ea44: 38 00 00 04 li r0,4 ffc0ea48: 98 01 00 14 stb r0,20(r1) ffc0ea4c: 48 00 3d 2d bl ffc12778 <_Objects_Allocate> va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { ffc0ea50: 7c 7f 1b 79 mr. r31,r3 ffc0ea54: 40 82 fe e0 bne+ ffc0e934 _Thread_Enable_dispatch(); ffc0ea58: 48 00 54 19 bl ffc13e70 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( ENFILE ); ffc0ea5c: 48 00 d4 41 bl ffc1be9c <__errno> ffc0ea60: 38 00 00 17 li r0,23 ffc0ea64: 90 03 00 00 stw r0,0(r3) ffc0ea68: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ea6c: 80 01 00 54 lwz r0,84(r1) ffc0ea70: 81 81 00 34 lwz r12,52(r1) ffc0ea74: 7c 08 03 a6 mtlr r0 ffc0ea78: 83 41 00 38 lwz r26,56(r1) ffc0ea7c: 83 61 00 3c lwz r27,60(r1) ffc0ea80: 7d 80 81 20 mtcrf 8,r12 ffc0ea84: 83 81 00 40 lwz r28,64(r1) ffc0ea88: 83 a1 00 44 lwz r29,68(r1) ffc0ea8c: 83 c1 00 48 lwz r30,72(r1) ffc0ea90: 83 e1 00 4c lwz r31,76(r1) ffc0ea94: 38 21 00 50 addi r1,r1,80 ffc0ea98: 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 ); ffc0ea9c: 7f c3 f3 78 mr r3,r30 ffc0eaa0: 7f e4 fb 78 mr r4,r31 ffc0eaa4: 48 00 40 f5 bl ffc12b98 <_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(); ffc0eaa8: 48 00 53 c9 bl ffc13e70 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, mqd_t ); ffc0eaac: 48 00 d3 f1 bl ffc1be9c <__errno> ffc0eab0: 38 00 00 11 li r0,17 ffc0eab4: 90 03 00 00 stw r0,0(r3) ffc0eab8: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0eabc: 80 01 00 54 lwz r0,84(r1) ffc0eac0: 81 81 00 34 lwz r12,52(r1) ffc0eac4: 7c 08 03 a6 mtlr r0 ffc0eac8: 83 41 00 38 lwz r26,56(r1) ffc0eacc: 83 61 00 3c lwz r27,60(r1) ffc0ead0: 7d 80 81 20 mtcrf 8,r12 ffc0ead4: 83 81 00 40 lwz r28,64(r1) ffc0ead8: 83 a1 00 44 lwz r29,68(r1) ffc0eadc: 83 c1 00 48 lwz r30,72(r1) ffc0eae0: 83 e1 00 4c lwz r31,76(r1) ffc0eae4: 38 21 00 50 addi r1,r1,80 ffc0eae8: 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) ) ) { ffc0eaec: 41 92 fe ec beq+ cr4,ffc0e9d8 /* * 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( ffc0eaf0: 7f a3 eb 78 mr r3,r29 ffc0eaf4: 38 80 00 01 li r4,1 ffc0eaf8: 7f 45 d3 78 mr r5,r26 ffc0eafc: 38 c1 00 0c addi r6,r1,12 ffc0eb00: 48 00 8c fd bl ffc177fc <_POSIX_Message_queue_Create_support> ); /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { ffc0eb04: 2f 83 ff ff cmpwi cr7,r3,-1 ffc0eb08: 41 9e 00 30 beq- cr7,ffc0eb38 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( ffc0eb0c: a0 1f 00 0a lhz r0,10(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0eb10: 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; ffc0eb14: 81 61 00 0c lwz r11,12(r1) ffc0eb18: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0eb1c: 91 7f 00 10 stw r11,16(r31) ffc0eb20: 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; ffc0eb24: 38 00 00 00 li r0,0 ffc0eb28: 90 1f 00 0c stw r0,12(r31) &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); ffc0eb2c: 48 00 53 45 bl ffc13e70 <_Thread_Enable_dispatch> return (mqd_t) the_mq_fd->Object.id; ffc0eb30: 80 7f 00 08 lwz r3,8(r31) ffc0eb34: 4b ff fe 6c b ffc0e9a0 ffc0eb38: 7f c3 f3 78 mr r3,r30 ffc0eb3c: 7f e4 fb 78 mr r4,r31 ffc0eb40: 48 00 40 59 bl ffc12b98 <_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(); ffc0eb44: 48 00 53 2d bl ffc13e70 <_Thread_Enable_dispatch> return (mqd_t) -1; ffc0eb48: 38 60 ff ff li r3,-1 ffc0eb4c: 4b ff fe 54 b ffc0e9a0 =============================================================================== ffc0e8f0 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) ffc0e8f0: 7c 69 1b 79 mr. r9,r3 return EINVAL; ffc0e8f4: 38 60 00 16 li r3,22 int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) ffc0e8f8: 4d 82 00 20 beqlr ffc0e8fc: 80 09 00 00 lwz r0,0(r9) ffc0e900: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e904: 4d 9e 00 20 beqlr cr7 return EINVAL; switch ( policy ) { ffc0e908: 2b 84 00 04 cmplwi cr7,r4,4 ffc0e90c: 40 9d 00 0c ble- cr7,ffc0e918 case SCHED_SPORADIC: attr->schedpolicy = policy; return 0; default: return ENOTSUP; ffc0e910: 38 60 00 86 li r3,134 } } ffc0e914: 4e 80 00 20 blr ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( policy ) { ffc0e918: 38 00 00 01 li r0,1 ffc0e91c: 7c 00 20 30 slw r0,r0,r4 ffc0e920: 70 0b 00 17 andi. r11,r0,23 ffc0e924: 41 a2 ff ec beq- ffc0e910 <== NEVER TAKEN case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; ffc0e928: 90 89 00 14 stw r4,20(r9) return 0; ffc0e92c: 38 60 00 00 li r3,0 ffc0e930: 4e 80 00 20 blr =============================================================================== ffc09324 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { ffc09324: 94 21 ff d0 stwu r1,-48(r1) ffc09328: 7c 08 02 a6 mflr r0 ffc0932c: 93 e1 00 2c stw r31,44(r1) const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) ffc09330: 7c 7f 1b 79 mr. r31,r3 return EINVAL; ffc09334: 38 60 00 16 li r3,22 int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { ffc09338: 90 01 00 34 stw r0,52(r1) ffc0933c: 93 81 00 20 stw r28,32(r1) ffc09340: 93 a1 00 24 stw r29,36(r1) ffc09344: 93 c1 00 28 stw r30,40(r1) const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) ffc09348: 41 82 00 8c beq- ffc093d4 return EINVAL; if ( count == 0 ) ffc0934c: 2f 85 00 00 cmpwi cr7,r5,0 ffc09350: 41 9e 00 84 beq- cr7,ffc093d4 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { ffc09354: 2f 84 00 00 cmpwi cr7,r4,0 ffc09358: 41 9e 00 a8 beq- cr7,ffc09400 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc0935c: 80 04 00 00 lwz r0,0(r4) return EINVAL; ffc09360: 38 60 00 16 li r3,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc09364: 2f 80 00 00 cmpwi cr7,r0,0 ffc09368: 41 9e 00 6c beq- cr7,ffc093d4 return EINVAL; switch ( the_attr->process_shared ) { ffc0936c: 83 c4 00 04 lwz r30,4(r4) ffc09370: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09374: 40 9e 00 60 bne- cr7,ffc093d4 <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc09378: 3d 20 00 00 lis r9,0 } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; ffc0937c: 93 c1 00 08 stw r30,8(r1) ffc09380: 81 69 28 14 lwz r11,10260(r9) the_attributes.maximum_count = count; ffc09384: 90 a1 00 0c stw r5,12(r1) ffc09388: 38 0b 00 01 addi r0,r11,1 ffc0938c: 90 09 28 14 stw r0,10260(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 ); ffc09390: 3f 80 00 00 lis r28,0 ffc09394: 3b 9c 2f ac addi r28,r28,12204 ffc09398: 7f 83 e3 78 mr r3,r28 ffc0939c: 48 00 2b a5 bl ffc0bf40 <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { ffc093a0: 7c 7d 1b 79 mr. r29,r3 ffc093a4: 41 82 00 50 beq- ffc093f4 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); ffc093a8: 38 7d 00 10 addi r3,r29,16 ffc093ac: 38 81 00 08 addi r4,r1,8 ffc093b0: 48 00 1f 51 bl ffc0b300 <_CORE_barrier_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc093b4: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc093b8: 81 7c 00 1c lwz r11,28(r28) ffc093bc: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc093c0: 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; ffc093c4: 93 dd 00 0c stw r30,12(r29) ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; ffc093c8: 90 1f 00 00 stw r0,0(r31) _Thread_Enable_dispatch(); ffc093cc: 48 00 41 ad bl ffc0d578 <_Thread_Enable_dispatch> return 0; ffc093d0: 38 60 00 00 li r3,0 } ffc093d4: 80 01 00 34 lwz r0,52(r1) ffc093d8: 83 81 00 20 lwz r28,32(r1) ffc093dc: 7c 08 03 a6 mtlr r0 ffc093e0: 83 a1 00 24 lwz r29,36(r1) ffc093e4: 83 c1 00 28 lwz r30,40(r1) ffc093e8: 83 e1 00 2c lwz r31,44(r1) ffc093ec: 38 21 00 30 addi r1,r1,48 ffc093f0: 4e 80 00 20 blr _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { _Thread_Enable_dispatch(); ffc093f4: 48 00 41 85 bl ffc0d578 <_Thread_Enable_dispatch> return EAGAIN; ffc093f8: 38 60 00 0b li r3,11 ffc093fc: 4b ff ff d8 b ffc093d4 * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); ffc09400: 3b c1 00 10 addi r30,r1,16 ffc09404: 90 a1 00 18 stw r5,24(r1) ffc09408: 7f c3 f3 78 mr r3,r30 ffc0940c: 4b ff fe 09 bl ffc09214 the_attr = &my_attr; ffc09410: 7f c4 f3 78 mr r4,r30 ffc09414: 80 a1 00 18 lwz r5,24(r1) ffc09418: 4b ff ff 44 b ffc0935c =============================================================================== ffc089bc : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { ffc089bc: 94 21 ff f0 stwu r1,-16(r1) ffc089c0: 7c 08 02 a6 mflr r0 ffc089c4: 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 ) ffc089c8: 7c 7e 1b 79 mr. r30,r3 void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { ffc089cc: 93 e1 00 0c stw r31,12(r1) ffc089d0: 7c 9f 23 78 mr r31,r4 ffc089d4: 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 ) ffc089d8: 41 82 00 48 beq- ffc08a20 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc089dc: 3d 20 00 00 lis r9,0 ffc089e0: 81 69 28 0c lwz r11,10252(r9) ffc089e4: 38 0b 00 01 addi r0,r11,1 ffc089e8: 90 09 28 0c stw r0,10252(r9) return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); ffc089ec: 38 60 00 10 li r3,16 ffc089f0: 48 00 5b b1 bl ffc0e5a0 <_Workspace_Allocate> if ( handler ) { ffc089f4: 7c 69 1b 79 mr. r9,r3 ffc089f8: 41 82 00 24 beq- ffc08a1c <== NEVER TAKEN thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc089fc: 3d 60 00 00 lis r11,0 ffc08a00: 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 ); ffc08a04: 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; ffc08a08: 80 6b 01 34 lwz r3,308(r11) handler->routine = routine; ffc08a0c: 93 c9 00 08 stw r30,8(r9) handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); ffc08a10: 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; ffc08a14: 93 e9 00 0c stw r31,12(r9) _Chain_Append( handler_stack, &handler->Node ); ffc08a18: 48 00 20 71 bl ffc0aa88 <_Chain_Append> } _Thread_Enable_dispatch(); ffc08a1c: 48 00 42 a1 bl ffc0ccbc <_Thread_Enable_dispatch> } ffc08a20: 80 01 00 14 lwz r0,20(r1) ffc08a24: 83 c1 00 08 lwz r30,8(r1) ffc08a28: 7c 08 03 a6 mtlr r0 ffc08a2c: 83 e1 00 0c lwz r31,12(r1) ffc08a30: 38 21 00 10 addi r1,r1,16 ffc08a34: 4e 80 00 20 blr =============================================================================== ffc09ce8 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { ffc09ce8: 94 21 ff e8 stwu r1,-24(r1) ffc09cec: 7c 08 02 a6 mflr r0 ffc09cf0: 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; ffc09cf4: 7c 9c 23 79 mr. r28,r4 int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { ffc09cf8: 93 c1 00 10 stw r30,16(r1) ffc09cfc: 7c 7e 1b 78 mr r30,r3 ffc09d00: 90 01 00 1c stw r0,28(r1) ffc09d04: 93 a1 00 0c stw r29,12(r1) ffc09d08: 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; ffc09d0c: 41 82 00 d0 beq- ffc09ddc else the_attr = &_POSIX_Condition_variables_Default_attributes; /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) ffc09d10: 80 1c 00 04 lwz r0,4(r28) return EINVAL; ffc09d14: 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 ) ffc09d18: 2f 80 00 01 cmpwi cr7,r0,1 ffc09d1c: 41 9e 00 10 beq- cr7,ffc09d2c <== NEVER TAKEN return EINVAL; if ( !the_attr->is_initialized ) ffc09d20: 80 1c 00 00 lwz r0,0(r28) ffc09d24: 2f 80 00 00 cmpwi cr7,r0,0 ffc09d28: 40 9e 00 24 bne- cr7,ffc09d4c *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } ffc09d2c: 80 01 00 1c lwz r0,28(r1) ffc09d30: 83 81 00 08 lwz r28,8(r1) ffc09d34: 7c 08 03 a6 mtlr r0 ffc09d38: 83 a1 00 0c lwz r29,12(r1) ffc09d3c: 83 c1 00 10 lwz r30,16(r1) ffc09d40: 83 e1 00 14 lwz r31,20(r1) ffc09d44: 38 21 00 18 addi r1,r1,24 ffc09d48: 4e 80 00 20 blr rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc09d4c: 3d 20 00 00 lis r9,0 ffc09d50: 81 69 28 40 lwz r11,10304(r9) ffc09d54: 38 0b 00 01 addi r0,r11,1 ffc09d58: 90 09 28 40 stw r0,10304(r9) RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); ffc09d5c: 3f a0 00 00 lis r29,0 ffc09d60: 3b bd 30 64 addi r29,r29,12388 ffc09d64: 7f a3 eb 78 mr r3,r29 ffc09d68: 48 00 33 a5 bl ffc0d10c <_Objects_Allocate> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { ffc09d6c: 7c 7f 1b 79 mr. r31,r3 ffc09d70: 41 82 00 78 beq- ffc09de8 _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; ffc09d74: 80 1c 00 04 lwz r0,4(r28) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; ffc09d78: 3b 80 00 00 li r28,0 ffc09d7c: 93 9f 00 14 stw r28,20(r31) _Thread_queue_Initialize( ffc09d80: 3c a0 10 00 lis r5,4096 ffc09d84: 38 7f 00 18 addi r3,r31,24 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; ffc09d88: 90 1f 00 10 stw r0,16(r31) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( ffc09d8c: 38 80 00 00 li r4,0 ffc09d90: 60 a5 08 00 ori r5,r5,2048 ffc09d94: 38 c0 00 74 li r6,116 ffc09d98: 48 00 53 cd bl ffc0f164 <_Thread_queue_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc09d9c: 80 1f 00 08 lwz r0,8(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc09da0: 81 7d 00 1c lwz r11,28(r29) ffc09da4: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc09da8: 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; ffc09dac: 93 9f 00 0c stw r28,12(r31) &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; ffc09db0: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc09db4: 48 00 49 91 bl ffc0e744 <_Thread_Enable_dispatch> return 0; } ffc09db8: 80 01 00 1c lwz r0,28(r1) *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; ffc09dbc: 38 60 00 00 li r3,0 } ffc09dc0: 83 81 00 08 lwz r28,8(r1) ffc09dc4: 7c 08 03 a6 mtlr r0 ffc09dc8: 83 a1 00 0c lwz r29,12(r1) ffc09dcc: 83 c1 00 10 lwz r30,16(r1) ffc09dd0: 83 e1 00 14 lwz r31,20(r1) ffc09dd4: 38 21 00 18 addi r1,r1,24 ffc09dd8: 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; ffc09ddc: 3f 80 00 00 lis r28,0 ffc09de0: 3b 9c 27 88 addi r28,r28,10120 ffc09de4: 4b ff ff 2c b ffc09d10 _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { _Thread_Enable_dispatch(); ffc09de8: 48 00 49 5d bl ffc0e744 <_Thread_Enable_dispatch> return ENOMEM; ffc09dec: 38 60 00 0c li r3,12 ffc09df0: 4b ff ff 3c b ffc09d2c =============================================================================== ffc08f80 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08f80: 94 21 ff 80 stwu r1,-128(r1) ffc08f84: 7c 08 02 a6 mflr r0 ffc08f88: 93 61 00 6c stw r27,108(r1) int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) ffc08f8c: 7c bb 2b 79 mr. r27,r5 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08f90: 93 81 00 70 stw r28,112(r1) ffc08f94: 7c dc 33 78 mr r28,r6 ffc08f98: 93 a1 00 74 stw r29,116(r1) ffc08f9c: 7c 7d 1b 78 mr r29,r3 ffc08fa0: 93 c1 00 78 stw r30,120(r1) struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) return EFAULT; ffc08fa4: 3b c0 00 0e li r30,14 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08fa8: 90 01 00 84 stw r0,132(r1) ffc08fac: 92 a1 00 54 stw r21,84(r1) ffc08fb0: 92 c1 00 58 stw r22,88(r1) ffc08fb4: 92 e1 00 5c stw r23,92(r1) ffc08fb8: 93 01 00 60 stw r24,96(r1) ffc08fbc: 93 21 00 64 stw r25,100(r1) ffc08fc0: 93 41 00 68 stw r26,104(r1) ffc08fc4: 93 e1 00 7c stw r31,124(r1) int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) ffc08fc8: 41 82 00 58 beq- ffc09020 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; ffc08fcc: 2f 84 00 00 cmpwi cr7,r4,0 ffc08fd0: 7c 9f 23 78 mr r31,r4 ffc08fd4: 41 9e 01 b4 beq- cr7,ffc09188 if ( !the_attr->is_initialized ) ffc08fd8: 80 1f 00 00 lwz r0,0(r31) return EINVAL; ffc08fdc: 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 ) ffc08fe0: 2f 80 00 00 cmpwi cr7,r0,0 ffc08fe4: 41 9e 00 3c beq- cr7,ffc09020 * 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) ) ffc08fe8: 80 1f 00 04 lwz r0,4(r31) ffc08fec: 2f 80 00 00 cmpwi cr7,r0,0 ffc08ff0: 41 9e 00 18 beq- cr7,ffc09008 ffc08ff4: 3d 60 00 00 lis r11,0 ffc08ff8: 81 3f 00 08 lwz r9,8(r31) ffc08ffc: 80 0b 27 48 lwz r0,10056(r11) ffc09000: 7f 89 00 40 cmplw cr7,r9,r0 ffc09004: 41 9c 00 1c blt- cr7,ffc09020 * 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 ) { ffc09008: 80 1f 00 10 lwz r0,16(r31) ffc0900c: 2f 80 00 01 cmpwi cr7,r0,1 ffc09010: 41 9e 01 84 beq- cr7,ffc09194 ffc09014: 2f 80 00 02 cmpwi cr7,r0,2 schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; break; default: return EINVAL; ffc09018: 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 ) { ffc0901c: 41 9e 00 44 beq- cr7,ffc09060 */ *thread = the_thread->Object.id; _RTEMS_Unlock_allocator(); return 0; } ffc09020: 80 01 00 84 lwz r0,132(r1) ffc09024: 7f c3 f3 78 mr r3,r30 ffc09028: 82 a1 00 54 lwz r21,84(r1) ffc0902c: 7c 08 03 a6 mtlr r0 ffc09030: 82 c1 00 58 lwz r22,88(r1) ffc09034: 82 e1 00 5c lwz r23,92(r1) ffc09038: 83 01 00 60 lwz r24,96(r1) ffc0903c: 83 21 00 64 lwz r25,100(r1) ffc09040: 83 41 00 68 lwz r26,104(r1) ffc09044: 83 61 00 6c lwz r27,108(r1) ffc09048: 83 81 00 70 lwz r28,112(r1) ffc0904c: 83 a1 00 74 lwz r29,116(r1) ffc09050: 83 c1 00 78 lwz r30,120(r1) ffc09054: 83 e1 00 7c lwz r31,124(r1) ffc09058: 38 21 00 80 addi r1,r1,128 ffc0905c: 4e 80 00 20 blr schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; ffc09060: 80 df 00 18 lwz r6,24(r31) ffc09064: 80 ff 00 1c lwz r7,28(r31) ffc09068: 81 1f 00 20 lwz r8,32(r31) ffc0906c: 81 5f 00 24 lwz r10,36(r31) ffc09070: 81 7f 00 28 lwz r11,40(r31) ffc09074: 81 3f 00 2c lwz r9,44(r31) ffc09078: 80 1f 00 30 lwz r0,48(r31) schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; ffc0907c: 83 5f 00 14 lwz r26,20(r31) schedparam = the_attr->schedparam; ffc09080: 90 c1 00 20 stw r6,32(r1) ffc09084: 90 e1 00 24 stw r7,36(r1) ffc09088: 91 01 00 28 stw r8,40(r1) ffc0908c: 91 41 00 2c stw r10,44(r1) ffc09090: 91 61 00 30 stw r11,48(r1) ffc09094: 91 21 00 34 stw r9,52(r1) ffc09098: 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 ) ffc0909c: 80 1f 00 0c lwz r0,12(r31) return ENOTSUP; ffc090a0: 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 ) ffc090a4: 2f 80 00 00 cmpwi cr7,r0,0 ffc090a8: 40 be ff 78 bne- cr7,ffc09020 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) ffc090ac: 80 61 00 20 lwz r3,32(r1) return EINVAL; ffc090b0: 3b c0 00 16 li r30,22 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) ffc090b4: 48 00 82 25 bl ffc112d8 <_POSIX_Priority_Is_valid> ffc090b8: 2f 83 00 00 cmpwi cr7,r3,0 ffc090bc: 41 9e ff 64 beq+ cr7,ffc09020 <== NEVER TAKEN return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); ffc090c0: 7c 24 0b 78 mr r4,r1 ffc090c4: 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); ffc090c8: 3d 20 00 00 lis r9,0 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( ffc090cc: 7f 43 d3 78 mr r3,r26 ffc090d0: 8a a9 27 4c lbz r21,10060(r9) ffc090d4: 38 a1 00 18 addi r5,r1,24 ffc090d8: 38 c1 00 1c addi r6,r1,28 ffc090dc: 48 00 82 21 bl ffc112fc <_POSIX_Thread_Translate_sched_param> schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) ffc090e0: 7c 7e 1b 79 mr. r30,r3 ffc090e4: 40 82 ff 3c bne+ ffc09020 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); ffc090e8: 3e e0 00 00 lis r23,0 ffc090ec: 80 77 28 34 lwz r3,10292(r23) * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); ffc090f0: 3f 20 00 00 lis r25,0 ffc090f4: 3b 39 2e 0c addi r25,r25,11788 ffc090f8: 48 00 20 ad bl ffc0b1a4 <_API_Mutex_Lock> ffc090fc: 7f 23 cb 78 mr r3,r25 ffc09100: 48 00 2d 61 bl ffc0be60 <_Objects_Allocate> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { ffc09104: 7c 78 1b 79 mr. r24,r3 ffc09108: 41 82 00 70 beq- ffc09178 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc0910c: 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( ffc09110: 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 ) ffc09114: 80 c9 27 48 lwz r6,10056(r9) /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( ffc09118: 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 ) ffc0911c: 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( ffc09120: 7f 86 00 40 cmplw cr7,r6,r0 ffc09124: 40 9c 00 08 bge- cr7,ffc0912c ffc09128: 7c 06 03 78 mr r6,r0 ffc0912c: 38 00 00 00 li r0,0 ffc09130: 81 81 00 1c lwz r12,28(r1) ffc09134: 7c 2b 0b 78 mr r11,r1 ffc09138: 81 41 00 18 lwz r10,24(r1) ffc0913c: 94 0b 00 48 stwu r0,72(r11) ffc09140: 7f 23 cb 78 mr r3,r25 ffc09144: 7f 04 c3 78 mr r4,r24 ffc09148: 38 e0 00 01 li r7,1 ffc0914c: 91 81 00 08 stw r12,8(r1) ffc09150: 7d 16 a8 50 subf r8,r22,r21 ffc09154: 39 20 00 01 li r9,1 ffc09158: 90 01 00 0c stw r0,12(r1) ffc0915c: 91 61 00 10 stw r11,16(r1) ffc09160: 48 00 44 25 bl ffc0d584 <_Thread_Initialize> budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { ffc09164: 2f 83 00 00 cmpwi cr7,r3,0 ffc09168: 40 9e 00 78 bne- cr7,ffc091e0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); ffc0916c: 7f 23 cb 78 mr r3,r25 ffc09170: 7f 04 c3 78 mr r4,r24 ffc09174: 48 00 31 0d bl ffc0c280 <_Objects_Free> _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); ffc09178: 80 77 28 34 lwz r3,10292(r23) return EAGAIN; ffc0917c: 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(); ffc09180: 48 00 20 a5 bl ffc0b224 <_API_Mutex_Unlock> return EAGAIN; ffc09184: 4b ff fe 9c b ffc09020 int rc; if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; ffc09188: 3f e0 ff c2 lis r31,-62 ffc0918c: 3b ff 24 e4 addi r31,r31,9444 ffc09190: 4b ff fe 48 b ffc08fd8 * 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 ]; ffc09194: 3d 20 00 00 lis r9,0 ffc09198: 81 29 31 10 lwz r9,12560(r9) ffc0919c: 81 29 01 34 lwz r9,308(r9) schedpolicy = api->schedpolicy; schedparam = api->schedparam; ffc091a0: 80 a9 00 88 lwz r5,136(r9) ffc091a4: 80 c9 00 8c lwz r6,140(r9) ffc091a8: 80 e9 00 90 lwz r7,144(r9) ffc091ac: 81 09 00 94 lwz r8,148(r9) ffc091b0: 81 49 00 98 lwz r10,152(r9) ffc091b4: 81 69 00 9c lwz r11,156(r9) ffc091b8: 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; ffc091bc: 83 49 00 84 lwz r26,132(r9) schedparam = api->schedparam; ffc091c0: 90 a1 00 20 stw r5,32(r1) ffc091c4: 90 c1 00 24 stw r6,36(r1) ffc091c8: 90 e1 00 28 stw r7,40(r1) ffc091cc: 91 01 00 2c stw r8,44(r1) ffc091d0: 91 41 00 30 stw r10,48(r1) ffc091d4: 91 61 00 34 stw r11,52(r1) ffc091d8: 90 01 00 38 stw r0,56(r1) break; ffc091dc: 4b ff fe c0 b ffc0909c } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc091e0: 83 38 01 34 lwz r25,308(r24) api->Attributes = *the_attr; ffc091e4: 7f e4 fb 78 mr r4,r31 ffc091e8: 38 a0 00 40 li r5,64 ffc091ec: 7f 23 cb 78 mr r3,r25 ffc091f0: 48 00 c0 69 bl ffc15258 api->detachstate = the_attr->detachstate; ffc091f4: 80 1f 00 3c lwz r0,60(r31) api->schedpolicy = schedpolicy; ffc091f8: 93 59 00 84 stw r26,132(r25) api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc091fc: 7f 03 c3 78 mr r3,r24 ffc09200: 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; ffc09204: 90 19 00 40 stw r0,64(r25) api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc09208: 7f 65 db 78 mr r5,r27 ffc0920c: 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; ffc09210: 80 01 00 20 lwz r0,32(r1) /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc09214: 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; ffc09218: 90 19 00 88 stw r0,136(r25) ffc0921c: 80 01 00 24 lwz r0,36(r1) ffc09220: 90 19 00 8c stw r0,140(r25) ffc09224: 80 01 00 28 lwz r0,40(r1) ffc09228: 90 19 00 90 stw r0,144(r25) ffc0922c: 80 01 00 2c lwz r0,44(r1) ffc09230: 90 19 00 94 stw r0,148(r25) ffc09234: 80 01 00 30 lwz r0,48(r1) ffc09238: 90 19 00 98 stw r0,152(r25) ffc0923c: 80 01 00 34 lwz r0,52(r1) ffc09240: 90 19 00 9c stw r0,156(r25) ffc09244: 80 01 00 38 lwz r0,56(r1) ffc09248: 90 19 00 a0 stw r0,160(r25) /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc0924c: 48 00 4f ad bl ffc0e1f8 <_Thread_Start> _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { ffc09250: 2f 9a 00 04 cmpwi cr7,r26,4 ffc09254: 41 9e 00 18 beq- cr7,ffc0926c } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; ffc09258: 80 18 00 08 lwz r0,8(r24) _RTEMS_Unlock_allocator(); ffc0925c: 80 77 28 34 lwz r3,10292(r23) } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; ffc09260: 90 1d 00 00 stw r0,0(r29) _RTEMS_Unlock_allocator(); ffc09264: 48 00 1f c1 bl ffc0b224 <_API_Mutex_Unlock> return 0; ffc09268: 4b ff fd b8 b ffc09020 return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { _Watchdog_Insert_ticks( ffc0926c: 38 79 00 90 addi r3,r25,144 ffc09270: 48 00 51 a1 bl ffc0e410 <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc09274: 38 99 00 a8 addi r4,r25,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc09278: 90 79 00 b4 stw r3,180(r25) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0927c: 3c 60 00 00 lis r3,0 ffc09280: 38 63 2d 28 addi r3,r3,11560 ffc09284: 48 00 57 39 bl ffc0e9bc <_Watchdog_Insert> ffc09288: 4b ff ff d0 b ffc09258 =============================================================================== ffc2a37c : int pthread_kill( pthread_t thread, int sig ) { ffc2a37c: 94 21 ff d8 stwu r1,-40(r1) ffc2a380: 7c 08 02 a6 mflr r0 ffc2a384: 93 a1 00 1c stw r29,28(r1) POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) ffc2a388: 7c 9d 23 79 mr. r29,r4 int pthread_kill( pthread_t thread, int sig ) { ffc2a38c: 90 01 00 2c stw r0,44(r1) ffc2a390: 93 81 00 18 stw r28,24(r1) ffc2a394: 93 c1 00 20 stw r30,32(r1) ffc2a398: 93 e1 00 24 stw r31,36(r1) POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) ffc2a39c: 41 82 00 b8 beq- ffc2a454 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc2a3a0: 3b 9d ff ff addi r28,r29,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc2a3a4: 2b 9c 00 1f cmplwi cr7,r28,31 ffc2a3a8: 41 9d 00 ac bgt- cr7,ffc2a454 rtems_set_errno_and_return_minus_one( EINVAL ); the_thread = _Thread_Get( thread, &location ); ffc2a3ac: 38 81 00 08 addi r4,r1,8 ffc2a3b0: 4b fe 8b 55 bl ffc12f04 <_Thread_Get> switch ( location ) { ffc2a3b4: 80 01 00 08 lwz r0,8(r1) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); the_thread = _Thread_Get( thread, &location ); ffc2a3b8: 7c 7f 1b 78 mr r31,r3 switch ( location ) { ffc2a3bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc2a3c0: 40 9e 00 a8 bne- cr7,ffc2a468 <== NEVER TAKEN api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { ffc2a3c4: 1c 1d 00 0c mulli r0,r29,12 case OBJECTS_LOCAL: /* * If sig == 0 then just validate arguments */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc2a3c8: 81 23 01 34 lwz r9,308(r3) if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { ffc2a3cc: 3d 60 00 00 lis r11,0 ffc2a3d0: 39 6b 32 e0 addi r11,r11,13024 ffc2a3d4: 7d 6b 02 14 add r11,r11,r0 ffc2a3d8: 80 0b 00 08 lwz r0,8(r11) ffc2a3dc: 2f 80 00 01 cmpwi cr7,r0,1 ffc2a3e0: 41 9e 00 44 beq- cr7,ffc2a424 return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); ffc2a3e4: 80 09 00 d4 lwz r0,212(r9) static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); ffc2a3e8: 3b c0 00 01 li r30,1 ffc2a3ec: 7f dc e0 30 slw r28,r30,r28 ffc2a3f0: 7c 1c e3 78 or r28,r0,r28 ffc2a3f4: 93 89 00 d4 stw r28,212(r9) (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); ffc2a3f8: 7f a4 eb 78 mr r4,r29 ffc2a3fc: 38 a0 00 00 li r5,0 ffc2a400: 4b ff fe 11 bl ffc2a210 <_POSIX_signals_Unblock_thread> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc2a404: 3d 20 00 00 lis r9,0 ffc2a408: 39 29 32 84 addi r9,r9,12932 ffc2a40c: 80 09 00 08 lwz r0,8(r9) ffc2a410: 2f 80 00 00 cmpwi cr7,r0,0 ffc2a414: 41 9e 00 10 beq- cr7,ffc2a424 ffc2a418: 80 09 00 0c lwz r0,12(r9) ffc2a41c: 7f 9f 00 00 cmpw cr7,r31,r0 ffc2a420: 41 9e 00 2c beq- cr7,ffc2a44c _Thread_Dispatch_necessary = true; } _Thread_Enable_dispatch(); ffc2a424: 4b fe 8a c1 bl ffc12ee4 <_Thread_Enable_dispatch> return 0; ffc2a428: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( ESRCH ); } ffc2a42c: 80 01 00 2c lwz r0,44(r1) ffc2a430: 83 81 00 18 lwz r28,24(r1) ffc2a434: 7c 08 03 a6 mtlr r0 ffc2a438: 83 a1 00 1c lwz r29,28(r1) ffc2a43c: 83 c1 00 20 lwz r30,32(r1) ffc2a440: 83 e1 00 24 lwz r31,36(r1) ffc2a444: 38 21 00 28 addi r1,r1,40 ffc2a448: 4e 80 00 20 blr api->signals_pending |= signo_to_mask( sig ); (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; ffc2a44c: 9b c9 00 18 stb r30,24(r9) ffc2a450: 4b ff ff d4 b ffc2a424 if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc2a454: 4b ff 01 5d bl ffc1a5b0 <__errno> ffc2a458: 38 00 00 16 li r0,22 ffc2a45c: 90 03 00 00 stw r0,0(r3) ffc2a460: 38 60 ff ff li r3,-1 ffc2a464: 4b ff ff c8 b ffc2a42c #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( ESRCH ); ffc2a468: 4b ff 01 49 bl ffc1a5b0 <__errno> <== NOT EXECUTED ffc2a46c: 38 00 00 03 li r0,3 <== NOT EXECUTED ffc2a470: 90 03 00 00 stw r0,0(r3) <== NOT EXECUTED ffc2a474: 38 60 ff ff li r3,-1 <== NOT EXECUTED ffc2a478: 4b ff ff b4 b ffc2a42c <== NOT EXECUTED =============================================================================== ffc0b614 : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { ffc0b614: 94 21 ff e0 stwu r1,-32(r1) ffc0b618: 7c 08 02 a6 mflr r0 ffc0b61c: 93 c1 00 18 stw r30,24(r1) ffc0b620: 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 ); ffc0b624: 7c 83 23 78 mr r3,r4 ffc0b628: 38 81 00 08 addi r4,r1,8 int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { ffc0b62c: 93 e1 00 1c stw r31,28(r1) ffc0b630: 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 ); ffc0b634: 48 00 01 2d bl ffc0b760 <_POSIX_Absolute_timeout_to_ticks> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0b638: 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 ); ffc0b63c: 7c 7f 1b 78 mr r31,r3 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0b640: 41 9e 00 50 beq- cr7,ffc0b690 do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); ffc0b644: 80 a1 00 08 lwz r5,8(r1) ffc0b648: 7f c3 f3 78 mr r3,r30 ffc0b64c: 38 80 00 00 li r4,0 ffc0b650: 4b ff fe 3d bl ffc0b48c <_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) ) { ffc0b654: 2f 83 00 10 cmpwi cr7,r3,16 ffc0b658: 41 9e 00 1c beq- cr7,ffc0b674 <== ALWAYS TAKEN status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } ffc0b65c: 80 01 00 24 lwz r0,36(r1) ffc0b660: 83 c1 00 18 lwz r30,24(r1) ffc0b664: 7c 08 03 a6 mtlr r0 ffc0b668: 83 e1 00 1c lwz r31,28(r1) ffc0b66c: 38 21 00 20 addi r1,r1,32 ffc0b670: 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 ) ffc0b674: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0b678: 41 9e 00 40 beq- cr7,ffc0b6b8 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0b67c: 3b ff ff ff addi r31,r31,-1 ffc0b680: 2b 9f 00 01 cmplwi cr7,r31,1 ffc0b684: 41 9d ff d8 bgt+ cr7,ffc0b65c <== NEVER TAKEN status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0b688: 38 60 00 74 li r3,116 ffc0b68c: 4b ff ff d0 b ffc0b65c */ 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 ); ffc0b690: 80 a1 00 08 lwz r5,8(r1) ffc0b694: 7f c3 f3 78 mr r3,r30 ffc0b698: 38 80 00 01 li r4,1 ffc0b69c: 4b ff fd f1 bl ffc0b48c <_POSIX_Mutex_Lock_support> status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } ffc0b6a0: 80 01 00 24 lwz r0,36(r1) ffc0b6a4: 83 c1 00 18 lwz r30,24(r1) ffc0b6a8: 7c 08 03 a6 mtlr r0 ffc0b6ac: 83 e1 00 1c lwz r31,28(r1) ffc0b6b0: 38 21 00 20 addi r1,r1,32 ffc0b6b4: 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; ffc0b6b8: 38 60 00 16 li r3,22 <== NOT EXECUTED ffc0b6bc: 4b ff ff a0 b ffc0b65c <== NOT EXECUTED =============================================================================== ffc09848 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { ffc09848: 94 21 ff d8 stwu r1,-40(r1) ffc0984c: 7c 08 02 a6 mflr r0 ffc09850: 93 e1 00 24 stw r31,36(r1) if ( !once_control || !init_routine ) ffc09854: 7c 7f 1b 79 mr. r31,r3 return EINVAL; ffc09858: 38 60 00 16 li r3,22 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { ffc0985c: 93 c1 00 20 stw r30,32(r1) ffc09860: 7c 9e 23 78 mr r30,r4 ffc09864: 90 01 00 2c stw r0,44(r1) ffc09868: 93 a1 00 1c stw r29,28(r1) if ( !once_control || !init_routine ) ffc0986c: 41 82 00 1c beq- ffc09888 ffc09870: 2f 84 00 00 cmpwi cr7,r4,0 ffc09874: 41 9e 00 14 beq- cr7,ffc09888 return EINVAL; if ( !once_control->init_executed ) { ffc09878: 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; ffc0987c: 38 60 00 00 li r3,0 ) { if ( !once_control || !init_routine ) return EINVAL; if ( !once_control->init_executed ) { ffc09880: 2f 80 00 00 cmpwi cr7,r0,0 ffc09884: 41 9e 00 20 beq- cr7,ffc098a4 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } ffc09888: 80 01 00 2c lwz r0,44(r1) ffc0988c: 83 a1 00 1c lwz r29,28(r1) ffc09890: 7c 08 03 a6 mtlr r0 ffc09894: 83 c1 00 20 lwz r30,32(r1) ffc09898: 83 e1 00 24 lwz r31,36(r1) ffc0989c: 38 21 00 28 addi r1,r1,40 ffc098a0: 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); ffc098a4: 3b a1 00 08 addi r29,r1,8 ffc098a8: 38 60 01 00 li r3,256 ffc098ac: 38 80 01 00 li r4,256 ffc098b0: 7f a5 eb 78 mr r5,r29 ffc098b4: 48 00 0f 95 bl ffc0a848 if ( !once_control->init_executed ) { ffc098b8: 80 1f 00 04 lwz r0,4(r31) ffc098bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc098c0: 41 9e 00 34 beq- cr7,ffc098f4 <== ALWAYS TAKEN once_control->is_initialized = true; once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); ffc098c4: 80 61 00 08 lwz r3,8(r1) ffc098c8: 7f a5 eb 78 mr r5,r29 ffc098cc: 38 80 01 00 li r4,256 ffc098d0: 48 00 0f 79 bl ffc0a848 } return 0; } ffc098d4: 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; ffc098d8: 38 60 00 00 li r3,0 } ffc098dc: 83 a1 00 1c lwz r29,28(r1) ffc098e0: 7c 08 03 a6 mtlr r0 ffc098e4: 83 c1 00 20 lwz r30,32(r1) ffc098e8: 83 e1 00 24 lwz r31,36(r1) ffc098ec: 38 21 00 28 addi r1,r1,40 ffc098f0: 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; ffc098f4: 38 00 00 01 li r0,1 once_control->init_executed = true; (*init_routine)(); ffc098f8: 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; ffc098fc: 90 1f 00 00 stw r0,0(r31) once_control->init_executed = true; ffc09900: 90 1f 00 04 stw r0,4(r31) (*init_routine)(); ffc09904: 4e 80 04 21 bctrl ffc09908: 4b ff ff bc b ffc098c4 =============================================================================== ffc0a1c0 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { ffc0a1c0: 94 21 ff d8 stwu r1,-40(r1) ffc0a1c4: 7c 08 02 a6 mflr r0 ffc0a1c8: 93 c1 00 20 stw r30,32(r1) const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) ffc0a1cc: 7c 7e 1b 79 mr. r30,r3 return EINVAL; ffc0a1d0: 38 60 00 16 li r3,22 int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { ffc0a1d4: 90 01 00 2c stw r0,44(r1) ffc0a1d8: 93 81 00 18 stw r28,24(r1) ffc0a1dc: 93 a1 00 1c stw r29,28(r1) ffc0a1e0: 93 e1 00 24 stw r31,36(r1) const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) ffc0a1e4: 41 82 00 80 beq- ffc0a264 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { ffc0a1e8: 2f 84 00 00 cmpwi cr7,r4,0 ffc0a1ec: 41 9e 00 a4 beq- cr7,ffc0a290 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc0a1f0: 80 04 00 00 lwz r0,0(r4) return EINVAL; ffc0a1f4: 38 60 00 16 li r3,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc0a1f8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a1fc: 41 9e 00 68 beq- cr7,ffc0a264 <== NEVER TAKEN return EINVAL; switch ( the_attr->process_shared ) { ffc0a200: 83 e4 00 04 lwz r31,4(r4) ffc0a204: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0a208: 40 9e 00 5c bne- cr7,ffc0a264 <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0a20c: 3d 20 00 00 lis r9,0 */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; ffc0a210: 93 e1 00 08 stw r31,8(r1) ffc0a214: 81 69 28 14 lwz r11,10260(r9) ffc0a218: 38 0b 00 01 addi r0,r11,1 ffc0a21c: 90 09 28 14 stw r0,10260(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 ); ffc0a220: 3f 80 00 00 lis r28,0 ffc0a224: 3b 9c 2d ec addi r28,r28,11756 ffc0a228: 7f 83 e3 78 mr r3,r28 ffc0a22c: 48 00 33 65 bl ffc0d590 <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { ffc0a230: 7c 7d 1b 79 mr. r29,r3 ffc0a234: 41 82 00 50 beq- ffc0a284 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); ffc0a238: 38 7d 00 10 addi r3,r29,16 ffc0a23c: 38 81 00 08 addi r4,r1,8 ffc0a240: 48 00 28 29 bl ffc0ca68 <_CORE_RWLock_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc0a244: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0a248: 81 7c 00 1c lwz r11,28(r28) ffc0a24c: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc0a250: 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; ffc0a254: 93 fd 00 0c stw r31,12(r29) &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; ffc0a258: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc0a25c: 48 00 49 6d bl ffc0ebc8 <_Thread_Enable_dispatch> return 0; ffc0a260: 38 60 00 00 li r3,0 } ffc0a264: 80 01 00 2c lwz r0,44(r1) ffc0a268: 83 81 00 18 lwz r28,24(r1) ffc0a26c: 7c 08 03 a6 mtlr r0 ffc0a270: 83 a1 00 1c lwz r29,28(r1) ffc0a274: 83 c1 00 20 lwz r30,32(r1) ffc0a278: 83 e1 00 24 lwz r31,36(r1) ffc0a27c: 38 21 00 28 addi r1,r1,40 ffc0a280: 4e 80 00 20 blr _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { _Thread_Enable_dispatch(); ffc0a284: 48 00 49 45 bl ffc0ebc8 <_Thread_Enable_dispatch> return EAGAIN; ffc0a288: 38 60 00 0b li r3,11 ffc0a28c: 4b ff ff d8 b ffc0a264 * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); ffc0a290: 3b e1 00 0c addi r31,r1,12 ffc0a294: 7f e3 fb 78 mr r3,r31 ffc0a298: 48 00 0c 41 bl ffc0aed8 the_attr = &default_attr; ffc0a29c: 7f e4 fb 78 mr r4,r31 ffc0a2a0: 4b ff ff 50 b ffc0a1f0 =============================================================================== ffc0a330 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a330: 94 21 ff d8 stwu r1,-40(r1) ffc0a334: 7c 08 02 a6 mflr r0 ffc0a338: 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 ) ffc0a33c: 7c 7c 1b 79 mr. r28,r3 int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a340: 7c 83 23 78 mr r3,r4 ffc0a344: 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; ffc0a348: 3b e0 00 16 li r31,22 int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a34c: 90 01 00 2c stw r0,44(r1) ffc0a350: 93 a1 00 1c stw r29,28(r1) ffc0a354: 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 ) ffc0a358: 41 82 00 7c beq- ffc0a3d4 * * 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 ); ffc0a35c: 38 81 00 0c addi r4,r1,12 ffc0a360: 48 00 84 e1 bl ffc12840 <_POSIX_Absolute_timeout_to_ticks> ffc0a364: 80 9c 00 00 lwz r4,0(r28) ffc0a368: 7c 7d 1b 78 mr r29,r3 ffc0a36c: 3c 60 00 00 lis r3,0 ffc0a370: 38 63 2d ec addi r3,r3,11756 ffc0a374: 38 a1 00 08 addi r5,r1,8 ffc0a378: 48 00 38 2d bl ffc0dba4 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { ffc0a37c: 80 01 00 08 lwz r0,8(r1) ffc0a380: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a384: 40 9e 00 50 bne- cr7,ffc0a3d4 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, ffc0a388: 6b be 00 03 xori r30,r29,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( ffc0a38c: 80 9c 00 00 lwz r4,0(r28) ffc0a390: 7f de 00 34 cntlzw r30,r30 ffc0a394: 80 c1 00 0c lwz r6,12(r1) ffc0a398: 57 de d9 7e rlwinm r30,r30,27,5,31 ffc0a39c: 38 63 00 10 addi r3,r3,16 ffc0a3a0: 7f c5 f3 78 mr r5,r30 ffc0a3a4: 38 e0 00 00 li r7,0 ffc0a3a8: 48 00 27 01 bl ffc0caa8 <_CORE_RWLock_Obtain_for_reading> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); ffc0a3ac: 48 00 48 1d bl ffc0ebc8 <_Thread_Enable_dispatch> if ( !do_wait ) { ffc0a3b0: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a3b4: 40 9e 00 60 bne- cr7,ffc0a414 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { ffc0a3b8: 3d 20 00 00 lis r9,0 ffc0a3bc: 81 29 31 30 lwz r9,12592(r9) ffc0a3c0: 80 69 00 34 lwz r3,52(r9) ffc0a3c4: 2f 83 00 02 cmpwi cr7,r3,2 ffc0a3c8: 41 9e 00 30 beq- cr7,ffc0a3f8 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( ffc0a3cc: 48 00 01 4d bl ffc0a518 <_POSIX_RWLock_Translate_core_RWLock_return_code> ffc0a3d0: 7c 7f 1b 78 mr r31,r3 case OBJECTS_ERROR: break; } return EINVAL; } ffc0a3d4: 80 01 00 2c lwz r0,44(r1) ffc0a3d8: 7f e3 fb 78 mr r3,r31 ffc0a3dc: 83 81 00 18 lwz r28,24(r1) ffc0a3e0: 7c 08 03 a6 mtlr r0 ffc0a3e4: 83 a1 00 1c lwz r29,28(r1) ffc0a3e8: 83 c1 00 20 lwz r30,32(r1) ffc0a3ec: 83 e1 00 24 lwz r31,36(r1) ffc0a3f0: 38 21 00 28 addi r1,r1,40 ffc0a3f4: 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 ) ffc0a3f8: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0a3fc: 41 be ff d8 beq- cr7,ffc0a3d4 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0a400: 3b bd ff ff addi r29,r29,-1 ffc0a404: 2b 9d 00 01 cmplwi cr7,r29,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0a408: 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 || ffc0a40c: 41 9d ff c0 bgt+ cr7,ffc0a3cc <== NEVER TAKEN ffc0a410: 4b ff ff c4 b ffc0a3d4 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait ) { ffc0a414: 3d 20 00 00 lis r9,0 ffc0a418: 81 29 31 30 lwz r9,12592(r9) ffc0a41c: 80 69 00 34 lwz r3,52(r9) ffc0a420: 4b ff ff ac b ffc0a3cc =============================================================================== ffc0a424 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a424: 94 21 ff d8 stwu r1,-40(r1) ffc0a428: 7c 08 02 a6 mflr r0 ffc0a42c: 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 ) ffc0a430: 7c 7c 1b 79 mr. r28,r3 int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a434: 7c 83 23 78 mr r3,r4 ffc0a438: 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; ffc0a43c: 3b e0 00 16 li r31,22 int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a440: 90 01 00 2c stw r0,44(r1) ffc0a444: 93 a1 00 1c stw r29,28(r1) ffc0a448: 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 ) ffc0a44c: 41 82 00 7c beq- ffc0a4c8 * * 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 ); ffc0a450: 38 81 00 0c addi r4,r1,12 ffc0a454: 48 00 83 ed bl ffc12840 <_POSIX_Absolute_timeout_to_ticks> ffc0a458: 80 9c 00 00 lwz r4,0(r28) ffc0a45c: 7c 7d 1b 78 mr r29,r3 ffc0a460: 3c 60 00 00 lis r3,0 ffc0a464: 38 63 2d ec addi r3,r3,11756 ffc0a468: 38 a1 00 08 addi r5,r1,8 ffc0a46c: 48 00 37 39 bl ffc0dba4 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { ffc0a470: 80 01 00 08 lwz r0,8(r1) ffc0a474: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a478: 40 9e 00 50 bne- cr7,ffc0a4c8 (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, ffc0a47c: 6b be 00 03 xori r30,r29,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( ffc0a480: 80 9c 00 00 lwz r4,0(r28) ffc0a484: 7f de 00 34 cntlzw r30,r30 ffc0a488: 80 c1 00 0c lwz r6,12(r1) ffc0a48c: 57 de d9 7e rlwinm r30,r30,27,5,31 ffc0a490: 38 63 00 10 addi r3,r3,16 ffc0a494: 7f c5 f3 78 mr r5,r30 ffc0a498: 38 e0 00 00 li r7,0 ffc0a49c: 48 00 27 51 bl ffc0cbec <_CORE_RWLock_Obtain_for_writing> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); ffc0a4a0: 48 00 47 29 bl ffc0ebc8 <_Thread_Enable_dispatch> if ( !do_wait && ffc0a4a4: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a4a8: 40 9e 00 60 bne- cr7,ffc0a508 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { ffc0a4ac: 3d 20 00 00 lis r9,0 ffc0a4b0: 81 29 31 30 lwz r9,12592(r9) ffc0a4b4: 80 69 00 34 lwz r3,52(r9) ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && ffc0a4b8: 2f 83 00 02 cmpwi cr7,r3,2 ffc0a4bc: 41 9e 00 30 beq- cr7,ffc0a4ec if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( ffc0a4c0: 48 00 00 59 bl ffc0a518 <_POSIX_RWLock_Translate_core_RWLock_return_code> ffc0a4c4: 7c 7f 1b 78 mr r31,r3 case OBJECTS_ERROR: break; } return EINVAL; } ffc0a4c8: 80 01 00 2c lwz r0,44(r1) ffc0a4cc: 7f e3 fb 78 mr r3,r31 ffc0a4d0: 83 81 00 18 lwz r28,24(r1) ffc0a4d4: 7c 08 03 a6 mtlr r0 ffc0a4d8: 83 a1 00 1c lwz r29,28(r1) ffc0a4dc: 83 c1 00 20 lwz r30,32(r1) ffc0a4e0: 83 e1 00 24 lwz r31,36(r1) ffc0a4e4: 38 21 00 28 addi r1,r1,40 ffc0a4e8: 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 ) ffc0a4ec: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0a4f0: 41 be ff d8 beq- cr7,ffc0a4c8 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0a4f4: 3b bd ff ff addi r29,r29,-1 ffc0a4f8: 2b 9d 00 01 cmplwi cr7,r29,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0a4fc: 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 || ffc0a500: 41 9d ff c0 bgt+ cr7,ffc0a4c0 <== NEVER TAKEN ffc0a504: 4b ff ff c4 b ffc0a4c8 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && ffc0a508: 3d 20 00 00 lis r9,0 ffc0a50c: 81 29 31 30 lwz r9,12592(r9) ffc0a510: 80 69 00 34 lwz r3,52(r9) ffc0a514: 4b ff ff ac b ffc0a4c0 =============================================================================== ffc0c1dc : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0c1dc: 94 21 ff d0 stwu r1,-48(r1) ffc0c1e0: 7c 08 02 a6 mflr r0 ffc0c1e4: 93 e1 00 2c stw r31,44(r1) int rc; /* * Check all the parameters */ if ( !param ) ffc0c1e8: 7c bf 2b 79 mr. r31,r5 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0c1ec: 93 81 00 20 stw r28,32(r1) /* * Check all the parameters */ if ( !param ) return EINVAL; ffc0c1f0: 3b 80 00 16 li r28,22 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0c1f4: 93 a1 00 24 stw r29,36(r1) ffc0c1f8: 7c 7d 1b 78 mr r29,r3 ffc0c1fc: 93 c1 00 28 stw r30,40(r1) ffc0c200: 7c 9e 23 78 mr r30,r4 ffc0c204: 90 01 00 34 stw r0,52(r1) ffc0c208: 93 61 00 1c stw r27,28(r1) int rc; /* * Check all the parameters */ if ( !param ) ffc0c20c: 41 82 00 20 beq- ffc0c22c return EINVAL; rc = _POSIX_Thread_Translate_sched_param( ffc0c210: 7c 83 23 78 mr r3,r4 ffc0c214: 38 a1 00 08 addi r5,r1,8 ffc0c218: 7f e4 fb 78 mr r4,r31 ffc0c21c: 38 c1 00 0c addi r6,r1,12 ffc0c220: 48 00 7a 39 bl ffc13c58 <_POSIX_Thread_Translate_sched_param> policy, param, &budget_algorithm, &budget_callout ); if ( rc ) ffc0c224: 7c 7c 1b 79 mr. r28,r3 ffc0c228: 41 82 00 2c beq- ffc0c254 case OBJECTS_ERROR: break; } return ESRCH; } ffc0c22c: 80 01 00 34 lwz r0,52(r1) ffc0c230: 7f 83 e3 78 mr r3,r28 ffc0c234: 83 61 00 1c lwz r27,28(r1) ffc0c238: 7c 08 03 a6 mtlr r0 ffc0c23c: 83 81 00 20 lwz r28,32(r1) ffc0c240: 83 a1 00 24 lwz r29,36(r1) ffc0c244: 83 c1 00 28 lwz r30,40(r1) ffc0c248: 83 e1 00 2c lwz r31,44(r1) ffc0c24c: 38 21 00 30 addi r1,r1,48 ffc0c250: 4e 80 00 20 blr return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); ffc0c254: 7f a3 eb 78 mr r3,r29 ffc0c258: 38 81 00 10 addi r4,r1,16 ffc0c25c: 48 00 3a 85 bl ffc0fce0 <_Thread_Get> switch ( location ) { ffc0c260: 80 01 00 10 lwz r0,16(r1) return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); ffc0c264: 7c 7b 1b 78 mr r27,r3 switch ( location ) { ffc0c268: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c26c: 40 9e 00 c4 bne- cr7,ffc0c330 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0c270: 83 a3 01 34 lwz r29,308(r3) if ( api->schedpolicy == SCHED_SPORADIC ) ffc0c274: 80 1d 00 84 lwz r0,132(r29) ffc0c278: 2f 80 00 04 cmpwi cr7,r0,4 ffc0c27c: 41 9e 01 08 beq- cr7,ffc0c384 (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; ffc0c280: 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 ) { ffc0c284: 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; ffc0c288: 81 5f 00 04 lwz r10,4(r31) ffc0c28c: 81 7f 00 08 lwz r11,8(r31) ffc0c290: 81 3f 00 0c lwz r9,12(r31) ffc0c294: 80 1f 00 00 lwz r0,0(r31) ffc0c298: 91 5d 00 8c stw r10,140(r29) ffc0c29c: 90 1d 00 88 stw r0,136(r29) ffc0c2a0: 91 7d 00 90 stw r11,144(r29) ffc0c2a4: 91 3d 00 94 stw r9,148(r29) ffc0c2a8: 81 3f 00 18 lwz r9,24(r31) ffc0c2ac: 81 5f 00 10 lwz r10,16(r31) ffc0c2b0: 81 7f 00 14 lwz r11,20(r31) ffc0c2b4: 91 3d 00 a0 stw r9,160(r29) the_thread->budget_algorithm = budget_algorithm; ffc0c2b8: 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; ffc0c2bc: 91 5d 00 98 stw r10,152(r29) ffc0c2c0: 91 7d 00 9c stw r11,156(r29) the_thread->budget_algorithm = budget_algorithm; ffc0c2c4: 91 3b 00 7c stw r9,124(r27) the_thread->budget_callout = budget_callout; ffc0c2c8: 81 21 00 0c lwz r9,12(r1) ffc0c2cc: 91 3b 00 80 stw r9,128(r27) switch ( api->schedpolicy ) { ffc0c2d0: 41 9c 00 34 blt- cr7,ffc0c304 <== NEVER TAKEN ffc0c2d4: 2f 9e 00 02 cmpwi cr7,r30,2 ffc0c2d8: 41 9d 00 84 bgt- cr7,ffc0c35c ffc0c2dc: 3d 20 00 00 lis r9,0 ffc0c2e0: 88 89 27 8c lbz r4,10124(r9) case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0c2e4: 3d 20 00 00 lis r9,0 ffc0c2e8: 81 29 28 84 lwz r9,10372(r9) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c2ec: 7f 63 db 78 mr r3,r27 ffc0c2f0: 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; ffc0c2f4: 91 3b 00 78 stw r9,120(r27) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c2f8: 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 = ffc0c2fc: 90 9b 00 18 stw r4,24(r27) _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c300: 48 00 33 79 bl ffc0f678 <_Thread_Change_priority> _Watchdog_Remove( &api->Sporadic_timer ); _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); break; } _Thread_Enable_dispatch(); ffc0c304: 48 00 39 bd bl ffc0fcc0 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return ESRCH; } ffc0c308: 80 01 00 34 lwz r0,52(r1) ffc0c30c: 7f 83 e3 78 mr r3,r28 ffc0c310: 83 61 00 1c lwz r27,28(r1) ffc0c314: 7c 08 03 a6 mtlr r0 ffc0c318: 83 81 00 20 lwz r28,32(r1) ffc0c31c: 83 a1 00 24 lwz r29,36(r1) ffc0c320: 83 c1 00 28 lwz r30,40(r1) ffc0c324: 83 e1 00 2c lwz r31,44(r1) ffc0c328: 38 21 00 30 addi r1,r1,48 ffc0c32c: 4e 80 00 20 blr ffc0c330: 80 01 00 34 lwz r0,52(r1) #endif case OBJECTS_ERROR: break; } return ESRCH; ffc0c334: 3b 80 00 03 li r28,3 } ffc0c338: 7f 83 e3 78 mr r3,r28 ffc0c33c: 83 61 00 1c lwz r27,28(r1) ffc0c340: 7c 08 03 a6 mtlr r0 ffc0c344: 83 81 00 20 lwz r28,32(r1) ffc0c348: 83 a1 00 24 lwz r29,36(r1) ffc0c34c: 83 c1 00 28 lwz r30,40(r1) ffc0c350: 83 e1 00 2c lwz r31,44(r1) ffc0c354: 38 21 00 30 addi r1,r1,48 ffc0c358: 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 ) { ffc0c35c: 2f 9e 00 04 cmpwi cr7,r30,4 ffc0c360: 40 9e ff a4 bne+ cr7,ffc0c304 <== NEVER TAKEN true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; ffc0c364: 90 1d 00 a4 stw r0,164(r29) _Watchdog_Remove( &api->Sporadic_timer ); ffc0c368: 38 7d 00 a8 addi r3,r29,168 ffc0c36c: 48 00 51 a1 bl ffc1150c <_Watchdog_Remove> _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); ffc0c370: 38 60 00 00 li r3,0 ffc0c374: 7f 64 db 78 mr r4,r27 ffc0c378: 4b ff fc bd bl ffc0c034 <_POSIX_Threads_Sporadic_budget_TSR> break; } _Thread_Enable_dispatch(); ffc0c37c: 48 00 39 45 bl ffc0fcc0 <_Thread_Enable_dispatch> ffc0c380: 4b ff ff 88 b ffc0c308 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); ffc0c384: 38 7d 00 a8 addi r3,r29,168 ffc0c388: 48 00 51 85 bl ffc1150c <_Watchdog_Remove> ffc0c38c: 4b ff fe f4 b ffc0c280 =============================================================================== ffc117dc : sigset_t *oset ) { POSIX_API_Control *api; if ( !set && !oset ) ffc117dc: 2c 04 00 00 cmpwi r4,0 int pthread_sigmask( int how, const sigset_t *set, sigset_t *oset ) { ffc117e0: 94 21 ff f0 stwu r1,-16(r1) ffc117e4: 7c 08 02 a6 mflr r0 ffc117e8: 90 01 00 14 stw r0,20(r1) POSIX_API_Control *api; if ( !set && !oset ) ffc117ec: 41 82 00 c4 beq- ffc118b0 rtems_set_errno_and_return_minus_one( EINVAL ); api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; if ( oset ) ffc117f0: 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 ]; ffc117f4: 3d 20 00 00 lis r9,0 ffc117f8: 81 29 31 90 lwz r9,12688(r9) ffc117fc: 81 29 01 34 lwz r9,308(r9) if ( oset ) ffc11800: 41 9e 00 10 beq- cr7,ffc11810 *oset = api->signals_blocked; ffc11804: 80 09 00 d0 lwz r0,208(r9) ffc11808: 90 05 00 00 stw r0,0(r5) if ( !set ) ffc1180c: 41 82 00 c4 beq- ffc118d0 <== NEVER TAKEN return 0; switch ( how ) { ffc11810: 2f 83 00 01 cmpwi cr7,r3,1 ffc11814: 41 9e 00 88 beq- cr7,ffc1189c ffc11818: 2f 83 00 02 cmpwi cr7,r3,2 ffc1181c: 41 9e 00 4c beq- cr7,ffc11868 ffc11820: 2f 83 00 00 cmpwi cr7,r3,0 ffc11824: 40 9e 00 58 bne- cr7,ffc1187c break; case SIG_UNBLOCK: api->signals_blocked &= ~*set; break; case SIG_SETMASK: api->signals_blocked = *set; ffc11828: 80 04 00 00 lwz r0,0(r4) ffc1182c: 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) ) { ffc11830: 3d 60 00 00 lis r11,0 ffc11834: 81 29 00 d4 lwz r9,212(r9) ffc11838: 81 6b 28 c4 lwz r11,10436(r11) _Thread_Dispatch(); } return 0; ffc1183c: 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) ) { ffc11840: 7d 69 4b 78 or r9,r11,r9 /* XXX are there critical section problems here? */ /* XXX evaluate the new set */ if ( ~api->signals_blocked & ffc11844: 7d 2b 00 79 andc. r11,r9,r0 ffc11848: 41 a2 00 10 beq+ ffc11858 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); ffc1184c: 90 61 00 08 stw r3,8(r1) ffc11850: 4b ff b9 39 bl ffc0d188 <_Thread_Dispatch> ffc11854: 80 61 00 08 lwz r3,8(r1) } return 0; } ffc11858: 80 01 00 14 lwz r0,20(r1) ffc1185c: 38 21 00 10 addi r1,r1,16 ffc11860: 7c 08 03 a6 mtlr r0 ffc11864: 4e 80 00 20 blr switch ( how ) { case SIG_BLOCK: api->signals_blocked |= *set; break; case SIG_UNBLOCK: api->signals_blocked &= ~*set; ffc11868: 81 64 00 00 lwz r11,0(r4) ffc1186c: 80 09 00 d0 lwz r0,208(r9) ffc11870: 7c 00 58 78 andc r0,r0,r11 ffc11874: 90 09 00 d0 stw r0,208(r9) break; ffc11878: 4b ff ff b8 b ffc11830 case SIG_SETMASK: api->signals_blocked = *set; break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc1187c: 48 00 32 e1 bl ffc14b5c <__errno> ffc11880: 38 00 00 16 li r0,22 ffc11884: 90 03 00 00 stw r0,0(r3) ffc11888: 38 60 ff ff li r3,-1 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc1188c: 80 01 00 14 lwz r0,20(r1) ffc11890: 38 21 00 10 addi r1,r1,16 ffc11894: 7c 08 03 a6 mtlr r0 ffc11898: 4e 80 00 20 blr if ( !set ) return 0; switch ( how ) { case SIG_BLOCK: api->signals_blocked |= *set; ffc1189c: 80 09 00 d0 lwz r0,208(r9) ffc118a0: 81 64 00 00 lwz r11,0(r4) ffc118a4: 7c 00 5b 78 or r0,r0,r11 ffc118a8: 90 09 00 d0 stw r0,208(r9) break; ffc118ac: 4b ff ff 84 b ffc11830 sigset_t *oset ) { POSIX_API_Control *api; if ( !set && !oset ) ffc118b0: 2f 85 00 00 cmpwi cr7,r5,0 ffc118b4: 41 be ff c8 beq- cr7,ffc1187c rtems_set_errno_and_return_minus_one( EINVAL ); api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc118b8: 3d 20 00 00 lis r9,0 ffc118bc: 81 29 31 90 lwz r9,12688(r9) ffc118c0: 81 29 01 34 lwz r9,308(r9) if ( oset ) *oset = api->signals_blocked; ffc118c4: 80 09 00 d0 lwz r0,208(r9) ffc118c8: 90 05 00 00 stw r0,0(r5) if ( !set ) ffc118cc: 40 82 ff 44 bne+ ffc11810 <== NEVER TAKEN (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc118d0: 80 01 00 14 lwz r0,20(r1) if ( oset ) *oset = api->signals_blocked; if ( !set ) return 0; ffc118d4: 38 60 00 00 li r3,0 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc118d8: 38 21 00 10 addi r1,r1,16 ffc118dc: 7c 08 03 a6 mtlr r0 ffc118e0: 4e 80 00 20 blr =============================================================================== ffc09438 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { ffc09438: 94 21 ff f0 stwu r1,-16(r1) ffc0943c: 7c 08 02 a6 mflr r0 ffc09440: 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() ) ffc09444: 3f e0 00 00 lis r31,0 ffc09448: 3b ff 31 04 addi r31,r31,12548 * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { ffc0944c: 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() ) ffc09450: 80 1f 00 08 lwz r0,8(r31) ffc09454: 2f 80 00 00 cmpwi cr7,r0,0 ffc09458: 40 9e 00 44 bne- cr7,ffc0949c <== NEVER TAKEN ffc0945c: 3d 20 00 00 lis r9,0 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc09460: 81 7f 00 0c lwz r11,12(r31) ffc09464: 81 49 28 0c lwz r10,10252(r9) ffc09468: 81 6b 01 34 lwz r11,308(r11) ffc0946c: 38 0a 00 01 addi r0,r10,1 ffc09470: 90 09 28 0c stw r0,10252(r9) _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc09474: 80 0b 00 d8 lwz r0,216(r11) ffc09478: 2f 80 00 00 cmpwi cr7,r0,0 ffc0947c: 40 9e 00 34 bne- cr7,ffc094b0 <== NEVER TAKEN ffc09480: 80 0b 00 e0 lwz r0,224(r11) ffc09484: 2f 80 00 00 cmpwi cr7,r0,0 ffc09488: 41 9e 00 28 beq- cr7,ffc094b0 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); ffc0948c: 48 00 38 31 bl ffc0ccbc <_Thread_Enable_dispatch> if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); ffc09490: 80 7f 00 0c lwz r3,12(r31) ffc09494: 38 80 ff ff li r4,-1 ffc09498: 48 00 78 b5 bl ffc10d4c <_POSIX_Thread_Exit> } ffc0949c: 80 01 00 14 lwz r0,20(r1) <== NOT EXECUTED ffc094a0: 83 e1 00 0c lwz r31,12(r1) <== NOT EXECUTED ffc094a4: 38 21 00 10 addi r1,r1,16 <== NOT EXECUTED ffc094a8: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc094ac: 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(); ffc094b0: 48 00 38 0d bl ffc0ccbc <_Thread_Enable_dispatch> if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); } ffc094b4: 80 01 00 14 lwz r0,20(r1) ffc094b8: 83 e1 00 0c lwz r31,12(r1) ffc094bc: 38 21 00 10 addi r1,r1,16 ffc094c0: 7c 08 03 a6 mtlr r0 ffc094c4: 4e 80 00 20 blr =============================================================================== ffc0a310 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a310: 94 21 ff b0 stwu r1,-80(r1) ffc0a314: 7c 08 02 a6 mflr r0 ffc0a318: 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); ffc0a31c: 3f e0 00 00 lis r31,0 ffc0a320: 3b ff 2c 70 addi r31,r31,11376 * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a324: 93 a1 00 44 stw r29,68(r1) ffc0a328: 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); ffc0a32c: 7f e3 fb 78 mr r3,r31 * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a330: 93 c1 00 48 stw r30,72(r1) ffc0a334: 90 01 00 54 stw r0,84(r1) ffc0a338: 93 61 00 3c stw r27,60(r1) ffc0a33c: 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); ffc0a340: 48 00 0c 51 bl ffc0af90 if (result != 0) { ffc0a344: 7c 7e 1b 79 mr. r30,r3 ffc0a348: 40 82 00 d4 bne- ffc0a41c <== 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); ffc0a34c: 48 00 17 cd bl ffc0bb18 ffc0a350: 38 81 00 0c addi r4,r1,12 ffc0a354: 38 a1 00 10 addi r5,r1,16 ffc0a358: 48 00 11 e1 bl ffc0b538 req->caller_thread = pthread_self (); ffc0a35c: 48 00 17 bd bl ffc0bb18 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) && ffc0a360: 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; ffc0a364: 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) && ffc0a368: 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; ffc0a36c: 81 61 00 10 lwz r11,16(r1) ffc0a370: 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 (); ffc0a374: 90 7d 00 10 stw r3,16(r29) req->priority = param.sched_priority - req->aiocbp->aio_reqprio; ffc0a378: 7c 00 58 50 subf r0,r0,r11 ffc0a37c: 90 1d 00 0c stw r0,12(r29) req->policy = policy; ffc0a380: 80 01 00 0c lwz r0,12(r1) ffc0a384: 90 1d 00 08 stw r0,8(r29) req->aiocbp->error_code = EINPROGRESS; ffc0a388: 38 00 00 77 li r0,119 ffc0a38c: 90 09 00 34 stw r0,52(r9) req->aiocbp->return_value = 0; ffc0a390: 93 c9 00 38 stw r30,56(r9) if ((aio_request_queue.idle_threads == 0) && ffc0a394: 40 9e 00 10 bne- cr7,ffc0a3a4 <== NEVER TAKEN ffc0a398: 80 1f 00 64 lwz r0,100(r31) ffc0a39c: 2f 80 00 04 cmpwi cr7,r0,4 ffc0a3a0: 40 9d 00 ac ble- cr7,ffc0a44c 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, ffc0a3a4: 3f 60 00 00 lis r27,0 ffc0a3a8: 80 89 00 00 lwz r4,0(r9) ffc0a3ac: 3b 7b 2c b8 addi r27,r27,11448 ffc0a3b0: 7f 63 db 78 mr r3,r27 ffc0a3b4: 38 a0 00 00 li r5,0 ffc0a3b8: 4b ff f9 29 bl ffc09ce0 req->aiocbp->aio_fildes, 0); if (r_chain != NULL) ffc0a3bc: 7c 7c 1b 79 mr. r28,r3 ffc0a3c0: 41 82 01 04 beq- ffc0a4c4 { pthread_mutex_lock (&r_chain->mutex); ffc0a3c4: 3b 7c 00 1c addi r27,r28,28 ffc0a3c8: 7f 63 db 78 mr r3,r27 ffc0a3cc: 48 00 0b c5 bl ffc0af90 rtems_aio_insert_prio (&r_chain->perfd, req); ffc0a3d0: 38 7c 00 08 addi r3,r28,8 ffc0a3d4: 7f a4 eb 78 mr r4,r29 ffc0a3d8: 4b ff fd 81 bl ffc0a158 pthread_cond_signal (&r_chain->cond); ffc0a3dc: 38 7c 00 20 addi r3,r28,32 ffc0a3e0: 48 00 05 8d bl ffc0a96c pthread_mutex_unlock (&r_chain->mutex); ffc0a3e4: 7f 63 db 78 mr r3,r27 ffc0a3e8: 48 00 0c 75 bl ffc0b05c if (aio_request_queue.idle_threads > 0) pthread_cond_signal (&aio_request_queue.new_req); } } pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a3ec: 7f e3 fb 78 mr r3,r31 ffc0a3f0: 48 00 0c 6d bl ffc0b05c return 0; } ffc0a3f4: 80 01 00 54 lwz r0,84(r1) ffc0a3f8: 7f c3 f3 78 mr r3,r30 ffc0a3fc: 83 61 00 3c lwz r27,60(r1) ffc0a400: 7c 08 03 a6 mtlr r0 ffc0a404: 83 81 00 40 lwz r28,64(r1) ffc0a408: 83 a1 00 44 lwz r29,68(r1) ffc0a40c: 83 c1 00 48 lwz r30,72(r1) ffc0a410: 83 e1 00 4c lwz r31,76(r1) ffc0a414: 38 21 00 50 addi r1,r1,80 ffc0a418: 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); ffc0a41c: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc0a420: 4b ff b5 7d bl ffc0599c <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); return 0; } ffc0a424: 80 01 00 54 lwz r0,84(r1) <== NOT EXECUTED ffc0a428: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc0a42c: 83 61 00 3c lwz r27,60(r1) <== NOT EXECUTED ffc0a430: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0a434: 83 81 00 40 lwz r28,64(r1) <== NOT EXECUTED ffc0a438: 83 a1 00 44 lwz r29,68(r1) <== NOT EXECUTED ffc0a43c: 83 c1 00 48 lwz r30,72(r1) <== NOT EXECUTED ffc0a440: 83 e1 00 4c lwz r31,76(r1) <== NOT EXECUTED ffc0a444: 38 21 00 50 addi r1,r1,80 <== NOT EXECUTED ffc0a448: 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); ffc0a44c: 80 89 00 00 lwz r4,0(r9) ffc0a450: 38 7f 00 48 addi r3,r31,72 ffc0a454: 38 a0 00 01 li r5,1 ffc0a458: 4b ff f8 89 bl ffc09ce0 if (r_chain->new_fd == 1) { ffc0a45c: 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); ffc0a460: 7c 7c 1b 78 mr r28,r3 if (r_chain->new_fd == 1) { ffc0a464: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a468: 40 9e ff 5c bne+ cr7,ffc0a3c4 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); ffc0a46c: 7f a4 eb 78 mr r4,r29 ffc0a470: 38 63 00 08 addi r3,r3,8 ffc0a474: 48 00 2e e5 bl ffc0d358 <_Chain_Insert> rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; ffc0a478: 93 dc 00 18 stw r30,24(r28) pthread_mutex_init (&r_chain->mutex, NULL); ffc0a47c: 38 80 00 00 li r4,0 ffc0a480: 38 7c 00 1c addi r3,r28,28 ffc0a484: 48 00 09 7d bl ffc0ae00 pthread_cond_init (&r_chain->cond, NULL); ffc0a488: 38 80 00 00 li r4,0 ffc0a48c: 38 7c 00 20 addi r3,r28,32 ffc0a490: 48 00 03 d1 bl ffc0a860 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, ffc0a494: 3c a0 ff c1 lis r5,-63 ffc0a498: 38 61 00 08 addi r3,r1,8 ffc0a49c: 38 9f 00 08 addi r4,r31,8 ffc0a4a0: 38 a5 9e 80 addi r5,r5,-24960 ffc0a4a4: 7f 86 e3 78 mr r6,r28 ffc0a4a8: 48 00 0d 85 bl ffc0b22c rtems_aio_handle, (void *) r_chain); if (result != 0) { ffc0a4ac: 7c 7d 1b 79 mr. r29,r3 ffc0a4b0: 40 82 00 88 bne- ffc0a538 <== NEVER TAKEN pthread_mutex_unlock (&aio_request_queue.mutex); return result; } ++aio_request_queue.active_threads; ffc0a4b4: 81 3f 00 64 lwz r9,100(r31) ffc0a4b8: 38 09 00 01 addi r0,r9,1 ffc0a4bc: 90 1f 00 64 stw r0,100(r31) ffc0a4c0: 4b ff ff 2c b ffc0a3ec } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); ffc0a4c4: 81 3d 00 14 lwz r9,20(r29) ffc0a4c8: 38 7b 00 0c addi r3,r27,12 ffc0a4cc: 38 a0 00 01 li r5,1 ffc0a4d0: 80 89 00 00 lwz r4,0(r9) ffc0a4d4: 4b ff f8 0d bl ffc09ce0 if (r_chain->new_fd == 1) { ffc0a4d8: 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); ffc0a4dc: 7c 7b 1b 78 mr r27,r3 if (r_chain->new_fd == 1) { ffc0a4e0: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a4e4: 41 9e 00 28 beq- cr7,ffc0a50c 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); ffc0a4e8: 38 63 00 08 addi r3,r3,8 ffc0a4ec: 7f a4 eb 78 mr r4,r29 ffc0a4f0: 4b ff fc 69 bl ffc0a158 if (aio_request_queue.idle_threads > 0) ffc0a4f4: 80 1f 00 68 lwz r0,104(r31) ffc0a4f8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a4fc: 40 bd fe f0 ble- cr7,ffc0a3ec <== ALWAYS TAKEN pthread_cond_signal (&aio_request_queue.new_req); ffc0a500: 38 7f 00 04 addi r3,r31,4 <== NOT EXECUTED ffc0a504: 48 00 04 69 bl ffc0a96c <== NOT EXECUTED ffc0a508: 4b ff fe e4 b ffc0a3ec <== NOT EXECUTED ffc0a50c: 7f a4 eb 78 mr r4,r29 ffc0a510: 38 63 00 08 addi r3,r3,8 ffc0a514: 48 00 2e 45 bl ffc0d358 <_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; ffc0a518: 93 9b 00 18 stw r28,24(r27) pthread_mutex_init (&r_chain->mutex, NULL); ffc0a51c: 38 7b 00 1c addi r3,r27,28 ffc0a520: 38 80 00 00 li r4,0 ffc0a524: 48 00 08 dd bl ffc0ae00 pthread_cond_init (&r_chain->cond, NULL); ffc0a528: 38 7b 00 20 addi r3,r27,32 ffc0a52c: 38 80 00 00 li r4,0 ffc0a530: 48 00 03 31 bl ffc0a860 ffc0a534: 4b ff ff c0 b ffc0a4f4 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); ffc0a538: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc0a53c: 48 00 0b 21 bl ffc0b05c <== NOT EXECUTED return result; ffc0a540: 7f be eb 78 mr r30,r29 <== NOT EXECUTED ffc0a544: 4b ff fe b0 b ffc0a3f4 <== NOT EXECUTED =============================================================================== ffc09e80 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e80: 94 21 ff 90 stwu r1,-112(r1) ffc09e84: 7c 08 02 a6 mflr r0 ffc09e88: 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); ffc09e8c: 3f 00 00 00 lis r24,0 ffc09e90: 3b 18 2c 70 addi r24,r24,11376 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e94: 90 01 00 74 stw r0,116(r1) ffc09e98: 92 61 00 3c stw r19,60(r1) ffc09e9c: 93 e1 00 6c stw r31,108(r1) ffc09ea0: 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, ffc09ea4: 3a 98 00 04 addi r20,r24,4 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09ea8: 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)) { ffc09eac: 3a b8 00 58 addi r21,r24,88 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09eb0: 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); ffc09eb4: 3a c1 00 0c addi r22,r1,12 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09eb8: 92 e1 00 4c stw r23,76(r1) default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; ffc09ebc: 3a e0 ff ff li r23,-1 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09ec0: 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); ffc09ec4: 7f 19 c3 78 mr r25,r24 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09ec8: 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; ffc09ecc: 3b 40 00 00 li r26,0 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09ed0: 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); ffc09ed4: 3b 61 00 08 addi r27,r1,8 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09ed8: 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); ffc09edc: 3b 81 00 14 addi r28,r1,20 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09ee0: 93 a1 00 64 stw r29,100(r1) ffc09ee4: 3b a3 00 1c addi r29,r3,28 ffc09ee8: 93 c1 00 68 stw r30,104(r1) ffc09eec: 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); ffc09ef0: 7f a3 eb 78 mr r3,r29 ffc09ef4: 48 00 10 9d bl ffc0af90 if (result != 0) ffc09ef8: 7c 73 1b 79 mr. r19,r3 ffc09efc: 40 82 00 8c bne- ffc09f88 <== NEVER TAKEN } } AIO_printf ("Thread finished\n"); return NULL; } ffc09f00: 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 ); ffc09f04: 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)) { ffc09f08: 7f 9f 00 00 cmpw cr7,r31,r0 ffc09f0c: 41 9e 01 1c beq- cr7,ffc0a028 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); ffc09f10: 48 00 1c 09 bl ffc0bb18 ffc09f14: 7f 64 db 78 mr r4,r27 ffc09f18: 7f 85 e3 78 mr r5,r28 ffc09f1c: 48 00 16 1d bl ffc0b538 param.sched_priority = req->priority; ffc09f20: 80 1f 00 0c lwz r0,12(r31) ffc09f24: 90 01 00 14 stw r0,20(r1) pthread_setschedparam (pthread_self(), req->policy, ¶m); ffc09f28: 48 00 1b f1 bl ffc0bb18 ffc09f2c: 7f 85 e3 78 mr r5,r28 ffc09f30: 80 9f 00 08 lwz r4,8(r31) ffc09f34: 48 00 1b f5 bl ffc0bb28 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc09f38: 7f e3 fb 78 mr r3,r31 ffc09f3c: 48 00 33 b1 bl ffc0d2ec <_Chain_Extract> rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); ffc09f40: 7f a3 eb 78 mr r3,r29 ffc09f44: 48 00 11 19 bl ffc0b05c switch (req->aiocbp->aio_lio_opcode) { ffc09f48: 82 7f 00 14 lwz r19,20(r31) ffc09f4c: 80 13 00 30 lwz r0,48(r19) ffc09f50: 2f 80 00 02 cmpwi cr7,r0,2 ffc09f54: 41 9e 00 b8 beq- cr7,ffc0a00c ffc09f58: 2f 80 00 03 cmpwi cr7,r0,3 ffc09f5c: 41 9e 00 a4 beq- cr7,ffc0a000 <== NEVER TAKEN ffc09f60: 2f 80 00 01 cmpwi cr7,r0,1 ffc09f64: 41 9e 00 6c beq- cr7,ffc09fd0 <== ALWAYS TAKEN default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; ffc09f68: 92 f3 00 38 stw r23,56(r19) <== NOT EXECUTED req->aiocbp->error_code = errno; ffc09f6c: 48 00 cc 55 bl ffc16bc0 <__errno> <== NOT EXECUTED ffc09f70: 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); ffc09f74: 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; ffc09f78: 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); ffc09f7c: 48 00 10 15 bl ffc0af90 <== NOT EXECUTED if (result != 0) ffc09f80: 7c 73 1b 79 mr. r19,r3 <== NOT EXECUTED ffc09f84: 41 82 ff 7c beq+ ffc09f00 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } ffc09f88: 80 01 00 74 lwz r0,116(r1) ffc09f8c: 38 60 00 00 li r3,0 ffc09f90: 82 61 00 3c lwz r19,60(r1) ffc09f94: 7c 08 03 a6 mtlr r0 ffc09f98: 82 81 00 40 lwz r20,64(r1) ffc09f9c: 82 a1 00 44 lwz r21,68(r1) ffc09fa0: 82 c1 00 48 lwz r22,72(r1) ffc09fa4: 82 e1 00 4c lwz r23,76(r1) ffc09fa8: 83 01 00 50 lwz r24,80(r1) ffc09fac: 83 21 00 54 lwz r25,84(r1) ffc09fb0: 83 41 00 58 lwz r26,88(r1) ffc09fb4: 83 61 00 5c lwz r27,92(r1) ffc09fb8: 83 81 00 60 lwz r28,96(r1) ffc09fbc: 83 a1 00 64 lwz r29,100(r1) ffc09fc0: 83 c1 00 68 lwz r30,104(r1) ffc09fc4: 83 e1 00 6c lwz r31,108(r1) ffc09fc8: 38 21 00 70 addi r1,r1,112 ffc09fcc: 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, ffc09fd0: 80 73 00 00 lwz r3,0(r19) ffc09fd4: 80 93 00 10 lwz r4,16(r19) ffc09fd8: 80 b3 00 14 lwz r5,20(r19) ffc09fdc: 80 f3 00 08 lwz r7,8(r19) ffc09fe0: 81 13 00 0c lwz r8,12(r19) ffc09fe4: 48 00 db 41 bl ffc17b24 break; default: result = -1; } if (result == -1) { ffc09fe8: 2f 83 ff ff cmpwi cr7,r3,-1 ffc09fec: 41 9e 01 4c beq- cr7,ffc0a138 <== NEVER TAKEN req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; } else { req->aiocbp->return_value = result; ffc09ff0: 81 3f 00 14 lwz r9,20(r31) ffc09ff4: 90 69 00 38 stw r3,56(r9) req->aiocbp->error_code = 0; ffc09ff8: 93 49 00 34 stw r26,52(r9) ffc09ffc: 4b ff fe f4 b ffc09ef0 req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_SYNC: AIO_printf ("sync\n"); result = fsync (req->aiocbp->aio_fildes); ffc0a000: 80 73 00 00 lwz r3,0(r19) <== NOT EXECUTED ffc0a004: 48 00 8a 4d bl ffc12a50 <== NOT EXECUTED break; ffc0a008: 4b ff ff e0 b ffc09fe8 <== NOT EXECUTED req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_WRITE: AIO_printf ("write\n"); result = pwrite (req->aiocbp->aio_fildes, ffc0a00c: 80 73 00 00 lwz r3,0(r19) ffc0a010: 80 93 00 10 lwz r4,16(r19) ffc0a014: 80 b3 00 14 lwz r5,20(r19) ffc0a018: 80 f3 00 08 lwz r7,8(r19) ffc0a01c: 81 13 00 0c lwz r8,12(r19) ffc0a020: 48 00 dc 3d bl ffc17c5c (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; ffc0a024: 4b ff ff c4 b ffc09fe8 struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); ffc0a028: 7f a3 eb 78 mr r3,r29 ffc0a02c: 48 00 10 31 bl ffc0b05c pthread_mutex_lock (&aio_request_queue.mutex); ffc0a030: 7f 23 cb 78 mr r3,r25 ffc0a034: 48 00 0f 5d bl ffc0af90 if (rtems_chain_is_empty (chain)) ffc0a038: 80 1e 00 08 lwz r0,8(r30) ffc0a03c: 7f 9f 00 00 cmpw cr7,r31,r0 ffc0a040: 41 9e 00 10 beq- cr7,ffc0a050 <== 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); ffc0a044: 7f 23 cb 78 mr r3,r25 ffc0a048: 48 00 10 15 bl ffc0b05c ffc0a04c: 4b ff fe a4 b ffc09ef0 pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); ffc0a050: 7e c4 b3 78 mr r4,r22 ffc0a054: 38 60 00 01 li r3,1 ffc0a058: 48 00 06 59 bl ffc0a6b0 timeout.tv_sec += 3; ffc0a05c: 81 21 00 0c lwz r9,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc0a060: 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; ffc0a064: 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; ffc0a068: 38 09 00 03 addi r0,r9,3 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc0a06c: 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; ffc0a070: 90 01 00 0c stw r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc0a074: 7f 24 cb 78 mr r4,r25 ffc0a078: 7e c5 b3 78 mr r5,r22 ffc0a07c: 48 00 09 cd bl ffc0aa48 &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) { ffc0a080: 2f 83 00 74 cmpwi cr7,r3,116 ffc0a084: 40 9e ff c0 bne+ cr7,ffc0a044 <== NEVER TAKEN ffc0a088: 7f c3 f3 78 mr r3,r30 ffc0a08c: 48 00 32 61 bl ffc0d2ec <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); ffc0a090: 7f a3 eb 78 mr r3,r29 ffc0a094: 48 00 0b a9 bl ffc0ac3c pthread_cond_destroy (&r_chain->cond); ffc0a098: 7f e3 fb 78 mr r3,r31 ffc0a09c: 48 00 06 b5 bl ffc0a750 free (r_chain); ffc0a0a0: 7f c3 f3 78 mr r3,r30 ffc0a0a4: 4b ff b8 f9 bl ffc0599c } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a0a8: 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)) { ffc0a0ac: 7f 9e a8 00 cmpw cr7,r30,r21 ffc0a0b0: 41 9e 00 34 beq- cr7,ffc0a0e4 } /* 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; ffc0a0b4: 81 78 00 64 lwz r11,100(r24) ffc0a0b8: 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; ffc0a0bc: 81 38 00 68 lwz r9,104(r24) ffc0a0c0: 3b be 00 1c addi r29,r30,28 ++aio_request_queue.active_threads; ffc0a0c4: 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; ffc0a0c8: 39 29 ff ff addi r9,r9,-1 ++aio_request_queue.active_threads; ffc0a0cc: 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; ffc0a0d0: 91 38 00 68 stw r9,104(r24) ffc0a0d4: 48 00 32 19 bl ffc0d2ec <_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); ffc0a0d8: 7f c3 f3 78 mr r3,r30 ffc0a0dc: 4b ff fd 15 bl ffc09df0 ffc0a0e0: 4b ff ff 64 b ffc0a044 /* 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; ffc0a0e4: 81 39 00 68 lwz r9,104(r25) --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); ffc0a0e8: 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; ffc0a0ec: 80 19 00 64 lwz r0,100(r25) clock_gettime (CLOCK_REALTIME, &timeout); ffc0a0f0: 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; ffc0a0f4: 39 29 00 01 addi r9,r9,1 --aio_request_queue.active_threads; ffc0a0f8: 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; ffc0a0fc: 91 39 00 68 stw r9,104(r25) --aio_request_queue.active_threads; ffc0a100: 90 19 00 64 stw r0,100(r25) clock_gettime (CLOCK_REALTIME, &timeout); ffc0a104: 48 00 05 ad bl ffc0a6b0 timeout.tv_sec += 3; ffc0a108: 80 01 00 0c lwz r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a10c: 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; ffc0a110: 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; ffc0a114: 30 00 00 03 addic r0,r0,3 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a118: 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; ffc0a11c: 90 01 00 0c stw r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a120: 7e c5 b3 78 mr r5,r22 ffc0a124: 48 00 09 25 bl ffc0aa48 &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { ffc0a128: 2f 83 00 74 cmpwi cr7,r3,116 ffc0a12c: 41 9e 00 14 beq- cr7,ffc0a140 <== ALWAYS TAKEN ffc0a130: 83 d9 00 54 lwz r30,84(r25) <== NOT EXECUTED ffc0a134: 4b ff ff 80 b ffc0a0b4 <== NOT EXECUTED break; default: result = -1; } if (result == -1) { ffc0a138: 82 7f 00 14 lwz r19,20(r31) <== NOT EXECUTED ffc0a13c: 4b ff fe 2c b ffc09f68 <== 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; ffc0a140: 80 19 00 68 lwz r0,104(r25) pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a144: 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; ffc0a148: 30 00 ff ff addic r0,r0,-1 ffc0a14c: 90 19 00 68 stw r0,104(r25) pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a150: 48 00 0f 0d bl ffc0b05c return NULL; ffc0a154: 4b ff fe 34 b ffc09f88 =============================================================================== ffc09b94 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { ffc09b94: 94 21 ff e8 stwu r1,-24(r1) ffc09b98: 7c 08 02 a6 mflr r0 ffc09b9c: 93 c1 00 10 stw r30,16(r1) int result = 0; result = pthread_attr_init (&aio_request_queue.attr); ffc09ba0: 3f c0 00 00 lis r30,0 ffc09ba4: 3b de 2c 78 addi r30,r30,11384 ffc09ba8: 7f c3 f3 78 mr r3,r30 * 0 - if initialization succeeded */ int rtems_aio_init (void) { ffc09bac: 93 a1 00 0c stw r29,12(r1) ffc09bb0: 90 01 00 1c stw r0,28(r1) ffc09bb4: 93 e1 00 14 stw r31,20(r1) int result = 0; result = pthread_attr_init (&aio_request_queue.attr); ffc09bb8: 48 00 16 09 bl ffc0b1c0 if (result != 0) ffc09bbc: 7c 7d 1b 79 mr. r29,r3 ffc09bc0: 41 82 00 24 beq- ffc09be4 <== ALWAYS TAKEN aio_request_queue.active_threads = 0; aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; return result; } ffc09bc4: 80 01 00 1c lwz r0,28(r1) <== NOT EXECUTED ffc09bc8: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc09bcc: 83 c1 00 10 lwz r30,16(r1) <== NOT EXECUTED ffc09bd0: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc09bd4: 83 a1 00 0c lwz r29,12(r1) <== NOT EXECUTED ffc09bd8: 83 e1 00 14 lwz r31,20(r1) <== NOT EXECUTED ffc09bdc: 38 21 00 18 addi r1,r1,24 <== NOT EXECUTED ffc09be0: 4e 80 00 20 blr <== NOT EXECUTED result = pthread_attr_init (&aio_request_queue.attr); if (result != 0) return result; result = ffc09be4: 7f c3 f3 78 mr r3,r30 ffc09be8: 38 80 00 00 li r4,0 ffc09bec: 48 00 16 15 bl ffc0b200 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) ffc09bf0: 2f 83 00 00 cmpwi cr7,r3,0 ffc09bf4: 40 9e 00 94 bne- cr7,ffc09c88 <== NEVER TAKEN pthread_attr_destroy (&aio_request_queue.attr); result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09bf8: 3f e0 00 00 lis r31,0 ffc09bfc: 3b ff 2c 70 addi r31,r31,11376 ffc09c00: 7f e3 fb 78 mr r3,r31 ffc09c04: 38 80 00 00 li r4,0 ffc09c08: 48 00 11 f9 bl ffc0ae00 if (result != 0) ffc09c0c: 2f 83 00 00 cmpwi cr7,r3,0 ffc09c10: 40 9e 00 9c bne- cr7,ffc09cac <== NEVER TAKEN pthread_attr_destroy (&aio_request_queue.attr); result = pthread_cond_init (&aio_request_queue.new_req, NULL); ffc09c14: 3c 60 00 00 lis r3,0 ffc09c18: 38 63 2c 74 addi r3,r3,11380 ffc09c1c: 38 80 00 00 li r4,0 ffc09c20: 48 00 0c 41 bl ffc0a860 if (result != 0) { ffc09c24: 7c 7d 1b 79 mr. r29,r3 ffc09c28: 40 82 00 a4 bne- ffc09ccc <== NEVER TAKEN { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; ffc09c2c: 38 00 00 00 li r0,0 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc09c30: 39 1f 00 4c addi r8,r31,76 head->previous = NULL; ffc09c34: 90 1f 00 4c stw r0,76(r31) tail->previous = head; ffc09c38: 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; ffc09c3c: 39 7f 00 58 addi r11,r31,88 head->previous = NULL; ffc09c40: 90 1f 00 58 stw r0,88(r31) tail->previous = head; ffc09c44: 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; ffc09c48: 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; } ffc09c4c: 7f a3 eb 78 mr r3,r29 head->previous = NULL; tail->previous = head; ffc09c50: 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; ffc09c54: 91 7f 00 54 stw r11,84(r31) head->previous = NULL; tail->previous = head; ffc09c58: 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; ffc09c5c: 90 1f 00 64 stw r0,100(r31) aio_request_queue.idle_threads = 0; ffc09c60: 90 1f 00 68 stw r0,104(r31) aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; ffc09c64: 60 00 b0 0b ori r0,r0,45067 ffc09c68: 90 1f 00 60 stw r0,96(r31) return result; } ffc09c6c: 80 01 00 1c lwz r0,28(r1) ffc09c70: 83 a1 00 0c lwz r29,12(r1) ffc09c74: 7c 08 03 a6 mtlr r0 ffc09c78: 83 c1 00 10 lwz r30,16(r1) ffc09c7c: 83 e1 00 14 lwz r31,20(r1) ffc09c80: 38 21 00 18 addi r1,r1,24 ffc09c84: 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); ffc09c88: 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); ffc09c8c: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09c90: 3b ff 2c 70 addi r31,r31,11376 <== NOT EXECUTED result = pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) pthread_attr_destroy (&aio_request_queue.attr); ffc09c94: 48 00 15 05 bl ffc0b198 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09c98: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc09c9c: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc09ca0: 48 00 11 61 bl ffc0ae00 <== NOT EXECUTED if (result != 0) ffc09ca4: 2f 83 00 00 cmpwi cr7,r3,0 <== NOT EXECUTED ffc09ca8: 41 9e ff 6c beq+ cr7,ffc09c14 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); ffc09cac: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc09cb0: 48 00 14 e9 bl ffc0b198 <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); ffc09cb4: 3c 60 00 00 lis r3,0 <== NOT EXECUTED ffc09cb8: 38 63 2c 74 addi r3,r3,11380 <== NOT EXECUTED ffc09cbc: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc09cc0: 48 00 0b a1 bl ffc0a860 <== NOT EXECUTED if (result != 0) { ffc09cc4: 7c 7d 1b 79 mr. r29,r3 <== NOT EXECUTED ffc09cc8: 41 82 ff 64 beq+ ffc09c2c <== NOT EXECUTED pthread_mutex_destroy (&aio_request_queue.mutex); ffc09ccc: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc09cd0: 48 00 0f 6d bl ffc0ac3c <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); ffc09cd4: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc09cd8: 48 00 14 c1 bl ffc0b198 <== NOT EXECUTED ffc09cdc: 4b ff ff 50 b ffc09c2c <== NOT EXECUTED =============================================================================== ffc0a158 : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { ffc0a158: 94 21 ff f8 stwu r1,-8(r1) ffc0a15c: 7c 08 02 a6 mflr r0 ffc0a160: 7c 8b 23 78 mr r11,r4 ffc0a164: 90 01 00 0c stw r0,12(r1) ffc0a168: 38 03 00 04 addi r0,r3,4 } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a16c: 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)) { ffc0a170: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a174: 41 9e 00 4c beq- cr7,ffc0a1c0 <== 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 && ffc0a178: 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; ffc0a17c: 81 49 00 14 lwz r10,20(r9) while (req->aiocbp->aio_reqprio > prio && ffc0a180: 80 e8 00 18 lwz r7,24(r8) ffc0a184: 81 0a 00 18 lwz r8,24(r10) ffc0a188: 7d 2a 4b 78 mr r10,r9 ffc0a18c: 7f 88 38 00 cmpw cr7,r8,r7 ffc0a190: 41 bc 00 0c blt+ cr7,ffc0a19c <== NEVER TAKEN ffc0a194: 48 00 00 24 b ffc0a1b8 ffc0a198: 41 9a 00 3c beq- cr6,ffc0a1d4 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a19c: 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; ffc0a1a0: 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 && ffc0a1a4: 7f 0a 00 00 cmpw cr6,r10,r0 <== NOT EXECUTED ffc0a1a8: 81 09 00 18 lwz r8,24(r9) <== NOT EXECUTED ffc0a1ac: 7d 49 53 78 mr r9,r10 <== NOT EXECUTED ffc0a1b0: 7f 88 38 00 cmpw cr7,r8,r7 <== NOT EXECUTED ffc0a1b4: 41 9c ff e4 blt+ cr7,ffc0a198 <== 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 ); ffc0a1b8: 80 6a 00 04 lwz r3,4(r10) ffc0a1bc: 7d 64 5b 78 mr r4,r11 ffc0a1c0: 48 00 31 99 bl ffc0d358 <_Chain_Insert> } rtems_chain_insert (node->previous, &req->next_prio); } } ffc0a1c4: 80 01 00 0c lwz r0,12(r1) ffc0a1c8: 38 21 00 08 addi r1,r1,8 ffc0a1cc: 7c 08 03 a6 mtlr r0 ffc0a1d0: 4e 80 00 20 blr } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a1d4: 7c 0a 03 78 mr r10,r0 <== NOT EXECUTED ffc0a1d8: 4b ff ff e0 b ffc0a1b8 <== NOT EXECUTED =============================================================================== ffc09df0 : * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { ffc09df0: 94 21 ff f8 stwu r1,-8(r1) ffc09df4: 7c 08 02 a6 mflr r0 } } AIO_printf ("Thread finished\n"); return NULL; } ffc09df8: 3d 60 00 00 lis r11,0 * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { ffc09dfc: 90 01 00 0c stw r0,12(r1) } } AIO_printf ("Thread finished\n"); return NULL; } ffc09e00: 39 6b 2c 70 addi r11,r11,11376 * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { ffc09e04: 7c 64 1b 78 mr r4,r3 } } AIO_printf ("Thread finished\n"); return NULL; } ffc09e08: 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 && ffc09e0c: 81 03 00 14 lwz r8,20(r3) ffc09e10: 80 09 00 14 lwz r0,20(r9) ffc09e14: 7d 2a 4b 78 mr r10,r9 ffc09e18: 7f 80 40 00 cmpw cr7,r0,r8 ffc09e1c: 40 9c 00 30 bge- cr7,ffc09e4c <== NEVER TAKEN ffc09e20: 39 6b 00 4c addi r11,r11,76 ffc09e24: 7f 89 58 00 cmpw cr7,r9,r11 ffc09e28: 40 be 00 0c bne+ cr7,ffc09e34 <== ALWAYS TAKEN ffc09e2c: 48 00 00 20 b ffc09e4c <== NOT EXECUTED ffc09e30: 41 9a 00 34 beq- cr6,ffc09e64 <== NEVER TAKEN } } AIO_printf ("Thread finished\n"); return NULL; } ffc09e34: 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 && ffc09e38: 80 0a 00 14 lwz r0,20(r10) ffc09e3c: 7f 0a 58 00 cmpw cr6,r10,r11 ffc09e40: 7d 49 53 78 mr r9,r10 ffc09e44: 7f 80 40 00 cmpw cr7,r0,r8 ffc09e48: 41 9c ff e8 blt+ cr7,ffc09e30 ffc09e4c: 80 6a 00 04 lwz r3,4(r10) ffc09e50: 48 00 35 09 bl ffc0d358 <_Chain_Insert> node = rtems_chain_next (node); temp = (rtems_aio_request_chain *) node; } rtems_chain_insert (rtems_chain_previous (node), &r_chain->next_fd); } ffc09e54: 80 01 00 0c lwz r0,12(r1) ffc09e58: 38 21 00 08 addi r1,r1,8 ffc09e5c: 7c 08 03 a6 mtlr r0 ffc09e60: 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 && ffc09e64: 7d 6a 5b 78 mr r10,r11 <== NOT EXECUTED ffc09e68: 80 6a 00 04 lwz r3,4(r10) <== NOT EXECUTED ffc09e6c: 48 00 34 ed bl ffc0d358 <_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); } ffc09e70: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc09e74: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc09e78: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc09e7c: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc0a1dc : * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { ffc0a1dc: 94 21 ff e0 stwu r1,-32(r1) ffc0a1e0: 7c 08 02 a6 mflr r0 ffc0a1e4: 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)); ffc0a1e8: 3b a3 00 0c addi r29,r3,12 ffc0a1ec: 90 01 00 24 stw r0,36(r1) ffc0a1f0: 93 61 00 0c stw r27,12(r1) ffc0a1f4: 93 81 00 10 stw r28,16(r1) ffc0a1f8: 93 c1 00 18 stw r30,24(r1) ffc0a1fc: 93 e1 00 1c stw r31,28(r1) } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a200: 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)) ffc0a204: 7f 9f e8 00 cmpw cr7,r31,r29 ffc0a208: 41 9e 00 38 beq- cr7,ffc0a240 <== NEVER TAKEN { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; ffc0a20c: 3b 60 00 8c li r27,140 req->aiocbp->return_value = -1; ffc0a210: 3b 80 ff ff li r28,-1 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc0a214: 7f e3 fb 78 mr r3,r31 ffc0a218: 48 00 30 d5 bl ffc0d2ec <_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; ffc0a21c: 81 3f 00 14 lwz r9,20(r31) } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a220: 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); ffc0a224: 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; ffc0a228: 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); ffc0a22c: 7f df f3 78 mr r31,r30 req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; ffc0a230: 93 89 00 38 stw r28,56(r9) free (req); ffc0a234: 4b ff b7 69 bl ffc0599c rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) ffc0a238: 7f 9e e8 00 cmpw cr7,r30,r29 ffc0a23c: 40 9e ff d8 bne+ cr7,ffc0a214 node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; free (req); } } ffc0a240: 80 01 00 24 lwz r0,36(r1) ffc0a244: 83 61 00 0c lwz r27,12(r1) ffc0a248: 7c 08 03 a6 mtlr r0 ffc0a24c: 83 81 00 10 lwz r28,16(r1) ffc0a250: 83 a1 00 14 lwz r29,20(r1) ffc0a254: 83 c1 00 18 lwz r30,24(r1) ffc0a258: 83 e1 00 1c lwz r31,28(r1) ffc0a25c: 38 21 00 20 addi r1,r1,32 ffc0a260: 4e 80 00 20 blr =============================================================================== ffc0a264 : * 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) { ffc0a264: 94 21 ff f0 stwu r1,-16(r1) ffc0a268: 7c 08 02 a6 mflr r0 ffc0a26c: 93 e1 00 0c stw r31,12(r1) ffc0a270: 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 ); ffc0a274: 38 03 00 04 addi r0,r3,4 } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a278: 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; ffc0a27c: 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)) ffc0a280: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a284: 41 9e 00 3c beq- cr7,ffc0a2c0 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) { ffc0a288: 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; ffc0a28c: 7d 3f 4b 78 mr r31,r9 while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) { ffc0a290: 7f 8b 20 00 cmpw cr7,r11,r4 ffc0a294: 40 be 00 14 bne+ cr7,ffc0a2a8 <== NEVER TAKEN ffc0a298: 48 00 00 3c b ffc0a2d4 ffc0a29c: 81 6b 00 14 lwz r11,20(r11) <== NOT EXECUTED ffc0a2a0: 7f 8b 20 00 cmpw cr7,r11,r4 <== NOT EXECUTED ffc0a2a4: 41 9e 00 30 beq- cr7,ffc0a2d4 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a2a8: 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) { ffc0a2ac: 7f 8b 00 00 cmpw cr7,r11,r0 <== NOT EXECUTED node = rtems_chain_next (node); current = (rtems_aio_request *) node; ffc0a2b0: 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) { ffc0a2b4: 7d 69 5b 78 mr r9,r11 <== NOT EXECUTED ffc0a2b8: 40 9e ff e4 bne+ cr7,ffc0a29c <== NOT EXECUTED node = rtems_chain_next (node); current = (rtems_aio_request *) node; } if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; ffc0a2bc: 38 60 00 01 li r3,1 <== NOT EXECUTED current->aiocbp->return_value = -1; free (current); } return AIO_CANCELED; } ffc0a2c0: 80 01 00 14 lwz r0,20(r1) ffc0a2c4: 83 e1 00 0c lwz r31,12(r1) ffc0a2c8: 38 21 00 10 addi r1,r1,16 ffc0a2cc: 7c 08 03 a6 mtlr r0 ffc0a2d0: 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) { ffc0a2d4: 7f e3 fb 78 mr r3,r31 ffc0a2d8: 48 00 30 15 bl ffc0d2ec <_Chain_Extract> if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; ffc0a2dc: 81 3f 00 14 lwz r9,20(r31) ffc0a2e0: 38 00 00 8c li r0,140 ffc0a2e4: 90 09 00 34 stw r0,52(r9) current->aiocbp->return_value = -1; ffc0a2e8: 38 00 ff ff li r0,-1 free (current); ffc0a2ec: 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; ffc0a2f0: 90 09 00 38 stw r0,56(r9) free (current); ffc0a2f4: 4b ff b6 a9 bl ffc0599c } return AIO_CANCELED; } ffc0a2f8: 80 01 00 14 lwz r0,20(r1) current->aiocbp->error_code = ECANCELED; current->aiocbp->return_value = -1; free (current); } return AIO_CANCELED; ffc0a2fc: 38 60 00 00 li r3,0 } ffc0a300: 83 e1 00 0c lwz r31,12(r1) ffc0a304: 7c 08 03 a6 mtlr r0 ffc0a308: 38 21 00 10 addi r1,r1,16 ffc0a30c: 4e 80 00 20 blr =============================================================================== ffc139c8 : rtems_name name, rtems_attribute attribute_set, uint32_t maximum_waiters, rtems_id *id ) { ffc139c8: 94 21 ff d0 stwu r1,-48(r1) ffc139cc: 7c 08 02 a6 mflr r0 ffc139d0: 93 e1 00 2c stw r31,44(r1) Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) ffc139d4: 7c 7f 1b 79 mr. r31,r3 return RTEMS_INVALID_NAME; ffc139d8: 38 60 00 03 li r3,3 rtems_name name, rtems_attribute attribute_set, uint32_t maximum_waiters, rtems_id *id ) { ffc139dc: 93 a1 00 24 stw r29,36(r1) ffc139e0: 7c dd 33 78 mr r29,r6 ffc139e4: 90 01 00 34 stw r0,52(r1) ffc139e8: 93 81 00 20 stw r28,32(r1) ffc139ec: 93 c1 00 28 stw r30,40(r1) Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) ffc139f0: 41 82 00 90 beq- ffc13a80 return RTEMS_INVALID_NAME; if ( !id ) ffc139f4: 2f 86 00 00 cmpwi cr7,r6,0 return RTEMS_INVALID_ADDRESS; ffc139f8: 38 60 00 09 li r3,9 CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !id ) ffc139fc: 41 9e 00 84 beq- cr7,ffc13a80 return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { ffc13a00: 70 80 00 10 andi. r0,r4,16 ffc13a04: 41 82 00 9c beq- ffc13aa0 the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) ffc13a08: 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; ffc13a0c: 38 00 00 00 li r0,0 ffc13a10: 90 01 00 08 stw r0,8(r1) if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; ffc13a14: 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 ) ffc13a18: 41 9e 00 68 beq- cr7,ffc13a80 ffc13a1c: 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; ffc13a20: 90 a1 00 0c stw r5,12(r1) ffc13a24: 81 69 27 e8 lwz r11,10216(r9) ffc13a28: 38 0b 00 01 addi r0,r11,1 ffc13a2c: 90 09 27 e8 stw r0,10216(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 ); ffc13a30: 3f 80 00 00 lis r28,0 ffc13a34: 90 81 00 18 stw r4,24(r1) ffc13a38: 3b 9c 35 1c addi r28,r28,13596 ffc13a3c: 7f 83 e3 78 mr r3,r28 ffc13a40: 4b ff 98 4d bl ffc0d28c <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { ffc13a44: 80 81 00 18 lwz r4,24(r1) ffc13a48: 7c 7e 1b 79 mr. r30,r3 ffc13a4c: 41 82 00 90 beq- ffc13adc <== NEVER TAKEN _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } the_barrier->attribute_set = attribute_set; ffc13a50: 90 9e 00 10 stw r4,16(r30) _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); ffc13a54: 38 7e 00 14 addi r3,r30,20 ffc13a58: 38 81 00 08 addi r4,r1,8 ffc13a5c: 48 00 0a d1 bl ffc1452c <_CORE_barrier_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc13a60: 80 1e 00 08 lwz r0,8(r30) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc13a64: 81 7c 00 1c lwz r11,28(r28) ffc13a68: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc13a6c: 7f cb 49 2e stwx r30,r11,r9 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc13a70: 93 fe 00 0c stw r31,12(r30) &_Barrier_Information, &the_barrier->Object, (Objects_Name) name ); *id = the_barrier->Object.id; ffc13a74: 90 1d 00 00 stw r0,0(r29) _Thread_Enable_dispatch(); ffc13a78: 4b ff ae a5 bl ffc0e91c <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc13a7c: 38 60 00 00 li r3,0 } ffc13a80: 80 01 00 34 lwz r0,52(r1) ffc13a84: 83 81 00 20 lwz r28,32(r1) ffc13a88: 7c 08 03 a6 mtlr r0 ffc13a8c: 83 a1 00 24 lwz r29,36(r1) ffc13a90: 83 c1 00 28 lwz r30,40(r1) ffc13a94: 83 e1 00 2c lwz r31,44(r1) ffc13a98: 38 21 00 30 addi r1,r1,48 ffc13a9c: 4e 80 00 20 blr ffc13aa0: 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; ffc13aa4: 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; ffc13aa8: 38 00 00 01 li r0,1 ffc13aac: 81 69 27 e8 lwz r11,10216(r9) ffc13ab0: 90 01 00 08 stw r0,8(r1) ffc13ab4: 38 0b 00 01 addi r0,r11,1 ffc13ab8: 90 09 27 e8 stw r0,10216(r9) ffc13abc: 3f 80 00 00 lis r28,0 ffc13ac0: 90 81 00 18 stw r4,24(r1) ffc13ac4: 3b 9c 35 1c addi r28,r28,13596 ffc13ac8: 7f 83 e3 78 mr r3,r28 ffc13acc: 4b ff 97 c1 bl ffc0d28c <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { ffc13ad0: 80 81 00 18 lwz r4,24(r1) ffc13ad4: 7c 7e 1b 79 mr. r30,r3 ffc13ad8: 40 82 ff 78 bne+ ffc13a50 _Thread_Enable_dispatch(); ffc13adc: 4b ff ae 41 bl ffc0e91c <_Thread_Enable_dispatch> *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } ffc13ae0: 80 01 00 34 lwz r0,52(r1) the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; ffc13ae4: 38 60 00 05 li r3,5 *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } ffc13ae8: 83 81 00 20 lwz r28,32(r1) ffc13aec: 7c 08 03 a6 mtlr r0 ffc13af0: 83 a1 00 24 lwz r29,36(r1) ffc13af4: 83 c1 00 28 lwz r30,40(r1) ffc13af8: 83 e1 00 2c lwz r31,44(r1) ffc13afc: 38 21 00 30 addi r1,r1,48 ffc13b00: 4e 80 00 20 blr =============================================================================== ffc09f78 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { ffc09f78: 94 21 ff d0 stwu r1,-48(r1) ffc09f7c: 7c 08 02 a6 mflr r0 ffc09f80: 93 e1 00 2c stw r31,44(r1) ffc09f84: 90 01 00 34 stw r0,52(r1) ffc09f88: 93 41 00 18 stw r26,24(r1) ffc09f8c: 7c da 33 78 mr r26,r6 ffc09f90: 93 61 00 1c stw r27,28(r1) ffc09f94: 7c 7b 1b 78 mr r27,r3 ffc09f98: 93 81 00 20 stw r28,32(r1) ffc09f9c: 7c 9c 23 78 mr r28,r4 ffc09fa0: 93 a1 00 24 stw r29,36(r1) ffc09fa4: 7c bd 2b 78 mr r29,r5 ffc09fa8: 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( ffc09fac: 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 ); ffc09fb0: 7f 63 db 78 mr r3,r27 ffc09fb4: 48 00 07 dd bl ffc0a790 <_Chain_Get> ffc09fb8: 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 ffc09fbc: 7c 7f 1b 79 mr. r31,r3 ) { rtems_event_set out; sc = rtems_event_receive( ffc09fc0: 7f a5 eb 78 mr r5,r29 ffc09fc4: 7f c6 f3 78 mr r6,r30 ffc09fc8: 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 ffc09fcc: 40 82 00 3c bne- ffc0a008 ) { rtems_event_set out; sc = rtems_event_receive( ffc09fd0: 4b ff ef 35 bl ffc08f04 ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( ffc09fd4: 2c 03 00 00 cmpwi r3,0 ffc09fd8: 41 82 ff d8 beq+ ffc09fb0 <== NEVER TAKEN } *node_ptr = node; return sc; } ffc09fdc: 80 01 00 34 lwz r0,52(r1) timeout, &out ); } *node_ptr = node; ffc09fe0: 93 fa 00 00 stw r31,0(r26) return sc; } ffc09fe4: 7c 08 03 a6 mtlr r0 ffc09fe8: 83 41 00 18 lwz r26,24(r1) ffc09fec: 83 61 00 1c lwz r27,28(r1) ffc09ff0: 83 81 00 20 lwz r28,32(r1) ffc09ff4: 83 a1 00 24 lwz r29,36(r1) ffc09ff8: 83 c1 00 28 lwz r30,40(r1) ffc09ffc: 83 e1 00 2c lwz r31,44(r1) ffc0a000: 38 21 00 30 addi r1,r1,48 ffc0a004: 4e 80 00 20 blr ffc0a008: 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 ffc0a00c: 38 60 00 00 li r3,0 timeout, &out ); } *node_ptr = node; ffc0a010: 93 fa 00 00 stw r31,0(r26) return sc; } ffc0a014: 7c 08 03 a6 mtlr r0 ffc0a018: 83 41 00 18 lwz r26,24(r1) ffc0a01c: 83 61 00 1c lwz r27,28(r1) ffc0a020: 83 81 00 20 lwz r28,32(r1) ffc0a024: 83 a1 00 24 lwz r29,36(r1) ffc0a028: 83 c1 00 28 lwz r30,40(r1) ffc0a02c: 83 e1 00 2c lwz r31,44(r1) ffc0a030: 38 21 00 30 addi r1,r1,48 ffc0a034: 4e 80 00 20 blr =============================================================================== ffc0ad1c : 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 ) { ffc0ad1c: 94 21 ff f0 stwu r1,-16(r1) ffc0ad20: 7c 08 02 a6 mflr r0 rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0ad24: 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 ) { ffc0ad28: 90 01 00 14 stw r0,20(r1) rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0ad2c: 80 09 31 ec lwz r0,12780(r9) rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; ffc0ad30: 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 ) { ffc0ad34: 93 e1 00 0c stw r31,12(r1) ffc0ad38: 7c 7f 1b 78 mr r31,r3 rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0ad3c: 2f 80 00 00 cmpwi cr7,r0,0 return RTEMS_CALLED_FROM_ISR; ffc0ad40: 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; ffc0ad44: 80 09 28 58 lwz r0,10328(r9) if ( rtems_interrupt_is_in_progress() ) ffc0ad48: 40 9e 00 ec bne- cr7,ffc0ae34 return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) ffc0ad4c: 2f 85 00 00 cmpwi cr7,r5,0 return RTEMS_INVALID_ADDRESS; ffc0ad50: 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 ) ffc0ad54: 41 9e 00 e0 beq- cr7,ffc0ae34 return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; if ( driver_table == NULL ) ffc0ad58: 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; ffc0ad5c: 90 05 00 00 stw r0,0(r5) if ( driver_table == NULL ) ffc0ad60: 41 9e 00 d4 beq- cr7,ffc0ae34 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ad64: 81 64 00 00 lwz r11,0(r4) ffc0ad68: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0ad6c: 41 9e 01 14 beq- cr7,ffc0ae80 return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) ffc0ad70: 7f 80 f8 40 cmplw cr7,r0,r31 return RTEMS_INVALID_NUMBER; ffc0ad74: 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 ) ffc0ad78: 40 9d 00 bc ble- cr7,ffc0ae34 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0ad7c: 3d 60 00 00 lis r11,0 ffc0ad80: 81 4b 28 04 lwz r10,10244(r11) ffc0ad84: 38 0a 00 01 addi r0,r10,1 ffc0ad88: 90 0b 28 04 stw r0,10244(r11) return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { ffc0ad8c: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0ad90: 40 9e 00 b8 bne- cr7,ffc0ae48 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; ffc0ad94: 81 49 28 58 lwz r10,10328(r9) rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { ffc0ad98: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0ad9c: 41 9e 00 f4 beq- cr7,ffc0ae90 <== NEVER TAKEN ffc0ada0: 3d 60 00 00 lis r11,0 ffc0ada4: 7d 49 03 a6 mtctr r10 ffc0ada8: 81 2b 28 5c lwz r9,10332(r11) ffc0adac: 40 be 00 14 bne+ cr7,ffc0adc0 <== ALWAYS TAKEN ffc0adb0: 48 00 01 04 b ffc0aeb4 <== NOT EXECUTED ffc0adb4: 3b ff 00 01 addi r31,r31,1 ffc0adb8: 39 29 00 18 addi r9,r9,24 ffc0adbc: 42 40 00 1c bdz- ffc0add8 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0adc0: 80 09 00 00 lwz r0,0(r9) ffc0adc4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0adc8: 40 9e ff ec bne+ cr7,ffc0adb4 ffc0adcc: 80 09 00 04 lwz r0,4(r9) ffc0add0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0add4: 40 9e ff e0 bne+ cr7,ffc0adb4 } /* Assigns invalid value in case of failure */ *major = m; if ( m != n ) ffc0add8: 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; ffc0addc: 93 e5 00 00 stw r31,0(r5) if ( m != n ) ffc0ade0: 1c 1f 00 18 mulli r0,r31,24 ffc0ade4: 41 9e 00 b0 beq- cr7,ffc0ae94 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; ffc0ade8: 81 6b 28 5c lwz r11,10332(r11) ffc0adec: 80 c4 00 00 lwz r6,0(r4) ffc0adf0: 80 e4 00 04 lwz r7,4(r4) ffc0adf4: 7d 2b 02 14 add r9,r11,r0 ffc0adf8: 81 04 00 08 lwz r8,8(r4) ffc0adfc: 81 44 00 0c lwz r10,12(r4) ffc0ae00: 7c cb 01 2e stwx r6,r11,r0 ffc0ae04: 90 e9 00 04 stw r7,4(r9) ffc0ae08: 91 09 00 08 stw r8,8(r9) ffc0ae0c: 91 49 00 0c stw r10,12(r9) ffc0ae10: 81 64 00 10 lwz r11,16(r4) ffc0ae14: 80 04 00 14 lwz r0,20(r4) ffc0ae18: 91 69 00 10 stw r11,16(r9) ffc0ae1c: 90 09 00 14 stw r0,20(r9) _Thread_Enable_dispatch(); ffc0ae20: 48 00 26 c1 bl ffc0d4e0 <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); ffc0ae24: 7f e3 fb 78 mr r3,r31 ffc0ae28: 38 80 00 00 li r4,0 ffc0ae2c: 38 a0 00 00 li r5,0 ffc0ae30: 48 00 a6 29 bl ffc15458 } ffc0ae34: 80 01 00 14 lwz r0,20(r1) ffc0ae38: 83 e1 00 0c lwz r31,12(r1) ffc0ae3c: 38 21 00 10 addi r1,r1,16 ffc0ae40: 7c 08 03 a6 mtlr r0 ffc0ae44: 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; ffc0ae48: 3d 60 00 00 lis r11,0 ffc0ae4c: 1c 1f 00 18 mulli r0,r31,24 ffc0ae50: 81 2b 28 5c lwz r9,10332(r11) static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ae54: 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; ffc0ae58: 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; ffc0ae5c: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0ae60: 41 9e 00 40 beq- cr7,ffc0aea0 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(); ffc0ae64: 48 00 26 7d bl ffc0d4e0 <_Thread_Enable_dispatch> _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } ffc0ae68: 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; ffc0ae6c: 38 60 00 0c li r3,12 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } ffc0ae70: 83 e1 00 0c lwz r31,12(r1) ffc0ae74: 7c 08 03 a6 mtlr r0 ffc0ae78: 38 21 00 10 addi r1,r1,16 ffc0ae7c: 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; ffc0ae80: 81 64 00 04 lwz r11,4(r4) ffc0ae84: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0ae88: 40 9e fe e8 bne+ cr7,ffc0ad70 ffc0ae8c: 4b ff ff a8 b ffc0ae34 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; ffc0ae90: 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(); ffc0ae94: 48 00 26 4d bl ffc0d4e0 <_Thread_Enable_dispatch> *major = m; if ( m != n ) return RTEMS_SUCCESSFUL; return RTEMS_TOO_MANY; ffc0ae98: 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; ffc0ae9c: 4b ff ff 98 b ffc0ae34 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0aea0: 81 29 00 04 lwz r9,4(r9) ffc0aea4: 2f 89 00 00 cmpwi cr7,r9,0 ffc0aea8: 40 9e ff bc bne+ cr7,ffc0ae64 if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; ffc0aeac: 93 e5 00 00 stw r31,0(r5) ffc0aeb0: 4b ff ff 38 b ffc0ade8 ffc0aeb4: 38 00 00 01 li r0,1 <== NOT EXECUTED ffc0aeb8: 7c 09 03 a6 mtctr r0 <== NOT EXECUTED ffc0aebc: 4b ff ff 04 b ffc0adc0 <== NOT EXECUTED =============================================================================== ffc0c8bc : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 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) uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) ffc0c8c8: 7c 60 1b 79 mr. r0,r3 #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { ffc0c8cc: 93 81 00 10 stw r28,16(r1) ffc0c8d0: 93 a1 00 14 stw r29,20(r1) ffc0c8d4: 93 c1 00 18 stw r30,24(r1) ffc0c8d8: 93 e1 00 1c stw r31,28(r1) uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) ffc0c8dc: 90 01 00 08 stw r0,8(r1) ffc0c8e0: 41 82 00 6c beq- ffc0c94c <== NEVER TAKEN ffc0c8e4: 3f a0 00 00 lis r29,0 ffc0c8e8: 3b bd 30 80 addi r29,r29,12416 #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) ffc0c8ec: 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 ]; ffc0c8f0: 85 3d 00 04 lwzu r9,4(r29) ffc0c8f4: 83 c9 00 04 lwz r30,4(r9) if ( !information ) ffc0c8f8: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0c8fc: 41 9e 00 48 beq- cr7,ffc0c944 continue; for ( i=1 ; i <= information->maximum ; i++ ) { ffc0c900: a0 1e 00 10 lhz r0,16(r30) ffc0c904: 70 09 ff ff andi. r9,r0,65535 ffc0c908: 41 82 00 3c beq- ffc0c944 ffc0c90c: 3b e0 00 01 li r31,1 the_thread = (Thread_Control *)information->local_table[ i ]; ffc0c910: 81 7e 00 1c lwz r11,28(r30) ffc0c914: 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++ ) { ffc0c918: 3b ff 00 01 addi r31,r31,1 the_thread = (Thread_Control *)information->local_table[ i ]; ffc0c91c: 7c 6b 48 2e lwzx r3,r11,r9 if ( !the_thread ) ffc0c920: 2f 83 00 00 cmpwi cr7,r3,0 ffc0c924: 41 9e 00 14 beq- cr7,ffc0c938 continue; (*routine)(the_thread); ffc0c928: 80 01 00 08 lwz r0,8(r1) ffc0c92c: 7c 09 03 a6 mtctr r0 ffc0c930: 4e 80 04 21 bctrl ffc0c934: 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++ ) { ffc0c938: 54 09 04 3e clrlwi r9,r0,16 ffc0c93c: 7f 89 f8 40 cmplw cr7,r9,r31 ffc0c940: 40 9c ff d0 bge+ cr7,ffc0c910 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { ffc0c944: 7f 9d e0 00 cmpw cr7,r29,r28 ffc0c948: 40 9e ff a8 bne+ cr7,ffc0c8f0 (*routine)(the_thread); } } } ffc0c94c: 80 01 00 24 lwz r0,36(r1) ffc0c950: 83 81 00 10 lwz r28,16(r1) ffc0c954: 7c 08 03 a6 mtlr r0 ffc0c958: 83 a1 00 14 lwz r29,20(r1) ffc0c95c: 83 c1 00 18 lwz r30,24(r1) ffc0c960: 83 e1 00 1c lwz r31,28(r1) ffc0c964: 38 21 00 20 addi r1,r1,32 ffc0c968: 4e 80 00 20 blr =============================================================================== ffc0af8c : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { ffc0af8c: 94 21 ff f0 stwu r1,-16(r1) ffc0af90: 7c 08 02 a6 mflr r0 ffc0af94: 93 e1 00 0c stw r31,12(r1) int i; /* * Validate parameters and look up information structure. */ if ( !info ) ffc0af98: 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 ) { ffc0af9c: 90 01 00 14 stw r0,20(r1) /* * Validate parameters and look up information structure. */ if ( !info ) return RTEMS_INVALID_ADDRESS; ffc0afa0: 38 00 00 09 li r0,9 int i; /* * Validate parameters and look up information structure. */ if ( !info ) ffc0afa4: 41 82 00 7c beq- ffc0b020 return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); ffc0afa8: 54 84 04 3e clrlwi r4,r4,16 ffc0afac: 48 00 25 2d bl ffc0d4d8 <_Objects_Get_information> if ( !obj_info ) return RTEMS_INVALID_NUMBER; ffc0afb0: 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 ) ffc0afb4: 2c 03 00 00 cmpwi r3,0 ffc0afb8: 41 82 00 68 beq- ffc0b020 * 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; ffc0afbc: 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; ffc0afc0: 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++ ) ffc0afc4: 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; ffc0afc8: 81 63 00 0c lwz r11,12(r3) info->auto_extend = obj_info->auto_extend; ffc0afcc: 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; ffc0afd0: 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++ ) ffc0afd4: 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; ffc0afd8: 91 7f 00 04 stw r11,4(r31) info->auto_extend = obj_info->auto_extend; ffc0afdc: 99 3f 00 0c stb r9,12(r31) info->maximum = obj_info->maximum; ffc0afe0: 91 1f 00 08 stw r8,8(r31) for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) ffc0afe4: 41 9e 00 34 beq- cr7,ffc0b018 <== NEVER TAKEN ffc0afe8: 80 e3 00 1c lwz r7,28(r3) ffc0afec: 39 60 00 01 li r11,1 ffc0aff0: 39 20 00 01 li r9,1 ffc0aff4: 39 29 00 01 addi r9,r9,1 ffc0aff8: 7f 88 48 40 cmplw cr7,r8,r9 if ( !obj_info->local_table[i] ) ffc0affc: 55 6b 10 3a rlwinm r11,r11,2,0,29 ffc0b000: 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++ ) ffc0b004: 7d 2b 4b 78 mr r11,r9 if ( !obj_info->local_table[i] ) unallocated++; ffc0b008: 20 ca 00 00 subfic r6,r10,0 ffc0b00c: 7c c0 01 94 addze r6,r0 ffc0b010: 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++ ) ffc0b014: 40 9c ff e0 bge+ cr7,ffc0aff4 if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; ffc0b018: 90 1f 00 10 stw r0,16(r31) return RTEMS_SUCCESSFUL; ffc0b01c: 38 00 00 00 li r0,0 } ffc0b020: 7c 03 03 78 mr r3,r0 ffc0b024: 80 01 00 14 lwz r0,20(r1) ffc0b028: 83 e1 00 0c lwz r31,12(r1) ffc0b02c: 38 21 00 10 addi r1,r1,16 ffc0b030: 7c 08 03 a6 mtlr r0 ffc0b034: 4e 80 00 20 blr =============================================================================== ffc18584 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { ffc18584: 94 21 ff d0 stwu r1,-48(r1) ffc18588: 7c 08 02 a6 mflr r0 ffc1858c: 93 e1 00 2c stw r31,44(r1) register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) ffc18590: 7c 7f 1b 79 mr. r31,r3 return RTEMS_INVALID_NAME; ffc18594: 38 60 00 03 li r3,3 uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { ffc18598: 93 c1 00 28 stw r30,40(r1) ffc1859c: 7c be 2b 78 mr r30,r5 ffc185a0: 90 01 00 34 stw r0,52(r1) ffc185a4: 93 61 00 1c stw r27,28(r1) ffc185a8: 93 81 00 20 stw r28,32(r1) ffc185ac: 93 a1 00 24 stw r29,36(r1) register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) ffc185b0: 41 82 00 48 beq- ffc185f8 return RTEMS_INVALID_NAME; if ( !starting_address ) ffc185b4: 2f 84 00 00 cmpwi cr7,r4,0 return RTEMS_INVALID_ADDRESS; ffc185b8: 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 ) ffc185bc: 41 9e 00 3c beq- cr7,ffc185f8 return RTEMS_INVALID_ADDRESS; if ( !id ) ffc185c0: 2f 88 00 00 cmpwi cr7,r8,0 ffc185c4: 41 9e 00 34 beq- cr7,ffc185f8 <== NEVER TAKEN return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || ffc185c8: 2f 85 00 00 cmpwi cr7,r5,0 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; ffc185cc: 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 || ffc185d0: 41 9e 00 28 beq- cr7,ffc185f8 ffc185d4: 2f 86 00 00 cmpwi cr7,r6,0 ffc185d8: 41 9e 00 20 beq- cr7,ffc185f8 ffc185dc: 7f 85 30 40 cmplw cr7,r5,r6 ffc185e0: 41 9c 00 18 blt- cr7,ffc185f8 ffc185e4: 70 c0 00 07 andi. r0,r6,7 ffc185e8: 40 82 00 10 bne- ffc185f8 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) ffc185ec: 70 9b 00 07 andi. r27,r4,7 return RTEMS_INVALID_ADDRESS; ffc185f0: 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 ) ) ffc185f4: 41 82 00 28 beq- ffc1861c ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } ffc185f8: 80 01 00 34 lwz r0,52(r1) ffc185fc: 83 61 00 1c lwz r27,28(r1) ffc18600: 7c 08 03 a6 mtlr r0 ffc18604: 83 81 00 20 lwz r28,32(r1) ffc18608: 83 a1 00 24 lwz r29,36(r1) ffc1860c: 83 c1 00 28 lwz r30,40(r1) ffc18610: 83 e1 00 2c lwz r31,44(r1) ffc18614: 38 21 00 30 addi r1,r1,48 ffc18618: 4e 80 00 20 blr ffc1861c: 3d 20 00 00 lis r9,0 ffc18620: 81 69 28 e0 lwz r11,10464(r9) ffc18624: 38 0b 00 01 addi r0,r11,1 ffc18628: 90 09 28 e0 stw r0,10464(r9) * This function allocates a partition control block from * the inactive chain of free partition control blocks. */ RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Allocate ( void ) { return (Partition_Control *) _Objects_Allocate( &_Partition_Information ); ffc1862c: 3f 80 00 00 lis r28,0 ffc18630: 90 81 00 08 stw r4,8(r1) ffc18634: 3b 9c 6f 20 addi r28,r28,28448 ffc18638: 7f 83 e3 78 mr r3,r28 ffc1863c: 90 c1 00 0c stw r6,12(r1) ffc18640: 90 e1 00 10 stw r7,16(r1) ffc18644: 91 01 00 14 stw r8,20(r1) ffc18648: 48 00 60 69 bl ffc1e6b0 <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { ffc1864c: 7c 7d 1b 79 mr. r29,r3 ffc18650: 80 81 00 08 lwz r4,8(r1) ffc18654: 80 c1 00 0c lwz r6,12(r1) ffc18658: 80 e1 00 10 lwz r7,16(r1) ffc1865c: 81 01 00 14 lwz r8,20(r1) ffc18660: 41 82 00 50 beq- ffc186b0 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, ffc18664: 7c be 33 96 divwu r5,r30,r6 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; ffc18668: 90 9d 00 10 stw r4,16(r29) the_partition->length = length; the_partition->buffer_size = buffer_size; ffc1866c: 90 dd 00 18 stw r6,24(r29) the_partition->attribute_set = attribute_set; ffc18670: 90 fd 00 1c stw r7,28(r29) return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; the_partition->length = length; ffc18674: 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; ffc18678: 93 7d 00 20 stw r27,32(r29) _Chain_Initialize( &the_partition->Memory, starting_address, ffc1867c: 91 01 00 14 stw r8,20(r1) ffc18680: 38 7d 00 24 addi r3,r29,36 ffc18684: 48 00 42 61 bl ffc1c8e4 <_Chain_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc18688: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc1868c: 81 7c 00 1c lwz r11,28(r28) ffc18690: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc18694: 7f ab 49 2e stwx r29,r11,r9 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc18698: 93 fd 00 0c stw r31,12(r29) &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; ffc1869c: 81 01 00 14 lwz r8,20(r1) ffc186a0: 90 08 00 00 stw r0,0(r8) name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); ffc186a4: 48 00 76 8d bl ffc1fd30 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc186a8: 38 60 00 00 li r3,0 ffc186ac: 4b ff ff 4c b ffc185f8 _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { _Thread_Enable_dispatch(); ffc186b0: 48 00 76 81 bl ffc1fd30 <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; ffc186b4: 38 60 00 05 li r3,5 ffc186b8: 4b ff ff 40 b ffc185f8 =============================================================================== ffc18848 : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { ffc18848: 94 21 ff e0 stwu r1,-32(r1) ffc1884c: 7c 08 02 a6 mflr r0 ffc18850: 90 01 00 24 stw r0,36(r1) ffc18854: 7c 60 1b 78 mr r0,r3 Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) _Objects_Get( &_Partition_Information, id, location ); ffc18858: 3c 60 00 00 lis r3,0 ffc1885c: 93 e1 00 1c stw r31,28(r1) ffc18860: 38 63 6f 20 addi r3,r3,28448 ffc18864: 7c 9f 23 78 mr r31,r4 ffc18868: 38 a1 00 08 addi r5,r1,8 ffc1886c: 93 c1 00 18 stw r30,24(r1) ffc18870: 7c 04 03 78 mr r4,r0 ffc18874: 48 00 64 99 bl ffc1ed0c <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { ffc18878: 80 01 00 08 lwz r0,8(r1) ffc1887c: 7c 7e 1b 78 mr r30,r3 ffc18880: 2f 80 00 00 cmpwi cr7,r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc18884: 38 60 00 04 li r3,4 { register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { ffc18888: 40 9e 00 58 bne- cr7,ffc188e0 ) { void *starting; void *ending; starting = the_partition->starting_address; ffc1888c: 80 1e 00 10 lwz r0,16(r30) ending = _Addresses_Add_offset( starting, the_partition->length ); ffc18890: 81 3e 00 14 lwz r9,20(r30) const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); ffc18894: 7f 9f 00 40 cmplw cr7,r31,r0 ffc18898: 41 9c 00 60 blt- cr7,ffc188f8 RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); ffc1889c: 7d 20 4a 14 add r9,r0,r9 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); ffc188a0: 7f 9f 48 40 cmplw cr7,r31,r9 ffc188a4: 41 9d 00 54 bgt- cr7,ffc188f8 <== NEVER TAKEN offset = (uint32_t) _Addresses_Subtract( the_buffer, the_partition->starting_address ); return ((offset % the_partition->buffer_size) == 0); ffc188a8: 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); ffc188ac: 7c 00 f8 50 subf r0,r0,r31 ffc188b0: 7d 60 4b 96 divwu r11,r0,r9 ffc188b4: 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 ) && ffc188b8: 7f 80 48 00 cmpw cr7,r0,r9 ffc188bc: 40 9e 00 3c bne- cr7,ffc188f8 RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); ffc188c0: 38 7e 00 24 addi r3,r30,36 ffc188c4: 7f e4 fb 78 mr r4,r31 ffc188c8: 48 00 3f 81 bl ffc1c848 <_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; ffc188cc: 81 3e 00 20 lwz r9,32(r30) ffc188d0: 38 09 ff ff addi r0,r9,-1 ffc188d4: 90 1e 00 20 stw r0,32(r30) _Thread_Enable_dispatch(); ffc188d8: 48 00 74 59 bl ffc1fd30 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc188dc: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc188e0: 80 01 00 24 lwz r0,36(r1) ffc188e4: 83 c1 00 18 lwz r30,24(r1) ffc188e8: 7c 08 03 a6 mtlr r0 ffc188ec: 83 e1 00 1c lwz r31,28(r1) ffc188f0: 38 21 00 20 addi r1,r1,32 ffc188f4: 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(); ffc188f8: 48 00 74 39 bl ffc1fd30 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc188fc: 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; ffc18900: 38 60 00 09 li r3,9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc18904: 83 c1 00 18 lwz r30,24(r1) ffc18908: 7c 08 03 a6 mtlr r0 ffc1890c: 83 e1 00 1c lwz r31,28(r1) ffc18910: 38 21 00 20 addi r1,r1,32 ffc18914: 4e 80 00 20 blr =============================================================================== ffc0a258 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { ffc0a258: 94 21 ff d0 stwu r1,-48(r1) ffc0a25c: 7c 08 02 a6 mflr r0 ffc0a260: 93 e1 00 2c stw r31,44(r1) ffc0a264: 7c 7f 1b 78 mr r31,r3 Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) _Objects_Get( &_Rate_monotonic_Information, id, location ); ffc0a268: 3c 60 00 00 lis r3,0 ffc0a26c: 93 c1 00 28 stw r30,40(r1) ffc0a270: 38 63 2c 78 addi r3,r3,11384 ffc0a274: 7c 9e 23 78 mr r30,r4 ffc0a278: 38 a1 00 08 addi r5,r1,8 ffc0a27c: 90 01 00 34 stw r0,52(r1) ffc0a280: 7f e4 fb 78 mr r4,r31 ffc0a284: 93 a1 00 24 stw r29,36(r1) ffc0a288: 93 61 00 1c stw r27,28(r1) ffc0a28c: 93 81 00 20 stw r28,32(r1) ffc0a290: 48 00 2e 41 bl ffc0d0d0 <_Objects_Get> ffc0a294: 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 ) { ffc0a298: 80 01 00 08 lwz r0,8(r1) ffc0a29c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a2a0: 41 9e 00 30 beq- cr7,ffc0a2d0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a2a4: 3b e0 00 04 li r31,4 } ffc0a2a8: 80 01 00 34 lwz r0,52(r1) ffc0a2ac: 7f e3 fb 78 mr r3,r31 ffc0a2b0: 83 61 00 1c lwz r27,28(r1) ffc0a2b4: 7c 08 03 a6 mtlr r0 ffc0a2b8: 83 81 00 20 lwz r28,32(r1) ffc0a2bc: 83 a1 00 24 lwz r29,36(r1) ffc0a2c0: 83 c1 00 28 lwz r30,40(r1) ffc0a2c4: 83 e1 00 2c lwz r31,44(r1) ffc0a2c8: 38 21 00 30 addi r1,r1,48 ffc0a2cc: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc0a2d0: 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 ) ) { ffc0a2d4: 81 23 00 40 lwz r9,64(r3) ffc0a2d8: 3b 9c 32 24 addi r28,r28,12836 ffc0a2dc: 80 1c 00 0c lwz r0,12(r28) ffc0a2e0: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a2e4: 41 9e 00 34 beq- cr7,ffc0a318 _Thread_Enable_dispatch(); ffc0a2e8: 48 00 3e 0d bl ffc0e0f4 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a2ec: 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; ffc0a2f0: 3b e0 00 17 li r31,23 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a2f4: 83 61 00 1c lwz r27,28(r1) ffc0a2f8: 7c 08 03 a6 mtlr r0 ffc0a2fc: 7f e3 fb 78 mr r3,r31 ffc0a300: 83 81 00 20 lwz r28,32(r1) ffc0a304: 83 a1 00 24 lwz r29,36(r1) ffc0a308: 83 c1 00 28 lwz r30,40(r1) ffc0a30c: 83 e1 00 2c lwz r31,44(r1) ffc0a310: 38 21 00 30 addi r1,r1,48 ffc0a314: 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 ) { ffc0a318: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a31c: 40 9e 00 1c bne- cr7,ffc0a338 switch ( the_period->state ) { ffc0a320: 80 03 00 38 lwz r0,56(r3) ffc0a324: 3b e0 00 00 li r31,0 ffc0a328: 2b 80 00 04 cmplwi cr7,r0,4 ffc0a32c: 40 9d 00 70 ble- cr7,ffc0a39c <== ALWAYS TAKEN case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); ffc0a330: 48 00 3d c5 bl ffc0e0f4 <_Thread_Enable_dispatch> <== NOT EXECUTED return( return_value ); ffc0a334: 4b ff ff 74 b ffc0a2a8 <== NOT EXECUTED static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a338: 7f 60 00 a6 mfmsr r27 ffc0a33c: 7c 10 42 a6 mfsprg r0,0 ffc0a340: 7f 60 00 78 andc r0,r27,r0 ffc0a344: 7c 00 01 24 mtmsr r0 } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { ffc0a348: 80 03 00 38 lwz r0,56(r3) ffc0a34c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a350: 41 9e 00 64 beq- cr7,ffc0a3b4 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { ffc0a354: 2f 80 00 02 cmpwi cr7,r0,2 ffc0a358: 41 9e 00 ac beq- cr7,ffc0a404 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { ffc0a35c: 2f 80 00 04 cmpwi cr7,r0,4 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a360: 3b e0 00 04 li r31,4 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { ffc0a364: 40 9e ff 44 bne+ cr7,ffc0a2a8 <== NEVER TAKEN /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); ffc0a368: 4b ff fd a9 bl ffc0a110 <_Rate_monotonic_Update_statistics> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a36c: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a370: 38 00 00 02 li r0,2 the_period->next_length = length; ffc0a374: 93 dd 00 3c stw r30,60(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a378: 3c 60 00 00 lis r3,0 */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a37c: 90 1d 00 38 stw r0,56(r29) ffc0a380: 38 63 2e 48 addi r3,r3,11848 ffc0a384: 38 9d 00 10 addi r4,r29,16 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a388: 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; ffc0a38c: 3b e0 00 06 li r31,6 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a390: 48 00 52 7d bl ffc0f60c <_Watchdog_Insert> the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); ffc0a394: 48 00 3d 61 bl ffc0e0f4 <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; ffc0a398: 4b ff ff 10 b ffc0a2a8 _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { switch ( the_period->state ) { ffc0a39c: 3d 20 ff c2 lis r9,-62 ffc0a3a0: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0a3a4: 39 29 2b 48 addi r9,r9,11080 ffc0a3a8: 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(); ffc0a3ac: 48 00 3d 49 bl ffc0e0f4 <_Thread_Enable_dispatch> ffc0a3b0: 4b ff fe f8 b ffc0a2a8 ffc0a3b4: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); ffc0a3b8: 4b ff fc a1 bl ffc0a058 <_Rate_monotonic_Initiate_statistics> the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a3bc: 39 20 00 02 li r9,2 ffc0a3c0: 91 3d 00 38 stw r9,56(r29) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc0a3c4: 3d 20 ff c1 lis r9,-63 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0a3c8: 38 00 00 00 li r0,0 the_watchdog->routine = routine; ffc0a3cc: 39 29 a8 6c addi r9,r9,-22420 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0a3d0: 90 1d 00 18 stw r0,24(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a3d4: 3c 60 00 00 lis r3,0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc0a3d8: 91 3d 00 2c stw r9,44(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a3dc: 38 63 2e 48 addi r3,r3,11848 ffc0a3e0: 38 9d 00 10 addi r4,r29,16 void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; ffc0a3e4: 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; ffc0a3e8: 3b e0 00 00 li r31,0 the_watchdog->user_data = user_data; ffc0a3ec: 90 1d 00 34 stw r0,52(r29) _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; ffc0a3f0: 93 dd 00 3c stw r30,60(r29) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a3f4: 93 dd 00 1c stw r30,28(r29) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a3f8: 48 00 52 15 bl ffc0f60c <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); ffc0a3fc: 48 00 3c f9 bl ffc0e0f4 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a400: 4b ff fe a8 b ffc0a2a8 if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); ffc0a404: 4b ff fd 0d bl ffc0a110 <_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; ffc0a408: 38 00 00 01 li r0,1 ffc0a40c: 90 1d 00 38 stw r0,56(r29) the_period->next_length = length; ffc0a410: 93 dd 00 3c stw r30,60(r29) ffc0a414: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; ffc0a418: 81 3c 00 0c lwz r9,12(r28) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a41c: 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; ffc0a420: 80 1d 00 08 lwz r0,8(r29) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a424: 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; ffc0a428: 90 09 00 20 stw r0,32(r9) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a42c: 48 00 47 e1 bl ffc0ec0c <_Thread_Set_state> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a430: 7d 20 00 a6 mfmsr r9 ffc0a434: 7c 10 42 a6 mfsprg r0,0 ffc0a438: 7d 20 00 78 andc r0,r9,r0 ffc0a43c: 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; ffc0a440: 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; ffc0a444: 80 1d 00 38 lwz r0,56(r29) the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a448: 91 7d 00 38 stw r11,56(r29) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a44c: 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 ) ffc0a450: 2f 80 00 03 cmpwi cr7,r0,3 ffc0a454: 41 9e 00 10 beq- cr7,ffc0a464 <== NEVER TAKEN _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); _Thread_Enable_dispatch(); ffc0a458: 48 00 3c 9d bl ffc0e0f4 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a45c: 3b e0 00 00 li r31,0 ffc0a460: 4b ff fe 48 b ffc0a2a8 /* * 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 ); ffc0a464: 80 7c 00 0c lwz r3,12(r28) <== NOT EXECUTED ffc0a468: 38 80 40 00 li r4,16384 <== NOT EXECUTED ffc0a46c: 48 00 37 e5 bl ffc0dc50 <_Thread_Clear_state> <== NOT EXECUTED ffc0a470: 4b ff ff e8 b ffc0a458 <== NOT EXECUTED =============================================================================== ffc0a474 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { ffc0a474: 94 21 ff 58 stwu r1,-168(r1) ffc0a478: 7c 08 02 a6 mflr r0 ffc0a47c: 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 ) ffc0a480: 7c 80 23 79 mr. r0,r4 */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { ffc0a484: 93 a1 00 9c stw r29,156(r1) ffc0a488: 7c 7d 1b 78 mr r29,r3 ffc0a48c: 92 41 00 70 stw r18,112(r1) ffc0a490: 92 61 00 74 stw r19,116(r1) ffc0a494: 92 81 00 78 stw r20,120(r1) ffc0a498: 92 a1 00 7c stw r21,124(r1) ffc0a49c: 92 c1 00 80 stw r22,128(r1) ffc0a4a0: 92 e1 00 84 stw r23,132(r1) ffc0a4a4: 93 01 00 88 stw r24,136(r1) ffc0a4a8: 93 21 00 8c stw r25,140(r1) ffc0a4ac: 93 41 00 90 stw r26,144(r1) ffc0a4b0: 93 61 00 94 stw r27,148(r1) ffc0a4b4: 93 81 00 98 stw r28,152(r1) ffc0a4b8: 93 c1 00 a0 stw r30,160(r1) ffc0a4bc: 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 ) ffc0a4c0: 90 01 00 68 stw r0,104(r1) ffc0a4c4: 41 82 01 88 beq- ffc0a64c <== NEVER TAKEN return; (*print)( context, "Period information by period\n" ); ffc0a4c8: 3c 80 ff c2 lis r4,-62 ffc0a4cc: 7c 09 03 a6 mtctr r0 ffc0a4d0: 38 84 2b 5c addi r4,r4,11100 /* * 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: 3f c0 00 00 lis r30,0 ffc0a4d8: 3b de 2c 78 addi r30,r30,11384 char name[5]; if ( !print ) return; (*print)( context, "Period information by period\n" ); ffc0a4dc: 4c c6 31 82 crclr 4*cr1+eq ffc0a4e0: 4e 80 04 21 bctrl #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); ffc0a4e4: 80 01 00 68 lwz r0,104(r1) ffc0a4e8: 3c 80 ff c2 lis r4,-62 ffc0a4ec: 7c 09 03 a6 mtctr r0 ffc0a4f0: 38 84 2b 7c addi r4,r4,11132 ffc0a4f4: 7f a3 eb 78 mr r3,r29 ffc0a4f8: 4c c6 31 82 crclr 4*cr1+eq ffc0a4fc: 4e 80 04 21 bctrl (*print)( context, "--- Wall times are in seconds ---\n" ); ffc0a500: 80 01 00 68 lwz r0,104(r1) ffc0a504: 3c 80 ff c2 lis r4,-62 ffc0a508: 7c 09 03 a6 mtctr r0 ffc0a50c: 38 84 2b a0 addi r4,r4,11168 ffc0a510: 7f a3 eb 78 mr r3,r29 ffc0a514: 4c c6 31 82 crclr 4*cr1+eq ffc0a518: 4e 80 04 21 bctrl Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " ffc0a51c: 80 01 00 68 lwz r0,104(r1) ffc0a520: 3c 80 ff c2 lis r4,-62 ffc0a524: 7c 09 03 a6 mtctr r0 ffc0a528: 38 84 2b c4 addi r4,r4,11204 ffc0a52c: 7f a3 eb 78 mr r3,r29 ffc0a530: 4c c6 31 82 crclr 4*cr1+eq ffc0a534: 4e 80 04 21 bctrl #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " ffc0a538: 80 01 00 68 lwz r0,104(r1) ffc0a53c: 3c 80 ff c2 lis r4,-62 ffc0a540: 7c 09 03 a6 mtctr r0 ffc0a544: 7f a3 eb 78 mr r3,r29 ffc0a548: 38 84 2c 10 addi r4,r4,11280 ffc0a54c: 4c c6 31 82 crclr 4*cr1+eq ffc0a550: 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 ; ffc0a554: 83 fe 00 08 lwz r31,8(r30) ffc0a558: 80 1e 00 0c lwz r0,12(r30) ffc0a55c: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0a560: 41 9d 00 ec bgt- cr7,ffc0a64c <== 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, ffc0a564: 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, ffc0a568: 3e 60 ff c2 lis r19,-62 ffc0a56c: 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, ffc0a570: 3e 40 ff c2 lis r18,-62 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a574: 3f 00 ff c2 lis r24,-62 ffc0a578: 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 ); ffc0a57c: 3a a1 00 18 addi r21,r1,24 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); ffc0a580: 3b 41 00 08 addi r26,r1,8 /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc0a584: 3a d6 2c 5c addi r22,r22,11356 { #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; ffc0a588: 3a e1 00 48 addi r23,r1,72 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); ffc0a58c: 3b 21 00 10 addi r25,r1,16 (*print)( context, ffc0a590: 3a 73 2c 74 addi r19,r19,11380 ffc0a594: 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; ffc0a598: 3a 81 00 60 addi r20,r1,96 _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); (*print)( context, ffc0a59c: 3a 52 2c 94 addi r18,r18,11412 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a5a0: 3b 18 18 40 addi r24,r24,6208 ffc0a5a4: 48 00 00 14 b ffc0a5b8 /* * 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 ; ffc0a5a8: 80 1e 00 0c lwz r0,12(r30) id <= _Rate_monotonic_Information.maximum_id ; id++ ) { ffc0a5ac: 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 ; ffc0a5b0: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a5b4: 41 9c 00 98 blt- cr7,ffc0a64c id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); ffc0a5b8: 7f e3 fb 78 mr r3,r31 ffc0a5bc: 7f 84 e3 78 mr r4,r28 ffc0a5c0: 48 00 7f cd bl ffc1258c if ( status != RTEMS_SUCCESSFUL ) ffc0a5c4: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a5c8: 40 9e ff e0 bne+ cr7,ffc0a5a8 #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 ); ffc0a5cc: 7e a4 ab 78 mr r4,r21 ffc0a5d0: 7f e3 fb 78 mr r3,r31 ffc0a5d4: 48 00 80 c9 bl ffc1269c #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); ffc0a5d8: 80 61 00 18 lwz r3,24(r1) ffc0a5dc: 7f 45 d3 78 mr r5,r26 ffc0a5e0: 38 80 00 05 li r4,5 ffc0a5e4: 48 00 03 51 bl ffc0a934 /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc0a5e8: 80 01 00 68 lwz r0,104(r1) ffc0a5ec: 7e c4 b3 78 mr r4,r22 ffc0a5f0: 80 e1 00 30 lwz r7,48(r1) ffc0a5f4: 7f e5 fb 78 mr r5,r31 ffc0a5f8: 7c 09 03 a6 mtctr r0 ffc0a5fc: 7f a3 eb 78 mr r3,r29 ffc0a600: 81 01 00 34 lwz r8,52(r1) ffc0a604: 7f 46 d3 78 mr r6,r26 ffc0a608: 4c c6 31 82 crclr 4*cr1+eq ffc0a60c: 4e 80 04 21 bctrl ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a610: 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 ); ffc0a614: 7e e3 bb 78 mr r3,r23 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a618: 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 ); ffc0a61c: 7f 25 cb 78 mr r5,r25 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a620: 7f 04 c3 78 mr r4,r24 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a624: 40 9e 00 70 bne- cr7,ffc0a694 (*print)( context, "\n" ); ffc0a628: 80 01 00 68 lwz r0,104(r1) ffc0a62c: 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++ ) { ffc0a630: 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" ); ffc0a634: 7c 09 03 a6 mtctr r0 ffc0a638: 4c c6 31 82 crclr 4*cr1+eq ffc0a63c: 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 ; ffc0a640: 80 1e 00 0c lwz r0,12(r30) ffc0a644: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a648: 40 9c ff 70 bge+ cr7,ffc0a5b8 <== ALWAYS TAKEN the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall ); #endif } } } ffc0a64c: 80 01 00 ac lwz r0,172(r1) ffc0a650: 82 41 00 70 lwz r18,112(r1) ffc0a654: 7c 08 03 a6 mtlr r0 ffc0a658: 82 61 00 74 lwz r19,116(r1) ffc0a65c: 82 81 00 78 lwz r20,120(r1) ffc0a660: 82 a1 00 7c lwz r21,124(r1) ffc0a664: 82 c1 00 80 lwz r22,128(r1) ffc0a668: 82 e1 00 84 lwz r23,132(r1) ffc0a66c: 83 01 00 88 lwz r24,136(r1) ffc0a670: 83 21 00 8c lwz r25,140(r1) ffc0a674: 83 41 00 90 lwz r26,144(r1) ffc0a678: 83 61 00 94 lwz r27,148(r1) ffc0a67c: 83 81 00 98 lwz r28,152(r1) ffc0a680: 83 a1 00 9c lwz r29,156(r1) ffc0a684: 83 c1 00 a0 lwz r30,160(r1) ffc0a688: 83 e1 00 a4 lwz r31,164(r1) ffc0a68c: 38 21 00 a8 addi r1,r1,168 ffc0a690: 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 ); ffc0a694: 7c 04 03 78 mr r4,r0 ffc0a698: 48 00 49 35 bl ffc0efcc <_Timespec_Divide_by_integer> (*print)( context, ffc0a69c: 80 01 00 14 lwz r0,20(r1) ffc0a6a0: 80 81 00 3c lwz r4,60(r1) ffc0a6a4: 7f a3 eb 78 mr r3,r29 ffc0a6a8: 81 61 00 44 lwz r11,68(r1) ffc0a6ac: 7d 40 d8 96 mulhw r10,r0,r27 ffc0a6b0: 80 e1 00 40 lwz r7,64(r1) ffc0a6b4: 7c c4 d8 96 mulhw r6,r4,r27 ffc0a6b8: 81 21 00 10 lwz r9,16(r1) ffc0a6bc: 80 a1 00 38 lwz r5,56(r1) ffc0a6c0: 7d 0b d8 96 mulhw r8,r11,r27 ffc0a6c4: 7c 00 fe 70 srawi r0,r0,31 ffc0a6c8: 7d 4a 36 70 srawi r10,r10,6 ffc0a6cc: 7d 40 50 50 subf r10,r0,r10 ffc0a6d0: 80 01 00 68 lwz r0,104(r1) ffc0a6d4: 7d 6b fe 70 srawi r11,r11,31 ffc0a6d8: 7c 84 fe 70 srawi r4,r4,31 ffc0a6dc: 7c 09 03 a6 mtctr r0 ffc0a6e0: 7c c6 36 70 srawi r6,r6,6 ffc0a6e4: 7d 08 36 70 srawi r8,r8,6 ffc0a6e8: 7c c4 30 50 subf r6,r4,r6 ffc0a6ec: 7d 0b 40 50 subf r8,r11,r8 ffc0a6f0: 7e 64 9b 78 mr r4,r19 ffc0a6f4: 4c c6 31 82 crclr 4*cr1+eq ffc0a6f8: 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); ffc0a6fc: 80 81 00 30 lwz r4,48(r1) ffc0a700: 7e 83 a3 78 mr r3,r20 ffc0a704: 7f 25 cb 78 mr r5,r25 ffc0a708: 48 00 48 c5 bl ffc0efcc <_Timespec_Divide_by_integer> (*print)( context, ffc0a70c: 80 01 00 14 lwz r0,20(r1) ffc0a710: 80 c1 00 54 lwz r6,84(r1) ffc0a714: 7f a3 eb 78 mr r3,r29 ffc0a718: 81 61 00 5c lwz r11,92(r1) ffc0a71c: 7d 40 d8 96 mulhw r10,r0,r27 ffc0a720: 80 a1 00 50 lwz r5,80(r1) ffc0a724: 7d 86 d8 96 mulhw r12,r6,r27 ffc0a728: 80 e1 00 58 lwz r7,88(r1) ffc0a72c: 81 21 00 10 lwz r9,16(r1) ffc0a730: 7d 0b d8 96 mulhw r8,r11,r27 ffc0a734: 7c 00 fe 70 srawi r0,r0,31 ffc0a738: 7d 4a 36 70 srawi r10,r10,6 ffc0a73c: 7d 40 50 50 subf r10,r0,r10 ffc0a740: 80 01 00 68 lwz r0,104(r1) ffc0a744: 7d 8c 36 70 srawi r12,r12,6 ffc0a748: 7d 6b fe 70 srawi r11,r11,31 ffc0a74c: 7c 09 03 a6 mtctr r0 ffc0a750: 7c c6 fe 70 srawi r6,r6,31 ffc0a754: 7d 08 36 70 srawi r8,r8,6 ffc0a758: 7e 44 93 78 mr r4,r18 ffc0a75c: 7c c6 60 50 subf r6,r6,r12 ffc0a760: 7d 0b 40 50 subf r8,r11,r8 ffc0a764: 4c c6 31 82 crclr 4*cr1+eq ffc0a768: 4e 80 04 21 bctrl ffc0a76c: 4b ff fe 3c b ffc0a5a8 =============================================================================== ffc0a780 : rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0a780: 3d 20 00 00 lis r9,0 /* * rtems_rate_monotonic_reset_all_statistics */ void rtems_rate_monotonic_reset_all_statistics( void ) { ffc0a784: 94 21 ff f0 stwu r1,-16(r1) ffc0a788: 7c 08 02 a6 mflr r0 ffc0a78c: 81 69 28 4c lwz r11,10316(r9) ffc0a790: 90 01 00 14 stw r0,20(r1) ffc0a794: 38 0b 00 01 addi r0,r11,1 ffc0a798: 93 c1 00 08 stw r30,8(r1) ffc0a79c: 93 e1 00 0c stw r31,12(r1) ffc0a7a0: 90 09 28 4c stw r0,10316(r9) /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; ffc0a7a4: 3f c0 00 00 lis r30,0 ffc0a7a8: 3b de 2c 78 addi r30,r30,11384 ffc0a7ac: 83 fe 00 08 lwz r31,8(r30) ffc0a7b0: 80 1e 00 0c lwz r0,12(r30) ffc0a7b4: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0a7b8: 41 9d 00 1c bgt- cr7,ffc0a7d4 <== NEVER TAKEN id <= _Rate_monotonic_Information.maximum_id ; id++ ) { (void) rtems_rate_monotonic_reset_statistics( id ); ffc0a7bc: 7f e3 fb 78 mr r3,r31 ffc0a7c0: 48 00 00 31 bl ffc0a7f0 /* * 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 ; ffc0a7c4: 80 1e 00 0c lwz r0,12(r30) id <= _Rate_monotonic_Information.maximum_id ; id++ ) { ffc0a7c8: 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 ; ffc0a7cc: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a7d0: 40 9c ff ec bge+ cr7,ffc0a7bc } /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); ffc0a7d4: 48 00 39 21 bl ffc0e0f4 <_Thread_Enable_dispatch> } ffc0a7d8: 80 01 00 14 lwz r0,20(r1) ffc0a7dc: 83 c1 00 08 lwz r30,8(r1) ffc0a7e0: 7c 08 03 a6 mtlr r0 ffc0a7e4: 83 e1 00 0c lwz r31,12(r1) ffc0a7e8: 38 21 00 10 addi r1,r1,16 ffc0a7ec: 4e 80 00 20 blr =============================================================================== ffc1a2a4 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { ffc1a2a4: 94 21 ff e0 stwu r1,-32(r1) ffc1a2a8: 7c 08 02 a6 mflr r0 ffc1a2ac: 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 ) ffc1a2b0: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { ffc1a2b4: 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; ffc1a2b8: 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 ) ffc1a2bc: 40 82 00 1c bne- ffc1a2d8 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1a2c0: 7c 03 03 78 mr r3,r0 ffc1a2c4: 80 01 00 24 lwz r0,36(r1) ffc1a2c8: 83 e1 00 1c lwz r31,28(r1) ffc1a2cc: 38 21 00 20 addi r1,r1,32 ffc1a2d0: 7c 08 03 a6 mtlr r0 ffc1a2d4: 4e 80 00 20 blr ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); ffc1a2d8: 38 81 00 08 addi r4,r1,8 ffc1a2dc: 48 00 5a 75 bl ffc1fd50 <_Thread_Get> switch ( location ) { ffc1a2e0: 80 01 00 08 lwz r0,8(r1) ffc1a2e4: 2f 80 00 00 cmpwi cr7,r0,0 ffc1a2e8: 41 9e 00 20 beq- cr7,ffc1a308 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1a2ec: 38 00 00 04 li r0,4 } ffc1a2f0: 83 e1 00 1c lwz r31,28(r1) ffc1a2f4: 7c 03 03 78 mr r3,r0 ffc1a2f8: 80 01 00 24 lwz r0,36(r1) ffc1a2fc: 38 21 00 20 addi r1,r1,32 ffc1a300: 7c 08 03 a6 mtlr r0 ffc1a304: 4e 80 00 20 blr the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; ffc1a308: 81 23 01 30 lwz r9,304(r3) asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { ffc1a30c: 80 09 00 0c lwz r0,12(r9) ffc1a310: 2f 80 00 00 cmpwi cr7,r0,0 ffc1a314: 41 9e 00 9c beq- cr7,ffc1a3b0 if ( asr->is_enabled ) { ffc1a318: 88 09 00 08 lbz r0,8(r9) ffc1a31c: 2f 80 00 00 cmpwi cr7,r0,0 ffc1a320: 41 9e 00 50 beq- cr7,ffc1a370 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1a324: 7c 00 00 a6 mfmsr r0 ffc1a328: 7d 70 42 a6 mfsprg r11,0 ffc1a32c: 7c 0b 58 78 andc r11,r0,r11 ffc1a330: 7d 60 01 24 mtmsr r11 ) { ISR_Level _level; _ISR_Disable( _level ); *signal_set |= signals; ffc1a334: 81 69 00 14 lwz r11,20(r9) ffc1a338: 7d 7f fb 78 or r31,r11,r31 ffc1a33c: 93 e9 00 14 stw r31,20(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1a340: 7c 00 01 24 mtmsr r0 _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc1a344: 3d 20 00 00 lis r9,0 ffc1a348: 39 29 75 44 addi r9,r9,30020 ffc1a34c: 80 09 00 08 lwz r0,8(r9) ffc1a350: 2f 80 00 00 cmpwi cr7,r0,0 ffc1a354: 41 9e 00 3c beq- cr7,ffc1a390 ffc1a358: 80 09 00 0c lwz r0,12(r9) ffc1a35c: 7f 83 00 00 cmpw cr7,r3,r0 ffc1a360: 40 be 00 30 bne+ cr7,ffc1a390 <== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc1a364: 38 00 00 01 li r0,1 ffc1a368: 98 09 00 18 stb r0,24(r9) ffc1a36c: 48 00 00 24 b ffc1a390 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1a370: 7c 00 00 a6 mfmsr r0 ffc1a374: 7d 70 42 a6 mfsprg r11,0 ffc1a378: 7c 0b 58 78 andc r11,r0,r11 ffc1a37c: 7d 60 01 24 mtmsr r11 ffc1a380: 81 69 00 18 lwz r11,24(r9) ffc1a384: 7d 7f fb 78 or r31,r11,r31 ffc1a388: 93 e9 00 18 stw r31,24(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1a38c: 7c 00 01 24 mtmsr r0 } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); ffc1a390: 48 00 59 a1 bl ffc1fd30 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc1a394: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1a398: 7c 03 03 78 mr r3,r0 ffc1a39c: 80 01 00 24 lwz r0,36(r1) ffc1a3a0: 83 e1 00 1c lwz r31,28(r1) ffc1a3a4: 38 21 00 20 addi r1,r1,32 ffc1a3a8: 7c 08 03 a6 mtlr r0 ffc1a3ac: 4e 80 00 20 blr _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); ffc1a3b0: 48 00 59 81 bl ffc1fd30 <_Thread_Enable_dispatch> return RTEMS_NOT_DEFINED; ffc1a3b4: 38 00 00 0b li r0,11 ffc1a3b8: 4b ff ff 08 b ffc1a2c0 =============================================================================== ffc12cec : ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) ffc12cec: 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 ) { ffc12cf0: 7c 08 02 a6 mflr r0 ffc12cf4: 94 21 ff f8 stwu r1,-8(r1) ffc12cf8: 90 01 00 0c stw r0,12(r1) ffc12cfc: 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; ffc12d00: 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 ) ffc12d04: 41 82 01 34 beq- ffc12e38 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; ffc12d08: 3c c0 00 00 lis r6,0 ffc12d0c: 38 c6 31 24 addi r6,r6,12580 ffc12d10: 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 ) ffc12d14: 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; ffc12d18: 89 09 00 74 lbz r8,116(r9) if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc12d1c: 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 ]; ffc12d20: 81 69 01 30 lwz r11,304(r9) asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; ffc12d24: 7d 08 00 34 cntlzw r8,r8 ffc12d28: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc12d2c: 55 07 40 2e rlwinm r7,r8,8,0,23 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc12d30: 40 9e 01 18 bne- cr7,ffc12e48 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; ffc12d34: 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); ffc12d38: 39 40 00 00 li r10,0 ffc12d3c: 7d 08 00 34 cntlzw r8,r8 ffc12d40: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc12d44: 55 08 50 2a rlwinm r8,r8,10,0,21 ffc12d48: 7d 07 3b 78 or r7,r8,r7 ffc12d4c: 7d 40 00 a6 mfmsr r10 if (msr & MSR_EE) return 0; ffc12d50: 55 48 8f fe rlwinm r8,r10,17,31,31 ffc12d54: 2f 88 00 00 cmpwi cr7,r8,0 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc12d58: 70 8a 01 00 andi. r10,r4,256 ffc12d5c: 7d 40 00 26 mfcr r10 ffc12d60: 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(); ffc12d64: 7c e7 53 78 or r7,r7,r10 *previous_mode_set = old_mode; ffc12d68: 90 e5 00 00 stw r7,0(r5) /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc12d6c: 41 82 00 14 beq- ffc12d80 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; ffc12d70: 70 08 01 00 andi. r8,r0,256 ffc12d74: 7d 40 00 26 mfcr r10 ffc12d78: 55 4a 1f fe rlwinm r10,r10,3,31,31 ffc12d7c: 99 49 00 74 stb r10,116(r9) if ( mask & RTEMS_TIMESLICE_MASK ) { ffc12d80: 70 8a 02 00 andi. r10,r4,512 ffc12d84: 41 82 00 20 beq- ffc12da4 if ( _Modes_Is_timeslice(mode_set) ) { ffc12d88: 70 0a 02 00 andi. r10,r0,512 ffc12d8c: 41 82 01 54 beq- ffc12ee0 executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc12d90: 3d 40 00 00 lis r10,0 ffc12d94: 81 4a 27 e4 lwz r10,10212(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; ffc12d98: 39 00 00 01 li r8,1 ffc12d9c: 91 09 00 7c stw r8,124(r9) executing->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc12da0: 91 49 00 78 stw r10,120(r9) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc12da4: 70 88 00 01 andi. r8,r4,1 ffc12da8: 41 82 00 20 beq- ffc12dc8 } static inline void _CPU_ISR_Set_level( uint32_t level ) { register unsigned int msr; _CPU_MSR_GET(msr); ffc12dac: 39 20 00 00 li r9,0 ffc12db0: 7d 20 00 a6 mfmsr r9 if (!(level & CPU_MODES_INTERRUPT_MASK)) { ffc12db4: 70 0a 00 01 andi. r10,r0,1 ffc12db8: 40 82 01 18 bne- ffc12ed0 static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; __asm__ volatile ( ffc12dbc: 7d 50 42 a6 mfsprg r10,0 msr |= ppc_interrupt_get_disable_mask(); ffc12dc0: 7d 49 4b 78 or r9,r10,r9 } else { msr &= ~ppc_interrupt_get_disable_mask(); } _CPU_MSR_SET(msr); ffc12dc4: 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 ) { ffc12dc8: 70 88 04 00 andi. r8,r4,1024 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; ffc12dcc: 39 40 00 00 li r10,0 if ( mask & RTEMS_ASR_MASK ) { ffc12dd0: 41 82 00 54 beq- ffc12e24 * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( ffc12dd4: 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 ) { ffc12dd8: 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( ffc12ddc: 7c 00 00 26 mfcr r0 ffc12de0: 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 ) { ffc12de4: 7f 89 00 00 cmpw cr7,r9,r0 ffc12de8: 41 9e 00 3c beq- cr7,ffc12e24 asr->is_enabled = is_asr_enabled; ffc12dec: 98 0b 00 08 stb r0,8(r11) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc12df0: 7c 00 00 a6 mfmsr r0 ffc12df4: 7d 30 42 a6 mfsprg r9,0 ffc12df8: 7c 09 48 78 andc r9,r0,r9 ffc12dfc: 7d 20 01 24 mtmsr r9 { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; ffc12e00: 81 4b 00 18 lwz r10,24(r11) information->signals_pending = information->signals_posted; ffc12e04: 81 2b 00 14 lwz r9,20(r11) information->signals_posted = _signals; ffc12e08: 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; ffc12e0c: 91 2b 00 18 stw r9,24(r11) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc12e10: 7c 00 01 24 mtmsr r0 _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { ffc12e14: 80 0b 00 14 lwz r0,20(r11) needs_asr_dispatching = true; ffc12e18: 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 ) ) { ffc12e1c: 2f 80 00 00 cmpwi cr7,r0,0 ffc12e20: 41 9e 00 d0 beq- cr7,ffc12ef0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc12e24: 3d 20 00 00 lis r9,0 ffc12e28: 80 09 28 2c lwz r0,10284(r9) if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; ffc12e2c: 38 60 00 00 li r3,0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc12e30: 2f 80 00 03 cmpwi cr7,r0,3 ffc12e34: 41 9e 00 58 beq- cr7,ffc12e8c if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; } ffc12e38: 80 01 00 0c lwz r0,12(r1) ffc12e3c: 38 21 00 08 addi r1,r1,8 ffc12e40: 7c 08 03 a6 mtlr r0 ffc12e44: 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; ffc12e48: 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; ffc12e4c: 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); ffc12e50: 39 40 00 00 li r10,0 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; ffc12e54: 7d 08 00 34 cntlzw r8,r8 ffc12e58: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc12e5c: 55 08 50 2a rlwinm r8,r8,10,0,21 ffc12e60: 7d 07 3b 78 or r7,r8,r7 ffc12e64: 7d 40 00 a6 mfmsr r10 if (msr & MSR_EE) return 0; ffc12e68: 55 48 8f fe rlwinm r8,r10,17,31,31 ffc12e6c: 2f 88 00 00 cmpwi cr7,r8,0 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc12e70: 70 8a 01 00 andi. r10,r4,256 ffc12e74: 7d 40 00 26 mfcr r10 ffc12e78: 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(); ffc12e7c: 7c e7 53 78 or r7,r7,r10 *previous_mode_set = old_mode; ffc12e80: 90 e5 00 00 stw r7,0(r5) /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc12e84: 41 a2 fe fc beq- ffc12d80 ffc12e88: 4b ff fe e8 b ffc12d70 { Thread_Control *executing; executing = _Thread_Executing; if ( are_signals_pending || ffc12e8c: 2f 8a 00 00 cmpwi cr7,r10,0 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; ffc12e90: 81 26 00 0c lwz r9,12(r6) if ( are_signals_pending || ffc12e94: 40 9e 00 1c bne- cr7,ffc12eb0 ffc12e98: 80 06 00 10 lwz r0,16(r6) ffc12e9c: 7f 89 00 00 cmpw cr7,r9,r0 ffc12ea0: 41 be ff 98 beq- cr7,ffc12e38 (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { ffc12ea4: 88 09 00 74 lbz r0,116(r9) ffc12ea8: 2f 80 00 00 cmpwi cr7,r0,0 ffc12eac: 41 be ff 8c beq- cr7,ffc12e38 <== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc12eb0: 38 00 00 01 li r0,1 ffc12eb4: 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(); ffc12eb8: 4b ff 8c f1 bl ffc0bba8 <_Thread_Dispatch> } return RTEMS_SUCCESSFUL; } ffc12ebc: 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; ffc12ec0: 38 60 00 00 li r3,0 } ffc12ec4: 7c 08 03 a6 mtlr r0 ffc12ec8: 38 21 00 08 addi r1,r1,8 ffc12ecc: 4e 80 00 20 blr static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; __asm__ volatile ( ffc12ed0: 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(); ffc12ed4: 7d 29 50 78 andc r9,r9,r10 } _CPU_MSR_SET(msr); ffc12ed8: 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 ) ); ffc12edc: 4b ff fe ec b ffc12dc8 } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc12ee0: 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; ffc12ee4: 91 49 00 7c stw r10,124(r9) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc12ee8: 41 a2 fe e0 beq- ffc12dc8 ffc12eec: 4b ff fe c0 b ffc12dac /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; ffc12ef0: 39 40 00 00 li r10,0 ffc12ef4: 4b ff ff 30 b ffc12e24 =============================================================================== ffc0e9e4 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { ffc0e9e4: 7d 80 00 26 mfcr r12 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0e9e8: 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 ) { ffc0e9ec: 94 21 ff d8 stwu r1,-40(r1) ffc0e9f0: 7c 08 02 a6 mflr r0 ffc0e9f4: 93 c1 00 20 stw r30,32(r1) ffc0e9f8: 7c be 2b 78 mr r30,r5 ffc0e9fc: 93 e1 00 24 stw r31,36(r1) register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0ea00: 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 ) { ffc0ea04: 90 01 00 2c stw r0,44(r1) ffc0ea08: 91 81 00 1c stw r12,28(r1) register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0ea0c: 41 92 00 18 beq- cr4,ffc0ea24 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 ) ); ffc0ea10: 3d 20 00 00 lis r9,0 ffc0ea14: 89 29 27 44 lbz r9,10052(r9) !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; ffc0ea18: 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 ) && ffc0ea1c: 7f 84 48 40 cmplw cr7,r4,r9 ffc0ea20: 41 9d 00 60 bgt- cr7,ffc0ea80 if ( !old_priority ) ffc0ea24: 2f 9e 00 00 cmpwi cr7,r30,0 return RTEMS_INVALID_ADDRESS; ffc0ea28: 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 ) ffc0ea2c: 41 9e 00 54 beq- cr7,ffc0ea80 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); ffc0ea30: 38 81 00 08 addi r4,r1,8 ffc0ea34: 48 00 2d a1 bl ffc117d4 <_Thread_Get> switch ( location ) { ffc0ea38: 80 01 00 08 lwz r0,8(r1) ffc0ea3c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ea40: 40 9e 00 64 bne- cr7,ffc0eaa4 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; ffc0ea44: 80 03 00 14 lwz r0,20(r3) ffc0ea48: 90 1e 00 00 stw r0,0(r30) if ( new_priority != RTEMS_CURRENT_PRIORITY ) { ffc0ea4c: 41 92 00 2c beq- cr4,ffc0ea78 the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || ffc0ea50: 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; ffc0ea54: 93 e3 00 18 stw r31,24(r3) if ( the_thread->resource_count == 0 || ffc0ea58: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ea5c: 41 9e 00 10 beq- cr7,ffc0ea6c ffc0ea60: 80 03 00 14 lwz r0,20(r3) ffc0ea64: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0ea68: 40 9c 00 10 bge- cr7,ffc0ea78 <== ALWAYS TAKEN the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); ffc0ea6c: 7f e4 fb 78 mr r4,r31 ffc0ea70: 38 a0 00 00 li r5,0 ffc0ea74: 48 00 26 f9 bl ffc1116c <_Thread_Change_priority> } _Thread_Enable_dispatch(); ffc0ea78: 48 00 2d 3d bl ffc117b4 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0ea7c: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0ea80: 7c 03 03 78 mr r3,r0 ffc0ea84: 80 01 00 2c lwz r0,44(r1) ffc0ea88: 81 81 00 1c lwz r12,28(r1) ffc0ea8c: 7c 08 03 a6 mtlr r0 ffc0ea90: 83 c1 00 20 lwz r30,32(r1) ffc0ea94: 83 e1 00 24 lwz r31,36(r1) ffc0ea98: 7d 80 81 20 mtcrf 8,r12 ffc0ea9c: 38 21 00 28 addi r1,r1,40 ffc0eaa0: 4e 80 00 20 blr case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0eaa4: 38 00 00 04 li r0,4 } ffc0eaa8: 81 81 00 1c lwz r12,28(r1) ffc0eaac: 7c 03 03 78 mr r3,r0 ffc0eab0: 80 01 00 2c lwz r0,44(r1) ffc0eab4: 83 c1 00 20 lwz r30,32(r1) ffc0eab8: 7d 80 81 20 mtcrf 8,r12 ffc0eabc: 7c 08 03 a6 mtlr r0 ffc0eac0: 83 e1 00 24 lwz r31,36(r1) ffc0eac4: 38 21 00 28 addi r1,r1,40 ffc0eac8: 4e 80 00 20 blr =============================================================================== ffc0a6d4 : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { ffc0a6d4: 94 21 ff e0 stwu r1,-32(r1) ffc0a6d8: 7c 08 02 a6 mflr r0 ffc0a6dc: 93 e1 00 1c stw r31,28(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) ffc0a6e0: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { ffc0a6e4: 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; ffc0a6e8: 38 00 00 09 li r0,9 { Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) ffc0a6ec: 41 82 00 58 beq- ffc0a744 return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); ffc0a6f0: 38 81 00 08 addi r4,r1,8 ffc0a6f4: 48 00 2b 35 bl ffc0d228 <_Thread_Get> switch (location) { ffc0a6f8: 80 01 00 08 lwz r0,8(r1) ffc0a6fc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a700: 40 9e 00 5c bne- cr7,ffc0a75c case OBJECTS_LOCAL: tvp = the_thread->task_variables; ffc0a704: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc0a708: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a70c: 41 9e 00 30 beq- cr7,ffc0a73c if (tvp->ptr == ptr) { ffc0a710: 80 09 00 04 lwz r0,4(r9) ffc0a714: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a718: 40 be 00 18 bne+ cr7,ffc0a730 ffc0a71c: 48 00 00 88 b ffc0a7a4 ffc0a720: 80 04 00 04 lwz r0,4(r4) ffc0a724: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a728: 41 9e 00 50 beq- cr7,ffc0a778 ffc0a72c: 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; ffc0a730: 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) { ffc0a734: 2f 84 00 00 cmpwi cr7,r4,0 ffc0a738: 40 9e ff e8 bne+ cr7,ffc0a720 <== ALWAYS TAKEN return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); ffc0a73c: 48 00 2a cd bl ffc0d208 <_Thread_Enable_dispatch> return RTEMS_INVALID_ADDRESS; ffc0a740: 38 00 00 09 li r0,9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a744: 7c 03 03 78 mr r3,r0 ffc0a748: 80 01 00 24 lwz r0,36(r1) ffc0a74c: 83 e1 00 1c lwz r31,28(r1) ffc0a750: 38 21 00 20 addi r1,r1,32 ffc0a754: 7c 08 03 a6 mtlr r0 ffc0a758: 4e 80 00 20 blr case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a75c: 38 00 00 04 li r0,4 } ffc0a760: 83 e1 00 1c lwz r31,28(r1) ffc0a764: 7c 03 03 78 mr r3,r0 ffc0a768: 80 01 00 24 lwz r0,36(r1) ffc0a76c: 38 21 00 20 addi r1,r1,32 ffc0a770: 7c 08 03 a6 mtlr r0 ffc0a774: 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; ffc0a778: 80 04 00 00 lwz r0,0(r4) ffc0a77c: 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 ); ffc0a780: 48 00 01 0d bl ffc0a88c <_RTEMS_Tasks_Invoke_task_variable_dtor> _Thread_Enable_dispatch(); ffc0a784: 48 00 2a 85 bl ffc0d208 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a788: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a78c: 7c 03 03 78 mr r3,r0 ffc0a790: 80 01 00 24 lwz r0,36(r1) ffc0a794: 83 e1 00 1c lwz r31,28(r1) ffc0a798: 38 21 00 20 addi r1,r1,32 ffc0a79c: 7c 08 03 a6 mtlr r0 ffc0a7a0: 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; ffc0a7a4: 80 09 00 00 lwz r0,0(r9) ffc0a7a8: 7d 24 4b 78 mr r4,r9 ffc0a7ac: 90 03 01 3c stw r0,316(r3) ffc0a7b0: 4b ff ff d0 b ffc0a780 =============================================================================== ffc0a7b4 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { ffc0a7b4: 94 21 ff e0 stwu r1,-32(r1) ffc0a7b8: 7c 08 02 a6 mflr r0 ffc0a7bc: 93 e1 00 1c stw r31,28(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) ffc0a7c0: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { ffc0a7c4: 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; ffc0a7c8: 38 00 00 09 li r0,9 rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { ffc0a7cc: 93 c1 00 18 stw r30,24(r1) ffc0a7d0: 7c be 2b 78 mr r30,r5 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) ffc0a7d4: 41 82 00 58 beq- ffc0a82c return RTEMS_INVALID_ADDRESS; if ( !result ) ffc0a7d8: 2f 85 00 00 cmpwi cr7,r5,0 ffc0a7dc: 41 9e 00 50 beq- cr7,ffc0a82c return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); ffc0a7e0: 38 81 00 08 addi r4,r1,8 ffc0a7e4: 48 00 2a 45 bl ffc0d228 <_Thread_Get> switch (location) { ffc0a7e8: 80 01 00 08 lwz r0,8(r1) ffc0a7ec: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a7f0: 40 9e 00 58 bne- cr7,ffc0a848 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; ffc0a7f4: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc0a7f8: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a7fc: 40 be 00 14 bne+ cr7,ffc0a810 ffc0a800: 48 00 00 68 b ffc0a868 */ *result = tvp->tval; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; ffc0a804: 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) { ffc0a808: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a80c: 41 9e 00 5c beq- cr7,ffc0a868 <== NEVER TAKEN if (tvp->ptr == ptr) { ffc0a810: 80 09 00 04 lwz r0,4(r9) ffc0a814: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a818: 40 9e ff ec bne+ cr7,ffc0a804 /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; ffc0a81c: 80 09 00 0c lwz r0,12(r9) ffc0a820: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc0a824: 48 00 29 e5 bl ffc0d208 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a828: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a82c: 7c 03 03 78 mr r3,r0 ffc0a830: 80 01 00 24 lwz r0,36(r1) ffc0a834: 83 c1 00 18 lwz r30,24(r1) ffc0a838: 7c 08 03 a6 mtlr r0 ffc0a83c: 83 e1 00 1c lwz r31,28(r1) ffc0a840: 38 21 00 20 addi r1,r1,32 ffc0a844: 4e 80 00 20 blr #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a848: 38 00 00 04 li r0,4 } ffc0a84c: 83 c1 00 18 lwz r30,24(r1) ffc0a850: 7c 03 03 78 mr r3,r0 ffc0a854: 80 01 00 24 lwz r0,36(r1) ffc0a858: 83 e1 00 1c lwz r31,28(r1) ffc0a85c: 38 21 00 20 addi r1,r1,32 ffc0a860: 7c 08 03 a6 mtlr r0 ffc0a864: 4e 80 00 20 blr _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); ffc0a868: 48 00 29 a1 bl ffc0d208 <_Thread_Enable_dispatch> return RTEMS_INVALID_ADDRESS; ffc0a86c: 38 00 00 09 li r0,9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a870: 7c 03 03 78 mr r3,r0 ffc0a874: 80 01 00 24 lwz r0,36(r1) ffc0a878: 83 c1 00 18 lwz r30,24(r1) ffc0a87c: 7c 08 03 a6 mtlr r0 ffc0a880: 83 e1 00 1c lwz r31,28(r1) ffc0a884: 38 21 00 20 addi r1,r1,32 ffc0a888: 4e 80 00 20 blr =============================================================================== ffc1b0b0 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { ffc1b0b0: 94 21 ff e8 stwu r1,-24(r1) ffc1b0b4: 7c 08 02 a6 mflr r0 ffc1b0b8: 7c 64 1b 78 mr r4,r3 Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); ffc1b0bc: 3c 60 00 00 lis r3,0 ffc1b0c0: 90 01 00 1c stw r0,28(r1) ffc1b0c4: 38 63 79 7c addi r3,r3,31100 ffc1b0c8: 38 a1 00 08 addi r5,r1,8 ffc1b0cc: 48 00 3c 41 bl ffc1ed0c <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { ffc1b0d0: 80 01 00 08 lwz r0,8(r1) ffc1b0d4: 2f 80 00 00 cmpwi cr7,r0,0 ffc1b0d8: 41 9e 00 18 beq- cr7,ffc1b0f0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1b0dc: 80 01 00 1c lwz r0,28(r1) #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1b0e0: 38 60 00 04 li r3,4 } ffc1b0e4: 38 21 00 18 addi r1,r1,24 ffc1b0e8: 7c 08 03 a6 mtlr r0 ffc1b0ec: 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 ) ) ffc1b0f0: 80 03 00 38 lwz r0,56(r3) ffc1b0f4: 2f 80 00 04 cmpwi cr7,r0,4 ffc1b0f8: 41 9e 00 0c beq- cr7,ffc1b104 <== NEVER TAKEN (void) _Watchdog_Remove( &the_timer->Ticker ); ffc1b0fc: 38 63 00 10 addi r3,r3,16 ffc1b100: 48 00 65 89 bl ffc21688 <_Watchdog_Remove> _Thread_Enable_dispatch(); ffc1b104: 48 00 4c 2d bl ffc1fd30 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1b108: 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; ffc1b10c: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1b110: 7c 08 03 a6 mtlr r0 ffc1b114: 38 21 00 18 addi r1,r1,24 ffc1b118: 4e 80 00 20 blr =============================================================================== ffc1b77c : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc1b77c: 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; ffc1b780: 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 ) { ffc1b784: 7c 08 02 a6 mflr r0 ffc1b788: 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; ffc1b78c: 83 e9 29 3c lwz r31,10556(r9) rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc1b790: 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; ffc1b794: 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 ) ffc1b798: 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 ) { ffc1b79c: 93 61 00 24 stw r27,36(r1) ffc1b7a0: 7c db 33 78 mr r27,r6 ffc1b7a4: 93 81 00 28 stw r28,40(r1) ffc1b7a8: 7c 9c 23 78 mr r28,r4 ffc1b7ac: 93 a1 00 2c stw r29,44(r1) ffc1b7b0: 7c 7d 1b 78 mr r29,r3 ffc1b7b4: 93 c1 00 30 stw r30,48(r1) ffc1b7b8: 7c be 2b 78 mr r30,r5 ffc1b7bc: 90 01 00 3c stw r0,60(r1) ffc1b7c0: 93 01 00 18 stw r24,24(r1) ffc1b7c4: 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 ) ffc1b7c8: 41 9e 00 38 beq- cr7,ffc1b800 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) ffc1b7cc: 3d 20 00 00 lis r9,0 ffc1b7d0: 88 09 28 e4 lbz r0,10468(r9) return RTEMS_NOT_DEFINED; ffc1b7d4: 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 ) ffc1b7d8: 2f 80 00 00 cmpwi cr7,r0,0 ffc1b7dc: 41 9e 00 24 beq- cr7,ffc1b800 <== NEVER TAKEN return RTEMS_NOT_DEFINED; if ( !routine ) ffc1b7e0: 2f 85 00 00 cmpwi cr7,r5,0 return RTEMS_INVALID_ADDRESS; ffc1b7e4: 3b 20 00 09 li r25,9 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) ffc1b7e8: 41 9e 00 18 beq- cr7,ffc1b800 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) ffc1b7ec: 7c 83 23 78 mr r3,r4 ffc1b7f0: 4b ff bf 59 bl ffc17748 <_TOD_Validate> return RTEMS_INVALID_CLOCK; ffc1b7f4: 3b 20 00 14 li r25,20 return RTEMS_NOT_DEFINED; if ( !routine ) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) ffc1b7f8: 2f 83 00 00 cmpwi cr7,r3,0 ffc1b7fc: 40 9e 00 38 bne- cr7,ffc1b834 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1b800: 80 01 00 3c lwz r0,60(r1) ffc1b804: 7f 23 cb 78 mr r3,r25 ffc1b808: 83 01 00 18 lwz r24,24(r1) ffc1b80c: 7c 08 03 a6 mtlr r0 ffc1b810: 83 21 00 1c lwz r25,28(r1) ffc1b814: 83 41 00 20 lwz r26,32(r1) ffc1b818: 83 61 00 24 lwz r27,36(r1) ffc1b81c: 83 81 00 28 lwz r28,40(r1) ffc1b820: 83 a1 00 2c lwz r29,44(r1) ffc1b824: 83 c1 00 30 lwz r30,48(r1) ffc1b828: 83 e1 00 34 lwz r31,52(r1) ffc1b82c: 38 21 00 38 addi r1,r1,56 ffc1b830: 4e 80 00 20 blr return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc1b834: 7f 83 e3 78 mr r3,r28 if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1b838: 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 ); ffc1b83c: 4b ff be 69 bl ffc176a4 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1b840: 80 1a 28 f8 lwz r0,10488(r26) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc1b844: 7c 7c 1b 78 mr r28,r3 if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1b848: 7f 83 00 40 cmplw cr7,r3,r0 ffc1b84c: 40 bd ff b4 ble- cr7,ffc1b800 ffc1b850: 3c 60 00 00 lis r3,0 ffc1b854: 38 63 79 7c addi r3,r3,31100 ffc1b858: 7f a4 eb 78 mr r4,r29 ffc1b85c: 38 a1 00 08 addi r5,r1,8 ffc1b860: 48 00 34 ad bl ffc1ed0c <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { ffc1b864: 83 01 00 08 lwz r24,8(r1) ffc1b868: 7c 79 1b 78 mr r25,r3 ffc1b86c: 2f 98 00 00 cmpwi cr7,r24,0 ffc1b870: 40 9e 00 50 bne- cr7,ffc1b8c0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); ffc1b874: 38 63 00 10 addi r3,r3,16 ffc1b878: 48 00 5e 11 bl ffc21688 <_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(); ffc1b87c: 80 1a 28 f8 lwz r0,10488(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; ffc1b880: 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(); ffc1b884: 7f 80 e0 50 subf r28,r0,r28 (*timer_server->schedule_operation)( timer_server, the_timer ); ffc1b888: 80 1f 00 04 lwz r0,4(r31) ffc1b88c: 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; ffc1b890: 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 ); ffc1b894: 7f e3 fb 78 mr r3,r31 ffc1b898: 7c 09 03 a6 mtctr r0 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc1b89c: 93 19 00 18 stw r24,24(r25) the_watchdog->routine = routine; ffc1b8a0: 93 d9 00 2c stw r30,44(r25) the_watchdog->id = id; ffc1b8a4: 93 b9 00 30 stw r29,48(r25) the_watchdog->user_data = user_data; ffc1b8a8: 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(); ffc1b8ac: 93 99 00 1c stw r28,28(r25) (*timer_server->schedule_operation)( timer_server, the_timer ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; ffc1b8b0: 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 ); ffc1b8b4: 4e 80 04 21 bctrl _Thread_Enable_dispatch(); ffc1b8b8: 48 00 44 79 bl ffc1fd30 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc1b8bc: 4b ff ff 44 b ffc1b800 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1b8c0: 3b 20 00 04 li r25,4 ffc1b8c4: 4b ff ff 3c b ffc1b800 =============================================================================== ffc0991c : int sched_get_priority_max( int policy ) { switch ( policy ) { ffc0991c: 2b 83 00 04 cmplwi cr7,r3,4 #include int sched_get_priority_max( int policy ) { ffc09920: 94 21 ff f8 stwu r1,-8(r1) ffc09924: 7c 08 02 a6 mflr r0 ffc09928: 90 01 00 0c stw r0,12(r1) switch ( policy ) { ffc0992c: 40 9d 00 24 ble- cr7,ffc09950 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc09930: 48 00 ac c9 bl ffc145f8 <__errno> ffc09934: 38 00 00 16 li r0,22 ffc09938: 90 03 00 00 stw r0,0(r3) ffc0993c: 38 60 ff ff li r3,-1 } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; } ffc09940: 80 01 00 0c lwz r0,12(r1) ffc09944: 38 21 00 08 addi r1,r1,8 ffc09948: 7c 08 03 a6 mtlr r0 ffc0994c: 4e 80 00 20 blr int sched_get_priority_max( int policy ) { switch ( policy ) { ffc09950: 38 00 00 01 li r0,1 ffc09954: 7c 03 18 30 slw r3,r0,r3 ffc09958: 70 60 00 17 andi. r0,r3,23 ffc0995c: 41 a2 ff d4 beq- ffc09930 <== NEVER TAKEN default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; } ffc09960: 80 01 00 0c lwz r0,12(r1) default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; ffc09964: 3d 20 00 00 lis r9,0 ffc09968: 88 69 27 4c lbz r3,10060(r9) } ffc0996c: 38 21 00 08 addi r1,r1,8 ffc09970: 7c 08 03 a6 mtlr r0 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; ffc09974: 38 63 ff ff addi r3,r3,-1 } ffc09978: 4e 80 00 20 blr =============================================================================== ffc0997c : int sched_get_priority_min( int policy ) { switch ( policy ) { ffc0997c: 2b 83 00 04 cmplwi cr7,r3,4 #include int sched_get_priority_min( int policy ) { ffc09980: 94 21 ff f8 stwu r1,-8(r1) ffc09984: 7c 08 02 a6 mflr r0 ffc09988: 90 01 00 0c stw r0,12(r1) switch ( policy ) { ffc0998c: 40 9d 00 24 ble- cr7,ffc099b0 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc09990: 48 00 ac 69 bl ffc145f8 <__errno> ffc09994: 38 00 00 16 li r0,22 ffc09998: 90 03 00 00 stw r0,0(r3) ffc0999c: 38 60 ff ff li r3,-1 } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } ffc099a0: 80 01 00 0c lwz r0,12(r1) ffc099a4: 38 21 00 08 addi r1,r1,8 ffc099a8: 7c 08 03 a6 mtlr r0 ffc099ac: 4e 80 00 20 blr int sched_get_priority_min( int policy ) { switch ( policy ) { ffc099b0: 38 00 00 01 li r0,1 ffc099b4: 7c 03 18 30 slw r3,r0,r3 ffc099b8: 70 60 00 17 andi. r0,r3,23 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; ffc099bc: 38 60 00 01 li r3,1 int sched_get_priority_min( int policy ) { switch ( policy ) { ffc099c0: 41 a2 ff d0 beq- ffc09990 <== NEVER TAKEN default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } ffc099c4: 80 01 00 0c lwz r0,12(r1) ffc099c8: 38 21 00 08 addi r1,r1,8 ffc099cc: 7c 08 03 a6 mtlr r0 ffc099d0: 4e 80 00 20 blr =============================================================================== ffc099d4 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { ffc099d4: 94 21 ff e8 stwu r1,-24(r1) ffc099d8: 7c 08 02 a6 mflr r0 ffc099dc: 93 e1 00 14 stw r31,20(r1) /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc099e0: 7c 7f 1b 79 mr. r31,r3 int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { ffc099e4: 90 01 00 1c stw r0,28(r1) /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc099e8: 40 82 00 30 bne- ffc09a18 <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( ESRCH ); if ( !interval ) ffc099ec: 2f 84 00 00 cmpwi cr7,r4,0 ffc099f0: 41 9e 00 50 beq- cr7,ffc09a40 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); ffc099f4: 3d 20 00 00 lis r9,0 ffc099f8: 80 69 28 0c lwz r3,10252(r9) ffc099fc: 48 00 49 75 bl ffc0e370 <_Timespec_From_ticks> return 0; ffc09a00: 38 60 00 00 li r3,0 } ffc09a04: 80 01 00 1c lwz r0,28(r1) ffc09a08: 83 e1 00 14 lwz r31,20(r1) ffc09a0c: 38 21 00 18 addi r1,r1,24 ffc09a10: 7c 08 03 a6 mtlr r0 ffc09a14: 4e 80 00 20 blr { /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc09a18: 90 81 00 08 stw r4,8(r1) ffc09a1c: 4b ff bb 6d bl ffc05588 ffc09a20: 7f 83 f8 00 cmpw cr7,r3,r31 ffc09a24: 80 81 00 08 lwz r4,8(r1) ffc09a28: 41 9e ff c4 beq+ cr7,ffc099ec rtems_set_errno_and_return_minus_one( ESRCH ); ffc09a2c: 48 00 ab cd bl ffc145f8 <__errno> ffc09a30: 38 00 00 03 li r0,3 ffc09a34: 90 03 00 00 stw r0,0(r3) ffc09a38: 38 60 ff ff li r3,-1 ffc09a3c: 4b ff ff c8 b ffc09a04 if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc09a40: 48 00 ab b9 bl ffc145f8 <__errno> ffc09a44: 38 00 00 16 li r0,22 ffc09a48: 90 03 00 00 stw r0,0(r3) ffc09a4c: 38 60 ff ff li r3,-1 ffc09a50: 4b ff ff b4 b ffc09a04 =============================================================================== ffc0c230 : rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc0c230: 3d 20 00 00 lis r9,0 int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { ffc0c234: 94 21 ff b8 stwu r1,-72(r1) ffc0c238: 7c 08 02 a6 mflr r0 ffc0c23c: 81 69 28 08 lwz r11,10248(r9) ffc0c240: 7d 80 00 26 mfcr r12 ffc0c244: 93 c1 00 40 stw r30,64(r1) ffc0c248: 7c 9e 23 78 mr r30,r4 ffc0c24c: 39 6b 00 01 addi r11,r11,1 ffc0c250: 93 e1 00 44 stw r31,68(r1) ffc0c254: 7c 7f 1b 78 mr r31,r3 ffc0c258: 90 01 00 4c stw r0,76(r1) ffc0c25c: 93 81 00 38 stw r28,56(r1) ffc0c260: 93 a1 00 3c stw r29,60(r1) ffc0c264: 91 81 00 34 stw r12,52(r1) ffc0c268: 90 a1 00 28 stw r5,40(r1) ffc0c26c: 90 c1 00 2c stw r6,44(r1) ffc0c270: 91 69 28 08 stw r11,10248(r9) POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0c274: 54 80 bf fe rlwinm r0,r4,23,31,31 ffc0c278: 2e 00 00 00 cmpwi cr4,r0,0 ffc0c27c: 40 92 00 c8 bne- cr4,ffc0c344 /* unsigned int value */ ) { va_list arg; mode_t mode; unsigned int value = 0; ffc0c280: 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 ); ffc0c284: 7f e3 fb 78 mr r3,r31 ffc0c288: 38 81 00 08 addi r4,r1,8 ffc0c28c: 48 00 82 f9 bl ffc14584 <_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 ) { ffc0c290: 7c 7c 1b 79 mr. r28,r3 ffc0c294: 41 82 00 48 beq- ffc0c2dc /* * 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) ) ) { ffc0c298: 2f 9c 00 02 cmpwi cr7,r28,2 ffc0c29c: 40 9e 00 08 bne- cr7,ffc0c2a4 <== NEVER TAKEN ffc0c2a0: 40 92 00 c4 bne- cr4,ffc0c364 _Thread_Enable_dispatch(); ffc0c2a4: 48 00 3c 69 bl ffc0ff0c <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); ffc0c2a8: 48 00 be 6d bl ffc18114 <__errno> id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c2ac: 80 01 00 4c lwz r0,76(r1) ffc0c2b0: 81 81 00 34 lwz r12,52(r1) ffc0c2b4: 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 * ); ffc0c2b8: 93 83 00 00 stw r28,0(r3) id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c2bc: 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 * ); ffc0c2c0: 38 60 ff ff li r3,-1 id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c2c4: 83 81 00 38 lwz r28,56(r1) ffc0c2c8: 83 a1 00 3c lwz r29,60(r1) ffc0c2cc: 83 c1 00 40 lwz r30,64(r1) ffc0c2d0: 83 e1 00 44 lwz r31,68(r1) ffc0c2d4: 38 21 00 48 addi r1,r1,72 ffc0c2d8: 4e 80 00 20 blr /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { ffc0c2dc: 73 de 0a 00 andi. r30,r30,2560 ffc0c2e0: 2f 9e 0a 00 cmpwi cr7,r30,2560 ffc0c2e4: 41 9e 00 ac beq- cr7,ffc0c390 ffc0c2e8: 80 81 00 08 lwz r4,8(r1) ffc0c2ec: 3c 60 00 00 lis r3,0 ffc0c2f0: 38 a1 00 10 addi r5,r1,16 ffc0c2f4: 38 63 30 ac addi r3,r3,12460 ffc0c2f8: 48 00 2b 31 bl ffc0ee28 <_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; ffc0c2fc: 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 ); ffc0c300: 90 61 00 0c stw r3,12(r1) the_semaphore->open_count += 1; ffc0c304: 38 09 00 01 addi r0,r9,1 ffc0c308: 90 03 00 18 stw r0,24(r3) _Thread_Enable_dispatch(); ffc0c30c: 48 00 3c 01 bl ffc0ff0c <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); ffc0c310: 48 00 3b fd bl ffc0ff0c <_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; ffc0c314: 80 61 00 0c lwz r3,12(r1) ffc0c318: 38 63 00 08 addi r3,r3,8 #endif return id; } ffc0c31c: 80 01 00 4c lwz r0,76(r1) ffc0c320: 81 81 00 34 lwz r12,52(r1) ffc0c324: 7c 08 03 a6 mtlr r0 ffc0c328: 83 81 00 38 lwz r28,56(r1) ffc0c32c: 83 a1 00 3c lwz r29,60(r1) ffc0c330: 7d 80 81 20 mtcrf 8,r12 ffc0c334: 83 c1 00 40 lwz r30,64(r1) ffc0c338: 83 e1 00 44 lwz r31,68(r1) ffc0c33c: 38 21 00 48 addi r1,r1,72 ffc0c340: 4e 80 00 20 blr Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0c344: 38 01 00 50 addi r0,r1,80 mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0c348: 83 a1 00 2c lwz r29,44(r1) Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0c34c: 90 01 00 18 stw r0,24(r1) ffc0c350: 38 01 00 20 addi r0,r1,32 ffc0c354: 90 01 00 1c stw r0,28(r1) mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0c358: 38 00 00 04 li r0,4 ffc0c35c: 98 01 00 14 stb r0,20(r1) ffc0c360: 4b ff ff 24 b ffc0c284 /* * 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( ffc0c364: 38 80 00 00 li r4,0 ffc0c368: 7f a5 eb 78 mr r5,r29 ffc0c36c: 38 c1 00 0c addi r6,r1,12 ffc0c370: 7f e3 fb 78 mr r3,r31 ffc0c374: 48 00 80 29 bl ffc1439c <_POSIX_Semaphore_Create_support> ffc0c378: 7c 7f 1b 78 mr r31,r3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); ffc0c37c: 48 00 3b 91 bl ffc0ff0c <_Thread_Enable_dispatch> if ( status == -1 ) ffc0c380: 2f 9f ff ff cmpwi cr7,r31,-1 return SEM_FAILED; ffc0c384: 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 ) ffc0c388: 40 9e ff 8c bne+ cr7,ffc0c314 ffc0c38c: 4b ff ff 90 b ffc0c31c /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _Thread_Enable_dispatch(); ffc0c390: 48 00 3b 7d bl ffc0ff0c <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); ffc0c394: 48 00 bd 81 bl ffc18114 <__errno> ffc0c398: 38 00 00 11 li r0,17 ffc0c39c: 90 03 00 00 stw r0,0(r3) ffc0c3a0: 38 60 ff ff li r3,-1 ffc0c3a4: 4b ff ff 78 b ffc0c31c =============================================================================== ffc0c41c : int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { ffc0c41c: 94 21 ff e0 stwu r1,-32(r1) ffc0c420: 7c 08 02 a6 mflr r0 ffc0c424: 93 e1 00 1c stw r31,28(r1) ffc0c428: 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 ); ffc0c42c: 7c 83 23 78 mr r3,r4 ffc0c430: 38 81 00 08 addi r4,r1,8 int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { ffc0c434: 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 ); ffc0c438: 48 00 72 95 bl ffc136cc <_POSIX_Absolute_timeout_to_ticks> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0c43c: 2f 83 00 03 cmpwi cr7,r3,3 ffc0c440: 41 9e 00 28 beq- cr7,ffc0c468 <== ALWAYS TAKEN do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); ffc0c444: 80 a1 00 08 lwz r5,8(r1) <== NOT EXECUTED ffc0c448: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc0c44c: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc0c450: 48 00 81 f9 bl ffc14648 <_POSIX_Semaphore_Wait_support><== NOT EXECUTED lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } ffc0c454: 80 01 00 24 lwz r0,36(r1) <== NOT EXECUTED ffc0c458: 83 e1 00 1c lwz r31,28(r1) <== NOT EXECUTED ffc0c45c: 38 21 00 20 addi r1,r1,32 <== NOT EXECUTED ffc0c460: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0c464: 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 ); ffc0c468: 80 a1 00 08 lwz r5,8(r1) ffc0c46c: 7f e3 fb 78 mr r3,r31 ffc0c470: 38 80 00 01 li r4,1 ffc0c474: 48 00 81 d5 bl ffc14648 <_POSIX_Semaphore_Wait_support> lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } ffc0c478: 80 01 00 24 lwz r0,36(r1) ffc0c47c: 83 e1 00 1c lwz r31,28(r1) ffc0c480: 38 21 00 20 addi r1,r1,32 ffc0c484: 7c 08 03 a6 mtlr r0 ffc0c488: 4e 80 00 20 blr =============================================================================== ffc09810 : struct sigaction *oact ) { ISR_Level level; if ( oact ) ffc09810: 2c 05 00 00 cmpwi r5,0 int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { ffc09814: 94 21 ff e8 stwu r1,-24(r1) ffc09818: 7c 08 02 a6 mflr r0 ffc0981c: 93 c1 00 10 stw r30,16(r1) ffc09820: 7c 9e 23 78 mr r30,r4 ffc09824: 93 e1 00 14 stw r31,20(r1) ffc09828: 7c 7f 1b 78 mr r31,r3 ffc0982c: 90 01 00 1c stw r0,28(r1) ffc09830: 93 a1 00 0c stw r29,12(r1) ISR_Level level; if ( oact ) ffc09834: 41 82 00 2c beq- ffc09860 *oact = _POSIX_signals_Vectors[ sig ]; ffc09838: 1c 03 00 0c mulli r0,r3,12 ffc0983c: 3d 60 00 00 lis r11,0 ffc09840: 39 6b 31 e0 addi r11,r11,12768 ffc09844: 7d 2b 02 14 add r9,r11,r0 ffc09848: 7d 4b 00 2e lwzx r10,r11,r0 ffc0984c: 81 69 00 04 lwz r11,4(r9) ffc09850: 80 09 00 08 lwz r0,8(r9) ffc09854: 91 45 00 00 stw r10,0(r5) ffc09858: 91 65 00 04 stw r11,4(r5) ffc0985c: 90 05 00 08 stw r0,8(r5) if ( !sig ) ffc09860: 2f 9f 00 00 cmpwi cr7,r31,0 ffc09864: 41 9e 00 cc beq- cr7,ffc09930 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc09868: 38 1f ff ff addi r0,r31,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc0986c: 2b 80 00 1f cmplwi cr7,r0,31 ffc09870: 41 9d 00 c0 bgt- cr7,ffc09930 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) ffc09874: 2f 9f 00 09 cmpwi cr7,r31,9 ffc09878: 41 9e 00 b8 beq- cr7,ffc09930 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { ffc0987c: 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; ffc09880: 38 60 00 00 li r3,0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { ffc09884: 41 9e 00 58 beq- cr7,ffc098dc <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc09888: 7f a0 00 a6 mfmsr r29 ffc0988c: 7c 10 42 a6 mfsprg r0,0 ffc09890: 7f a0 00 78 andc r0,r29,r0 ffc09894: 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 ) { ffc09898: 80 1e 00 08 lwz r0,8(r30) ffc0989c: 2f 80 00 00 cmpwi cr7,r0,0 ffc098a0: 41 9e 00 58 beq- cr7,ffc098f8 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); ffc098a4: 7f e3 fb 78 mr r3,r31 ffc098a8: 48 00 76 e5 bl ffc10f8c <_POSIX_signals_Clear_process_signals> _POSIX_signals_Vectors[ sig ] = *act; ffc098ac: 1f ff 00 0c mulli r31,r31,12 ffc098b0: 81 1e 00 00 lwz r8,0(r30) ffc098b4: 3d 60 00 00 lis r11,0 ffc098b8: 81 5e 00 04 lwz r10,4(r30) ffc098bc: 80 1e 00 08 lwz r0,8(r30) ffc098c0: 39 6b 31 e0 addi r11,r11,12768 ffc098c4: 7d 2b fa 14 add r9,r11,r31 ffc098c8: 7d 0b f9 2e stwx r8,r11,r31 ffc098cc: 91 49 00 04 stw r10,4(r9) ffc098d0: 90 09 00 08 stw r0,8(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc098d4: 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; ffc098d8: 38 60 00 00 li r3,0 } ffc098dc: 80 01 00 1c lwz r0,28(r1) ffc098e0: 83 a1 00 0c lwz r29,12(r1) ffc098e4: 7c 08 03 a6 mtlr r0 ffc098e8: 83 c1 00 10 lwz r30,16(r1) ffc098ec: 83 e1 00 14 lwz r31,20(r1) ffc098f0: 38 21 00 18 addi r1,r1,24 ffc098f4: 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 ]; ffc098f8: 1f ff 00 0c mulli r31,r31,12 ffc098fc: 3d 40 ff c2 lis r10,-62 ffc09900: 39 4a 39 b4 addi r10,r10,14772 ffc09904: 7d 2a fa 14 add r9,r10,r31 ffc09908: 7d 0a f8 2e lwzx r8,r10,r31 ffc0990c: 3d 60 00 00 lis r11,0 ffc09910: 81 49 00 04 lwz r10,4(r9) ffc09914: 39 6b 31 e0 addi r11,r11,12768 ffc09918: 80 09 00 08 lwz r0,8(r9) ffc0991c: 7d 2b fa 14 add r9,r11,r31 ffc09920: 7d 0b f9 2e stwx r8,r11,r31 ffc09924: 91 49 00 04 stw r10,4(r9) ffc09928: 90 09 00 08 stw r0,8(r9) ffc0992c: 4b ff ff a8 b ffc098d4 * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc09930: 48 00 b2 2d bl ffc14b5c <__errno> ffc09934: 38 00 00 16 li r0,22 ffc09938: 90 03 00 00 stw r0,0(r3) ffc0993c: 38 60 ff ff li r3,-1 ffc09940: 4b ff ff 9c b ffc098dc =============================================================================== ffc09dc8 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { ffc09dc8: 94 21 ff d0 stwu r1,-48(r1) ffc09dcc: 7c 08 02 a6 mflr r0 ffc09dd0: 93 a1 00 24 stw r29,36(r1) ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) ffc09dd4: 7c 7d 1b 79 mr. r29,r3 int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { ffc09dd8: 93 c1 00 28 stw r30,40(r1) ffc09ddc: 7c be 2b 78 mr r30,r5 ffc09de0: 93 e1 00 2c stw r31,44(r1) ffc09de4: 7c 9f 23 78 mr r31,r4 ffc09de8: 90 01 00 34 stw r0,52(r1) ffc09dec: 93 41 00 18 stw r26,24(r1) ffc09df0: 93 61 00 1c stw r27,28(r1) ffc09df4: 93 81 00 20 stw r28,32(r1) ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) ffc09df8: 41 82 02 48 beq- ffc0a040 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { ffc09dfc: 2f 85 00 00 cmpwi cr7,r5,0 ffc09e00: 41 9e 01 9c beq- cr7,ffc09f9c if ( !_Timespec_Is_valid( timeout ) ) ffc09e04: 7c a3 2b 78 mr r3,r5 ffc09e08: 48 00 4a 4d bl ffc0e854 <_Timespec_Is_valid> ffc09e0c: 2f 83 00 00 cmpwi cr7,r3,0 ffc09e10: 41 9e 02 30 beq- cr7,ffc0a040 rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); ffc09e14: 7f c3 f3 78 mr r3,r30 ffc09e18: 48 00 4a cd bl ffc0e8e4 <_Timespec_To_ticks> if ( !interval ) ffc09e1c: 7c 64 1b 79 mr. r4,r3 ffc09e20: 41 82 02 20 beq- ffc0a040 <== NEVER TAKEN /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09e24: 2f 9f 00 00 cmpwi cr7,r31,0 ffc09e28: 41 9e 01 80 beq- cr7,ffc09fa8 <== NEVER TAKEN the_thread = _Thread_Executing; ffc09e2c: 3f 80 00 00 lis r28,0 ffc09e30: 3b 9c 31 84 addi r28,r28,12676 ffc09e34: 81 3c 00 0c lwz r9,12(r28) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc09e38: 83 49 01 34 lwz r26,308(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc09e3c: 7f 60 00 a6 mfmsr r27 ffc09e40: 7c 10 42 a6 mfsprg r0,0 ffc09e44: 7f 60 00 78 andc r0,r27,r0 ffc09e48: 7c 00 01 24 mtmsr r0 */ /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { ffc09e4c: 80 1d 00 00 lwz r0,0(r29) ffc09e50: 80 7a 00 d4 lwz r3,212(r26) ffc09e54: 7c 0b 18 39 and. r11,r0,r3 ffc09e58: 40 82 01 84 bne- ffc09fdc return the_info->si_signo; } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { ffc09e5c: 3d 60 00 00 lis r11,0 ffc09e60: 80 6b 28 c4 lwz r3,10436(r11) ffc09e64: 7c 0b 18 39 and. r11,r0,r3 ffc09e68: 40 82 00 d0 bne- ffc09f38 ffc09e6c: 3d 60 00 00 lis r11,0 ffc09e70: 81 4b 28 78 lwz r10,10360(r11) ffc09e74: 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; ffc09e78: 39 40 ff ff li r10,-1 ffc09e7c: 91 5f 00 00 stw r10,0(r31) ffc09e80: 90 0b 28 78 stw r0,10360(r11) _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; ffc09e84: 38 00 00 04 li r0,4 ffc09e88: 90 09 00 34 stw r0,52(r9) } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; ffc09e8c: 3d 60 00 00 lis r11,0 ffc09e90: 39 6b 33 6c addi r11,r11,13164 the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; ffc09e94: 80 1d 00 00 lwz r0,0(r29) the_thread->Wait.return_argument = the_info; ffc09e98: 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; ffc09e9c: 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; ffc09ea0: 38 00 00 01 li r0,1 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; ffc09ea4: 91 69 00 44 stw r11,68(r9) ffc09ea8: 90 0b 00 30 stw r0,48(r11) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc09eac: 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 ); ffc09eb0: 3c a0 ff c1 lis r5,-63 ffc09eb4: 3c 60 00 00 lis r3,0 ffc09eb8: 38 a5 e4 20 addi r5,r5,-7136 ffc09ebc: 38 63 33 6c addi r3,r3,13164 ffc09ec0: 48 00 40 f1 bl ffc0dfb0 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); ffc09ec4: 48 00 3a b9 bl ffc0d97c <_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 ); ffc09ec8: 80 9f 00 00 lwz r4,0(r31) ffc09ecc: 7f 43 d3 78 mr r3,r26 ffc09ed0: 7f e5 fb 78 mr r5,r31 ffc09ed4: 38 c0 00 00 li r6,0 ffc09ed8: 38 e0 00 00 li r7,0 ffc09edc: 48 00 79 ed bl ffc118c8 <_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) ffc09ee0: 81 3c 00 0c lwz r9,12(r28) ffc09ee4: 80 09 00 34 lwz r0,52(r9) ffc09ee8: 2f 80 00 04 cmpwi cr7,r0,4 ffc09eec: 40 9e 01 68 bne- cr7,ffc0a054 || !(*set & signo_to_mask( the_info->si_signo )) ) { ffc09ef0: 83 df 00 00 lwz r30,0(r31) ffc09ef4: 39 60 00 01 li r11,1 ffc09ef8: 80 1d 00 00 lwz r0,0(r29) ffc09efc: 39 3e ff ff addi r9,r30,-1 ffc09f00: 7d 69 48 30 slw r9,r11,r9 ffc09f04: 7d 2b 00 39 and. r11,r9,r0 ffc09f08: 41 82 01 4c beq- ffc0a054 errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09f0c: 80 01 00 34 lwz r0,52(r1) ffc09f10: 7f c3 f3 78 mr r3,r30 ffc09f14: 83 41 00 18 lwz r26,24(r1) ffc09f18: 7c 08 03 a6 mtlr r0 ffc09f1c: 83 61 00 1c lwz r27,28(r1) ffc09f20: 83 81 00 20 lwz r28,32(r1) ffc09f24: 83 a1 00 24 lwz r29,36(r1) ffc09f28: 83 c1 00 28 lwz r30,40(r1) ffc09f2c: 83 e1 00 2c lwz r31,44(r1) ffc09f30: 38 21 00 30 addi r1,r1,48 ffc09f34: 4e 80 00 20 blr } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); ffc09f38: 4b ff fe 35 bl ffc09d6c <_POSIX_signals_Get_lowest> _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); ffc09f3c: 7f e5 fb 78 mr r5,r31 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); ffc09f40: 7c 7e 1b 78 mr r30,r3 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); ffc09f44: 7f c4 f3 78 mr r4,r30 ffc09f48: 7f 43 d3 78 mr r3,r26 ffc09f4c: 38 c0 00 01 li r6,1 ffc09f50: 38 e0 00 00 li r7,0 ffc09f54: 48 00 79 75 bl ffc118c8 <_POSIX_signals_Clear_signals> ffc09f58: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); the_info->si_signo = signo; the_info->si_code = SI_USER; ffc09f5c: 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; ffc09f60: 93 df 00 00 stw r30,0(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09f64: 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; ffc09f68: 90 1f 00 04 stw r0,4(r31) the_info->si_value.sival_int = 0; ffc09f6c: 38 00 00 00 li r0,0 ffc09f70: 90 1f 00 08 stw r0,8(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09f74: 80 01 00 34 lwz r0,52(r1) ffc09f78: 83 41 00 18 lwz r26,24(r1) ffc09f7c: 7c 08 03 a6 mtlr r0 ffc09f80: 83 61 00 1c lwz r27,28(r1) ffc09f84: 83 81 00 20 lwz r28,32(r1) ffc09f88: 83 a1 00 24 lwz r29,36(r1) ffc09f8c: 83 c1 00 28 lwz r30,40(r1) ffc09f90: 83 e1 00 2c lwz r31,44(r1) ffc09f94: 38 21 00 30 addi r1,r1,48 ffc09f98: 4e 80 00 20 blr /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09f9c: 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; ffc09fa0: 38 80 00 00 li r4,0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09fa4: 40 9e fe 88 bne+ cr7,ffc09e2c the_thread = _Thread_Executing; ffc09fa8: 3f 80 00 00 lis r28,0 ffc09fac: 3b 9c 31 84 addi r28,r28,12676 ffc09fb0: 81 3c 00 0c lwz r9,12(r28) /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09fb4: 3b e1 00 08 addi r31,r1,8 the_thread = _Thread_Executing; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc09fb8: 83 49 01 34 lwz r26,308(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc09fbc: 7f 60 00 a6 mfmsr r27 ffc09fc0: 7c 10 42 a6 mfsprg r0,0 ffc09fc4: 7f 60 00 78 andc r0,r27,r0 ffc09fc8: 7c 00 01 24 mtmsr r0 */ /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { ffc09fcc: 80 1d 00 00 lwz r0,0(r29) ffc09fd0: 80 7a 00 d4 lwz r3,212(r26) ffc09fd4: 7c 0b 18 39 and. r11,r0,r3 ffc09fd8: 41 82 fe 84 beq+ ffc09e5c /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); ffc09fdc: 4b ff fd 91 bl ffc09d6c <_POSIX_signals_Get_lowest> _POSIX_signals_Clear_signals( ffc09fe0: 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 ); ffc09fe4: 90 7f 00 00 stw r3,0(r31) ffc09fe8: 7c 64 1b 78 mr r4,r3 _POSIX_signals_Clear_signals( ffc09fec: 38 c0 00 00 li r6,0 ffc09ff0: 7f 43 d3 78 mr r3,r26 ffc09ff4: 38 e0 00 00 li r7,0 ffc09ff8: 48 00 78 d1 bl ffc118c8 <_POSIX_signals_Clear_signals> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc09ffc: 7f 60 01 24 mtmsr r27 false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; ffc0a000: 38 00 00 01 li r0,1 the_info->si_value.sival_int = 0; return the_info->si_signo; ffc0a004: 83 df 00 00 lwz r30,0(r31) false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; ffc0a008: 90 1f 00 04 stw r0,4(r31) the_info->si_value.sival_int = 0; ffc0a00c: 38 00 00 00 li r0,0 errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc0a010: 7f c3 f3 78 mr r3,r30 false ); _ISR_Enable( level ); the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; ffc0a014: 90 1f 00 08 stw r0,8(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc0a018: 80 01 00 34 lwz r0,52(r1) ffc0a01c: 83 41 00 18 lwz r26,24(r1) ffc0a020: 7c 08 03 a6 mtlr r0 ffc0a024: 83 61 00 1c lwz r27,28(r1) ffc0a028: 83 81 00 20 lwz r28,32(r1) ffc0a02c: 83 a1 00 24 lwz r29,36(r1) ffc0a030: 83 c1 00 28 lwz r30,40(r1) ffc0a034: 83 e1 00 2c lwz r31,44(r1) ffc0a038: 38 21 00 30 addi r1,r1,48 ffc0a03c: 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 ); ffc0a040: 48 00 b3 69 bl ffc153a8 <__errno> ffc0a044: 38 00 00 16 li r0,22 ffc0a048: 90 03 00 00 stw r0,0(r3) ffc0a04c: 3b c0 ff ff li r30,-1 ffc0a050: 4b ff fe bc b ffc09f0c * 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; ffc0a054: 48 00 b3 55 bl ffc153a8 <__errno> ffc0a058: 81 3c 00 0c lwz r9,12(r28) return -1; ffc0a05c: 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; ffc0a060: 80 09 00 34 lwz r0,52(r9) ffc0a064: 90 03 00 00 stw r0,0(r3) return -1; ffc0a068: 4b ff fe a4 b ffc09f0c =============================================================================== ffc0c324 : int sigwait( const sigset_t *set, int *sig ) { ffc0c324: 94 21 ff f0 stwu r1,-16(r1) ffc0c328: 7c 08 02 a6 mflr r0 int status; status = sigtimedwait( set, NULL, NULL ); ffc0c32c: 38 a0 00 00 li r5,0 int sigwait( const sigset_t *set, int *sig ) { ffc0c330: 93 e1 00 0c stw r31,12(r1) ffc0c334: 7c 9f 23 78 mr r31,r4 int status; status = sigtimedwait( set, NULL, NULL ); ffc0c338: 38 80 00 00 li r4,0 int sigwait( const sigset_t *set, int *sig ) { ffc0c33c: 90 01 00 14 stw r0,20(r1) int status; status = sigtimedwait( set, NULL, NULL ); ffc0c340: 4b ff fd 1d bl ffc0c05c if ( status != -1 ) { ffc0c344: 2f 83 ff ff cmpwi cr7,r3,-1 int *sig ) { int status; status = sigtimedwait( set, NULL, NULL ); ffc0c348: 7c 60 1b 78 mr r0,r3 if ( status != -1 ) { ffc0c34c: 41 9e 00 28 beq- cr7,ffc0c374 if ( sig ) ffc0c350: 2f 9f 00 00 cmpwi cr7,r31,0 *sig = status; return 0; ffc0c354: 38 60 00 00 li r3,0 int status; status = sigtimedwait( set, NULL, NULL ); if ( status != -1 ) { if ( sig ) ffc0c358: 41 9e 00 08 beq- cr7,ffc0c360 <== NEVER TAKEN *sig = status; ffc0c35c: 90 1f 00 00 stw r0,0(r31) return 0; } return errno; } ffc0c360: 80 01 00 14 lwz r0,20(r1) ffc0c364: 83 e1 00 0c lwz r31,12(r1) ffc0c368: 38 21 00 10 addi r1,r1,16 ffc0c36c: 7c 08 03 a6 mtlr r0 ffc0c370: 4e 80 00 20 blr if ( sig ) *sig = status; return 0; } return errno; ffc0c374: 48 00 ae 89 bl ffc171fc <__errno> } ffc0c378: 80 01 00 14 lwz r0,20(r1) if ( sig ) *sig = status; return 0; } return errno; ffc0c37c: 80 63 00 00 lwz r3,0(r3) } ffc0c380: 7c 08 03 a6 mtlr r0 ffc0c384: 83 e1 00 0c lwz r31,12(r1) ffc0c388: 38 21 00 10 addi r1,r1,16 ffc0c38c: 4e 80 00 20 blr =============================================================================== ffc08cc8 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { ffc08cc8: 7d 80 00 26 mfcr r12 POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) ffc08ccc: 2f 83 00 01 cmpwi cr7,r3,1 int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { ffc08cd0: 94 21 ff e8 stwu r1,-24(r1) ffc08cd4: 7c 08 02 a6 mflr r0 ffc08cd8: 93 c1 00 10 stw r30,16(r1) ffc08cdc: 7c be 2b 78 mr r30,r5 ffc08ce0: 93 e1 00 14 stw r31,20(r1) ffc08ce4: 7c 9f 23 78 mr r31,r4 ffc08ce8: 90 01 00 1c stw r0,28(r1) ffc08cec: 93 a1 00 0c stw r29,12(r1) ffc08cf0: 91 81 00 08 stw r12,8(r1) POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) ffc08cf4: 40 9e 01 04 bne- cr7,ffc08df8 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) ffc08cf8: 2f 85 00 00 cmpwi cr7,r5,0 ffc08cfc: 41 9e 00 fc beq- cr7,ffc08df8 /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { ffc08d00: 2e 04 00 00 cmpwi cr4,r4,0 ffc08d04: 41 92 00 2c beq- cr4,ffc08d30 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && ffc08d08: 81 24 00 00 lwz r9,0(r4) ffc08d0c: 38 09 ff ff addi r0,r9,-1 ffc08d10: 2b 80 00 01 cmplwi cr7,r0,1 ffc08d14: 41 9d 00 e4 bgt- cr7,ffc08df8 <== 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 ) ffc08d18: 81 24 00 04 lwz r9,4(r4) ffc08d1c: 2f 89 00 00 cmpwi cr7,r9,0 ffc08d20: 41 9e 00 d8 beq- cr7,ffc08df8 <== NEVER TAKEN static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc08d24: 39 29 ff ff addi r9,r9,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) ffc08d28: 2b 89 00 1f cmplwi cr7,r9,31 ffc08d2c: 41 9d 00 cc bgt- cr7,ffc08df8 <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; ffc08d30: 3d 20 00 00 lis r9,0 ffc08d34: 81 69 28 54 lwz r11,10324(r9) ffc08d38: 38 0b 00 01 addi r0,r11,1 ffc08d3c: 90 09 28 54 stw r0,10324(r9) * the inactive chain of free timer control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Allocate( void ) { return (POSIX_Timer_Control *) _Objects_Allocate( &_POSIX_Timer_Information ); ffc08d40: 3f a0 00 00 lis r29,0 ffc08d44: 3b bd 2f 4c addi r29,r29,12108 ffc08d48: 7f a3 eb 78 mr r3,r29 ffc08d4c: 48 00 28 c9 bl ffc0b614 <_Objects_Allocate> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { ffc08d50: 2c 03 00 00 cmpwi r3,0 ffc08d54: 41 82 00 d8 beq- ffc08e2c 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; ffc08d58: 38 00 00 02 li r0,2 ffc08d5c: 98 03 00 3c stb r0,60(r3) ptimer->thread_id = _Thread_Executing->Object.id; ffc08d60: 3d 20 00 00 lis r9,0 ffc08d64: 81 29 31 90 lwz r9,12688(r9) ffc08d68: 80 09 00 08 lwz r0,8(r9) ffc08d6c: 90 03 00 38 stw r0,56(r3) if ( evp != NULL ) { ffc08d70: 41 92 00 1c beq- cr4,ffc08d8c ptimer->inf.sigev_notify = evp->sigev_notify; ffc08d74: 81 7f 00 00 lwz r11,0(r31) ptimer->inf.sigev_signo = evp->sigev_signo; ffc08d78: 81 3f 00 04 lwz r9,4(r31) ptimer->inf.sigev_value = evp->sigev_value; ffc08d7c: 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; ffc08d80: 91 63 00 40 stw r11,64(r3) ptimer->inf.sigev_signo = evp->sigev_signo; ffc08d84: 91 23 00 44 stw r9,68(r3) ptimer->inf.sigev_value = evp->sigev_value; ffc08d88: 90 03 00 48 stw r0,72(r3) uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc08d8c: 81 23 00 08 lwz r9,8(r3) } ptimer->overrun = 0; ffc08d90: 38 00 00 00 li r0,0 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc08d94: 81 5d 00 1c lwz r10,28(r29) ffc08d98: 55 2b 13 ba rlwinm r11,r9,2,14,29 ffc08d9c: 90 03 00 68 stw r0,104(r3) ptimer->timer_data.it_value.tv_sec = 0; ffc08da0: 90 03 00 5c stw r0,92(r3) ptimer->timer_data.it_value.tv_nsec = 0; ffc08da4: 90 03 00 60 stw r0,96(r3) ptimer->timer_data.it_interval.tv_sec = 0; ffc08da8: 90 03 00 54 stw r0,84(r3) ptimer->timer_data.it_interval.tv_nsec = 0; ffc08dac: 90 03 00 58 stw r0,88(r3) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc08db0: 90 03 00 18 stw r0,24(r3) the_watchdog->routine = routine; ffc08db4: 90 03 00 2c stw r0,44(r3) the_watchdog->id = id; ffc08db8: 90 03 00 30 stw r0,48(r3) the_watchdog->user_data = user_data; ffc08dbc: 90 03 00 34 stw r0,52(r3) ffc08dc0: 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; ffc08dc4: 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; ffc08dc8: 91 3e 00 00 stw r9,0(r30) _Thread_Enable_dispatch(); ffc08dcc: 48 00 3e 81 bl ffc0cc4c <_Thread_Enable_dispatch> return 0; ffc08dd0: 38 60 00 00 li r3,0 } ffc08dd4: 80 01 00 1c lwz r0,28(r1) ffc08dd8: 81 81 00 08 lwz r12,8(r1) ffc08ddc: 7c 08 03 a6 mtlr r0 ffc08de0: 83 a1 00 0c lwz r29,12(r1) ffc08de4: 83 c1 00 10 lwz r30,16(r1) ffc08de8: 7d 80 81 20 mtcrf 8,r12 ffc08dec: 83 e1 00 14 lwz r31,20(r1) ffc08df0: 38 21 00 18 addi r1,r1,24 ffc08df4: 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 ); ffc08df8: 48 00 b9 35 bl ffc1472c <__errno> ffc08dfc: 38 00 00 16 li r0,22 ffc08e00: 90 03 00 00 stw r0,0(r3) ffc08e04: 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; } ffc08e08: 80 01 00 1c lwz r0,28(r1) ffc08e0c: 81 81 00 08 lwz r12,8(r1) ffc08e10: 7c 08 03 a6 mtlr r0 ffc08e14: 83 a1 00 0c lwz r29,12(r1) ffc08e18: 83 c1 00 10 lwz r30,16(r1) ffc08e1c: 7d 80 81 20 mtcrf 8,r12 ffc08e20: 83 e1 00 14 lwz r31,20(r1) ffc08e24: 38 21 00 18 addi r1,r1,24 ffc08e28: 4e 80 00 20 blr /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { _Thread_Enable_dispatch(); ffc08e2c: 48 00 3e 21 bl ffc0cc4c <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); ffc08e30: 48 00 b8 fd bl ffc1472c <__errno> ffc08e34: 38 00 00 0b li r0,11 ffc08e38: 90 03 00 00 stw r0,0(r3) ffc08e3c: 38 60 ff ff li r3,-1 ffc08e40: 4b ff ff 94 b ffc08dd4 =============================================================================== ffc08e44 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { ffc08e44: 94 21 ff c0 stwu r1,-64(r1) ffc08e48: 7c 08 02 a6 mflr r0 ffc08e4c: 93 a1 00 34 stw r29,52(r1) Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) ffc08e50: 7c bd 2b 79 mr. r29,r5 timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { ffc08e54: 93 81 00 30 stw r28,48(r1) ffc08e58: 7c 9c 23 78 mr r28,r4 ffc08e5c: 93 c1 00 38 stw r30,56(r1) ffc08e60: 7c de 33 78 mr r30,r6 ffc08e64: 93 e1 00 3c stw r31,60(r1) ffc08e68: 7c 7f 1b 78 mr r31,r3 ffc08e6c: 90 01 00 44 stw r0,68(r1) ffc08e70: 93 61 00 2c stw r27,44(r1) Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) ffc08e74: 41 82 01 c4 beq- ffc09038 <== 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) ) ) { ffc08e78: 38 7d 00 08 addi r3,r29,8 ffc08e7c: 48 00 4c e5 bl ffc0db60 <_Timespec_Is_valid> ffc08e80: 2f 83 00 00 cmpwi cr7,r3,0 ffc08e84: 41 9e 01 b4 beq- cr7,ffc09038 rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { ffc08e88: 7f a3 eb 78 mr r3,r29 ffc08e8c: 48 00 4c d5 bl ffc0db60 <_Timespec_Is_valid> ffc08e90: 2f 83 00 00 cmpwi cr7,r3,0 ffc08e94: 41 9e 01 a4 beq- cr7,ffc09038 <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { ffc08e98: 2f 9c 00 04 cmpwi cr7,r28,4 ffc08e9c: 41 9e 01 24 beq- cr7,ffc08fc0 ffc08ea0: 2f 9c 00 00 cmpwi cr7,r28,0 ffc08ea4: 40 9e 01 94 bne- cr7,ffc09038 rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08ea8: 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 ); ffc08eac: 3c 60 00 00 lis r3,0 ffc08eb0: 81 5d 00 00 lwz r10,0(r29) ffc08eb4: 7f e4 fb 78 mr r4,r31 ffc08eb8: 81 7d 00 04 lwz r11,4(r29) ffc08ebc: 38 63 2f 4c addi r3,r3,12108 ffc08ec0: 81 3d 00 08 lwz r9,8(r29) ffc08ec4: 38 a1 00 08 addi r5,r1,8 ffc08ec8: 90 01 00 20 stw r0,32(r1) ffc08ecc: 91 41 00 14 stw r10,20(r1) ffc08ed0: 91 61 00 18 stw r11,24(r1) ffc08ed4: 91 21 00 1c stw r9,28(r1) ffc08ed8: 48 00 2d 51 bl ffc0bc28 <_Objects_Get> ffc08edc: 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 ) { ffc08ee0: 80 01 00 08 lwz r0,8(r1) ffc08ee4: 2f 80 00 00 cmpwi cr7,r0,0 ffc08ee8: 40 9e 01 50 bne- cr7,ffc09038 <== 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 ) { ffc08eec: 80 01 00 1c lwz r0,28(r1) ffc08ef0: 2f 80 00 00 cmpwi cr7,r0,0 ffc08ef4: 40 9e 00 10 bne- cr7,ffc08f04 ffc08ef8: 80 01 00 20 lwz r0,32(r1) ffc08efc: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f00: 41 9e 01 4c beq- cr7,ffc0904c _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); ffc08f04: 7f a3 eb 78 mr r3,r29 ffc08f08: 48 00 4c e9 bl ffc0dbf0 <_Timespec_To_ticks> ffc08f0c: 90 7f 00 64 stw r3,100(r31) initial_period = _Timespec_To_ticks( &normalize.it_value ); ffc08f10: 38 61 00 1c addi r3,r1,28 ffc08f14: 48 00 4c dd bl ffc0dbf0 <_Timespec_To_ticks> activated = _POSIX_Timer_Insert_helper( ffc08f18: 80 bf 00 08 lwz r5,8(r31) ffc08f1c: 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 ); ffc08f20: 7c 64 1b 78 mr r4,r3 activated = _POSIX_Timer_Insert_helper( ffc08f24: 38 c6 90 d0 addi r6,r6,-28464 ffc08f28: 38 7f 00 10 addi r3,r31,16 ffc08f2c: 7f e7 fb 78 mr r7,r31 ffc08f30: 48 00 80 ed bl ffc1101c <_POSIX_Timer_Insert_helper> initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { ffc08f34: 2f 83 00 00 cmpwi cr7,r3,0 ffc08f38: 41 9e 00 5c beq- cr7,ffc08f94 /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) ffc08f3c: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08f40: 41 9e 00 24 beq- cr7,ffc08f64 *ovalue = ptimer->timer_data; ffc08f44: 81 5f 00 54 lwz r10,84(r31) ffc08f48: 81 7f 00 58 lwz r11,88(r31) ffc08f4c: 81 3f 00 5c lwz r9,92(r31) ffc08f50: 80 1f 00 60 lwz r0,96(r31) ffc08f54: 91 5e 00 00 stw r10,0(r30) ffc08f58: 91 7e 00 04 stw r11,4(r30) ffc08f5c: 91 3e 00 08 stw r9,8(r30) ffc08f60: 90 1e 00 0c stw r0,12(r30) ptimer->timer_data = normalize; ffc08f64: 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 ); ffc08f68: 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; ffc08f6c: 90 1f 00 54 stw r0,84(r31) ffc08f70: 80 01 00 18 lwz r0,24(r1) ffc08f74: 90 1f 00 58 stw r0,88(r31) ffc08f78: 80 01 00 1c lwz r0,28(r1) ffc08f7c: 90 1f 00 5c stw r0,92(r31) ffc08f80: 80 01 00 20 lwz r0,32(r1) ffc08f84: 90 1f 00 60 stw r0,96(r31) /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc08f88: 38 00 00 03 li r0,3 ffc08f8c: 98 1f 00 3c stb r0,60(r31) _TOD_Get( &ptimer->time ); ffc08f90: 48 00 20 39 bl ffc0afc8 <_TOD_Get> _Thread_Enable_dispatch(); ffc08f94: 48 00 3c b9 bl ffc0cc4c <_Thread_Enable_dispatch> return 0; ffc08f98: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc08f9c: 80 01 00 44 lwz r0,68(r1) ffc08fa0: 83 61 00 2c lwz r27,44(r1) ffc08fa4: 7c 08 03 a6 mtlr r0 ffc08fa8: 83 81 00 30 lwz r28,48(r1) ffc08fac: 83 a1 00 34 lwz r29,52(r1) ffc08fb0: 83 c1 00 38 lwz r30,56(r1) ffc08fb4: 83 e1 00 3c lwz r31,60(r1) ffc08fb8: 38 21 00 40 addi r1,r1,64 ffc08fbc: 4e 80 00 20 blr if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08fc0: 81 5d 00 00 lwz r10,0(r29) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); ffc08fc4: 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; ffc08fc8: 81 7d 00 04 lwz r11,4(r29) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); ffc08fcc: 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; ffc08fd0: 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 ) ) ffc08fd4: 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; ffc08fd8: 80 1d 00 0c lwz r0,12(r29) ffc08fdc: 91 41 00 14 stw r10,20(r1) ffc08fe0: 91 61 00 18 stw r11,24(r1) ffc08fe4: 91 21 00 1c stw r9,28(r1) ffc08fe8: 90 01 00 20 stw r0,32(r1) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); ffc08fec: 48 00 1f dd bl ffc0afc8 <_TOD_Get> /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) ffc08ff0: 7f 83 e3 78 mr r3,r28 ffc08ff4: 7f 64 db 78 mr r4,r27 ffc08ff8: 48 00 4b 2d bl ffc0db24 <_Timespec_Greater_than> ffc08ffc: 2f 83 00 00 cmpwi cr7,r3,0 ffc09000: 40 9e 00 38 bne- cr7,ffc09038 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); ffc09004: 7f 64 db 78 mr r4,r27 ffc09008: 7f 83 e3 78 mr r3,r28 ffc0900c: 7f 65 db 78 mr r5,r27 ffc09010: 48 00 4b 8d bl ffc0db9c <_Timespec_Subtract> ffc09014: 3c 60 00 00 lis r3,0 ffc09018: 7f e4 fb 78 mr r4,r31 ffc0901c: 38 63 2f 4c addi r3,r3,12108 ffc09020: 38 a1 00 08 addi r5,r1,8 ffc09024: 48 00 2c 05 bl ffc0bc28 <_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 ) { ffc09028: 80 01 00 08 lwz r0,8(r1) ffc0902c: 7c 7f 1b 78 mr r31,r3 ffc09030: 2f 80 00 00 cmpwi cr7,r0,0 ffc09034: 41 be fe b8 beq- cr7,ffc08eec #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); ffc09038: 48 00 b6 f5 bl ffc1472c <__errno> ffc0903c: 38 00 00 16 li r0,22 ffc09040: 90 03 00 00 stw r0,0(r3) ffc09044: 38 60 ff ff li r3,-1 ffc09048: 4b ff ff 54 b ffc08f9c 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 ); ffc0904c: 38 63 00 10 addi r3,r3,16 ffc09050: 48 00 52 c5 bl ffc0e314 <_Watchdog_Remove> /* The old data of the timer are returned */ if ( ovalue ) ffc09054: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09058: 41 9e 00 24 beq- cr7,ffc0907c *ovalue = ptimer->timer_data; ffc0905c: 81 5f 00 54 lwz r10,84(r31) ffc09060: 81 7f 00 58 lwz r11,88(r31) ffc09064: 81 3f 00 5c lwz r9,92(r31) ffc09068: 80 1f 00 60 lwz r0,96(r31) ffc0906c: 91 5e 00 00 stw r10,0(r30) ffc09070: 91 7e 00 04 stw r11,4(r30) ffc09074: 91 3e 00 08 stw r9,8(r30) ffc09078: 90 1e 00 0c stw r0,12(r30) /* The new data are set */ ptimer->timer_data = normalize; ffc0907c: 80 01 00 14 lwz r0,20(r1) ffc09080: 90 1f 00 54 stw r0,84(r31) ffc09084: 80 01 00 18 lwz r0,24(r1) ffc09088: 90 1f 00 58 stw r0,88(r31) ffc0908c: 80 01 00 1c lwz r0,28(r1) ffc09090: 90 1f 00 5c stw r0,92(r31) ffc09094: 80 01 00 20 lwz r0,32(r1) ffc09098: 90 1f 00 60 stw r0,96(r31) /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; ffc0909c: 38 00 00 04 li r0,4 ffc090a0: 98 1f 00 3c stb r0,60(r31) /* Returns with success */ _Thread_Enable_dispatch(); ffc090a4: 48 00 3b a9 bl ffc0cc4c <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc090a8: 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; ffc090ac: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc090b0: 83 61 00 2c lwz r27,44(r1) ffc090b4: 7c 08 03 a6 mtlr r0 ffc090b8: 83 81 00 30 lwz r28,48(r1) ffc090bc: 83 a1 00 34 lwz r29,52(r1) ffc090c0: 83 c1 00 38 lwz r30,56(r1) ffc090c4: 83 e1 00 3c lwz r31,60(r1) ffc090c8: 38 21 00 40 addi r1,r1,64 ffc090cc: 4e 80 00 20 blr =============================================================================== ffc08b78 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08b78: 94 21 ff d8 stwu r1,-40(r1) ffc08b7c: 7c 08 02 a6 mflr r0 ffc08b80: 93 e1 00 24 stw r31,36(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08b84: 3f e0 00 00 lis r31,0 ffc08b88: 3b ff 35 54 addi r31,r31,13652 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08b8c: 90 01 00 2c stw r0,44(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08b90: 80 1f 00 1c lwz r0,28(r31) useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08b94: 93 c1 00 20 stw r30,32(r1) ffc08b98: 7c 7e 1b 78 mr r30,r3 /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08b9c: 2f 80 00 00 cmpwi cr7,r0,0 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08ba0: 93 81 00 18 stw r28,24(r1) ffc08ba4: 93 a1 00 1c stw r29,28(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08ba8: 41 9e 00 ac beq- cr7,ffc08c54 _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); ffc08bac: 7f e3 fb 78 mr r3,r31 ffc08bb0: 48 00 51 bd bl ffc0dd6c <_Watchdog_Remove> useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; ffc08bb4: 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) ) { ffc08bb8: 38 63 ff fe addi r3,r3,-2 ffc08bbc: 2b 83 00 01 cmplwi cr7,r3,1 ffc08bc0: 40 9d 00 b4 ble- cr7,ffc08c74 <== 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 ) { ffc08bc4: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08bc8: 41 be 00 68 beq+ cr7,ffc08c30 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; ffc08bcc: 3c 00 43 1b lis r0,17179 ffc08bd0: 60 00 de 83 ori r0,r0,56963 ffc08bd4: 7c 1e 00 16 mulhwu r0,r30,r0 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); ffc08bd8: 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; ffc08bdc: 54 00 74 be rlwinm r0,r0,14,18,31 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc08be0: 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; ffc08be4: 90 01 00 08 stw r0,8(r1) tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc08be8: 54 09 18 38 rlwinm r9,r0,3,0,28 ffc08bec: 7d 29 58 50 subf r9,r9,r11 ffc08bf0: 55 2b 30 32 rlwinm r11,r9,6,0,25 ffc08bf4: 7d 29 58 50 subf r9,r9,r11 ffc08bf8: 7d 29 02 14 add r9,r9,r0 ffc08bfc: 55 29 30 32 rlwinm r9,r9,6,0,25 ffc08c00: 7f c9 f0 50 subf r30,r9,r30 ffc08c04: 1f de 03 e8 mulli r30,r30,1000 ticks = _Timespec_To_ticks( &tp ); ffc08c08: 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; ffc08c0c: 93 c1 00 0c stw r30,12(r1) ticks = _Timespec_To_ticks( &tp ); ffc08c10: 48 00 49 0d bl ffc0d51c <_Timespec_To_ticks> if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); ffc08c14: 7f 83 e3 78 mr r3,r28 ffc08c18: 48 00 49 05 bl ffc0d51c <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08c1c: 7f e4 fb 78 mr r4,r31 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc08c20: 90 7f 00 0c stw r3,12(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08c24: 3c 60 00 00 lis r3,0 ffc08c28: 38 63 2d a8 addi r3,r3,11688 ffc08c2c: 48 00 4f 71 bl ffc0db9c <_Watchdog_Insert> } return remaining; } ffc08c30: 80 01 00 2c lwz r0,44(r1) ffc08c34: 7f a3 eb 78 mr r3,r29 ffc08c38: 83 81 00 18 lwz r28,24(r1) ffc08c3c: 7c 08 03 a6 mtlr r0 ffc08c40: 83 a1 00 1c lwz r29,28(r1) ffc08c44: 83 c1 00 20 lwz r30,32(r1) ffc08c48: 83 e1 00 24 lwz r31,36(r1) ffc08c4c: 38 21 00 28 addi r1,r1,40 ffc08c50: 4e 80 00 20 blr Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc08c54: 3d 20 ff c1 lis r9,-63 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc08c58: 90 1f 00 08 stw r0,8(r31) the_watchdog->routine = routine; ffc08c5c: 39 29 8b 28 addi r9,r9,-29912 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; ffc08c60: 3b a0 00 00 li r29,0 ffc08c64: 91 3f 00 1c stw r9,28(r31) the_watchdog->id = id; ffc08c68: 90 1f 00 20 stw r0,32(r31) the_watchdog->user_data = user_data; ffc08c6c: 90 1f 00 24 stw r0,36(r31) ffc08c70: 4b ff ff 54 b ffc08bc4 * 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); ffc08c74: 81 3f 00 0c lwz r9,12(r31) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); ffc08c78: 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); ffc08c7c: 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; ffc08c80: 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); ffc08c84: 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; ffc08c88: 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); ffc08c8c: 7c 63 4a 14 add r3,r3,r9 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); ffc08c90: 7c 60 18 50 subf r3,r0,r3 ffc08c94: 48 00 47 e9 bl ffc0d47c <_Timespec_From_ticks> remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; ffc08c98: 80 01 00 08 lwz r0,8(r1) remaining += tp.tv_nsec / 1000; ffc08c9c: 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; ffc08ca0: 54 0a 40 2e rlwinm r10,r0,8,0,23 ffc08ca4: 54 0b 18 38 rlwinm r11,r0,3,0,28 ffc08ca8: 7d 6b 50 50 subf r11,r11,r10 remaining += tp.tv_nsec / 1000; ffc08cac: 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; ffc08cb0: 55 6a 30 32 rlwinm r10,r11,6,0,25 ffc08cb4: 7d 6b 50 50 subf r11,r11,r10 ffc08cb8: 7c 0b 02 14 add r0,r11,r0 remaining += tp.tv_nsec / 1000; ffc08cbc: 7f bd 36 70 srawi r29,r29,6 ffc08cc0: 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; ffc08cc4: 54 00 30 32 rlwinm r0,r0,6,0,25 remaining += tp.tv_nsec / 1000; ffc08cc8: 7f a9 e8 50 subf r29,r9,r29 ffc08ccc: 7f bd 02 14 add r29,r29,r0 ffc08cd0: 4b ff fe f4 b ffc08bc4