0004af70 <TOD_MICROSECONDS_TO_TICKS>:
uint32_t TOD_MICROSECONDS_TO_TICKS(
uint32_t microseconds
)
{
return (microseconds / rtems_configuration_get_microseconds_per_tick());
}
4af70: 41f9 0006 2100 lea 62100 <Configuration+0xc>,%a0
#include <rtems/score/tod.h>
uint32_t TOD_MICROSECONDS_TO_TICKS(
uint32_t microseconds
)
{
4af76: 4e56 0000 linkw %fp,#0
return (microseconds / rtems_configuration_get_microseconds_per_tick()); }
4af7a: 202e 0008 movel %fp@(8),%d0 4af7e: 4e5e unlk %fp 4af80: 4c50 0000 remul %a0@,%d0,%d0 4af84: 4e75 rts
...
000464c8 <TOD_MILLISECONDS_TO_TICKS>:
#include <rtems/score/tod.h>
uint32_t TOD_MILLISECONDS_TO_TICKS(
uint32_t milliseconds
)
{
464c8: 4e56 0000 linkw %fp,#0 464cc: 2039 0005 c660 movel 5c660 <Configuration+0xc>,%d0 464d2: 2f02 movel %d2,%sp@- 464d4: 243c 0000 03e8 movel #1000,%d2 464da: 4c42 0000 remul %d2,%d0,%d0
return (milliseconds / rtems_configuration_get_milliseconds_per_tick()); }
464de: 242e 0008 movel %fp@(8),%d2 464e2: 4c40 2002 remul %d0,%d2,%d2 464e6: 2002 movel %d2,%d0 464e8: 241f movel %sp@+,%d2 464ea: 4e5e unlk %fp 464ec: 4e75 rts
...
0004583c <_API_Mutex_Lock>:
API_Mutex_Control *the_mutex
)
{
ISR_Level level;
_ISR_Disable( level );
4583c: 203c 0000 0700 movel #1792,%d0
#include <rtems/score/apimutex.h>
void _API_Mutex_Lock(
API_Mutex_Control *the_mutex
)
{
45842: 4e56 0000 linkw %fp,#0 45846: 206e 0008 moveal %fp@(8),%a0
ISR_Level level;
_ISR_Disable( level );
4584a: 40c1 movew %sr,%d1 4584c: 8081 orl %d1,%d0 4584e: 46c0 movew %d0,%sr
_CORE_mutex_Seize(
45850: 2f01 movel %d1,%sp@- 45852: 42a7 clrl %sp@- 45854: 4878 0001 pea 1 <ADD> 45858: 2f28 0008 movel %a0@(8),%sp@- 4585c: 4868 0010 pea %a0@(16) 45860: 4eb9 0004 5a20 jsr 45a20 <_CORE_mutex_Seize> 45866: 4fef 0014 lea %sp@(20),%sp
the_mutex->Object.id,
true,
0,
level
);
}
4586a: 4e5e unlk %fp 4586c: 4e75 rts
...
0004589c <_API_Mutex_Unlock>:
#include <rtems/score/apimutex.h>
void _API_Mutex_Unlock(
API_Mutex_Control *the_mutex
)
{
4589c: 4e56 0000 linkw %fp,#0
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
458a0: 2039 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d0 458a6: 5280 addql #1,%d0 458a8: 206e 0008 moveal %fp@(8),%a0 458ac: 23c0 0005 cc94 movel %d0,5cc94 <_Thread_Dispatch_disable_level>
_Thread_Disable_dispatch();
_CORE_mutex_Surrender(
458b2: 42a7 clrl %sp@- 458b4: 2f28 0008 movel %a0@(8),%sp@- 458b8: 4868 0010 pea %a0@(16) 458bc: 4eb9 0004 5ac8 jsr 45ac8 <_CORE_mutex_Surrender>
&the_mutex->Mutex,
the_mutex->Object.id,
NULL
);
_Thread_Enable_dispatch();
458c2: 4fef 000c lea %sp@(12),%sp
}
458c6: 4e5e unlk %fp
_CORE_mutex_Surrender(
&the_mutex->Mutex,
the_mutex->Object.id,
NULL
);
_Thread_Enable_dispatch();
458c8: 4ef9 0004 6ce2 jmp 46ce2 <_Thread_Enable_dispatch>
...
000457b4 <_API_extensions_Add>:
*/
void _API_extensions_Add(
API_extensions_Control *the_extension
)
{
457b4: 4e56 0000 linkw %fp,#0
_Chain_Append( &_API_extensions_List, &the_extension->Node );
457b8: 2f2e 0008 movel %fp@(8),%sp@- 457bc: 4879 0005 ce34 pea 5ce34 <_API_extensions_List> 457c2: 4eb9 0004 58d0 jsr 458d0 <_Chain_Append> 457c8: 508f addql #8,%sp
}
457ca: 4e5e unlk %fp 457cc: 4e75 rts
...
0004c9d4 <_Barrier_Translate_core_barrier_return_code>:
};
rtems_status_code _Barrier_Translate_core_barrier_return_code (
CORE_barrier_Status the_barrier_status
)
{
4c9d4: 41f9 0005 b5fc lea 5b5fc <_Barrier_Translate_core_barrier_return_code_>,%a0 4c9da: 4e56 0000 linkw %fp,#0
#if defined(RTEMS_DEBUG)
if ( the_barrier_status > CORE_BARRIER_STATUS_LAST )
return RTEMS_INTERNAL_ERROR;
#endif
return _Barrier_Translate_core_barrier_return_code_[the_barrier_status];
}
4c9de: 202e 0008 movel %fp@(8),%d0 4c9e2: 4e5e unlk %fp 4c9e4: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4c9e8: 4e75 rts
...
000478a8 <_CORE_RWLock_Obtain_for_writing>:
* Otherwise, we have to block.
* If locked for reading and no waiters, then OK to read.
* If any thread is waiting, then we wait.
*/
_ISR_Disable( level );
478a8: 223c 0000 0700 movel #1792,%d1
Objects_Id id,
bool wait,
Watchdog_Interval timeout,
CORE_RWLock_API_mp_support_callout api_rwlock_mp_support
)
{
478ae: 4e56 fff4 linkw %fp,#-12 478b2: 226e 0008 moveal %fp@(8),%a1 478b6: 48d7 001c moveml %d2-%d4,%sp@ 478ba: 262e 000c movel %fp@(12),%d3 478be: 282e 0010 movel %fp@(16),%d4 478c2: 242e 0014 movel %fp@(20),%d2
ISR_Level level; Thread_Control *executing = _Thread_Executing;
478c6: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0
* Otherwise, we have to block.
* If locked for reading and no waiters, then OK to read.
* If any thread is waiting, then we wait.
*/
_ISR_Disable( level );
478cc: 40c0 movew %sr,%d0 478ce: 8280 orl %d0,%d1 478d0: 46c1 movew %d1,%sr
switch ( the_rwlock->current_state ) {
478d2: 4aa9 0044 tstl %a1@(68) 478d6: 660e bnes 478e6 <_CORE_RWLock_Obtain_for_writing+0x3e>
case CORE_RWLOCK_UNLOCKED:
the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING;
478d8: 7202 moveq #2,%d1 478da: 2341 0044 movel %d1,%a1@(68)
_ISR_Enable( level );
478de: 46c0 movew %d0,%sr
executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL;
478e0: 42a8 0034 clrl %a0@(52)
return;
478e4: 6044 bras 4792a <_CORE_RWLock_Obtain_for_writing+0x82>
/*
* If the thread is not willing to wait, then return immediately.
*/
if ( !wait ) {
478e6: 4a04 tstb %d4 478e8: 660a bnes 478f4 <_CORE_RWLock_Obtain_for_writing+0x4c>
_ISR_Enable( level );
478ea: 46c0 movew %d0,%sr
executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE;
478ec: 7002 moveq #2,%d0 478ee: 2140 0034 movel %d0,%a0@(52) 478f2: 6036 bras 4792a <_CORE_RWLock_Obtain_for_writing+0x82>
*/
_Thread_queue_Enter_critical_section( &the_rwlock->Wait_queue );
executing->Wait.queue = &the_rwlock->Wait_queue;
executing->Wait.id = id;
executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_WRITE;
478f4: 7201 moveq #1,%d1
* We need to wait to enter this critical section
*/
_Thread_queue_Enter_critical_section( &the_rwlock->Wait_queue );
executing->Wait.queue = &the_rwlock->Wait_queue;
executing->Wait.id = id;
478f6: 2143 0020 movel %d3,%a0@(32)
executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_WRITE;
executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL;
478fa: 42a8 0034 clrl %a0@(52)
/*
* We need to wait to enter this critical section
*/
_Thread_queue_Enter_critical_section( &the_rwlock->Wait_queue );
executing->Wait.queue = &the_rwlock->Wait_queue;
478fe: 2149 0044 movel %a1,%a0@(68)
executing->Wait.id = id;
executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_WRITE;
47902: 2141 0030 movel %d1,%a0@(48) 47906: 2341 0030 movel %d1,%a1@(48)
executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL;
_ISR_Enable( level );
4790a: 46c0 movew %d0,%sr
_Thread_queue_Enqueue_with_handler(
4790c: 2d42 000c movel %d2,%fp@(12) 47910: 203c 0004 79e8 movel #293352,%d0 47916: 2d49 0008 movel %a1,%fp@(8) 4791a: 2d40 0010 movel %d0,%fp@(16)
_CORE_RWLock_Timeout
);
/* return to API level so it can dispatch and we block */
}
4791e: 4cd7 001c moveml %sp@,%d2-%d4 47922: 4e5e unlk %fp
executing->Wait.id = id;
executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_WRITE;
executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL;
_ISR_Enable( level );
_Thread_queue_Enqueue_with_handler(
47924: 4ef9 0004 8ff0 jmp 48ff0 <_Thread_queue_Enqueue_with_handler>
_CORE_RWLock_Timeout
);
/* return to API level so it can dispatch and we block */
}
4792a: 4cd7 001c moveml %sp@,%d2-%d4 4792e: 4e5e unlk %fp 47930: 4e75 rts
...
00047934 <_CORE_RWLock_Release>:
* Otherwise, we have to block.
* If locked for reading and no waiters, then OK to read.
* If any thread is waiting, then we wait.
*/
_ISR_Disable( level );
47934: 223c 0000 0700 movel #1792,%d1
*/
CORE_RWLock_Status _CORE_RWLock_Release(
CORE_RWLock_Control *the_rwlock
)
{
4793a: 4e56 fff0 linkw %fp,#-16
ISR_Level level; Thread_Control *executing = _Thread_Executing;
4793e: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0
*/
CORE_RWLock_Status _CORE_RWLock_Release(
CORE_RWLock_Control *the_rwlock
)
{
47944: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 47948: 246e 0008 moveal %fp@(8),%a2
* Otherwise, we have to block.
* If locked for reading and no waiters, then OK to read.
* If any thread is waiting, then we wait.
*/
_ISR_Disable( level );
4794c: 40c0 movew %sr,%d0 4794e: 8280 orl %d0,%d1 47950: 46c1 movew %d1,%sr
if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){
47952: 222a 0044 movel %a2@(68),%d1 47956: 660a bnes 47962 <_CORE_RWLock_Release+0x2e>
_ISR_Enable( level );
47958: 46c0 movew %d0,%sr
executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE;
4795a: 7002 moveq #2,%d0 4795c: 2140 0034 movel %d0,%a0@(52)
return CORE_RWLOCK_SUCCESSFUL;
47960: 6078 bras 479da <_CORE_RWLock_Release+0xa6>
}
if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) {
47962: 7401 moveq #1,%d2 47964: b481 cmpl %d1,%d2 47966: 6610 bnes 47978 <_CORE_RWLock_Release+0x44>
the_rwlock->number_of_readers -= 1;
47968: 222a 0048 movel %a2@(72),%d1 4796c: 5381 subql #1,%d1 4796e: 2541 0048 movel %d1,%a2@(72)
if ( the_rwlock->number_of_readers != 0 ) {
47972: 6704 beqs 47978 <_CORE_RWLock_Release+0x44>
/* must be unlocked again */
_ISR_Enable( level );
47974: 46c0 movew %d0,%sr
return CORE_RWLOCK_SUCCESSFUL;
47976: 6062 bras 479da <_CORE_RWLock_Release+0xa6>
}
}
/* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */
executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL;
47978: 42a8 0034 clrl %a0@(52)
/*
* Implicitly transition to "unlocked" and find another thread interested
* in obtaining this rwlock.
*/
the_rwlock->current_state = CORE_RWLOCK_UNLOCKED;
4797c: 42aa 0044 clrl %a2@(68)
_ISR_Enable( level );
47980: 46c0 movew %d0,%sr
next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue );
47982: 2f0a movel %a2,%sp@- 47984: 4eb9 0004 8eb0 jsr 48eb0 <_Thread_queue_Dequeue>
if ( next ) {
4798a: 588f addql #4,%sp 4798c: 4a80 tstl %d0 4798e: 674a beqs 479da <_CORE_RWLock_Release+0xa6>
if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) {
47990: 7201 moveq #1,%d1 47992: 2040 moveal %d0,%a0 47994: b2a8 0030 cmpl %a0@(48),%d1 47998: 6608 bnes 479a2 <_CORE_RWLock_Release+0x6e>
the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING;
4799a: 7002 moveq #2,%d0 4799c: 2540 0044 movel %d0,%a2@(68)
return CORE_RWLOCK_SUCCESSFUL;
479a0: 6038 bras 479da <_CORE_RWLock_Release+0xa6>
/*
* Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING
*/
the_rwlock->number_of_readers += 1;
the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING;
479a2: 7201 moveq #1,%d1
}
/*
* Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING
*/
the_rwlock->number_of_readers += 1;
479a4: 52aa 0048 addql #1,%a2@(72)
/*
* Now see if more readers can be let go.
*/
while ( 1 ) {
next = _Thread_queue_First( &the_rwlock->Wait_queue );
479a8: 49f9 0004 92f0 lea 492f0 <_Thread_queue_First>,%a4
if ( !next ||
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 );
479ae: 47f9 0004 91c4 lea 491c4 <_Thread_queue_Extract>,%a3
/*
* Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING
*/
the_rwlock->number_of_readers += 1;
the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING;
479b4: 2541 0044 movel %d1,%a2@(68)
/*
* Now see if more readers can be let go.
*/
while ( 1 ) {
next = _Thread_queue_First( &the_rwlock->Wait_queue );
479b8: 2f0a movel %a2,%sp@- 479ba: 4e94 jsr %a4@
if ( !next ||
479bc: 588f addql #4,%sp 479be: 4a80 tstl %d0 479c0: 6718 beqs 479da <_CORE_RWLock_Release+0xa6>
next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE )
479c2: 7401 moveq #1,%d2 479c4: 2040 moveal %d0,%a0 479c6: b4a8 0030 cmpl %a0@(48),%d2 479ca: 670e beqs 479da <_CORE_RWLock_Release+0xa6>
return CORE_RWLOCK_SUCCESSFUL;
the_rwlock->number_of_readers += 1;
479cc: 52aa 0048 addql #1,%a2@(72)
_Thread_queue_Extract( &the_rwlock->Wait_queue, next );
479d0: 2f00 movel %d0,%sp@- 479d2: 2f0a movel %a2,%sp@- 479d4: 4e93 jsr %a3@
}
479d6: 508f addql #8,%sp 479d8: 60de bras 479b8 <_CORE_RWLock_Release+0x84>
}
/* indentation is to match _ISR_Disable at top */
return CORE_RWLOCK_SUCCESSFUL;
}
479da: 4280 clrl %d0 479dc: 4cee 1c04 fff0 moveml %fp@(-16),%d2/%a2-%a4 479e2: 4e5e unlk %fp 479e4: 4e75 rts
...
000479e8 <_CORE_RWLock_Timeout>:
void _CORE_RWLock_Timeout(
Objects_Id id,
void *ignored
)
{
479e8: 4e56 fffc linkw %fp,#-4
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
479ec: 486e fffc pea %fp@(-4) 479f0: 2f2e 0008 movel %fp@(8),%sp@- 479f4: 4eb9 0004 8b8c jsr 48b8c <_Thread_Get>
switch ( location ) {
479fa: 508f addql #8,%sp 479fc: 4aae fffc tstl %fp@(-4) 47a00: 6618 bnes 47a1a <_CORE_RWLock_Timeout+0x32>
#if defined(RTEMS_MULTIPROCESSING)
case OBJECTS_REMOTE: /* impossible */
#endif
break;
case OBJECTS_LOCAL:
_Thread_queue_Process_timeout( the_thread );
47a02: 2f00 movel %d0,%sp@- 47a04: 4eb9 0004 93d4 jsr 493d4 <_Thread_queue_Process_timeout>
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
47a0a: 588f addql #4,%sp 47a0c: 2039 0005 f638 movel 5f638 <_Thread_Dispatch_disable_level>,%d0 47a12: 5380 subql #1,%d0 47a14: 23c0 0005 f638 movel %d0,5f638 <_Thread_Dispatch_disable_level>
_Thread_Unnest_dispatch();
break;
}
}
47a1a: 4e5e unlk %fp 47a1c: 4e75 rts
...
0004bf0c <_CORE_barrier_Initialize>:
void _CORE_barrier_Initialize(
CORE_barrier_Control *the_barrier,
CORE_barrier_Attributes *the_barrier_attributes
)
{
4bf0c: 4e56 0000 linkw %fp,#0
the_barrier->Attributes = *the_barrier_attributes;
4bf10: 226e 000c moveal %fp@(12),%a1
the_barrier->number_of_waiting_threads = 0;
_Thread_queue_Initialize(
4bf14: 4878 0003 pea 3 <DIVIDE>
void _CORE_barrier_Initialize(
CORE_barrier_Control *the_barrier,
CORE_barrier_Attributes *the_barrier_attributes
)
{
4bf18: 206e 0008 moveal %fp@(8),%a0
the_barrier->Attributes = *the_barrier_attributes;
the_barrier->number_of_waiting_threads = 0;
_Thread_queue_Initialize(
4bf1c: 2f3c 0001 0000 movel #65536,%sp@- 4bf22: 42a7 clrl %sp@-
CORE_barrier_Control *the_barrier,
CORE_barrier_Attributes *the_barrier_attributes
)
{
the_barrier->Attributes = *the_barrier_attributes;
4bf24: 2011 movel %a1@,%d0 4bf26: 2229 0004 movel %a1@(4),%d1 4bf2a: 2140 0040 movel %d0,%a0@(64) 4bf2e: 2141 0044 movel %d1,%a0@(68)
the_barrier->number_of_waiting_threads = 0;
_Thread_queue_Initialize(
4bf32: 2f08 movel %a0,%sp@-
CORE_barrier_Attributes *the_barrier_attributes
)
{
the_barrier->Attributes = *the_barrier_attributes;
the_barrier->number_of_waiting_threads = 0;
4bf34: 42a8 0048 clrl %a0@(72)
_Thread_queue_Initialize(
4bf38: 4eb9 0004 739c jsr 4739c <_Thread_queue_Initialize> 4bf3e: 4fef 0010 lea %sp@(16),%sp
&the_barrier->Wait_queue,
THREAD_QUEUE_DISCIPLINE_FIFO,
STATES_WAITING_FOR_BARRIER,
CORE_BARRIER_TIMEOUT
);
}
4bf42: 4e5e unlk %fp 4bf44: 4e75 rts
...
0004bf48 <_CORE_barrier_Release>:
#else
Objects_Id id __attribute__((unused)),
CORE_barrier_API_mp_support_callout api_barrier_mp_support __attribute__((unused))
#endif
)
{
4bf48: 4e56 fff4 linkw %fp,#-12 4bf4c: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 4bf50: 246e 0008 moveal %fp@(8),%a2
Thread_Control *the_thread;
uint32_t count;
count = 0;
while ( (the_thread = _Thread_queue_Dequeue(&the_barrier->Wait_queue)) ) {
4bf54: 4282 clrl %d2 4bf56: 47f9 0004 702c lea 4702c <_Thread_queue_Dequeue>,%a3 4bf5c: 6002 bras 4bf60 <_CORE_barrier_Release+0x18>
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
(*api_barrier_mp_support) ( the_thread, id );
#endif
count++;
4bf5e: 5282 addql #1,%d2
{
Thread_Control *the_thread;
uint32_t count;
count = 0;
while ( (the_thread = _Thread_queue_Dequeue(&the_barrier->Wait_queue)) ) {
4bf60: 2f0a movel %a2,%sp@- 4bf62: 4e93 jsr %a3@ 4bf64: 588f addql #4,%sp 4bf66: 4a80 tstl %d0 4bf68: 66f4 bnes 4bf5e <_CORE_barrier_Release+0x16>
#endif
count++;
}
the_barrier->number_of_waiting_threads = 0;
return count;
}
4bf6a: 2002 movel %d2,%d0
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
(*api_barrier_mp_support) ( the_thread, id );
#endif
count++;
}
the_barrier->number_of_waiting_threads = 0;
4bf6c: 42aa 0048 clrl %a2@(72)
return count; }
4bf70: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 4bf76: 4e5e unlk %fp 4bf78: 4e75 rts
...
0004bf7c <_CORE_barrier_Wait>:
Thread_Control *executing;
ISR_Level level;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL;
_ISR_Disable( level );
4bf7c: 203c 0000 0700 movel #1792,%d0
Objects_Id id,
bool wait,
Watchdog_Interval timeout,
CORE_barrier_API_mp_support_callout api_barrier_mp_support
)
{
4bf82: 4e56 fff4 linkw %fp,#-12
Thread_Control *executing;
ISR_Level level;
executing = _Thread_Executing;
4bf86: 2279 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a1
Objects_Id id,
bool wait,
Watchdog_Interval timeout,
CORE_barrier_API_mp_support_callout api_barrier_mp_support
)
{
4bf8c: 48d7 001c moveml %d2-%d4,%sp@ 4bf90: 242e 000c movel %fp@(12),%d2 4bf94: 262e 0014 movel %fp@(20),%d3
Thread_Control *executing;
ISR_Level level;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL;
4bf98: 42a9 0034 clrl %a1@(52)
Objects_Id id,
bool wait,
Watchdog_Interval timeout,
CORE_barrier_API_mp_support_callout api_barrier_mp_support
)
{
4bf9c: 206e 0008 moveal %fp@(8),%a0 4bfa0: 282e 0018 movel %fp@(24),%d4
Thread_Control *executing;
ISR_Level level;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL;
_ISR_Disable( level );
4bfa4: 40c1 movew %sr,%d1 4bfa6: 8081 orl %d1,%d0 4bfa8: 46c0 movew %d0,%sr
the_barrier->number_of_waiting_threads++;
4bfaa: 2028 0048 movel %a0@(72),%d0 4bfae: 5280 addql #1,%d0 4bfb0: 2140 0048 movel %d0,%a0@(72)
if ( _CORE_barrier_Is_automatic( &the_barrier->Attributes ) ) {
4bfb4: 4aa8 0040 tstl %a0@(64) 4bfb8: 6626 bnes 4bfe0 <_CORE_barrier_Wait+0x64>
if ( the_barrier->number_of_waiting_threads ==
the_barrier->Attributes.maximum_count) {
4bfba: b0a8 0044 cmpl %a0@(68),%d0 4bfbe: 6620 bnes 4bfe0 <_CORE_barrier_Wait+0x64>
executing->Wait.return_code = CORE_BARRIER_STATUS_AUTOMATICALLY_RELEASED;
4bfc0: 7001 moveq #1,%d0 4bfc2: 2340 0034 movel %d0,%a1@(52)
_ISR_Enable( level );
4bfc6: 46c1 movew %d1,%sr
_CORE_barrier_Release( the_barrier, id, api_barrier_mp_support );
4bfc8: 2d44 0010 movel %d4,%fp@(16) 4bfcc: 2d42 000c movel %d2,%fp@(12) 4bfd0: 2d48 0008 movel %a0,%fp@(8)
executing->Wait.queue = &the_barrier->Wait_queue;
executing->Wait.id = id;
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout );
}
4bfd4: 4cd7 001c moveml %sp@,%d2-%d4 4bfd8: 4e5e unlk %fp
if ( _CORE_barrier_Is_automatic( &the_barrier->Attributes ) ) {
if ( the_barrier->number_of_waiting_threads ==
the_barrier->Attributes.maximum_count) {
executing->Wait.return_code = CORE_BARRIER_STATUS_AUTOMATICALLY_RELEASED;
_ISR_Enable( level );
_CORE_barrier_Release( the_barrier, id, api_barrier_mp_support );
4bfda: 4ef9 0004 bf48 jmp 4bf48 <_CORE_barrier_Release> 4bfe0: 7001 moveq #1,%d0
}
}
_Thread_queue_Enter_critical_section( &the_barrier->Wait_queue );
executing->Wait.queue = &the_barrier->Wait_queue;
executing->Wait.id = id;
4bfe2: 2342 0020 movel %d2,%a1@(32)
return;
}
}
_Thread_queue_Enter_critical_section( &the_barrier->Wait_queue );
executing->Wait.queue = &the_barrier->Wait_queue;
4bfe6: 2348 0044 movel %a0,%a1@(68) 4bfea: 2140 0030 movel %d0,%a0@(48)
executing->Wait.id = id; _ISR_Enable( level );
4bfee: 46c1 movew %d1,%sr
_Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout );
4bff0: 2d43 000c movel %d3,%fp@(12) 4bff4: 203c 0004 7458 movel #291928,%d0 4bffa: 2d48 0008 movel %a0,%fp@(8) 4bffe: 2d40 0010 movel %d0,%fp@(16)
}
4c002: 4cd7 001c moveml %sp@,%d2-%d4 4c006: 4e5e unlk %fp
_Thread_queue_Enter_critical_section( &the_barrier->Wait_queue );
executing->Wait.queue = &the_barrier->Wait_queue;
executing->Wait.id = id;
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout );
4c008: 4ef9 0004 716c jmp 4716c <_Thread_queue_Enqueue_with_handler>
...
00052088 <_CORE_message_queue_Broadcast>:
Objects_Id id __attribute__((unused)),
CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)),
#endif
uint32_t *count
)
{
52088: 4e56 ffe0 linkw %fp,#-32 5208c: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 52090: 246e 0008 moveal %fp@(8),%a2 52094: 2a2e 000c movel %fp@(12),%d5 52098: 262e 0010 movel %fp@(16),%d3 5209c: 286e 001c moveal %fp@(28),%a4
Thread_Control *the_thread;
uint32_t number_broadcasted;
Thread_Wait_information *waitp;
if ( size > the_message_queue->maximum_message_size ) {
520a0: b6aa 004c cmpl %a2@(76),%d3 520a4: 6304 blss 520aa <_CORE_message_queue_Broadcast+0x22>
520a6: 7001 moveq #1,%d0 <== NOT EXECUTED 520a8: 6042 bras 520ec <_CORE_message_queue_Broadcast+0x64><== NOT EXECUTED
* NOTE: This check is critical because threads can block on
* send and receive and this ensures that we are broadcasting
* the message to threads waiting to receive -- not to send.
*/
if ( the_message_queue->number_of_pending_messages != 0 ) {
520aa: 4aaa 0048 tstl %a2@(72) 520ae: 6610 bnes 520c0 <_CORE_message_queue_Broadcast+0x38>
* There must be no pending messages if there is a thread waiting to
* receive a message.
*/
number_broadcasted = 0;
while ((the_thread =
_Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
520b0: 4282 clrl %d2 520b2: 283c 0005 438c movel #344972,%d4
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
520b8: 4bf9 0005 a388 lea 5a388 <memcpy>,%a5 520be: 601a bras 520da <_CORE_message_queue_Broadcast+0x52>
* send and receive and this ensures that we are broadcasting
* the message to threads waiting to receive -- not to send.
*/
if ( the_message_queue->number_of_pending_messages != 0 ) {
*count = 0;
520c0: 4294 clrl %a4@ 520c2: 6026 bras 520ea <_CORE_message_queue_Broadcast+0x62> 520c4: 2f03 movel %d3,%sp@-
*/
number_broadcasted = 0;
while ((the_thread =
_Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
waitp = &the_thread->Wait;
number_broadcasted += 1;
520c6: 5282 addql #1,%d2 520c8: 2f05 movel %d5,%sp@- 520ca: 2f2b 002c movel %a3@(44),%sp@- 520ce: 4e95 jsr %a5@
buffer,
waitp->return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
520d0: 206b 0028 moveal %a3@(40),%a0 520d4: 4fef 000c lea %sp@(12),%sp 520d8: 2083 movel %d3,%a0@
* There must be no pending messages if there is a thread waiting to
* receive a message.
*/
number_broadcasted = 0;
while ((the_thread =
_Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
520da: 2f0a movel %a2,%sp@- 520dc: 2044 moveal %d4,%a0 520de: 4e90 jsr %a0@
/* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread =
520e0: 588f addql #4,%sp
_Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
520e2: 2640 moveal %d0,%a3
/* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread =
520e4: 4a80 tstl %d0 520e6: 66dc bnes 520c4 <_CORE_message_queue_Broadcast+0x3c>
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
(*api_message_queue_mp_support) ( the_thread, id );
#endif
}
*count = number_broadcasted;
520e8: 2882 movel %d2,%a4@ 520ea: 4280 clrl %d0
return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; }
520ec: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 520f2: 4e5e unlk %fp 520f4: 4e75 rts
...
0004dc30 <_CORE_message_queue_Initialize>:
/*
* 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)) {
4dc30: 7003 moveq #3,%d0
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
)
{
4dc32: 4e56 fff4 linkw %fp,#-12 4dc36: 222e 0014 movel %fp@(20),%d1 4dc3a: 48d7 040c moveml %d2-%d3/%a2,%sp@ 4dc3e: 246e 0008 moveal %fp@(8),%a2 4dc42: 242e 0010 movel %fp@(16),%d2
/*
* 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)) {
4dc46: c081 andl %d1,%d0
)
{
size_t message_buffering_required;
size_t allocated_message_size;
the_message_queue->maximum_pending_messages = maximum_pending_messages;
4dc48: 2542 0044 movel %d2,%a2@(68)
the_message_queue->number_of_pending_messages = 0;
4dc4c: 42aa 0048 clrl %a2@(72)
the_message_queue->maximum_message_size = maximum_message_size;
4dc50: 2541 004c movel %d1,%a2@(76)
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Notify_Handler the_handler,
void *the_argument
)
{
the_message_queue->notify_handler = the_handler;
4dc54: 42aa 0060 clrl %a2@(96)
the_message_queue->notify_argument = the_argument;
4dc58: 42aa 0064 clrl %a2@(100)
/*
* 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)) {
4dc5c: 4a80 tstl %d0 4dc5e: 6604 bnes 4dc64 <_CORE_message_queue_Initialize+0x34> 4dc60: 2001 movel %d1,%d0 4dc62: 600c bras 4dc70 <_CORE_message_queue_Initialize+0x40>
allocated_message_size += sizeof(uint32_t);
4dc64: 2001 movel %d1,%d0 4dc66: 5880 addql #4,%d0
allocated_message_size &= ~(sizeof(uint32_t) - 1);
4dc68: 76fc moveq #-4,%d3 4dc6a: c083 andl %d3,%d0
}
if (allocated_message_size < maximum_message_size)
4dc6c: b280 cmpl %d0,%d1 4dc6e: 626e bhis 4dcde <_CORE_message_queue_Initialize+0xae>
/*
* 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));
4dc70: 2600 movel %d0,%d3 4dc72: 0683 0000 0014 addil #20,%d3
/*
* 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 *
4dc78: 2203 movel %d3,%d1 4dc7a: 4c02 1800 mulsl %d2,%d1
(allocated_message_size + sizeof(CORE_message_queue_Buffer_control));
if (message_buffering_required < allocated_message_size)
4dc7e: b081 cmpl %d1,%d0 4dc80: 625c bhis 4dcde <_CORE_message_queue_Initialize+0xae>
return false;
/*
* Attempt to allocate the message memory
*/
the_message_queue->message_buffers = (CORE_message_queue_Buffer *)
4dc82: 2f01 movel %d1,%sp@- 4dc84: 4eb9 0005 05e8 jsr 505e8 <_Workspace_Allocate>
_Workspace_Allocate( message_buffering_required );
if (the_message_queue->message_buffers == 0)
4dc8a: 588f addql #4,%sp
return false;
/*
* Attempt to allocate the message memory
*/
the_message_queue->message_buffers = (CORE_message_queue_Buffer *)
4dc8c: 2540 005c movel %d0,%a2@(92)
_Workspace_Allocate( message_buffering_required );
if (the_message_queue->message_buffers == 0)
4dc90: 674c beqs 4dcde <_CORE_message_queue_Initialize+0xae>
/*
* Initialize the pool of inactive messages, pending messages,
* and set of waiting threads.
*/
_Chain_Initialize (
4dc92: 2f03 movel %d3,%sp@- 4dc94: 2f02 movel %d2,%sp@- 4dc96: 2f00 movel %d0,%sp@- 4dc98: 486a 0068 pea %a2@(104) 4dc9c: 4eb9 0005 2534 jsr 52534 <_Chain_Initialize>
allocated_message_size + sizeof( CORE_message_queue_Buffer_control )
);
_Chain_Initialize_empty( &the_message_queue->Pending_messages );
_Thread_queue_Initialize(
4dca2: 4878 0006 pea 6 <EXTENDSFDF> 4dca6: 7001 moveq #1,%d0 4dca8: 206e 000c moveal %fp@(12),%a0 4dcac: b090 cmpl %a0@,%d0 4dcae: 57c0 seq %d0 4dcb0: 4878 0080 pea 80 <DBL_MANT_DIG+0x4b> 4dcb4: 49c0 extbl %d0 4dcb6: 4480 negl %d0
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
4dcb8: 41ea 0054 lea %a2@(84),%a0 4dcbc: 2f00 movel %d0,%sp@- 4dcbe: 2548 0050 movel %a0,%a2@(80)
the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain);
4dcc2: 41ea 0050 lea %a2@(80),%a0 4dcc6: 2548 0058 movel %a0,%a2@(88) 4dcca: 2f0a movel %a2,%sp@-
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
the_chain->permanent_null = NULL;
4dccc: 42aa 0054 clrl %a2@(84) 4dcd0: 4eb9 0004 faf4 jsr 4faf4 <_Thread_queue_Initialize>
THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO,
STATES_WAITING_FOR_MESSAGE,
CORE_MESSAGE_QUEUE_STATUS_TIMEOUT
);
return true;
4dcd6: 4fef 0020 lea %sp@(32),%sp
allocated_message_size + sizeof( CORE_message_queue_Buffer_control )
);
_Chain_Initialize_empty( &the_message_queue->Pending_messages );
_Thread_queue_Initialize(
4dcda: 7001 moveq #1,%d0
THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO,
STATES_WAITING_FOR_MESSAGE,
CORE_MESSAGE_QUEUE_STATUS_TIMEOUT
);
return true;
4dcdc: 6002 bras 4dce0 <_CORE_message_queue_Initialize+0xb0> 4dcde: 4200 clrb %d0
}
4dce0: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 4dce6: 4e5e unlk %fp 4dce8: 4e75 rts
...
00052574 <_CORE_message_queue_Insert_message>:
void _CORE_message_queue_Insert_message(
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Buffer_control *the_message,
CORE_message_queue_Submit_types submit_type
)
{
52574: 4e56 0000 linkw %fp,#0 52578: 226e 000c moveal %fp@(12),%a1 5257c: 2f0b movel %a3,%sp@- 5257e: 202e 0010 movel %fp@(16),%d0 52582: 206e 0008 moveal %fp@(8),%a0 52586: 2f0a movel %a2,%sp@- 52588: 2340 0008 movel %d0,%a1@(8)
_CORE_message_queue_Append_unprotected(the_message_queue, the_message);
else
_CORE_message_queue_Prepend_unprotected(the_message_queue, the_message);
_ISR_Enable( level );
#else
if ( submit_type == CORE_MESSAGE_QUEUE_SEND_REQUEST ) {
5258c: 0c80 7fff ffff cmpil #2147483647,%d0 52592: 6628 bnes 525bc <_CORE_message_queue_Insert_message+0x48>
_ISR_Disable( level );
52594: 203c 0000 0700 movel #1792,%d0 5259a: 40c1 movew %sr,%d1 5259c: 8081 orl %d1,%d0 5259e: 46c0 movew %d0,%sr
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
525a0: 45e8 0054 lea %a0@(84),%a2
SET_NOTIFY();
the_message_queue->number_of_pending_messages++;
525a4: 52a8 0048 addql #1,%a0@(72) 525a8: 228a movel %a2,%a1@
old_last_node = the_chain->last;
525aa: 2468 0058 moveal %a0@(88),%a2
the_chain->last = the_node;
525ae: 2149 0058 movel %a1,%a0@(88)
old_last_node->next = the_node; the_node->previous = old_last_node;
525b2: 234a 0004 movel %a2,%a1@(4)
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
525b6: 2489 movel %a1,%a2@
_CORE_message_queue_Append_unprotected(the_message_queue, the_message);
_ISR_Enable( level );
525b8: 46c1 movew %d1,%sr 525ba: 606c bras 52628 <_CORE_message_queue_Insert_message+0xb4>
} else if ( submit_type == CORE_MESSAGE_QUEUE_URGENT_REQUEST ) {
525bc: 0c80 8000 0000 cmpil #-2147483648,%d0 525c2: 6626 bnes 525ea <_CORE_message_queue_Insert_message+0x76>
_ISR_Disable( level );
525c4: 203c 0000 0700 movel #1792,%d0 525ca: 40c1 movew %sr,%d1 525cc: 8081 orl %d1,%d0 525ce: 46c0 movew %d0,%sr
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Head(
Chain_Control *the_chain
)
{
return (Chain_Node *) the_chain;
525d0: 45e8 0050 lea %a0@(80),%a2
SET_NOTIFY();
the_message_queue->number_of_pending_messages++;
525d4: 52a8 0048 addql #1,%a0@(72)
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
525d8: 2652 moveal %a2@,%a3
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
525da: 234a 0004 movel %a2,%a1@(4)
before_node = after_node->next; after_node->next = the_node;
525de: 2489 movel %a1,%a2@
the_node->next = before_node; before_node->previous = the_node;
525e0: 2749 0004 movel %a1,%a3@(4)
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
525e4: 228b movel %a3,%a1@
_CORE_message_queue_Prepend_unprotected(the_message_queue, the_message);
_ISR_Enable( level );
525e6: 46c1 movew %d1,%sr 525e8: 603e bras 52628 <_CORE_message_queue_Insert_message+0xb4>
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
525ea: 2208 movel %a0,%d1 525ec: 0681 0000 0054 addil #84,%d1
Chain_Control *the_header;
int the_priority;
the_priority = _CORE_message_queue_Get_message_priority(the_message);
the_header = &the_message_queue->Pending_messages;
the_node = the_header->first;
525f2: 2468 0050 moveal %a0@(80),%a2
while ( !_Chain_Is_tail( the_header, the_node ) ) {
525f6: 6008 bras 52600 <_CORE_message_queue_Insert_message+0x8c>
RTEMS_INLINE_ROUTINE int _CORE_message_queue_Get_message_priority (
CORE_message_queue_Buffer_control *the_message
)
{
#if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY)
return the_message->priority;
525f8: b0aa 0008 cmpl %a2@(8),%d0 525fc: 6d06 blts 52604 <_CORE_message_queue_Insert_message+0x90>
this_message = (CORE_message_queue_Buffer_control *) the_node;
this_priority = _CORE_message_queue_Get_message_priority(this_message);
if ( this_priority <= the_priority ) {
the_node = the_node->next;
525fe: 2452 moveal %a2@,%a2
int the_priority;
the_priority = _CORE_message_queue_Get_message_priority(the_message);
the_header = &the_message_queue->Pending_messages;
the_node = the_header->first;
while ( !_Chain_Is_tail( the_header, the_node ) ) {
52600: b28a cmpl %a2,%d1 52602: 66f4 bnes 525f8 <_CORE_message_queue_Insert_message+0x84>
the_node = the_node->next;
continue;
}
break;
}
_ISR_Disable( level );
52604: 203c 0000 0700 movel #1792,%d0 5260a: 40c1 movew %sr,%d1 5260c: 8081 orl %d1,%d0 5260e: 46c0 movew %d0,%sr
SET_NOTIFY();
the_message_queue->number_of_pending_messages++;
_Chain_Insert_unprotected( the_node->previous, &the_message->Node );
52610: 246a 0004 moveal %a2@(4),%a2
}
break;
}
_ISR_Disable( level );
SET_NOTIFY();
the_message_queue->number_of_pending_messages++;
52614: 52a8 0048 addql #1,%a0@(72)
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
52618: 2652 moveal %a2@,%a3
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
5261a: 234a 0004 movel %a2,%a1@(4)
before_node = after_node->next; after_node->next = the_node;
5261e: 2489 movel %a1,%a2@
the_node->next = before_node; before_node->previous = the_node;
52620: 2749 0004 movel %a1,%a3@(4)
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
52624: 228b movel %a3,%a1@
_Chain_Insert_unprotected( the_node->previous, &the_message->Node );
_ISR_Enable( level );
52626: 46c1 movew %d1,%sr
/*
* According to POSIX, does this happen before or after the message
* is actually enqueued. It is logical to think afterwards, because
* the message is actually in the queue at this point.
*/
if ( notify && the_message_queue->notify_handler )
52628: 2268 0060 moveal %a0@(96),%a1 5262c: 4a89 tstl %a1 5262e: 670e beqs 5263e <_CORE_message_queue_Insert_message+0xca>
(*the_message_queue->notify_handler)(the_message_queue->notify_argument);
52630: 2d68 0064 0008 movel %a0@(100),%fp@(8)
#endif }
52636: 245f moveal %sp@+,%a2 52638: 265f moveal %sp@+,%a3 5263a: 4e5e unlk %fp
* According to POSIX, does this happen before or after the message
* is actually enqueued. It is logical to think afterwards, because
* the message is actually in the queue at this point.
*/
if ( notify && the_message_queue->notify_handler )
(*the_message_queue->notify_handler)(the_message_queue->notify_argument);
5263c: 4ed1 jmp %a1@
#endif }
5263e: 245f moveal %sp@+,%a2 52640: 265f moveal %sp@+,%a3 52642: 4e5e unlk %fp 52644: 4e75 rts
...
0004dcec <_CORE_message_queue_Seize>:
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
_ISR_Disable( level );
4dcec: 223c 0000 0700 movel #1792,%d1
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
4dcf2: 4e56 ffe0 linkw %fp,#-32
ISR_Level level;
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
executing = _Thread_Executing;
4dcf6: 2079 0006 6302 moveal 66302 <_Thread_Executing>,%a0
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
4dcfc: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 4dd00: 282e 000c movel %fp@(12),%d4 4dd04: 242e 001c movel %fp@(28),%d2 4dd08: 246e 0008 moveal %fp@(8),%a2
ISR_Level level;
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
4dd0c: 42a8 0034 clrl %a0@(52)
void *buffer,
size_t *size_p,
bool wait,
Watchdog_Interval timeout
)
{
4dd10: 262e 0010 movel %fp@(16),%d3 4dd14: 226e 0014 moveal %fp@(20),%a1 4dd18: 1a2e 001b moveb %fp@(27),%d5
CORE_message_queue_Buffer_control *the_message;
Thread_Control *executing;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
_ISR_Disable( level );
4dd1c: 40c0 movew %sr,%d0 4dd1e: 8280 orl %d0,%d1 4dd20: 46c1 movew %d1,%sr
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
4dd22: 220a movel %a2,%d1 4dd24: 0681 0000 0054 addil #84,%d1
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
Chain_Control *the_chain
)
{
return (the_chain->first == _Chain_Tail(the_chain));
4dd2a: 266a 0050 moveal %a2@(80),%a3
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
4dd2e: b28b cmpl %a3,%d1 4dd30: 6700 00a6 beqw 4ddd8 <_CORE_message_queue_Seize+0xec>
{
Chain_Node *return_node;
Chain_Node *new_first;
return_node = the_chain->first;
new_first = return_node->next;
4dd34: 2853 moveal %a3@,%a4
the_chain->first = new_first; new_first->previous = _Chain_Head(the_chain);
4dd36: 4bea 0050 lea %a2@(80),%a5
Chain_Node *return_node;
Chain_Node *new_first;
return_node = the_chain->first;
new_first = return_node->next;
the_chain->first = new_first;
4dd3a: 254c 0050 movel %a4,%a2@(80)
new_first->previous = _Chain_Head(the_chain);
4dd3e: 294d 0004 movel %a5,%a4@(4)
the_message = _CORE_message_queue_Get_pending_message( the_message_queue );
if ( the_message != NULL ) {
4dd42: 4a8b tstl %a3 4dd44: 6700 0092 beqw 4ddd8 <_CORE_message_queue_Seize+0xec>
the_message_queue->number_of_pending_messages -= 1;
4dd48: 53aa 0048 subql #1,%a2@(72)
_ISR_Enable( level );
4dd4c: 46c0 movew %d0,%sr
*size_p = the_message->Contents.size;
_Thread_Executing->Wait.count =
4dd4e: 2079 0006 6302 moveal 66302 <_Thread_Executing>,%a0
the_message = _CORE_message_queue_Get_pending_message( the_message_queue );
if ( the_message != NULL ) {
the_message_queue->number_of_pending_messages -= 1;
_ISR_Enable( level );
*size_p = the_message->Contents.size;
4dd54: 22ab 000c movel %a3@(12),%a1@
_Thread_Executing->Wait.count =
_CORE_message_queue_Get_message_priority( the_message );
_CORE_message_queue_Copy_buffer(
the_message->Contents.buffer,
4dd58: 240b movel %a3,%d2 4dd5a: 0682 0000 0010 addil #16,%d2
if ( the_message != NULL ) {
the_message_queue->number_of_pending_messages -= 1;
_ISR_Enable( level );
*size_p = the_message->Contents.size;
_Thread_Executing->Wait.count =
4dd60: 216b 0008 0024 movel %a3@(8),%a0@(36)
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
4dd66: 49f9 0005 5548 lea 55548 <memcpy>,%a4 4dd6c: 2f11 movel %a1@,%sp@- 4dd6e: 2f02 movel %d2,%sp@- 4dd70: 2f03 movel %d3,%sp@- 4dd72: 4e94 jsr %a4@
* is not, then we can go ahead and free the buffer.
*
* NOTE: If we note that the queue was not full before this receive,
* then we can avoid this dequeue.
*/
the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue );
4dd74: 2f0a movel %a2,%sp@- 4dd76: 4eb9 0004 f784 jsr 4f784 <_Thread_queue_Dequeue>
if ( !the_thread ) {
4dd7c: 4fef 0010 lea %sp@(16),%sp
* is not, then we can go ahead and free the buffer.
*
* NOTE: If we note that the queue was not full before this receive,
* then we can avoid this dequeue.
*/
the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue );
4dd80: 2040 moveal %d0,%a0
if ( !the_thread ) {
4dd82: 4a80 tstl %d0 4dd84: 661a bnes 4dda0 <_CORE_message_queue_Seize+0xb4>
RTEMS_INLINE_ROUTINE void _CORE_message_queue_Free_message_buffer (
CORE_message_queue_Control *the_message_queue,
CORE_message_queue_Buffer_control *the_message
)
{
_Chain_Append( &the_message_queue->Inactive_messages, &the_message->Node );
4dd86: 45ea 0068 lea %a2@(104),%a2 4dd8a: 2d4b 000c movel %a3,%fp@(12) 4dd8e: 2d4a 0008 movel %a2,%fp@(8)
executing->Wait.return_argument = size_p;
/* Wait.count will be filled in with the message priority */
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
}
4dd92: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4dd98: 4e5e unlk %fp 4dd9a: 4ef9 0004 db6c jmp 4db6c <_Chain_Append>
*/
_CORE_message_queue_Set_message_priority(
the_message,
the_thread->Wait.count
);
the_message->Contents.size = (size_t) the_thread->Wait.option;
4dda0: 2028 0030 movel %a0@(48),%d0
CORE_message_queue_Buffer_control *the_message,
int priority
)
{
#if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY)
the_message->priority = priority;
4dda4: 2768 0024 0008 movel %a0@(36),%a3@(8) 4ddaa: 2740 000c movel %d0,%a3@(12)
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
4ddae: 2f00 movel %d0,%sp@- 4ddb0: 2f28 002c movel %a0@(44),%sp@- 4ddb4: 2f02 movel %d2,%sp@- 4ddb6: 4e94 jsr %a4@
the_thread->Wait.return_argument_second.immutable_object,
the_message->Contents.buffer,
the_message->Contents.size
);
_CORE_message_queue_Insert_message(
4ddb8: 2d6b 0008 0010 movel %a3@(8),%fp@(16) 4ddbe: 4fef 000c lea %sp@(12),%sp 4ddc2: 2d4b 000c movel %a3,%fp@(12) 4ddc6: 2d4a 0008 movel %a2,%fp@(8)
executing->Wait.return_argument = size_p;
/* Wait.count will be filled in with the message priority */
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
}
4ddca: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4ddd0: 4e5e unlk %fp
the_thread->Wait.return_argument_second.immutable_object,
the_message->Contents.buffer,
the_message->Contents.size
);
_CORE_message_queue_Insert_message(
4ddd2: 4ef9 0005 2574 jmp 52574 <_CORE_message_queue_Insert_message>
return;
}
#endif
}
if ( !wait ) {
4ddd8: 4a05 tstb %d5 4ddda: 6612 bnes 4ddee <_CORE_message_queue_Seize+0x102>
_ISR_Enable( level );
4dddc: 46c0 movew %d0,%sr
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT;
4ddde: 7004 moveq #4,%d0
executing->Wait.return_argument = size_p;
/* Wait.count will be filled in with the message priority */
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
}
4dde0: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5
#endif
}
if ( !wait ) {
_ISR_Enable( level );
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT;
4dde6: 2140 0034 movel %d0,%a0@(52)
executing->Wait.return_argument = size_p;
/* Wait.count will be filled in with the message priority */
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
}
4ddea: 4e5e unlk %fp 4ddec: 4e75 rts
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;
4ddee: 7201 moveq #1,%d1 4ddf0: 2541 0030 movel %d1,%a2@(48)
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
executing->Wait.return_argument_second.mutable_object = buffer;
executing->Wait.return_argument = size_p;
4ddf4: 2149 0028 movel %a1,%a0@(40)
}
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
executing->Wait.return_argument_second.mutable_object = buffer;
4ddf8: 2143 002c movel %d3,%a0@(44)
return;
}
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
4ddfc: 2144 0020 movel %d4,%a0@(32)
executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT;
return;
}
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
4de00: 214a 0044 movel %a2,%a0@(68)
executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level );
4de04: 46c0 movew %d0,%sr
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
4de06: 4bf9 0004 fbb0 lea 4fbb0 <_Thread_queue_Timeout>,%a5 4de0c: 2d42 000c movel %d2,%fp@(12) 4de10: 2d4d 0010 movel %a5,%fp@(16) 4de14: 2d4a 0008 movel %a2,%fp@(8)
}
4de18: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4de1e: 4e5e unlk %fp
executing->Wait.return_argument_second.mutable_object = buffer;
executing->Wait.return_argument = size_p;
/* Wait.count will be filled in with the message priority */
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
4de20: 4ef9 0004 f8c4 jmp 4f8c4 <_Thread_queue_Enqueue_with_handler>
...
0004de28 <_CORE_message_queue_Submit>:
#endif
CORE_message_queue_Submit_types submit_type,
bool wait,
Watchdog_Interval timeout
)
{
4de28: 4e56 ffe8 linkw %fp,#-24 4de2c: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 4de30: 246e 0008 moveal %fp@(8),%a2 4de34: 282e 000c movel %fp@(12),%d4 4de38: 242e 0010 movel %fp@(16),%d2 4de3c: 262e 001c movel %fp@(28),%d3 4de40: 1a2e 0023 moveb %fp@(35),%d5
CORE_message_queue_Buffer_control *the_message;
Thread_Control *the_thread;
if ( size > the_message_queue->maximum_message_size ) {
4de44: b4aa 004c cmpl %a2@(76),%d2 4de48: 6306 blss 4de50 <_CORE_message_queue_Submit+0x28> 4de4a: 7001 moveq #1,%d0 4de4c: 6000 00d6 braw 4df24 <_CORE_message_queue_Submit+0xfc>
}
/*
* Is there a thread currently waiting on this message queue?
*/
if ( the_message_queue->number_of_pending_messages == 0 ) {
4de50: 4aaa 0048 tstl %a2@(72) 4de54: 6632 bnes 4de88 <_CORE_message_queue_Submit+0x60>
the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue );
4de56: 2f0a movel %a2,%sp@- 4de58: 4eb9 0004 f784 jsr 4f784 <_Thread_queue_Dequeue>
if ( the_thread ) {
4de5e: 588f addql #4,%sp
/*
* Is there a thread currently waiting on this message queue?
*/
if ( the_message_queue->number_of_pending_messages == 0 ) {
the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue );
4de60: 2640 moveal %d0,%a3
if ( the_thread ) {
4de62: 4a80 tstl %d0 4de64: 6722 beqs 4de88 <_CORE_message_queue_Submit+0x60> 4de66: 2f02 movel %d2,%sp@- 4de68: 2f04 movel %d4,%sp@- 4de6a: 2f2b 002c movel %a3@(44),%sp@- 4de6e: 4eb9 0005 5548 jsr 55548 <memcpy>
_CORE_message_queue_Copy_buffer(
buffer,
the_thread->Wait.return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
4de74: 206b 0028 moveal %a3@(40),%a0
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
(*api_message_queue_mp_support) ( the_thread, id );
#endif
return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
4de78: 4fef 000c lea %sp@(12),%sp
buffer,
the_thread->Wait.return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
the_thread->Wait.count = (uint32_t) submit_type;
4de7c: 4280 clrl %d0
_CORE_message_queue_Copy_buffer(
buffer,
the_thread->Wait.return_argument_second.mutable_object,
size
);
*(size_t *) the_thread->Wait.return_argument = size;
4de7e: 2082 movel %d2,%a0@
the_thread->Wait.count = (uint32_t) submit_type;
4de80: 2743 0024 movel %d3,%a3@(36)
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
(*api_message_queue_mp_support) ( the_thread, id );
#endif
return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
4de84: 6000 009e braw 4df24 <_CORE_message_queue_Submit+0xfc>
/*
* No one waiting on the message queue at this time, so attempt to
* queue the message up for a future receive.
*/
if ( the_message_queue->number_of_pending_messages <
the_message_queue->maximum_pending_messages ) {
4de88: 202a 0044 movel %a2@(68),%d0 4de8c: b0aa 0048 cmpl %a2@(72),%d0 4de90: 6336 blss 4dec8 <_CORE_message_queue_Submit+0xa0>
RTEMS_INLINE_ROUTINE CORE_message_queue_Buffer_control *
_CORE_message_queue_Allocate_message_buffer (
CORE_message_queue_Control *the_message_queue
)
{
return (CORE_message_queue_Buffer_control *)
4de92: 486a 0068 pea %a2@(104) 4de96: 4eb9 0004 dbcc jsr 4dbcc <_Chain_Get> 4de9c: 2640 moveal %d0,%a3
const void *source,
void *destination,
size_t size
)
{
memcpy(destination, source, size);
4de9e: 2f02 movel %d2,%sp@- 4dea0: 2f04 movel %d4,%sp@- 4dea2: 486b 0010 pea %a3@(16) 4dea6: 4eb9 0005 5548 jsr 55548 <memcpy>
_CORE_message_queue_Copy_buffer(
buffer,
the_message->Contents.buffer,
size
);
the_message->Contents.size = size;
4deac: 2742 000c movel %d2,%a3@(12)
CORE_message_queue_Buffer_control *the_message,
int priority
)
{
#if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY)
the_message->priority = priority;
4deb0: 2743 0008 movel %d3,%a3@(8)
_CORE_message_queue_Set_message_priority( the_message, submit_type );
_CORE_message_queue_Insert_message(
4deb4: 2f03 movel %d3,%sp@- 4deb6: 2f0b movel %a3,%sp@- 4deb8: 2f0a movel %a2,%sp@- 4deba: 4eb9 0005 2574 jsr 52574 <_CORE_message_queue_Insert_message>
the_message_queue,
the_message,
submit_type
);
return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
4dec0: 4fef 001c lea %sp@(28),%sp
size
);
the_message->Contents.size = size;
_CORE_message_queue_Set_message_priority( the_message, submit_type );
_CORE_message_queue_Insert_message(
4dec4: 4280 clrl %d0
the_message_queue,
the_message,
submit_type
);
return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
4dec6: 605c bras 4df24 <_CORE_message_queue_Submit+0xfc>
/*
* No message buffers were available so we may need to return an
* overflow error or block the sender until the message is placed
* on the queue.
*/
if ( !wait ) {
4dec8: 4a05 tstb %d5 4deca: 6604 bnes 4ded0 <_CORE_message_queue_Submit+0xa8> 4decc: 7002 moveq #2,%d0 4dece: 6054 bras 4df24 <_CORE_message_queue_Submit+0xfc>
/*
* Do NOT block on a send if the caller is in an ISR. It is
* deadly to block in an ISR.
*/
if ( _ISR_Is_in_progress() ) {
4ded0: 2039 0006 62e2 movel 662e2 <_ISR_Nest_level>,%d0 4ded6: 6704 beqs 4dedc <_CORE_message_queue_Submit+0xb4> 4ded8: 7003 moveq #3,%d0 4deda: 6048 bras 4df24 <_CORE_message_queue_Submit+0xfc>
* Thus the unusual choice to open a new scope and declare
* it as a variable. Doing this emphasizes how dangerous it
* would be to use this variable prior to here.
*/
{
Thread_Control *executing = _Thread_Executing;
4dedc: 2079 0006 6302 moveal 66302 <_Thread_Executing>,%a0
ISR_Level level;
_ISR_Disable( level );
4dee2: 203c 0000 0700 movel #1792,%d0 4dee8: 40c1 movew %sr,%d1 4deea: 8081 orl %d1,%d0 4deec: 46c0 movew %d0,%sr 4deee: 7001 moveq #1,%d0
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
4def0: 216e 0014 0020 movel %fp@(20),%a0@(32) 4def6: 2540 0030 movel %d0,%a2@(48)
executing->Wait.return_argument_second.immutable_object = buffer;
executing->Wait.option = (uint32_t) size;
executing->Wait.count = submit_type;
4defa: 2143 0024 movel %d3,%a0@(36)
_ISR_Disable( level );
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
executing->Wait.id = id;
executing->Wait.return_argument_second.immutable_object = buffer;
4defe: 2144 002c movel %d4,%a0@(44)
executing->Wait.option = (uint32_t) size;
4df02: 2142 0030 movel %d2,%a0@(48)
Thread_Control *executing = _Thread_Executing;
ISR_Level level;
_ISR_Disable( level );
_Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue );
executing->Wait.queue = &the_message_queue->Wait_queue;
4df06: 214a 0044 movel %a2,%a0@(68)
executing->Wait.id = id;
executing->Wait.return_argument_second.immutable_object = buffer;
executing->Wait.option = (uint32_t) size;
executing->Wait.count = submit_type;
_ISR_Enable( level );
4df0a: 46c1 movew %d1,%sr
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
4df0c: 4879 0004 fbb0 pea 4fbb0 <_Thread_queue_Timeout> 4df12: 2f2e 0024 movel %fp@(36),%sp@- 4df16: 2f0a movel %a2,%sp@- 4df18: 4eb9 0004 f8c4 jsr 4f8c4 <_Thread_queue_Enqueue_with_handler>
}
return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT;
4df1e: 4fef 000c lea %sp@(12),%sp
executing->Wait.return_argument_second.immutable_object = buffer;
executing->Wait.option = (uint32_t) size;
executing->Wait.count = submit_type;
_ISR_Enable( level );
_Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout );
4df22: 7007 moveq #7,%d0
}
return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT;
#endif
}
4df24: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 4df2a: 4e5e unlk %fp 4df2c: 4e75 rts
...
00045a20 <_CORE_mutex_Seize>:
Objects_Id _id,
bool _wait,
Watchdog_Interval _timeout,
ISR_Level _level
)
{
45a20: 4e56 0000 linkw %fp,#0 45a24: 202e 0010 movel %fp@(16),%d0 45a28: 2f0a movel %a2,%sp@- 45a2a: 246e 0008 moveal %fp@(8),%a2 45a2e: 2f02 movel %d2,%sp@-
_CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level );
45a30: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1
Objects_Id _id,
bool _wait,
Watchdog_Interval _timeout,
ISR_Level _level
)
{
45a36: 1400 moveb %d0,%d2
_CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level );
45a38: 4a81 tstl %d1 45a3a: 671c beqs 45a58 <_CORE_mutex_Seize+0x38> 45a3c: 4a00 tstb %d0 45a3e: 6718 beqs 45a58 <_CORE_mutex_Seize+0x38> 45a40: 7001 moveq #1,%d0 45a42: b0b9 0005 ce1c cmpl 5ce1c <_System_state_Current>,%d0 45a48: 640e bccs 45a58 <_CORE_mutex_Seize+0x38> 45a4a: 4878 0013 pea 13 <INVALID_OPERATION+0x3> 45a4e: 42a7 clrl %sp@- 45a50: 42a7 clrl %sp@- 45a52: 4eb9 0004 5fd8 jsr 45fd8 <_Internal_error_Occurred> 45a58: 486e 0018 pea %fp@(24) 45a5c: 2f0a movel %a2,%sp@- 45a5e: 4eb9 0004 a07c jsr 4a07c <_CORE_mutex_Seize_interrupt_trylock> 45a64: 508f addql #8,%sp 45a66: 4a80 tstl %d0 45a68: 6750 beqs 45aba <_CORE_mutex_Seize+0x9a> 45a6a: 4a02 tstb %d2 45a6c: 6614 bnes 45a82 <_CORE_mutex_Seize+0x62> 45a6e: 202e 0018 movel %fp@(24),%d0 45a72: 46c0 movew %d0,%sr 45a74: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 45a7a: 7001 moveq #1,%d0 45a7c: 2140 0034 movel %d0,%a0@(52) 45a80: 6038 bras 45aba <_CORE_mutex_Seize+0x9a> 45a82: 2039 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d0 45a88: 5280 addql #1,%d0 45a8a: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 45a90: 216e 000c 0020 movel %fp@(12),%a0@(32) 45a96: 23c0 0005 cc94 movel %d0,5cc94 <_Thread_Dispatch_disable_level>
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;
45a9c: 7001 moveq #1,%d0 45a9e: 214a 0044 movel %a2,%a0@(68) 45aa2: 2540 0030 movel %d0,%a2@(48) 45aa6: 202e 0018 movel %fp@(24),%d0 45aaa: 46c0 movew %d0,%sr 45aac: 2f2e 0014 movel %fp@(20),%sp@- 45ab0: 2f0a movel %a2,%sp@- 45ab2: 4eb9 0004 59bc jsr 459bc <_CORE_mutex_Seize_interrupt_blocking> 45ab8: 508f addql #8,%sp
}
45aba: 242e fff8 movel %fp@(-8),%d2 45abe: 246e fffc moveal %fp@(-4),%a2 45ac2: 4e5e unlk %fp 45ac4: 4e75 rts
...
00045ac8 <_CORE_mutex_Surrender>:
#else
Objects_Id id __attribute__((unused)),
CORE_mutex_API_mp_support_callout api_mutex_mp_support __attribute__((unused))
#endif
)
{
45ac8: 4e56 0000 linkw %fp,#0 45acc: 2f0a movel %a2,%sp@- 45ace: 246e 0008 moveal %fp@(8),%a2
Thread_Control *the_thread; Thread_Control *holder; #ifdef __RTEMS_STRICT_ORDER_MUTEX__ Chain_Node *first_node; #endif holder = the_mutex->holder;
45ad2: 206a 005a moveal %a2@(90),%a0
* allowed when the mutex in quetion is FIFO or simple Priority
* discipline. But Priority Ceiling or Priority Inheritance mutexes
* must be released by the thread which acquired them.
*/
if ( the_mutex->Attributes.only_owner_release ) {
45ad6: 4a2a 0044 tstb %a2@(68) 45ada: 670e beqs 45aea <_CORE_mutex_Surrender+0x22>
if ( !_Thread_Is_executing( holder ) )
45adc: b1f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a0 45ae2: 6706 beqs 45aea <_CORE_mutex_Surrender+0x22> 45ae4: 7003 moveq #3,%d0 45ae6: 6000 00ce braw 45bb6 <_CORE_mutex_Surrender+0xee>
return CORE_MUTEX_STATUS_NOT_OWNER_OF_RESOURCE;
}
/* XXX already unlocked -- not right status */
if ( !the_mutex->nest_count )
45aea: 202a 0052 movel %a2@(82),%d0 45aee: 6700 00c4 beqw 45bb4 <_CORE_mutex_Surrender+0xec>
return CORE_MUTEX_STATUS_SUCCESSFUL;
the_mutex->nest_count--;
45af2: 5380 subql #1,%d0 45af4: 2540 0052 movel %d0,%a2@(82)
if ( the_mutex->nest_count != 0 ) {
45af8: 6600 00ba bnew 45bb4 <_CORE_mutex_Surrender+0xec> 45afc: 202a 0046 movel %a2@(70),%d0
/*
* Formally release the mutex before possibly transferring it to a
* blocked thread.
*/
if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
45b00: 7202 moveq #2,%d1 45b02: b280 cmpl %d0,%d1 45b04: 6708 beqs 45b0e <_CORE_mutex_Surrender+0x46> 45b06: 123c 0003 moveb #3,%d1 45b0a: b280 cmpl %d0,%d1 45b0c: 6604 bnes 45b12 <_CORE_mutex_Surrender+0x4a>
the_mutex->nest_count++;
return CORE_MUTEX_RELEASE_NOT_ORDER;
}
first_node = _Chain_Get_first_unprotected(&holder->lock_mutex);
#endif
holder->resource_count--;
45b0e: 53a8 001c subql #1,%a0@(28) 45b12: 202a 0046 movel %a2@(70),%d0
/* * Whether or not someone is waiting for the mutex, an * inherited priority must be lowered if this is the last * mutex (i.e. resource) this task has. */ if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
45b16: 7202 moveq #2,%d1
}
first_node = _Chain_Get_first_unprotected(&holder->lock_mutex);
#endif
holder->resource_count--;
}
the_mutex->holder = NULL;
45b18: 42aa 005a clrl %a2@(90)
the_mutex->holder_id = 0;
45b1c: 42aa 005e clrl %a2@(94)
/* * Whether or not someone is waiting for the mutex, an * inherited priority must be lowered if this is the last * mutex (i.e. resource) this task has. */ if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
45b20: b280 cmpl %d0,%d1 45b22: 6708 beqs 45b2c <_CORE_mutex_Surrender+0x64> 45b24: 123c 0003 moveb #3,%d1 45b28: b280 cmpl %d0,%d1 45b2a: 6622 bnes 45b4e <_CORE_mutex_Surrender+0x86>
_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
#ifdef __RTEMS_STRICT_ORDER_MUTEX__
if(the_mutex->queue.priority_before != holder->current_priority)
_Thread_Change_priority(holder,the_mutex->queue.priority_before,true);
#endif
if ( holder->resource_count == 0 &&
45b2c: 4aa8 001c tstl %a0@(28) 45b30: 661c bnes 45b4e <_CORE_mutex_Surrender+0x86>
holder->real_priority != holder->current_priority ) {
45b32: 2028 0018 movel %a0@(24),%d0 45b36: b0a8 0014 cmpl %a0@(20),%d0 45b3a: 6712 beqs 45b4e <_CORE_mutex_Surrender+0x86>
_Thread_Change_priority( holder, holder->real_priority, true );
45b3c: 4878 0001 pea 1 <ADD> 45b40: 2f00 movel %d0,%sp@- 45b42: 2f08 movel %a0,%sp@- 45b44: 4eb9 0004 67e8 jsr 467e8 <_Thread_Change_priority> 45b4a: 4fef 000c lea %sp@(12),%sp
/*
* Now we check if another thread was waiting for this mutex. If so,
* transfer the mutex to that thread.
*/
if ( ( the_thread = _Thread_queue_Dequeue( &the_mutex->Wait_queue ) ) ) {
45b4e: 2f0a movel %a2,%sp@- 45b50: 4eb9 0004 702c jsr 4702c <_Thread_queue_Dequeue> 45b56: 588f addql #4,%sp 45b58: 2040 moveal %d0,%a0 45b5a: 4a80 tstl %d0 45b5c: 674c beqs 45baa <_CORE_mutex_Surrender+0xe2>
#endif
{
the_mutex->holder = the_thread;
the_mutex->holder_id = the_thread->Object.id;
the_mutex->nest_count = 1;
45b5e: 7201 moveq #1,%d1
} else
#endif
{
the_mutex->holder = the_thread;
the_mutex->holder_id = the_thread->Object.id;
45b60: 2568 0008 005e movel %a0@(8),%a2@(94)
the_mutex->nest_count = 1;
switch ( the_mutex->Attributes.discipline ) {
45b66: 202a 0046 movel %a2@(70),%d0
#endif
{
the_mutex->holder = the_thread;
the_mutex->holder_id = the_thread->Object.id;
the_mutex->nest_count = 1;
45b6a: 2541 0052 movel %d1,%a2@(82)
switch ( the_mutex->Attributes.discipline ) {
45b6e: 123c 0002 moveb #2,%d1
} else
#endif
{
the_mutex->holder = the_thread;
45b72: 2548 005a movel %a0,%a2@(90)
the_mutex->holder_id = the_thread->Object.id;
the_mutex->nest_count = 1;
switch ( the_mutex->Attributes.discipline ) {
45b76: b280 cmpl %d0,%d1 45b78: 670a beqs 45b84 <_CORE_mutex_Surrender+0xbc> 45b7a: 123c 0003 moveb #3,%d1 45b7e: b280 cmpl %d0,%d1 45b80: 6632 bnes 45bb4 <_CORE_mutex_Surrender+0xec> 45b82: 6006 bras 45b8a <_CORE_mutex_Surrender+0xc2>
case CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT:
#ifdef __RTEMS_STRICT_ORDER_MUTEX__
_Chain_Prepend_unprotected(&the_thread->lock_mutex,&the_mutex->queue.lock_queue);
the_mutex->queue.priority_before = the_thread->current_priority;
#endif
the_thread->resource_count++;
45b84: 52a8 001c addql #1,%a0@(28) 45b88: 602a bras 45bb4 <_CORE_mutex_Surrender+0xec>
case CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING:
#ifdef __RTEMS_STRICT_ORDER_MUTEX__
_Chain_Prepend_unprotected(&the_thread->lock_mutex,&the_mutex->queue.lock_queue);
the_mutex->queue.priority_before = the_thread->current_priority;
#endif
the_thread->resource_count++;
45b8a: 52a8 001c addql #1,%a0@(28)
if (the_mutex->Attributes.priority_ceiling <
45b8e: 202a 004a movel %a2@(74),%d0
the_thread->current_priority){
45b92: b0a8 0014 cmpl %a0@(20),%d0 45b96: 641c bccs 45bb4 <_CORE_mutex_Surrender+0xec>
_Thread_Change_priority(
45b98: 42a7 clrl %sp@- 45b9a: 2f00 movel %d0,%sp@- 45b9c: 2f08 movel %a0,%sp@- 45b9e: 4eb9 0004 67e8 jsr 467e8 <_Thread_Change_priority> 45ba4: 4fef 000c lea %sp@(12),%sp 45ba8: 600a bras 45bb4 <_CORE_mutex_Surrender+0xec>
}
break;
}
}
} else
the_mutex->lock = CORE_MUTEX_UNLOCKED;
45baa: 7001 moveq #1,%d0 45bac: 2540 004e movel %d0,%a2@(78) 45bb0: 4200 clrb %d0 45bb2: 6002 bras 45bb6 <_CORE_mutex_Surrender+0xee> 45bb4: 4280 clrl %d0
return CORE_MUTEX_STATUS_SUCCESSFUL;
}
45bb6: 246e fffc moveal %fp@(-4),%a2 45bba: 4e5e unlk %fp 45bbc: 4e75 rts
...
00045bcc <_CORE_semaphore_Initialize>:
void _CORE_semaphore_Initialize(
CORE_semaphore_Control *the_semaphore,
CORE_semaphore_Attributes *the_semaphore_attributes,
uint32_t initial_value
)
{
45bcc: 4e56 0000 linkw %fp,#0 45bd0: 226e 000c moveal %fp@(12),%a1
the_semaphore->Attributes = *the_semaphore_attributes;
the_semaphore->count = initial_value;
_Thread_queue_Initialize(
45bd4: 4878 0003 pea 3 <DIVIDE> 45bd8: 4878 0200 pea 200 <DBL_MANT_DIG+0x1cb>
void _CORE_semaphore_Initialize(
CORE_semaphore_Control *the_semaphore,
CORE_semaphore_Attributes *the_semaphore_attributes,
uint32_t initial_value
)
{
45bdc: 206e 0008 moveal %fp@(8),%a0
the_semaphore->Attributes = *the_semaphore_attributes;
45be0: 2011 movel %a1@,%d0 45be2: 2229 0004 movel %a1@(4),%d1
the_semaphore->count = initial_value;
45be6: 216e 0010 0048 movel %fp@(16),%a0@(72)
CORE_semaphore_Attributes *the_semaphore_attributes,
uint32_t initial_value
)
{
the_semaphore->Attributes = *the_semaphore_attributes;
45bec: 2140 0040 movel %d0,%a0@(64) 45bf0: 2141 0044 movel %d1,%a0@(68)
the_semaphore->count = initial_value;
_Thread_queue_Initialize(
45bf4: 7201 moveq #1,%d1 45bf6: b2a9 0004 cmpl %a1@(4),%d1 45bfa: 57c0 seq %d0 45bfc: 49c0 extbl %d0 45bfe: 4480 negl %d0 45c00: 2f00 movel %d0,%sp@- 45c02: 2f08 movel %a0,%sp@- 45c04: 4eb9 0004 739c jsr 4739c <_Thread_queue_Initialize> 45c0a: 4fef 0010 lea %sp@(16),%sp
_CORE_semaphore_Is_priority( the_semaphore_attributes ) ?
THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO,
STATES_WAITING_FOR_SEMAPHORE,
CORE_SEMAPHORE_TIMEOUT
);
}
45c0e: 4e5e unlk %fp 45c10: 4e75 rts
...
0004dcc0 <_CORE_semaphore_Seize>:
Thread_Control *executing;
ISR_Level level;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL;
_ISR_Disable( level );
4dcc0: 223c 0000 0700 movel #1792,%d1
CORE_semaphore_Control *the_semaphore,
Objects_Id id,
bool wait,
Watchdog_Interval timeout
)
{
4dcc6: 4e56 fff4 linkw %fp,#-12
Thread_Control *executing;
ISR_Level level;
executing = _Thread_Executing;
4dcca: 2279 0006 1b4a moveal 61b4a <_Thread_Executing>,%a1
CORE_semaphore_Control *the_semaphore,
Objects_Id id,
bool wait,
Watchdog_Interval timeout
)
{
4dcd0: 48d7 001c moveml %d2-%d4,%sp@ 4dcd4: 262e 000c movel %fp@(12),%d3 4dcd8: 242e 0014 movel %fp@(20),%d2
Thread_Control *executing;
ISR_Level level;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL;
4dcdc: 42a9 0034 clrl %a1@(52)
CORE_semaphore_Control *the_semaphore,
Objects_Id id,
bool wait,
Watchdog_Interval timeout
)
{
4dce0: 206e 0008 moveal %fp@(8),%a0 4dce4: 282e 0010 movel %fp@(16),%d4
Thread_Control *executing;
ISR_Level level;
executing = _Thread_Executing;
executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL;
_ISR_Disable( level );
4dce8: 40c0 movew %sr,%d0 4dcea: 8280 orl %d0,%d1 4dcec: 46c1 movew %d1,%sr
if ( the_semaphore->count != 0 ) {
4dcee: 2228 0048 movel %a0@(72),%d1 4dcf2: 670a beqs 4dcfe <_CORE_semaphore_Seize+0x3e>
the_semaphore->count -= 1;
4dcf4: 5381 subql #1,%d1 4dcf6: 2141 0048 movel %d1,%a0@(72)
_ISR_Enable( level );
4dcfa: 46c0 movew %d0,%sr
return;
4dcfc: 603c bras 4dd3a <_CORE_semaphore_Seize+0x7a>
/*
* If the semaphore was not available and the caller was not willing
* to block, then return immediately with a status indicating that
* the semaphore was not available and the caller never blocked.
*/
if ( !wait ) {
4dcfe: 4a04 tstb %d4 4dd00: 660a bnes 4dd0c <_CORE_semaphore_Seize+0x4c>
_ISR_Enable( level );
4dd02: 46c0 movew %d0,%sr
executing->Wait.return_code = CORE_SEMAPHORE_STATUS_UNSATISFIED_NOWAIT;
4dd04: 7001 moveq #1,%d0 4dd06: 2340 0034 movel %d0,%a1@(52) 4dd0a: 602e bras 4dd3a <_CORE_semaphore_Seize+0x7a> 4dd0c: 7201 moveq #1,%d1
* If the semaphore is not available and the caller is willing to * block, then we now block the caller with optional timeout. */ _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue; executing->Wait.id = id;
4dd0e: 2343 0020 movel %d3,%a1@(32)
/* * If the semaphore is not available and the caller is willing to * block, then we now block the caller with optional timeout. */ _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue;
4dd12: 2348 0044 movel %a0,%a1@(68) 4dd16: 2141 0030 movel %d1,%a0@(48)
executing->Wait.id = id; _ISR_Enable( level );
4dd1a: 46c0 movew %d0,%sr
_Thread_queue_Enqueue( &the_semaphore->Wait_queue, timeout );
4dd1c: 2d42 000c movel %d2,%fp@(12) 4dd20: 203c 0004 aa68 movel #305768,%d0 4dd26: 2d48 0008 movel %a0,%fp@(8) 4dd2a: 2d40 0010 movel %d0,%fp@(16)
}
4dd2e: 4cd7 001c moveml %sp@,%d2-%d4 4dd32: 4e5e unlk %fp
*/ _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue; executing->Wait.id = id; _ISR_Enable( level ); _Thread_queue_Enqueue( &the_semaphore->Wait_queue, timeout );
4dd34: 4ef9 0004 a77c jmp 4a77c <_Thread_queue_Enqueue_with_handler>
}
4dd3a: 4cd7 001c moveml %sp@,%d2-%d4 4dd3e: 4e5e unlk %fp 4dd40: 4e75 rts
...
00045c14 <_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
)
{
45c14: 4e56 0000 linkw %fp,#0 45c18: 2f0a movel %a2,%sp@- 45c1a: 246e 0008 moveal %fp@(8),%a2
ISR_Level level;
CORE_semaphore_Status status;
status = CORE_SEMAPHORE_STATUS_SUCCESSFUL;
if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) {
45c1e: 2f0a movel %a2,%sp@- 45c20: 4eb9 0004 702c jsr 4702c <_Thread_queue_Dequeue> 45c26: 588f addql #4,%sp 45c28: 4a80 tstl %d0 45c2a: 6704 beqs 45c30 <_CORE_semaphore_Surrender+0x1c> 45c2c: 4280 clrl %d0 45c2e: 6024 bras 45c54 <_CORE_semaphore_Surrender+0x40>
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
(*api_semaphore_mp_support) ( the_thread, id );
#endif
} else {
_ISR_Disable( level );
45c30: 203c 0000 0700 movel #1792,%d0 45c36: 40c1 movew %sr,%d1 45c38: 8081 orl %d1,%d0 45c3a: 46c0 movew %d0,%sr
if ( the_semaphore->count < the_semaphore->Attributes.maximum_count )
45c3c: 202a 0048 movel %a2@(72),%d0 45c40: b0aa 0040 cmpl %a2@(64),%d0 45c44: 6504 bcss 45c4a <_CORE_semaphore_Surrender+0x36>
45c46: 7004 moveq #4,%d0 <== NOT EXECUTED 45c48: 6008 bras 45c52 <_CORE_semaphore_Surrender+0x3e> <== NOT EXECUTED
the_semaphore->count += 1;
45c4a: 5280 addql #1,%d0 45c4c: 2540 0048 movel %d0,%a2@(72) 45c50: 4280 clrl %d0
else
status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED;
_ISR_Enable( level );
45c52: 46c1 movew %d1,%sr
}
return status;
}
45c54: 246e fffc moveal %fp@(-4),%a2 45c58: 4e5e unlk %fp 45c5a: 4e75 rts
00046558 <_CORE_spinlock_Initialize>:
void _CORE_spinlock_Initialize(
CORE_spinlock_Control *the_spinlock,
CORE_spinlock_Attributes *the_spinlock_attributes
)
{
46558: 4e56 0000 linkw %fp,#0 4655c: 206e 0008 moveal %fp@(8),%a0 46560: 226e 000c moveal %fp@(12),%a1
the_spinlock->Attributes = *the_spinlock_attributes;
the_spinlock->lock = 0;
the_spinlock->users = 0;
the_spinlock->holder = 0;
}
46564: 4e5e unlk %fp
CORE_spinlock_Control *the_spinlock,
CORE_spinlock_Attributes *the_spinlock_attributes
)
{
the_spinlock->Attributes = *the_spinlock_attributes;
46566: 2091 movel %a1@,%a0@
the_spinlock->lock = 0;
46568: 42a8 0004 clrl %a0@(4)
the_spinlock->users = 0;
4656c: 42a8 0008 clrl %a0@(8)
the_spinlock->holder = 0;
46570: 42a8 000c clrl %a0@(12)
}
46574: 4e75 rts
...
000465c8 <_CORE_spinlock_Wait>:
ISR_Level level;
#if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API)
Watchdog_Interval limit = _Watchdog_Ticks_since_boot + timeout;
#endif
_ISR_Disable( level );
465c8: 223c 0000 0700 movel #1792,%d1
CORE_spinlock_Status _CORE_spinlock_Wait(
CORE_spinlock_Control *the_spinlock,
bool wait,
Watchdog_Interval timeout
)
{
465ce: 4e56 fff0 linkw %fp,#-16 465d2: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ 465d6: 246e 0008 moveal %fp@(8),%a2 465da: 162e 000f moveb %fp@(15),%d3
ISR_Level level;
#if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API)
Watchdog_Interval limit = _Watchdog_Ticks_since_boot + timeout;
#endif
_ISR_Disable( level );
465de: 40c0 movew %sr,%d0 465e0: 8280 orl %d0,%d1 465e2: 46c1 movew %d1,%sr
if ( (the_spinlock->lock == CORE_SPINLOCK_LOCKED) &&
465e4: 222a 0004 movel %a2@(4),%d1 465e8: 7401 moveq #1,%d2 465ea: b481 cmpl %d1,%d2 465ec: 6616 bnes 46604 <_CORE_spinlock_Wait+0x3c>
(the_spinlock->holder == _Thread_Executing->Object.id) ) {
465ee: 222a 000c movel %a2@(12),%d1 465f2: 2079 0005 dd2e moveal 5dd2e <_Thread_Executing>,%a0 465f8: b2a8 0008 cmpl %a0@(8),%d1 465fc: 6606 bnes 46604 <_CORE_spinlock_Wait+0x3c>
_ISR_Enable( level );
465fe: 46c0 movew %d0,%sr 46600: 7001 moveq #1,%d0
return CORE_SPINLOCK_HOLDER_RELOCKING;
46602: 6068 bras 4666c <_CORE_spinlock_Wait+0xa4>
}
the_spinlock->users += 1;
46604: 222a 0008 movel %a2@(8),%d1 46608: 5281 addql #1,%d1
*/
_ISR_Enable( level );
/* An ISR could occur here */
_Thread_Enable_dispatch();
4660a: 47f9 0004 768e lea 4768e <_Thread_Enable_dispatch>,%a3
/* Another thread could get dispatched here */
/* Reenter the critical sections so we can attempt the lock again. */
_Thread_Disable_dispatch();
_ISR_Disable( level );
46610: 243c 0000 0700 movel #1792,%d2
if ( (the_spinlock->lock == CORE_SPINLOCK_LOCKED) &&
(the_spinlock->holder == _Thread_Executing->Object.id) ) {
_ISR_Enable( level );
return CORE_SPINLOCK_HOLDER_RELOCKING;
}
the_spinlock->users += 1;
46616: 2541 0008 movel %d1,%a2@(8)
for ( ;; ) {
if ( the_spinlock->lock == CORE_SPINLOCK_UNLOCKED ) {
4661a: 222a 0004 movel %a2@(4),%d1 4661e: 661c bnes 4663c <_CORE_spinlock_Wait+0x74>
the_spinlock->lock = CORE_SPINLOCK_LOCKED;
46620: 123c 0001 moveb #1,%d1
the_spinlock->holder = _Thread_Executing->Object.id;
46624: 2079 0005 dd2e moveal 5dd2e <_Thread_Executing>,%a0
return CORE_SPINLOCK_HOLDER_RELOCKING;
}
the_spinlock->users += 1;
for ( ;; ) {
if ( the_spinlock->lock == CORE_SPINLOCK_UNLOCKED ) {
the_spinlock->lock = CORE_SPINLOCK_LOCKED;
4662a: 2541 0004 movel %d1,%a2@(4)
the_spinlock->holder = _Thread_Executing->Object.id;
4662e: 2228 0008 movel %a0@(8),%d1 46632: 2541 000c movel %d1,%a2@(12)
_ISR_Enable( level );
46636: 46c0 movew %d0,%sr 46638: 4280 clrl %d0
return CORE_SPINLOCK_SUCCESSFUL;
4663a: 6030 bras 4666c <_CORE_spinlock_Wait+0xa4>
}
/*
* Spinlock is unavailable. If not willing to wait, return.
*/
if ( !wait ) {
4663c: 4a03 tstb %d3 4663e: 6610 bnes 46650 <_CORE_spinlock_Wait+0x88>
the_spinlock->users -= 1;
46640: 222a 0008 movel %a2@(8),%d1 46644: 5381 subql #1,%d1 46646: 2541 0008 movel %d1,%a2@(8)
_ISR_Enable( level );
4664a: 46c0 movew %d0,%sr 4664c: 7005 moveq #5,%d0
return CORE_SPINLOCK_UNAVAILABLE;
4664e: 601c bras 4666c <_CORE_spinlock_Wait+0xa4>
*
* A spinlock cannot be deleted while it is being used so we are
* safe from deletion.
*/
_ISR_Enable( level );
46650: 46c0 movew %d0,%sr
/* An ISR could occur here */
_Thread_Enable_dispatch();
46652: 4e93 jsr %a3@ 46654: 2039 0005 dc74 movel 5dc74 <_Thread_Dispatch_disable_level>,%d0 4665a: 5280 addql #1,%d0 4665c: 23c0 0005 dc74 movel %d0,5dc74 <_Thread_Dispatch_disable_level>
/* Another thread could get dispatched here */
/* Reenter the critical sections so we can attempt the lock again. */
_Thread_Disable_dispatch();
_ISR_Disable( level );
46662: 2202 movel %d2,%d1 46664: 40c0 movew %sr,%d0 46666: 8280 orl %d0,%d1 46668: 46c1 movew %d1,%sr
}
4666a: 60ae bras 4661a <_CORE_spinlock_Wait+0x52>
}
4666c: 4cee 0c0c fff0 moveml %fp@(-16),%d2-%d3/%a2-%a3 46672: 4e5e unlk %fp 46674: 4e75 rts
...
000458d0 <_Chain_Append>:
Chain_Node *node
)
{
ISR_Level level;
_ISR_Disable( level );
458d0: 203c 0000 0700 movel #1792,%d0
void _Chain_Append(
Chain_Control *the_chain,
Chain_Node *node
)
{
458d6: 4e56 0000 linkw %fp,#0 458da: 206e 000c moveal %fp@(12),%a0 458de: 2f0a movel %a2,%sp@- 458e0: 226e 0008 moveal %fp@(8),%a1
ISR_Level level;
_ISR_Disable( level );
458e4: 40c1 movew %sr,%d1 458e6: 8081 orl %d1,%d0 458e8: 46c0 movew %d0,%sr
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
458ea: 2009 movel %a1,%d0 458ec: 5880 addql #4,%d0 458ee: 2080 movel %d0,%a0@
old_last_node = the_chain->last;
458f0: 2469 0008 moveal %a1@(8),%a2
the_chain->last = the_node;
458f4: 2348 0008 movel %a0,%a1@(8)
old_last_node->next = the_node; the_node->previous = old_last_node;
458f8: 214a 0004 movel %a2,%a0@(4)
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
458fc: 2488 movel %a0,%a2@
_Chain_Append_unprotected( the_chain, node );
_ISR_Enable( level );
458fe: 46c1 movew %d1,%sr
}
45900: 245f moveal %sp@+,%a2 45902: 4e5e unlk %fp 45904: 4e75 rts
...
00049fe0 <_Chain_Extract>:
Chain_Node *node
)
{
ISR_Level level;
_ISR_Disable( level );
49fe0: 203c 0000 0700 movel #1792,%d0
*/
void _Chain_Extract(
Chain_Node *node
)
{
49fe6: 4e56 0000 linkw %fp,#0 49fea: 206e 0008 moveal %fp@(8),%a0
ISR_Level level;
_ISR_Disable( level );
49fee: 40c1 movew %sr,%d1 49ff0: 8081 orl %d1,%d0 49ff2: 46c0 movew %d0,%sr
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
49ff4: 2268 0004 moveal %a0@(4),%a1
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
49ff8: 2050 moveal %a0@,%a0
previous = the_node->previous; next->previous = previous; previous->next = next;
49ffa: 2288 movel %a0,%a1@
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
next->previous = previous;
49ffc: 2149 0004 movel %a1,%a0@(4)
_Chain_Extract_unprotected( node );
_ISR_Enable( level );
4a000: 46c1 movew %d1,%sr
}
4a002: 4e5e unlk %fp 4a004: 4e75 rts
...
0004a03c <_Chain_Initialize>:
Chain_Control *the_chain,
void *starting_address,
size_t number_nodes,
size_t node_size
)
{
4a03c: 4e56 0000 linkw %fp,#0 4a040: 202e 0010 movel %fp@(16),%d0 4a044: 2f0a movel %a2,%sp@- 4a046: 246e 0008 moveal %fp@(8),%a2
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Head(
Chain_Control *the_chain
)
{
return (Chain_Node *) the_chain;
4a04a: 204a moveal %a2,%a0
Chain_Node *current;
Chain_Node *next;
count = number_nodes;
current = _Chain_Head( the_chain );
the_chain->permanent_null = NULL;
4a04c: 42aa 0004 clrl %a2@(4)
Chain_Control *the_chain,
void *starting_address,
size_t number_nodes,
size_t node_size
)
{
4a050: 222e 0014 movel %fp@(20),%d1
Chain_Node *next;
count = number_nodes;
current = _Chain_Head( the_chain );
the_chain->permanent_null = NULL;
next = starting_address;
4a054: 226e 000c moveal %fp@(12),%a1
while ( count-- ) {
4a058: 600c bras 4a066 <_Chain_Initialize+0x2a>
current->next = next;
next->previous = current;
4a05a: 2348 0004 movel %a0,%a1@(4)
current = next;
next = (Chain_Node *)
4a05e: 5380 subql #1,%d0
count = number_nodes;
current = _Chain_Head( the_chain );
the_chain->permanent_null = NULL;
next = starting_address;
while ( count-- ) {
current->next = next;
4a060: 2089 movel %a1,%a0@
next->previous = current;
current = next;
next = (Chain_Node *)
4a062: 2049 moveal %a1,%a0 4a064: d3c1 addal %d1,%a1
count = number_nodes;
current = _Chain_Head( the_chain );
the_chain->permanent_null = NULL;
next = starting_address;
while ( count-- ) {
4a066: 4a80 tstl %d0 4a068: 66f0 bnes 4a05a <_Chain_Initialize+0x1e>
next->previous = current;
current = next;
next = (Chain_Node *)
_Addresses_Add_offset( (void *) next, node_size );
}
current->next = _Chain_Tail( the_chain );
4a06a: 200a movel %a2,%d0 4a06c: 5880 addql #4,%d0 4a06e: 2080 movel %d0,%a0@
the_chain->last = current;
4a070: 2548 0008 movel %a0,%a2@(8)
}
4a074: 245f moveal %sp@+,%a2 4a076: 4e5e unlk %fp 4a078: 4e75 rts
...
00049bd8 <_Event_Manager_initialization>:
*
* This routine performs the initialization necessary for this manager.
*/
void _Event_Manager_initialization( void )
{
49bd8: 4e56 0000 linkw %fp,#0
*/
#if defined(RTEMS_MULTIPROCESSING)
_MPCI_Register_packet_processor( MP_PACKET_EVENT, _Event_MP_Process_packet );
#endif
}
49bdc: 4e5e unlk %fp
* This routine performs the initialization necessary for this manager.
*/
void _Event_Manager_initialization( void )
{
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
49bde: 42b9 0005 d4e2 clrl 5d4e2 <_Event_Sync_state>
*/
#if defined(RTEMS_MULTIPROCESSING)
_MPCI_Register_packet_processor( MP_PACKET_EVENT, _Event_MP_Process_packet );
#endif
}
49be4: 4e75 rts
...
000449d8 <_Event_Seize>:
executing = _Thread_Executing;
executing->Wait.return_code = RTEMS_SUCCESSFUL;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
_ISR_Disable( level );
449d8: 203c 0000 0700 movel #1792,%d0
rtems_event_set event_in,
rtems_option option_set,
rtems_interval ticks,
rtems_event_set *event_out
)
{
449de: 4e56 ffec linkw %fp,#-20 449e2: 226e 0010 moveal %fp@(16),%a1 449e6: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@
rtems_event_set pending_events;
ISR_Level level;
RTEMS_API_Control *api;
Thread_blocking_operation_States sync_state;
executing = _Thread_Executing;
449ea: 2479 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a2
rtems_event_set event_in,
rtems_option option_set,
rtems_interval ticks,
rtems_event_set *event_out
)
{
449f0: 242e 0008 movel %fp@(8),%d2 449f4: 262e 000c movel %fp@(12),%d3
ISR_Level level;
RTEMS_API_Control *api;
Thread_blocking_operation_States sync_state;
executing = _Thread_Executing;
executing->Wait.return_code = RTEMS_SUCCESSFUL;
449f8: 42aa 0034 clrl %a2@(52)
rtems_event_set event_in,
rtems_option option_set,
rtems_interval ticks,
rtems_event_set *event_out
)
{
449fc: 206e 0014 moveal %fp@(20),%a0
Thread_blocking_operation_States sync_state;
executing = _Thread_Executing;
executing->Wait.return_code = RTEMS_SUCCESSFUL;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
44a00: 266a 010a moveal %a2@(266),%a3
_ISR_Disable( level );
44a04: 40c1 movew %sr,%d1 44a06: 8081 orl %d1,%d0 44a08: 46c0 movew %d0,%sr
pending_events = api->pending_events;
44a0a: 2813 movel %a3@,%d4
RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Get(
rtems_event_set the_event_set,
rtems_event_set the_event_condition
)
{
return ( the_event_set & the_event_condition );
44a0c: 2002 movel %d2,%d0 44a0e: c084 andl %d4,%d0
seized_events = _Event_sets_Get( pending_events, event_in );
if ( !_Event_sets_Is_empty( seized_events ) &&
44a10: 6716 beqs 44a28 <_Event_Seize+0x50> 44a12: b480 cmpl %d0,%d2 44a14: 6706 beqs 44a1c <_Event_Seize+0x44> 44a16: 0803 0001 btst #1,%d3 44a1a: 670c beqs 44a28 <_Event_Seize+0x50>
(seized_events == event_in || _Options_Is_any( option_set )) ) {
api->pending_events =
44a1c: 2400 movel %d0,%d2 44a1e: 4682 notl %d2 44a20: c484 andl %d4,%d2 44a22: 2682 movel %d2,%a3@
_Event_sets_Clear( pending_events, seized_events );
_ISR_Enable( level );
44a24: 46c1 movew %d1,%sr 44a26: 600e bras 44a36 <_Event_Seize+0x5e>
*event_out = seized_events;
return;
}
if ( _Options_Is_no_wait( option_set ) ) {
44a28: 0803 0000 btst #0,%d3 44a2c: 670e beqs 44a3c <_Event_Seize+0x64>
_ISR_Enable( level );
44a2e: 46c1 movew %d1,%sr
executing->Wait.return_code = RTEMS_UNSATISFIED;
44a30: 720d moveq #13,%d1 44a32: 2541 0034 movel %d1,%a2@(52)
*event_out = seized_events;
44a36: 2080 movel %d0,%a0@
return;
44a38: 6000 0096 braw 44ad0 <_Event_Seize+0xf8>
* * NOTE: Since interrupts are disabled, this isn't that much of an * issue but better safe than sorry. */ executing->Wait.option = (uint32_t) option_set; executing->Wait.count = (uint32_t) event_in;
44a3c: 2542 0024 movel %d2,%a2@(36)
executing->Wait.return_argument = event_out;
_Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
44a40: 7401 moveq #1,%d2
* set properly when we are marked as in the event critical section. * * NOTE: Since interrupts are disabled, this isn't that much of an * issue but better safe than sorry. */ executing->Wait.option = (uint32_t) option_set;
44a42: 2543 0030 movel %d3,%a2@(48)
executing->Wait.count = (uint32_t) event_in; executing->Wait.return_argument = event_out;
44a46: 2548 0028 movel %a0,%a2@(40)
_Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
44a4a: 23c2 0005 d4e2 movel %d2,5d4e2 <_Event_Sync_state>
_ISR_Enable( level );
44a50: 46c1 movew %d1,%sr
if ( ticks ) {
44a52: 4a89 tstl %a1 44a54: 6730 beqs 44a86 <_Event_Seize+0xae>
_Watchdog_Initialize(
44a56: 202a 0008 movel %a2@(8),%d0
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
44a5a: 223c 0004 4c38 movel #281656,%d1
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
44a60: 2549 0054 movel %a1,%a2@(84)
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
44a64: 2541 0064 movel %d1,%a2@(100)
the_watchdog->id = id;
44a68: 2540 0068 movel %d0,%a2@(104)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
44a6c: 42aa 0050 clrl %a2@(80)
the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data;
44a70: 42aa 006c clrl %a2@(108)
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
44a74: 486a 0048 pea %a2@(72) 44a78: 4879 0005 cd6c pea 5cd6c <_Watchdog_Ticks_chain> 44a7e: 4eb9 0004 7c48 jsr 47c48 <_Watchdog_Insert> 44a84: 508f addql #8,%sp
NULL
);
_Watchdog_Insert_ticks( &executing->Timer, ticks );
}
_Thread_Set_state( executing, STATES_WAITING_FOR_EVENT );
44a86: 4878 0100 pea 100 <DBL_MANT_DIG+0xcb> 44a8a: 2f0a movel %a2,%sp@- 44a8c: 4eb9 0004 7500 jsr 47500 <_Thread_Set_state>
_ISR_Disable( level );
44a92: 203c 0000 0700 movel #1792,%d0 44a98: 40c1 movew %sr,%d1 44a9a: 8081 orl %d1,%d0 44a9c: 46c0 movew %d0,%sr
sync_state = _Event_Sync_state;
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) {
44a9e: 7401 moveq #1,%d2 44aa0: 508f addql #8,%sp
_Thread_Set_state( executing, STATES_WAITING_FOR_EVENT );
_ISR_Disable( level );
sync_state = _Event_Sync_state;
44aa2: 2039 0005 d4e2 movel 5d4e2 <_Event_Sync_state>,%d0
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
44aa8: 42b9 0005 d4e2 clrl 5d4e2 <_Event_Sync_state>
if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) {
44aae: b480 cmpl %d0,%d2 44ab0: 6604 bnes 44ab6 <_Event_Seize+0xde>
_ISR_Enable( level );
44ab2: 46c1 movew %d1,%sr 44ab4: 601a bras 44ad0 <_Event_Seize+0xf8>
* An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level );
44ab6: 2d4a 000c movel %a2,%fp@(12) 44aba: 2d41 0010 movel %d1,%fp@(16)
}
44abe: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3
* An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level );
44ac4: 2d40 0008 movel %d0,%fp@(8)
}
44ac8: 4e5e unlk %fp
* An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level );
44aca: 4ef9 0004 6798 jmp 46798 <_Thread_blocking_operation_Cancel>
}
44ad0: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 44ad6: 4e5e unlk %fp 44ad8: 4e75 rts
...
00044b30 <_Event_Surrender>:
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
option_set = (rtems_option) the_thread->Wait.option;
_ISR_Disable( level );
44b30: 203c 0000 0700 movel #1792,%d0
*/
void _Event_Surrender(
Thread_Control *the_thread
)
{
44b36: 4e56 ffe8 linkw %fp,#-24 44b3a: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 44b3e: 246e 0008 moveal %fp@(8),%a2
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 ];
44b42: 206a 010a moveal %a2@(266),%a0
option_set = (rtems_option) the_thread->Wait.option;
44b46: 282a 0030 movel %a2@(48),%d4
_ISR_Disable( level );
44b4a: 40c1 movew %sr,%d1 44b4c: 8081 orl %d1,%d0 44b4e: 46c0 movew %d0,%sr
pending_events = api->pending_events; event_condition = (rtems_event_set) the_thread->Wait.count;
44b50: 262a 0024 movel %a2@(36),%d3
RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Get(
rtems_event_set the_event_set,
rtems_event_set the_event_condition
)
{
return ( the_event_set & the_event_condition );
44b54: 2003 movel %d3,%d0
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
option_set = (rtems_option) the_thread->Wait.option;
_ISR_Disable( level );
pending_events = api->pending_events;
44b56: 2410 movel %a0@,%d2 44b58: c082 andl %d2,%d0
seized_events = _Event_sets_Get( pending_events, event_condition );
/*
* No events were seized in this operation
*/
if ( _Event_sets_Is_empty( seized_events ) ) {
44b5a: 6606 bnes 44b62 <_Event_Surrender+0x32>
_ISR_Enable( level );
44b5c: 46c1 movew %d1,%sr
return;
44b5e: 6000 00cc braw 44c2c <_Event_Surrender+0xfc>
/*
* 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() &&
44b62: 2279 0005 cd2e moveal 5cd2e <_ISR_Nest_level>,%a1 44b68: 4a89 tstl %a1 44b6a: 674a beqs 44bb6 <_Event_Surrender+0x86> 44b6c: b5f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a2 44b72: 6642 bnes 44bb6 <_Event_Surrender+0x86>
_Thread_Is_executing( the_thread ) &&
((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
44b74: 2279 0005 d4e2 moveal 5d4e2 <_Event_Sync_state>,%a1
/*
* 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() &&
44b7a: 7a02 moveq #2,%d5 44b7c: ba89 cmpl %a1,%d5 44b7e: 670e beqs 44b8e <_Event_Surrender+0x5e>
_Thread_Is_executing( the_thread ) &&
((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
(_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) {
44b80: 2279 0005 d4e2 moveal 5d4e2 <_Event_Sync_state>,%a1
/*
* 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() &&
44b86: 1a3c 0001 moveb #1,%d5 44b8a: ba89 cmpl %a1,%d5 44b8c: 6628 bnes 44bb6 <_Event_Surrender+0x86>
_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) ) {
44b8e: b680 cmpl %d0,%d3 44b90: 6706 beqs 44b98 <_Event_Surrender+0x68> 44b92: 0804 0001 btst #1,%d4 44b96: 671a beqs 44bb2 <_Event_Surrender+0x82>
api->pending_events = _Event_sets_Clear( pending_events,seized_events );
44b98: 2600 movel %d0,%d3 44b9a: 4683 notl %d3 44b9c: c682 andl %d2,%d3 44b9e: 2083 movel %d3,%a0@
the_thread->Wait.count = 0;
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
44ba0: 206a 0028 moveal %a2@(40),%a0
_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;
44ba4: 42aa 0024 clrl %a2@(36)
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
44ba8: 2080 movel %d0,%a0@
_Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED;
44baa: 7003 moveq #3,%d0 44bac: 23c0 0005 d4e2 movel %d0,5d4e2 <_Event_Sync_state>
}
_ISR_Enable( level );
44bb2: 46c1 movew %d1,%sr
return;
44bb4: 6076 bras 44c2c <_Event_Surrender+0xfc>
}
/*
* Otherwise, this is a normal send to another thread
*/
if ( _States_Is_waiting_for_event( the_thread->current_state ) ) {
44bb6: 2a2a 0010 movel %a2@(16),%d5 44bba: 0285 0000 0100 andil #256,%d5 44bc0: 6768 beqs 44c2a <_Event_Surrender+0xfa>
if ( seized_events == event_condition || _Options_Is_any( option_set ) ) {
44bc2: b680 cmpl %d0,%d3 44bc4: 6706 beqs 44bcc <_Event_Surrender+0x9c> 44bc6: 0804 0001 btst #1,%d4 44bca: 675e beqs 44c2a <_Event_Surrender+0xfa>
api->pending_events = _Event_sets_Clear( pending_events, seized_events );
44bcc: 2600 movel %d0,%d3 44bce: 4683 notl %d3 44bd0: c682 andl %d2,%d3 44bd2: 2083 movel %d3,%a0@
the_thread->Wait.count = 0;
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
44bd4: 206a 0028 moveal %a2@(40),%a0
* 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;
44bd8: 42aa 0024 clrl %a2@(36)
*(rtems_event_set *)the_thread->Wait.return_argument = seized_events;
44bdc: 2080 movel %d0,%a0@
_ISR_Flash( level );
44bde: 203c 0000 0700 movel #1792,%d0 44be4: 46c1 movew %d1,%sr 44be6: 8081 orl %d1,%d0 44be8: 46c0 movew %d0,%sr 44bea: 47f9 0004 6928 lea 46928 <_Thread_Clear_state>,%a3
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
44bf0: 7a02 moveq #2,%d5 44bf2: baaa 0050 cmpl %a2@(80),%d5 44bf6: 6710 beqs 44c08 <_Event_Surrender+0xd8>
_ISR_Enable( level );
44bf8: 46c1 movew %d1,%sr
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
44bfa: 2f3c 1003 fff8 movel #268697592,%sp@- 44c00: 2f0a movel %a2,%sp@- 44c02: 4e93 jsr %a3@ 44c04: 508f addql #8,%sp 44c06: 6024 bras 44c2c <_Event_Surrender+0xfc>
RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_REMOVE_IT;
44c08: 7003 moveq #3,%d0 44c0a: 2540 0050 movel %d0,%a2@(80)
_Thread_Unblock( the_thread );
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
44c0e: 46c1 movew %d1,%sr
(void) _Watchdog_Remove( &the_thread->Timer );
44c10: 486a 0048 pea %a2@(72) 44c14: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 44c1a: 2f3c 1003 fff8 movel #268697592,%sp@- 44c20: 2f0a movel %a2,%sp@- 44c22: 4e93 jsr %a3@ 44c24: 4fef 000c lea %sp@(12),%sp 44c28: 6002 bras 44c2c <_Event_Surrender+0xfc>
_Thread_Unblock( the_thread );
}
return;
}
}
_ISR_Enable( level );
44c2a: 46c1 movew %d1,%sr
}
44c2c: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 44c32: 4e5e unlk %fp 44c34: 4e75 rts
...
00045ee2 <_Heap_Block_allocate>:
Heap_Block *free_list_anchor = NULL;
_HAssert( alloc_area_begin <= alloc_begin );
if ( _Heap_Is_free( block ) ) {
45ee2: 70fe moveq #-2,%d0
Heap_Control *heap,
Heap_Block *block,
uintptr_t alloc_begin,
uintptr_t alloc_size
)
{
45ee4: 4e56 ffe0 linkw %fp,#-32 45ee8: 222e 0010 movel %fp@(16),%d1
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block(
const Heap_Block *block
)
{
return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE;
45eec: 2241 moveal %d1,%a1 45eee: 5189 subql #8,%a1 45ef0: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 45ef4: 246e 000c moveal %fp@(12),%a2
Heap_Block *free_list_anchor = NULL;
_HAssert( alloc_area_begin <= alloc_begin );
if ( _Heap_Is_free( block ) ) {
45ef8: 7601 moveq #1,%d3
)
{
Heap_Statistics *const stats = &heap->stats;
uintptr_t const alloc_area_begin = _Heap_Alloc_area_of_block( block );
uintptr_t const alloc_area_offset = alloc_begin - alloc_area_begin;
45efa: 2a49 moveal %a1,%a5 45efc: 240a movel %a2,%d2 45efe: 9bca subal %a2,%a5
Heap_Block *free_list_anchor = NULL;
_HAssert( alloc_area_begin <= alloc_begin );
if ( _Heap_Is_free( block ) ) {
45f00: c0aa 0004 andl %a2@(4),%d0
Heap_Control *heap,
Heap_Block *block,
uintptr_t alloc_begin,
uintptr_t alloc_size
)
{
45f04: 266e 0008 moveal %fp@(8),%a3
Heap_Block *free_list_anchor = NULL;
_HAssert( alloc_area_begin <= alloc_begin );
if ( _Heap_Is_free( block ) ) {
45f08: c6b2 0804 andl %a2@(00000004,%d0:l),%d3
Heap_Control *heap,
Heap_Block *block,
uintptr_t alloc_begin,
uintptr_t alloc_size
)
{
45f0c: 2a2e 0014 movel %fp@(20),%d5
Heap_Block *free_list_anchor = NULL;
_HAssert( alloc_area_begin <= alloc_begin );
if ( _Heap_Is_free( block ) ) {
45f10: 4a03 tstb %d3 45f12: 6626 bnes 45f3a <_Heap_Block_allocate+0x58>
free_list_anchor = block->prev;
_Heap_Free_list_remove( block );
/* Statistics */
--stats->free_blocks;
45f14: 53ab 0038 subql #1,%a3@(56)
++stats->used_blocks;
stats->free_size -= _Heap_Block_size( block );
45f18: 76fe moveq #-2,%d3
_Heap_Free_list_remove( block );
/* Statistics */
--stats->free_blocks;
++stats->used_blocks;
45f1a: 52ab 0040 addql #1,%a3@(64)
return _Heap_Free_list_tail(heap)->prev;
}
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
45f1e: 202a 0008 movel %a2@(8),%d0
Heap_Block *prev = block->prev;
prev->next = next;
next->prev = prev;
45f22: 2840 moveal %d0,%a4
stats->free_size -= _Heap_Block_size( block );
45f24: c6aa 0004 andl %a2@(4),%d3
Heap_Block *free_list_anchor = NULL;
_HAssert( alloc_area_begin <= alloc_begin );
if ( _Heap_Is_free( block ) ) {
free_list_anchor = block->prev;
45f28: 206a 000c moveal %a2@(12),%a0
_Heap_Free_list_remove( block );
/* Statistics */
--stats->free_blocks;
++stats->used_blocks;
stats->free_size -= _Heap_Block_size( block );
45f2c: 97ab 0030 subl %d3,%a3@(48) 45f30: 2948 000c movel %a0,%a4@(12)
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
Heap_Block *prev = block->prev;
prev->next = next;
45f34: 2140 0008 movel %d0,%a0@(8) 45f38: 6002 bras 45f3c <_Heap_Block_allocate+0x5a>
} else {
free_list_anchor = _Heap_Free_list_head( heap );
45f3a: 204b moveal %a3,%a0
}
if ( alloc_area_offset < heap->page_size ) {
45f3c: 202b 0010 movel %a3@(16),%d0 45f40: b08d cmpl %a5,%d0 45f42: 630a blss 45f4e <_Heap_Block_allocate+0x6c>
Heap_Block *block,
Heap_Block *free_list_anchor,
uintptr_t alloc_size
)
{
_Heap_Block_split( heap, block, free_list_anchor, alloc_size );
45f44: 4875 5800 pea %a5@(00000000,%d5:l) 45f48: 2f08 movel %a0,%sp@- 45f4a: 2f0a movel %a2,%sp@- 45f4c: 6062 bras 45fb0 <_Heap_Block_allocate+0xce>
- 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;
45f4e: 262a 0004 movel %a2@(4),%d3
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 )
45f52: 4c40 1004 remul %d0,%d4,%d1
_HAssert( new_block_size >= heap->min_block_size );
/* Statistics */
stats->free_size += block_size;
if ( _Heap_Is_prev_used( block ) ) {
45f56: 7201 moveq #1,%d1 45f58: 93c4 subal %d4,%a1
_Heap_Block_of_alloc_area( alloc_begin, heap->page_size );
uintptr_t const new_block_begin = (uintptr_t) new_block;
uintptr_t const new_block_size = block_end - new_block_begin;
block_end = new_block_begin;
block_size = block_end - block_begin;
45f5a: 2009 movel %a1,%d0 45f5c: 908a subl %a2,%d0
_HAssert( block_size >= heap->min_block_size );
_HAssert( new_block_size >= heap->min_block_size );
/* Statistics */
stats->free_size += block_size;
45f5e: d1ab 0030 addl %d0,%a3@(48)
if ( _Heap_Is_prev_used( block ) ) {
45f62: c2aa 0004 andl %a2@(4),%d1 45f66: 671c beqs 45f84 <_Heap_Block_allocate+0xa2>
RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after(
Heap_Block *block_before,
Heap_Block *new_block
)
{
Heap_Block *next = block_before->next;
45f68: 2a68 0008 moveal %a0@(8),%a5
_Heap_Free_list_insert_after( free_list_anchor, block );
free_list_anchor = block;
/* Statistics */
++stats->free_blocks;
45f6c: 52ab 0038 addql #1,%a3@(56) 45f70: 220a movel %a2,%d1
new_block->next = next;
45f72: 254d 0008 movel %a5,%a2@(8)
new_block->prev = block_before;
45f76: 2548 000c movel %a0,%a2@(12)
block_before->next = new_block;
45f7a: 214a 0008 movel %a2,%a0@(8)
next->prev = new_block;
45f7e: 2b4a 000c movel %a2,%a5@(12) 45f82: 600c bras 45f90 <_Heap_Block_allocate+0xae>
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Prev_block(
const Heap_Block *block
)
{
return (Heap_Block *) ((uintptr_t) block - block->prev_size);
45f84: 95d2 subal %a2@,%a2
Heap_Block *const prev_block = _Heap_Prev_block( block );
uintptr_t const prev_block_size = _Heap_Block_size( prev_block );
block = prev_block;
block_begin = (uintptr_t) block;
block_size += prev_block_size;
45f86: 78fe moveq #-2,%d4 45f88: 2208 movel %a0,%d1 45f8a: c8aa 0004 andl %a2@(4),%d4 45f8e: d084 addl %d4,%d0
}
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
new_block->prev_size = block_size;
new_block->size_and_flag = new_block_size;
45f90: 78fe moveq #-2,%d4 45f92: c684 andl %d4,%d3
block = prev_block;
block_begin = (uintptr_t) block;
block_size += prev_block_size;
}
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
45f94: 7801 moveq #1,%d4 45f96: 8880 orl %d0,%d4
new_block->prev_size = block_size;
45f98: 2280 movel %d0,%a1@
new_block->size_and_flag = new_block_size;
45f9a: 2002 movel %d2,%d0 45f9c: d083 addl %d3,%d0 45f9e: 9089 subl %a1,%d0
block = prev_block;
block_begin = (uintptr_t) block;
block_size += prev_block_size;
}
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
45fa0: 2544 0004 movel %d4,%a2@(4)
new_block->prev_size = block_size;
new_block->size_and_flag = new_block_size;
_Heap_Block_split( heap, new_block, free_list_anchor, alloc_size );
45fa4: 2449 moveal %a1,%a2
}
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
new_block->prev_size = block_size;
new_block->size_and_flag = new_block_size;
45fa6: 2340 0004 movel %d0,%a1@(4)
_Heap_Block_split( heap, new_block, free_list_anchor, alloc_size );
45faa: 2f05 movel %d5,%sp@- 45fac: 2f01 movel %d1,%sp@- 45fae: 2f09 movel %a1,%sp@- 45fb0: 2f0b movel %a3,%sp@- 45fb2: 4eb9 0004 5e14 jsr 45e14 <_Heap_Block_split>
alloc_size
);
}
/* Statistics */
if ( stats->min_free_size > stats->free_size ) {
45fb8: 202b 0030 movel %a3@(48),%d0
block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED;
new_block->prev_size = block_size;
new_block->size_and_flag = new_block_size;
_Heap_Block_split( heap, new_block, free_list_anchor, alloc_size );
45fbc: 4fef 0010 lea %sp@(16),%sp
Heap_Block *block,
uintptr_t alloc_begin,
uintptr_t alloc_size
)
{
Heap_Statistics *const stats = &heap->stats;
45fc0: b0ab 0034 cmpl %a3@(52),%d0 45fc4: 6404 bccs 45fca <_Heap_Block_allocate+0xe8>
);
}
/* Statistics */
if ( stats->min_free_size > stats->free_size ) {
stats->min_free_size = stats->free_size;
45fc6: 2740 0034 movel %d0,%a3@(52)
}
return block;
}
45fca: 200a movel %a2,%d0 45fcc: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 45fd2: 4e5e unlk %fp 45fd4: 4e75 rts
...
0004a39c <_Heap_Free>:
#include <rtems/system.h>
#include <rtems/score/sysstate.h>
#include <rtems/score/heap.h>
bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr )
{
4a39c: 4e56 ffe8 linkw %fp,#-24 4a3a0: 202e 000c movel %fp@(12),%d0
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 )
4a3a4: 2240 moveal %d0,%a1 4a3a6: 5189 subql #8,%a1 4a3a8: 206e 0008 moveal %fp@(8),%a0 4a3ac: 4c68 0001 0010 remul %a0@(16),%d1,%d0 4a3b2: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@
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;
4a3b6: 2828 0020 movel %a0@(32),%d4
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 )
4a3ba: 93c1 subal %d1,%a1
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
4a3bc: b889 cmpl %a1,%d4 4a3be: 6200 0140 bhiw 4a500 <_Heap_Free+0x164> 4a3c2: b3e8 0024 cmpal %a0@(36),%a1 4a3c6: 53c0 sls %d0 4a3c8: 49c0 extbl %d0 4a3ca: 4480 negl %d0
Heap_Block *next_block = NULL;
uintptr_t block_size = 0;
uintptr_t next_block_size = 0;
bool next_is_free = false;
if ( !_Heap_Is_block_in_heap( heap, block ) ) {
4a3cc: 4a00 tstb %d0 4a3ce: 6700 0130 beqw 4a500 <_Heap_Free+0x164>
- 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;
4a3d2: 2629 0004 movel %a1@(4),%d3 4a3d6: 70fe moveq #-2,%d0 4a3d8: c083 andl %d3,%d0
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
const Heap_Block *block,
uintptr_t offset
)
{
return (Heap_Block *) ((uintptr_t) block + offset);
4a3da: 45f1 0800 lea %a1@(00000000,%d0:l),%a2
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
4a3de: b88a cmpl %a2,%d4 4a3e0: 6200 011e bhiw 4a500 <_Heap_Free+0x164> 4a3e4: b5e8 0024 cmpal %a0@(36),%a2 4a3e8: 53c1 sls %d1 4a3ea: 49c1 extbl %d1 4a3ec: 4481 negl %d1
}
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
if ( !_Heap_Is_block_in_heap( heap, next_block ) ) {
4a3ee: 4a01 tstb %d1 4a3f0: 6700 010e beqw 4a500 <_Heap_Free+0x164>
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;
4a3f4: 222a 0004 movel %a2@(4),%d1
_HAssert( false );
return false;
}
if ( !_Heap_Is_prev_used( next_block ) ) {
4a3f8: 7401 moveq #1,%d2 4a3fa: c481 andl %d1,%d2 4a3fc: 4a02 tstb %d2 4a3fe: 6700 0100 beqw 4a500 <_Heap_Free+0x164>
- 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;
4a402: 74fe moveq #-2,%d2
return false;
}
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 ));
4a404: 2668 0024 moveal %a0@(36),%a3 4a408: c282 andl %d2,%d1
_HAssert( false );
return false;
}
next_block_size = _Heap_Block_size( next_block );
next_is_free = next_block != heap->last_block
4a40a: b7ca cmpal %a2,%a3 4a40c: 6604 bnes 4a412 <_Heap_Free+0x76> 4a40e: 4282 clrl %d2 4a410: 6010 bras 4a422 <_Heap_Free+0x86> 4a412: 7401 moveq #1,%d2 4a414: 7a01 moveq #1,%d5 4a416: c4b2 1804 andl %a2@(00000004,%d1:l),%d2 4a41a: bb82 eorl %d5,%d2 4a41c: 0282 0000 00ff andil #255,%d2
&& !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size ));
if ( !_Heap_Is_prev_used( block ) ) {
4a422: 7a01 moveq #1,%d5 4a424: c685 andl %d5,%d3 4a426: 4a03 tstb %d3 4a428: 6662 bnes 4a48c <_Heap_Free+0xf0>
uintptr_t const prev_size = block->prev_size;
4a42a: 2611 movel %a1@,%d3
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
const Heap_Block *block,
uintptr_t offset
)
{
return (Heap_Block *) ((uintptr_t) block + offset);
4a42c: 93c3 subal %d3,%a1
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
4a42e: b889 cmpl %a1,%d4 4a430: 6200 00ce bhiw 4a500 <_Heap_Free+0x164> 4a434: b3cb cmpal %a3,%a1 4a436: 53c4 sls %d4 4a438: 49c4 extbl %d4 4a43a: 4484 negl %d4
Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size );
if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) {
4a43c: 4a04 tstb %d4 4a43e: 6700 00c0 beqw 4a500 <_Heap_Free+0x164>
return( false );
}
/* As we always coalesce free blocks, the block that preceedes prev_block
must have been used. */
if ( !_Heap_Is_prev_used ( prev_block) ) {
4a442: 7801 moveq #1,%d4 4a444: c8a9 0004 andl %a1@(4),%d4 4a448: 4a04 tstb %d4 4a44a: 6700 00b4 beqw 4a500 <_Heap_Free+0x164>
_HAssert( false );
return( false );
}
if ( next_is_free ) { /* coalesce both */
4a44e: 4a02 tstb %d2 4a450: 6726 beqs 4a478 <_Heap_Free+0xdc>
uintptr_t const size = block_size + prev_size + next_block_size;
4a452: d280 addl %d0,%d1 4a454: d681 addl %d1,%d3
_Heap_Free_list_remove( next_block );
stats->free_blocks -= 1;
4a456: 53a8 0038 subql #1,%a0@(56)
prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
4a45a: 7201 moveq #1,%d1
}
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
Heap_Block *prev = block->prev;
4a45c: 266a 000c moveal %a2@(12),%a3 4a460: 8283 orl %d3,%d1
return _Heap_Free_list_tail(heap)->prev;
}
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
4a462: 246a 0008 moveal %a2@(8),%a2
next_block = _Heap_Block_at( prev_block, size );
_HAssert(!_Heap_Is_prev_used( next_block));
next_block->prev_size = size;
4a466: 2383 3800 movel %d3,%a1@(00000000,%d3:l)
if ( next_is_free ) { /* coalesce both */
uintptr_t const size = block_size + prev_size + next_block_size;
_Heap_Free_list_remove( next_block );
stats->free_blocks -= 1;
prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
4a46a: 2341 0004 movel %d1,%a1@(4)
Heap_Block *prev = block->prev;
prev->next = next;
next->prev = prev;
4a46e: 254b 000c movel %a3,%a2@(12)
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
Heap_Block *prev = block->prev;
prev->next = next;
4a472: 274a 0008 movel %a2,%a3@(8) 4a476: 6078 bras 4a4f0 <_Heap_Free+0x154>
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;
4a478: d680 addl %d0,%d3
prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
4a47a: 7401 moveq #1,%d2
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
4a47c: 7afe moveq #-2,%d5
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;
4a47e: 8483 orl %d3,%d2
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
next_block->prev_size = size;
4a480: 2483 movel %d3,%a2@
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;
4a482: 2342 0004 movel %d2,%a1@(4)
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
4a486: cbaa 0004 andl %d5,%a2@(4) 4a48a: 6064 bras 4a4f0 <_Heap_Free+0x154>
next_block->prev_size = size;
}
} else if ( next_is_free ) { /* coalesce next */
4a48c: 4a02 tstb %d2 4a48e: 6728 beqs 4a4b8 <_Heap_Free+0x11c>
Heap_Block *old_block,
Heap_Block *new_block
)
{
Heap_Block *next = old_block->next;
Heap_Block *prev = old_block->prev;
4a490: 266a 000c moveal %a2@(12),%a3
uintptr_t const size = block_size + next_block_size;
4a494: d280 addl %d0,%d1
_Heap_Free_list_replace( next_block, block );
block->size_and_flag = size | HEAP_PREV_BLOCK_USED;
4a496: 7401 moveq #1,%d2
RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace(
Heap_Block *old_block,
Heap_Block *new_block
)
{
Heap_Block *next = old_block->next;
4a498: 246a 0008 moveal %a2@(8),%a2
Heap_Block *prev = old_block->prev;
new_block->next = next;
new_block->prev = prev;
4a49c: 234b 000c movel %a3,%a1@(12) 4a4a0: 8481 orl %d1,%d2
)
{
Heap_Block *next = old_block->next;
Heap_Block *prev = old_block->prev;
new_block->next = next;
4a4a2: 234a 0008 movel %a2,%a1@(8)
next_block = _Heap_Block_at( block, size );
next_block->prev_size = size;
4a4a6: 2381 1800 movel %d1,%a1@(00000000,%d1:l)
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;
4a4aa: 2342 0004 movel %d2,%a1@(4)
new_block->prev = prev;
next->prev = new_block;
4a4ae: 2549 000c movel %a1,%a2@(12)
prev->next = new_block;
4a4b2: 2749 0008 movel %a1,%a3@(8) 4a4b6: 6038 bras 4a4f0 <_Heap_Free+0x154>
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;
4a4b8: 7a01 moveq #1,%d5
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
4a4ba: 72fe moveq #-2,%d1
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;
4a4bc: 8a80 orl %d0,%d5
RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after(
Heap_Block *block_before,
Heap_Block *new_block
)
{
Heap_Block *next = block_before->next;
4a4be: 2668 0008 moveal %a0@(8),%a3 4a4c2: 2345 0004 movel %d5,%a1@(4)
next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED;
4a4c6: c3aa 0004 andl %d1,%a2@(4)
next_block->prev_size = block_size;
4a4ca: 2480 movel %d0,%a2@
/* Statistics */
++stats->free_blocks;
4a4cc: 2228 0038 movel %a0@(56),%d1 4a4d0: 5281 addql #1,%d1
new_block->next = next;
4a4d2: 234b 0008 movel %a3,%a1@(8)
new_block->prev = block_before;
4a4d6: 2348 000c movel %a0,%a1@(12)
block_before->next = new_block;
4a4da: 2149 0008 movel %a1,%a0@(8)
next->prev = new_block;
4a4de: 2749 000c movel %a1,%a3@(12) 4a4e2: 2141 0038 movel %d1,%a0@(56)
#include <rtems/score/sysstate.h>
#include <rtems/score/heap.h>
bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr )
{
Heap_Statistics *const stats = &heap->stats;
4a4e6: b2a8 003c cmpl %a0@(60),%d1 4a4ea: 6304 blss 4a4f0 <_Heap_Free+0x154>
next_block->prev_size = block_size;
/* Statistics */
++stats->free_blocks;
if ( stats->max_free_blocks < stats->free_blocks ) {
stats->max_free_blocks = stats->free_blocks;
4a4ec: 2141 003c movel %d1,%a0@(60)
}
/* Statistics */
--stats->used_blocks;
++stats->frees;
stats->free_size += block_size;
4a4f0: d1a8 0030 addl %d0,%a0@(48)
stats->max_free_blocks = stats->free_blocks;
}
}
/* Statistics */
--stats->used_blocks;
4a4f4: 53a8 0040 subql #1,%a0@(64)
++stats->frees;
4a4f8: 52a8 0050 addql #1,%a0@(80)
stats->free_size += block_size;
4a4fc: 7001 moveq #1,%d0
return( true );
4a4fe: 6002 bras 4a502 <_Heap_Free+0x166> 4a500: 4200 clrb %d0
}
4a502: 4cd7 0c3c moveml %sp@,%d2-%d5/%a2-%a3 4a506: 4e5e unlk %fp 4a508: 4e75 rts
...
00063b88 <_Heap_Get_free_information>:
void _Heap_Get_free_information(
Heap_Control *the_heap,
Heap_Information *info
)
{
63b88: 4e56 0000 linkw %fp,#0 63b8c: 206e 000c moveal %fp@(12),%a0 63b90: 2f0a movel %a2,%sp@- 63b92: 246e 0008 moveal %fp@(8),%a2
Heap_Block *the_block;
Heap_Block *const tail = _Heap_Free_list_tail(the_heap);
info->number = 0;
63b96: 4290 clrl %a0@
return &heap->free_list;
}
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap )
{
return _Heap_Free_list_head(heap)->next;
63b98: 226a 0008 moveal %a2@(8),%a1
info->largest = 0;
63b9c: 42a8 0004 clrl %a0@(4)
info->total = 0;
63ba0: 42a8 0008 clrl %a0@(8)
for(the_block = _Heap_Free_list_first(the_heap);
63ba4: 601a bras 63bc0 <_Heap_Get_free_information+0x38>
- 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;
63ba6: 70fe moveq #-2,%d0 63ba8: c0a9 0004 andl %a1@(4),%d0
uint32_t const the_size = _Heap_Block_size(the_block);
/* As we always coalesce free blocks, prev block must have been used. */
_HAssert(_Heap_Is_prev_used(the_block));
info->number++;
63bac: 5290 addql #1,%a0@
info->total += the_size;
63bae: d1a8 0008 addl %d0,%a0@(8)
if ( info->largest < the_size )
63bb2: b0a8 0004 cmpl %a0@(4),%d0 63bb6: 6304 blss 63bbc <_Heap_Get_free_information+0x34>
info->largest = the_size;
63bb8: 2140 0004 movel %d0,%a0@(4)
info->largest = 0;
info->total = 0;
for(the_block = _Heap_Free_list_first(the_heap);
the_block != tail;
the_block = the_block->next)
63bbc: 2269 0008 moveal %a1@(8),%a1
info->number = 0;
info->largest = 0;
info->total = 0;
for(the_block = _Heap_Free_list_first(the_heap);
63bc0: b5c9 cmpal %a1,%a2 63bc2: 66e2 bnes 63ba6 <_Heap_Get_free_information+0x1e>
info->number++;
info->total += the_size;
if ( info->largest < the_size )
info->largest = the_size;
}
}
63bc4: 245f moveal %sp@+,%a2 63bc6: 4e5e unlk %fp 63bc8: 4e75 rts
...
00059754 <_Heap_Resize_block>:
void *alloc_begin_ptr,
uintptr_t new_alloc_size,
uintptr_t *old_size,
uintptr_t *new_size
)
{
59754: 4e56 ffe0 linkw %fp,#-32 59758: 48d7 1c7c moveml %d2-%d6/%a2-%a4,%sp@ 5975c: 242e 000c movel %fp@(12),%d2
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 )
59760: 2202 movel %d2,%d1 59762: 2042 moveal %d2,%a0 59764: 5188 subql #8,%a0 59766: 246e 0008 moveal %fp@(8),%a2 5976a: 286e 0014 moveal %fp@(20),%a4 5976e: 4c6a 1000 0010 remul %a2@(16),%d0,%d1
uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr;
Heap_Block *const block = _Heap_Block_of_alloc_area( alloc_begin, page_size );
*old_size = 0;
59774: 4294 clrl %a4@
void *alloc_begin_ptr,
uintptr_t new_alloc_size,
uintptr_t *old_size,
uintptr_t *new_size
)
{
59776: 266e 0018 moveal %fp@(24),%a3 5977a: 91c0 subal %d0,%a0 5977c: 2a2e 0010 movel %fp@(16),%d5
uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr;
Heap_Block *const block = _Heap_Block_of_alloc_area( alloc_begin, page_size );
*old_size = 0;
*new_size = 0;
59780: 4293 clrl %a3@
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
59782: b1ea 0020 cmpal %a2@(32),%a0 59786: 6500 0096 bcsw 5981e <_Heap_Resize_block+0xca> 5978a: b1ea 0024 cmpal %a2@(36),%a0 5978e: 6200 008e bhiw 5981e <_Heap_Resize_block+0xca>
- 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;
59792: 70fe moveq #-2,%d0 59794: 72fe moveq #-2,%d1
RTEMS_INLINE_ROUTINE bool _Heap_Is_free(
const Heap_Block *block
)
{
return !_Heap_Is_used( block );
59796: 7801 moveq #1,%d4 59798: 7c01 moveq #1,%d6
uintptr_t const block_begin = (uintptr_t) block;
uintptr_t block_size = _Heap_Block_size( block );
uintptr_t block_end = block_begin + block_size;
uintptr_t alloc_size = block_end - alloc_begin + HEAP_BLOCK_SIZE_OFFSET;
5979a: 7604 moveq #4,%d3 5979c: 9682 subl %d2,%d3
- 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;
5979e: c0a8 0004 andl %a0@(4),%d0
{
Heap_Statistics *const stats = &heap->stats;
uintptr_t const block_begin = (uintptr_t) block;
uintptr_t block_size = _Heap_Block_size( block );
uintptr_t block_end = block_begin + block_size;
597a2: 43f0 0800 lea %a0@(00000000,%d0:l),%a1
uintptr_t alloc_size = block_end - alloc_begin + HEAP_BLOCK_SIZE_OFFSET;
597a6: d689 addl %a1,%d3 597a8: c2a9 0004 andl %a1@(4),%d1
RTEMS_INLINE_ROUTINE bool _Heap_Is_free(
const Heap_Block *block
)
{
return !_Heap_Is_used( block );
597ac: c8b1 1804 andl %a1@(00000004,%d1:l),%d4
bool next_block_is_free = _Heap_Is_free( next_block );;
_HAssert( _Heap_Is_block_in_heap( heap, next_block ) );
_HAssert( _Heap_Is_prev_used( next_block ) );
*old_size = alloc_size;
597b0: 2883 movel %d3,%a4@ 597b2: bd84 eorl %d6,%d4 597b4: 1c04 moveb %d4,%d6
if ( next_block_is_free ) {
597b6: 6704 beqs 597bc <_Heap_Resize_block+0x68>
block_size += next_block_size;
597b8: d081 addl %d1,%d0
alloc_size += next_block_size;
597ba: d681 addl %d1,%d3
}
if ( new_alloc_size > alloc_size ) {
597bc: b685 cmpl %d5,%d3 597be: 6404 bccs 597c4 <_Heap_Resize_block+0x70> 597c0: 7001 moveq #1,%d0 597c2: 605c bras 59820 <_Heap_Resize_block+0xcc>
return HEAP_RESIZE_UNSATISFIED;
}
if ( next_block_is_free ) {
597c4: 4a06 tstb %d6 597c6: 672a beqs 597f2 <_Heap_Resize_block+0x9e>
uintptr_t size
)
{
uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;
block->size_and_flag = size | flag;
597c8: 7601 moveq #1,%d3 597ca: c6a8 0004 andl %a0@(4),%d3
}
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
Heap_Block *prev = block->prev;
597ce: 2869 000c moveal %a1@(12),%a4
uintptr_t size
)
{
uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;
block->size_and_flag = size | flag;
597d2: 8680 orl %d0,%d3
return _Heap_Free_list_tail(heap)->prev;
}
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
597d4: 2269 0008 moveal %a1@(8),%a1
uintptr_t size
)
{
uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;
block->size_and_flag = size | flag;
597d8: 2143 0004 movel %d3,%a0@(4)
_Heap_Block_set_size( block, block_size );
_Heap_Free_list_remove( next_block );
next_block = _Heap_Block_at( block, block_size );
next_block->size_and_flag |= HEAP_PREV_BLOCK_USED;
597dc: 7601 moveq #1,%d3 597de: 87b0 0804 orl %d3,%a0@(00000004,%d0:l)
{
Heap_Block *next = block->next;
Heap_Block *prev = block->prev;
prev->next = next;
next->prev = prev;
597e2: 234c 000c movel %a4,%a1@(12)
/* Statistics */
--stats->free_blocks;
stats->free_size -= next_block_size;
597e6: 93aa 0030 subl %d1,%a2@(48)
next_block = _Heap_Block_at( block, block_size );
next_block->size_and_flag |= HEAP_PREV_BLOCK_USED;
/* Statistics */
--stats->free_blocks;
597ea: 53aa 0038 subql #1,%a2@(56)
RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block )
{
Heap_Block *next = block->next;
Heap_Block *prev = block->prev;
prev->next = next;
597ee: 2949 0008 movel %a1,%a4@(8)
stats->free_size -= next_block_size;
}
block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size );
597f2: 2f05 movel %d5,%sp@- 597f4: 2f02 movel %d2,%sp@- 597f6: 2f08 movel %a0,%sp@- 597f8: 2f0a movel %a2,%sp@- 597fa: 4eb9 0004 5ee2 jsr 45ee2 <_Heap_Block_allocate>
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
*new_size = (uintptr_t) next_block - alloc_begin + HEAP_BLOCK_SIZE_OFFSET;
/* Statistics */
++stats->resizes;
59800: 4fef 0010 lea %sp@(16),%sp
block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size );
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
*new_size = (uintptr_t) next_block - alloc_begin + HEAP_BLOCK_SIZE_OFFSET;
59804: 72fe moveq #-2,%d1
/* Statistics */
--stats->free_blocks;
stats->free_size -= next_block_size;
}
block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size );
59806: 2040 moveal %d0,%a0
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
*new_size = (uintptr_t) next_block - alloc_begin + HEAP_BLOCK_SIZE_OFFSET;
59808: 2240 moveal %d0,%a1 5980a: 93c2 subal %d2,%a1
/* Statistics */
++stats->resizes;
5980c: 4280 clrl %d0
block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size );
block_size = _Heap_Block_size( block );
next_block = _Heap_Block_at( block, block_size );
*new_size = (uintptr_t) next_block - alloc_begin + HEAP_BLOCK_SIZE_OFFSET;
5980e: c2a8 0004 andl %a0@(4),%d1 59812: 43f1 1804 lea %a1@(00000004,%d1:l),%a1 59816: 2689 movel %a1,%a3@
/* Statistics */
++stats->resizes;
59818: 52aa 0054 addql #1,%a2@(84) 5981c: 6002 bras 59820 <_Heap_Resize_block+0xcc> 5981e: 7002 moveq #2,%d0
new_size
);
} else {
return HEAP_RESIZE_FATAL_ERROR;
}
}
59820: 4cee 1c7c ffe0 moveml %fp@(-32),%d2-%d6/%a2-%a4 59826: 4e5e unlk %fp 59828: 4e75 rts
...
00046cc4 <_Heap_Walk_print>:
{
/* Do nothing */
}
static void _Heap_Walk_print( int source, bool error, const char *fmt, ... )
{
46cc4: 41f9 0004 3474 lea 43474 <printk>,%a0 46cca: 4e56 0000 linkw %fp,#0 46cce: 202e 0008 movel %fp@(8),%d0
va_list ap;
if ( error ) {
46cd2: 4a2e 000f tstb %fp@(15) 46cd6: 670a beqs 46ce2 <_Heap_Walk_print+0x1e>
printk( "FAIL[%d]: ", source );
46cd8: 2f00 movel %d0,%sp@- 46cda: 4879 0005 b723 pea 5b723 <C.30.3398+0x40f> 46ce0: 6008 bras 46cea <_Heap_Walk_print+0x26>
} else {
printk( "PASS[%d]: ", source );
46ce2: 2f00 movel %d0,%sp@- 46ce4: 4879 0005 b72e pea 5b72e <C.30.3398+0x41a> 46cea: 4e90 jsr %a0@ 46cec: 508f addql #8,%sp
}
va_start( ap, fmt );
vprintk( fmt, ap );
46cee: 486e 0014 pea %fp@(20) 46cf2: 2f2e 0010 movel %fp@(16),%sp@- 46cf6: 4eb9 0004 4df8 jsr 44df8 <vprintk> 46cfc: 508f addql #8,%sp
va_end( ap ); }
46cfe: 4e5e unlk %fp 46d00: 4e75 rts
...
00045fd8 <_Internal_error_Occurred>:
void _Internal_error_Occurred(
Internal_errors_Source the_source,
bool is_internal,
Internal_errors_t the_error
)
{
45fd8: 4e56 0000 linkw %fp,#0 45fdc: 222e 000c movel %fp@(12),%d1 45fe0: 2f03 movel %d3,%sp@-
_Internal_errors_What_happened.the_source = the_source;
_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 );
45fe2: 4283 clrl %d3 45fe4: 1601 moveb %d1,%d3
void _Internal_error_Occurred(
Internal_errors_Source the_source,
bool is_internal,
Internal_errors_t the_error
)
{
45fe6: 2f02 movel %d2,%sp@- 45fe8: 242e 0010 movel %fp@(16),%d2
_Internal_errors_What_happened.the_source = the_source;
_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 );
45fec: 2f02 movel %d2,%sp@-
void _Internal_error_Occurred(
Internal_errors_Source the_source,
bool is_internal,
Internal_errors_t the_error
)
{
45fee: 202e 0008 movel %fp@(8),%d0
_Internal_errors_What_happened.the_source = the_source;
_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 );
45ff2: 2f03 movel %d3,%sp@-
_System_state_Set( SYSTEM_STATE_FAILED );
_CPU_Fatal_halt( the_error );
45ff4: 263c 0000 0700 movel #1792,%d3
_Internal_errors_What_happened.the_source = the_source;
_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 );
45ffa: 2f00 movel %d0,%sp@-
Internal_errors_t the_error
)
{
_Internal_errors_What_happened.the_source = the_source;
_Internal_errors_What_happened.is_internal = is_internal;
45ffc: 13c1 0005 cd3e moveb %d1,5cd3e <_Internal_errors_What_happened+0x4>
bool is_internal,
Internal_errors_t the_error
)
{
_Internal_errors_What_happened.the_source = the_source;
46002: 23c0 0005 cd3a movel %d0,5cd3a <_Internal_errors_What_happened>
_Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error;
46008: 23c2 0005 cd40 movel %d2,5cd40 <_Internal_errors_What_happened+0x6>
_User_extensions_Fatal( the_source, is_internal, the_error );
4600e: 4eb9 0004 7b02 jsr 47b02 <_User_extensions_Fatal>
_System_state_Set( SYSTEM_STATE_FAILED );
_CPU_Fatal_halt( the_error );
46014: 40c0 movew %sr,%d0 46016: 8083 orl %d3,%d0 46018: 46c0 movew %d0,%sr
4601a: 2002 movel %d2,%d0 <== NOT EXECUTED 4601c: 223c dead beef movel #-559038737,%d1 <== NOT EXECUTED 46022: 4ac8 halt <== NOT EXECUTED
RTEMS_INLINE_ROUTINE void _System_state_Set (
System_state_Codes state
)
{
_System_state_Current = state;
46024: 7005 moveq #5,%d0 46026: 4fef 000c lea %sp@(12),%sp 4602a: 23c0 0005 ce1c movel %d0,5ce1c <_System_state_Current> 46030: 60fe bras 46030 <_Internal_error_Occurred+0x58>
...
0004cc78 <_Message_queue_Translate_core_message_queue_return_code>:
};
rtems_status_code _Message_queue_Translate_core_message_queue_return_code (
uint32_t status
)
{
4cc78: 41f9 0006 49e4 lea 649e4 <_Message_queue_Translate_core_return_code_>,%a0 4cc7e: 4e56 0000 linkw %fp,#0
if ( status > CORE_MESSAGE_QUEUE_STATUS_TIMEOUT )
return RTEMS_INTERNAL_ERROR;
#endif
return _Message_queue_Translate_core_return_code_[status];
}
4cc82: 202e 0008 movel %fp@(8),%d0 4cc86: 4e5e unlk %fp 4cc88: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4cc8c: 4e75 rts
...
0004a50c <_Objects_API_maximum_class>:
case OBJECTS_NO_API:
default:
break;
}
return 0;
}
4a50c: 7203 moveq #3,%d1
#include <rtems/score/object.h>
unsigned int _Objects_API_maximum_class(
uint32_t api
)
{
4a50e: 4e56 0000 linkw %fp,#0
case OBJECTS_NO_API:
default:
break;
}
return 0;
}
4a512: 202e 0008 movel %fp@(8),%d0 4a516: 5380 subql #1,%d0 4a518: b280 cmpl %d0,%d1 4a51a: 6404 bccs 4a520 <_Objects_API_maximum_class+0x14> 4a51c: 4280 clrl %d0 4a51e: 600a bras 4a52a <_Objects_API_maximum_class+0x1e> 4a520: 41f9 0005 a984 lea 5a984 <CSWTCH.8>,%a0 4a526: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4a52a: 4e5e unlk %fp 4a52c: 4e75 rts
...
0004609c <_Objects_Allocate>:
*/
Objects_Control *_Objects_Allocate(
Objects_Information *information
)
{
4609c: 4e56 fff0 linkw %fp,#-16 460a0: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ 460a4: 246e 0008 moveal %fp@(8),%a2
* 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 )
460a8: 4aaa 0014 tstl %a2@(20) 460ac: 6604 bnes 460b2 <_Objects_Allocate+0x16>
460ae: 4280 clrl %d0 <== NOT EXECUTED 460b0: 605e bras 46110 <_Objects_Allocate+0x74> <== NOT EXECUTED
/*
* 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 );
460b2: 240a movel %a2,%d2 460b4: 0682 0000 001c addil #28,%d2 460ba: 47f9 0004 a008 lea 4a008 <_Chain_Get>,%a3 460c0: 2f02 movel %d2,%sp@- 460c2: 4e93 jsr %a3@
if ( information->auto_extend ) {
460c4: 588f addql #4,%sp 460c6: 4a2a 0010 tstb %a2@(16) 460ca: 6744 beqs 46110 <_Objects_Allocate+0x74>
/*
* If the list is empty then we are out of objects and need to
* extend information base.
*/
if ( !the_object ) {
460cc: 4a80 tstl %d0 460ce: 6612 bnes 460e2 <_Objects_Allocate+0x46>
_Objects_Extend_information( information );
460d0: 2f0a movel %a2,%sp@- 460d2: 4eb9 0004 6148 jsr 46148 <_Objects_Extend_information>
the_object = (Objects_Control *) _Chain_Get( &information->Inactive );
460d8: 2f02 movel %d2,%sp@- 460da: 4e93 jsr %a3@
}
if ( the_object ) {
460dc: 508f addql #8,%sp 460de: 4a80 tstl %d0 460e0: 672e beqs 46110 <_Objects_Allocate+0x74>
uint32_t block;
block = (uint32_t) _Objects_Get_index( the_object->id ) -
460e2: 2040 moveal %d0,%a0 460e4: 4281 clrl %d1 460e6: 4283 clrl %d3
_Objects_Get_index( information->minimum_id );
block /= information->allocation_size;
information->inactive_per_block[ block ]--;
460e8: 4282 clrl %d2
}
if ( the_object ) {
uint32_t block;
block = (uint32_t) _Objects_Get_index( the_object->id ) -
460ea: 362a 0008 movew %a2@(8),%d3 460ee: 3228 000a movew %a0@(10),%d1
_Objects_Get_index( information->minimum_id );
block /= information->allocation_size;
information->inactive_per_block[ block ]--;
460f2: 342a 0012 movew %a2@(18),%d2
information->inactive--;
460f6: 306a 0028 moveaw %a2@(40),%a0
}
if ( the_object ) {
uint32_t block;
block = (uint32_t) _Objects_Get_index( the_object->id ) -
460fa: 9283 subl %d3,%d1
_Objects_Get_index( information->minimum_id );
block /= information->allocation_size;
information->inactive_per_block[ block ]--;
460fc: 4c42 1001 remul %d2,%d1,%d1
information->inactive--;
46100: 5388 subql #1,%a0
block = (uint32_t) _Objects_Get_index( the_object->id ) -
_Objects_Get_index( information->minimum_id );
block /= information->allocation_size;
information->inactive_per_block[ block ]--;
46102: e589 lsll #2,%d1
information->inactive--;
46104: 3548 0028 movew %a0,%a2@(40)
block = (uint32_t) _Objects_Get_index( the_object->id ) -
_Objects_Get_index( information->minimum_id );
block /= information->allocation_size;
information->inactive_per_block[ block ]--;
46108: 206a 002a moveal %a2@(42),%a0 4610c: d1c1 addal %d1,%a0 4610e: 5390 subql #1,%a0@
information->inactive--;
}
}
return the_object;
}
46110: 4cee 0c0c fff0 moveml %fp@(-16),%d2-%d3/%a2-%a3 46116: 4e5e unlk %fp 46118: 4e75 rts
...
0004611c <_Objects_Close>:
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4611c: 4280 clrl %d0
void _Objects_Close(
Objects_Information *information,
Objects_Control *the_object
)
{
4611e: 4e56 0000 linkw %fp,#0 46122: 226e 000c moveal %fp@(12),%a1 46126: 206e 0008 moveal %fp@(8),%a0 4612a: 2f0a movel %a2,%sp@- 4612c: 2468 0018 moveal %a0@(24),%a2 46130: 3029 000a movew %a1@(10),%d0 46134: 42b2 0c00 clrl %a2@(00000000,%d0:l:4)
_Objects_Invalidate_Id( information, the_object );
_Objects_Namespace_remove( information, the_object );
46138: 2d49 000c movel %a1,%fp@(12)
}
4613c: 245f moveal %sp@+,%a2 4613e: 4e5e unlk %fp
Objects_Control *the_object
)
{
_Objects_Invalidate_Id( information, the_object );
_Objects_Namespace_remove( information, the_object );
46140: 4ef9 0004 6640 jmp 46640 <_Objects_Namespace_remove>
...
00046148 <_Objects_Extend_information>:
*/
void _Objects_Extend_information(
Objects_Information *information
)
{
46148: 4e56 ffc8 linkw %fp,#-56 4614c: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 46150: 246e 0008 moveal %fp@(8),%a2
/*
* Search for a free block of indexes. The block variable ends up set
* to block_count + 1 if the table needs to be extended.
*/
minimum_index = _Objects_Get_index( information->minimum_id );
46154: 4283 clrl %d3
index_base = minimum_index;
block = 0;
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
46156: 206a 002e moveal %a2@(46),%a0
/*
* Search for a free block of indexes. The block variable ends up set
* to block_count + 1 if the table needs to be extended.
*/
minimum_index = _Objects_Get_index( information->minimum_id );
4615a: 362a 0008 movew %a2@(8),%d3
index_base = minimum_index;
block = 0;
/* if ( information->maximum < minimum_index ) */
if ( information->object_blocks == NULL )
4615e: 4a88 tstl %a0 46160: 6608 bnes 4616a <_Objects_Extend_information+0x22> 46162: 2403 movel %d3,%d2 46164: 4284 clrl %d4 46166: 4285 clrl %d5 46168: 602a bras 46194 <_Objects_Extend_information+0x4c>
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
4616a: 4280 clrl %d0 4616c: 2403 movel %d3,%d2 4616e: 4284 clrl %d4 46170: 302a 0012 movew %a2@(18),%d0 46174: 3a2a 000e movew %a2@(14),%d5 46178: 0285 0000 ffff andil #65535,%d5 4617e: 8ac0 divuw %d0,%d5 46180: 0285 0000 ffff andil #65535,%d5
for ( ; block < block_count; block++ ) {
46186: 6008 bras 46190 <_Objects_Extend_information+0x48>
if ( information->object_blocks[ block ] == NULL )
46188: 4a98 tstl %a0@+ 4618a: 6708 beqs 46194 <_Objects_Extend_information+0x4c> 4618c: d480 addl %d0,%d2
if ( information->object_blocks == NULL )
block_count = 0;
else {
block_count = information->maximum / information->allocation_size;
for ( ; block < block_count; block++ ) {
4618e: 5284 addql #1,%d4 46190: ba84 cmpl %d4,%d5 46192: 62f4 bhis 46188 <_Objects_Extend_information+0x40>
else
index_base += information->allocation_size;
}
}
maximum = (uint32_t) information->maximum + information->allocation_size;
46194: 4280 clrl %d0 46196: 4287 clrl %d7 46198: 302a 0012 movew %a2@(18),%d0 4619c: 3e2a 000e movew %a2@(14),%d7 461a0: de80 addl %d0,%d7
/*
* 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 ) {
461a2: 0c87 0000 ffff cmpil #65535,%d7 461a8: 6200 01da bhiw 46384 <_Objects_Extend_information+0x23c>
/*
* 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;
461ac: 41ea 0014 lea %a2@(20),%a0 461b0: 4c10 0800 mulsl %a0@,%d0
if ( information->auto_extend ) {
461b4: 4a2a 0010 tstb %a2@(16) 461b8: 6712 beqs 461cc <_Objects_Extend_information+0x84>
new_object_block = _Workspace_Allocate( block_size );
461ba: 2f00 movel %d0,%sp@- 461bc: 4eb9 0004 7e90 jsr 47e90 <_Workspace_Allocate>
if ( !new_object_block )
461c2: 588f addql #4,%sp
* 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 ) {
new_object_block = _Workspace_Allocate( block_size );
461c4: 2c00 movel %d0,%d6
if ( !new_object_block )
461c6: 6610 bnes 461d8 <_Objects_Extend_information+0x90> 461c8: 6000 01ba braw 46384 <_Objects_Extend_information+0x23c>
return;
} else {
new_object_block = _Workspace_Allocate_or_fatal_error( block_size );
461cc: 2f00 movel %d0,%sp@- 461ce: 4eb9 0004 7e5c jsr 47e5c <_Workspace_Allocate_or_fatal_error> 461d4: 588f addql #4,%sp 461d6: 2c00 movel %d0,%d6
}
/*
* If the index_base is the maximum we need to grow the tables.
*/
if (index_base >= information->maximum ) {
461d8: 4280 clrl %d0 461da: 302a 000e movew %a2@(14),%d0 461de: b082 cmpl %d2,%d0 461e0: 6200 0112 bhiw 462f4 <_Objects_Extend_information+0x1ac>
*/
/*
* Up the block count and maximum
*/
block_count++;
461e4: 2845 moveal %d5,%a4 461e6: 528c addql #1,%a4
* Allocate the tables and break it up.
*/
block_size = block_count *
(sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) +
((maximum + minimum_index) * sizeof(Objects_Control *));
object_blocks = (void**) _Workspace_Allocate( block_size );
461e8: 2007 movel %d7,%d0 461ea: d083 addl %d3,%d0 461ec: 41f4 ca00 lea %a4@(00000000,%a4:l:2),%a0 461f0: d088 addl %a0,%d0 461f2: e588 lsll #2,%d0 461f4: 2f00 movel %d0,%sp@- 461f6: 4eb9 0004 7e90 jsr 47e90 <_Workspace_Allocate>
if ( !object_blocks ) {
461fc: 588f addql #4,%sp
* Allocate the tables and break it up.
*/
block_size = block_count *
(sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) +
((maximum + minimum_index) * sizeof(Objects_Control *));
object_blocks = (void**) _Workspace_Allocate( block_size );
461fe: 2640 moveal %d0,%a3
if ( !object_blocks ) {
46200: 4a80 tstl %d0 46202: 660e bnes 46212 <_Objects_Extend_information+0xca>
_Workspace_Free( new_object_block );
46204: 2f06 movel %d6,%sp@- 46206: 4eb9 0004 7eac jsr 47eac <_Workspace_Free>
return;
4620c: 588f addql #4,%sp 4620e: 6000 0174 braw 46384 <_Objects_Extend_information+0x23c>
}
/*
* Break the block into the various sections.
*/
inactive_per_block = (uint32_t *) _Addresses_Add_offset(
46212: 200c movel %a4,%d0 46214: e588 lsll #2,%d0 46216: 2840 moveal %d0,%a4
* Take the block count down. Saves all the (block_count - 1)
* in the copies.
*/
block_count--;
if ( information->maximum > minimum_index ) {
46218: 4280 clrl %d0
RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset (
const void *base,
uintptr_t offset
)
{
return (void *)((uintptr_t)base + offset);
4621a: 4bf3 c800 lea %a3@(00000000,%a4:l),%a5 4621e: 49f5 c800 lea %a5@(00000000,%a4:l),%a4 46222: 302a 000e movew %a2@(14),%d0 46226: b680 cmpl %d0,%d3 46228: 6506 bcss 46230 <_Objects_Extend_information+0xe8> 4622a: 204c moveal %a4,%a0 4622c: 4280 clrl %d0 4622e: 604a bras 4627a <_Objects_Extend_information+0x132>
/*
* 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,
46230: 2205 movel %d5,%d1 46232: e589 lsll #2,%d1 46234: 2f01 movel %d1,%sp@- 46236: 2f2a 002e movel %a2@(46),%sp@- 4623a: 2d41 fff0 movel %d1,%fp@(-16) 4623e: 2f0b movel %a3,%sp@- 46240: 4eb9 0004 d23c jsr 4d23c <memcpy>
information->object_blocks,
block_count * sizeof(void*) );
memcpy( inactive_per_block,
46246: 222e fff0 movel %fp@(-16),%d1 4624a: 2f01 movel %d1,%sp@- 4624c: 2f2a 002a movel %a2@(42),%sp@- 46250: 2f0d movel %a5,%sp@- 46252: 4eb9 0004 d23c jsr 4d23c <memcpy>
information->inactive_per_block,
block_count * sizeof(uint32_t) );
memcpy( local_table,
46258: 4280 clrl %d0 4625a: 302a 000e movew %a2@(14),%d0 4625e: d680 addl %d0,%d3 46260: e58b lsll #2,%d3 46262: 2f03 movel %d3,%sp@- 46264: 2f2a 0018 movel %a2@(24),%sp@- 46268: 2f0c movel %a4,%sp@- 4626a: 4eb9 0004 d23c jsr 4d23c <memcpy> 46270: 4fef 0024 lea %sp@(36),%sp 46274: 6008 bras 4627e <_Objects_Extend_information+0x136>
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
local_table[ index ] = NULL;
46276: 4298 clrl %a0@+
} else {
/*
* Deal with the special case of the 0 to minimum_index
*/
for ( index = 0; index < minimum_index; index++ ) {
46278: 5280 addql #1,%d0 4627a: b680 cmpl %d0,%d3 4627c: 62f8 bhis 46276 <_Objects_Extend_information+0x12e>
*/
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
4627e: 4281 clrl %d1 46280: 2002 movel %d2,%d0
}
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
46282: e58d lsll #2,%d5
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
46284: 322a 0012 movew %a2@(18),%d1 46288: 41f4 2c00 lea %a4@(00000000,%d2:l:4),%a0
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
4628c: 42b5 5800 clrl %a5@(00000000,%d5:l)
for ( index=index_base ;
index < ( information->allocation_size + index_base );
46290: d282 addl %d2,%d1
}
/*
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
46292: 42b3 5800 clrl %a3@(00000000,%d5:l)
inactive_per_block[block_count] = 0;
for ( index=index_base ;
46296: 6004 bras 4629c <_Objects_Extend_information+0x154>
index < ( information->allocation_size + index_base );
index++ ) {
local_table[ index ] = NULL;
46298: 4298 clrl %a0@+
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
index < ( information->allocation_size + index_base );
index++ ) {
4629a: 5280 addql #1,%d0
* Initialise the new entries in the table.
*/
object_blocks[block_count] = NULL;
inactive_per_block[block_count] = 0;
for ( index=index_base ;
4629c: b280 cmpl %d0,%d1 4629e: 62f8 bhis 46298 <_Objects_Extend_information+0x150>
index < ( information->allocation_size + index_base );
index++ ) {
local_table[ index ] = NULL;
}
_ISR_Disable( level );
462a0: 203c 0000 0700 movel #1792,%d0 462a6: 40c3 movew %sr,%d3 462a8: 8083 orl %d3,%d0 462aa: 46c0 movew %d0,%sr
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = (Objects_Maximum) maximum;
information->maximum_id = _Objects_Build_id(
462ac: 2012 movel %a2@,%d0 462ae: 7218 moveq #24,%d1 462b0: 4285 clrl %d5 462b2: e3a8 lsll %d1,%d0 462b4: 3a07 movew %d7,%d5 462b6: 4281 clrl %d1 462b8: 2245 moveal %d5,%a1 462ba: 7a1b moveq #27,%d5 462bc: 322a 0004 movew %a2@(4),%d1 462c0: 08c0 0010 bset #16,%d0
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;
462c4: 3547 000e movew %d7,%a2@(14)
information->maximum_id = _Objects_Build_id(
462c8: eba9 lsll %d5,%d1 462ca: 2e09 movel %a1,%d7 462cc: 8081 orl %d1,%d0
local_table[ index ] = NULL;
}
_ISR_Disable( level );
old_tables = information->object_blocks;
462ce: 206a 002e moveal %a2@(46),%a0
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
information->maximum = (Objects_Maximum) maximum;
information->maximum_id = _Objects_Build_id(
462d2: 8e80 orl %d0,%d7
_ISR_Disable( level );
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
462d4: 254b 002e movel %a3,%a2@(46)
information->inactive_per_block = inactive_per_block;
462d8: 254d 002a movel %a5,%a2@(42)
information->local_table = local_table;
information->maximum = (Objects_Maximum) maximum;
information->maximum_id = _Objects_Build_id(
462dc: 2547 000a movel %d7,%a2@(10)
old_tables = information->object_blocks;
information->object_blocks = object_blocks;
information->inactive_per_block = inactive_per_block;
information->local_table = local_table;
462e0: 254c 0018 movel %a4,%a2@(24)
information->the_class,
_Objects_Local_node,
information->maximum
);
_ISR_Enable( level );
462e4: 46c3 movew %d3,%sr
if ( old_tables )
462e6: 4a88 tstl %a0 462e8: 670a beqs 462f4 <_Objects_Extend_information+0x1ac>
_Workspace_Free( old_tables );
462ea: 2f08 movel %a0,%sp@- 462ec: 4eb9 0004 7eac jsr 47eac <_Workspace_Free> 462f2: 588f addql #4,%sp
}
/*
* Assign the new object block to the object block table.
*/
information->object_blocks[ block ] = new_object_block;
462f4: 206a 002e moveal %a2@(46),%a0
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
462f8: 4281 clrl %d1 462fa: 200e movel %fp,%d0 462fc: 0680 ffff fff4 addil #-12,%d0
/*
* Move from the local chain, initialise, then append to the inactive chain
*/
index = index_base;
while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) {
46302: 2a00 movel %d0,%d5
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
46304: 260a movel %a2,%d3 46306: 0683 0000 001c addil #28,%d3
/*
* Move from the local chain, initialise, then append to the inactive chain
*/
index = index_base;
while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) {
4630c: 49f9 0004 a008 lea 4a008 <_Chain_Get>,%a4
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
46312: 47f9 0004 58d0 lea 458d0 <_Chain_Append>,%a3
}
/*
* Assign the new object block to the object block table.
*/
information->object_blocks[ block ] = new_object_block;
46318: e58c lsll #2,%d4
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
4631a: 322a 0012 movew %a2@(18),%d1
}
/*
* Assign the new object block to the object block table.
*/
information->object_blocks[ block ] = new_object_block;
4631e: 2186 4800 movel %d6,%a0@(00000000,%d4:l)
/*
* Initialize objects .. add to a local chain first.
*/
_Chain_Initialize(
46322: 2f2a 0014 movel %a2@(20),%sp@- 46326: 2f01 movel %d1,%sp@- 46328: 2f06 movel %d6,%sp@- 4632a: 2f00 movel %d0,%sp@- 4632c: 4eb9 0004 a03c jsr 4a03c <_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 ) {
46332: 4fef 0010 lea %sp@(16),%sp 46336: 6028 bras 46360 <_Objects_Extend_information+0x218>
the_object->id = _Objects_Build_id(
46338: 2212 movel %a2@,%d1 4633a: 7c18 moveq #24,%d6 4633c: 7e1b moveq #27,%d7 4633e: 2040 moveal %d0,%a0 46340: eda9 lsll %d6,%d1 46342: 4286 clrl %d6 46344: 3c2a 0004 movew %a2@(4),%d6 46348: 08c1 0010 bset #16,%d1 4634c: efae lsll %d7,%d6 4634e: 8286 orl %d6,%d1 46350: 8282 orl %d2,%d1
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
46352: 5282 addql #1,%d2
*/
index = index_base;
while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) {
the_object->id = _Objects_Build_id(
46354: 2141 0008 movel %d1,%a0@(8)
information->the_class,
_Objects_Local_node,
index
);
_Chain_Append( &information->Inactive, &the_object->Node );
46358: 2f00 movel %d0,%sp@- 4635a: 2f03 movel %d3,%sp@- 4635c: 4e93 jsr %a3@
index++;
4635e: 508f addql #8,%sp
/*
* Move from the local chain, initialise, then append to the inactive chain
*/
index = index_base;
while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) {
46360: 2f05 movel %d5,%sp@- 46362: 4e94 jsr %a4@ 46364: 588f addql #4,%sp 46366: 4a80 tstl %d0 46368: 66ce bnes 46338 <_Objects_Extend_information+0x1f0>
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
4636a: 4280 clrl %d0
information->inactive =
4636c: 322a 0028 movew %a2@(40),%d1 46370: 326a 0012 moveaw %a2@(18),%a1
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
46374: 206a 002a moveal %a2@(42),%a0
information->inactive =
46378: d289 addl %a1,%d1
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
4637a: 3009 movew %a1,%d0
information->inactive =
4637c: 3541 0028 movew %d1,%a2@(40)
_Chain_Append( &information->Inactive, &the_object->Node );
index++;
}
information->inactive_per_block[ block ] = information->allocation_size;
46380: 2180 4800 movel %d0,%a0@(00000000,%d4:l)
information->inactive =
(Objects_Maximum)(information->inactive + information->allocation_size);
}
46384: 4cee 3cfc ffc8 moveml %fp@(-56),%d2-%d7/%a2-%a5 4638a: 4e5e unlk %fp 4638c: 4e75 rts
...
00046440 <_Objects_Get_information>:
Objects_Information *_Objects_Get_information(
Objects_APIs the_api,
uint32_t the_class
)
{
46440: 4e56 0000 linkw %fp,#0 46444: 2f03 movel %d3,%sp@- 46446: 262e 0008 movel %fp@(8),%d3 4644a: 2f02 movel %d2,%sp@- 4644c: 242e 000c movel %fp@(12),%d2
Objects_Information *info;
int the_class_api_maximum;
if ( !the_class )
46450: 672e beqs 46480 <_Objects_Get_information+0x40>
/*
* 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 );
46452: 2f03 movel %d3,%sp@- 46454: 4eb9 0004 a50c jsr 4a50c <_Objects_API_maximum_class>
if ( the_class_api_maximum == 0 )
4645a: 588f addql #4,%sp 4645c: 4a80 tstl %d0 4645e: 6720 beqs 46480 <_Objects_Get_information+0x40>
return NULL;
if ( the_class > (uint32_t) the_class_api_maximum )
46460: b082 cmpl %d2,%d0 46462: 651c bcss 46480 <_Objects_Get_information+0x40>
return NULL;
if ( !_Objects_Information_table[ the_api ] )
46464: 41f9 0005 cc4c lea 5cc4c <_Objects_Information_table>,%a0 4646a: 2070 3c00 moveal %a0@(00000000,%d3:l:4),%a0 4646e: 4a88 tstl %a0 46470: 670e beqs 46480 <_Objects_Get_information+0x40>
return NULL;
info = _Objects_Information_table[ the_api ][ the_class ];
46472: 2030 2c00 movel %a0@(00000000,%d2:l:4),%d0
if ( !info )
46476: 670a beqs 46482 <_Objects_Get_information+0x42>
* 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 )
46478: 2040 moveal %d0,%a0 4647a: 4a68 000e tstw %a0@(14) 4647e: 6602 bnes 46482 <_Objects_Get_information+0x42> 46480: 4280 clrl %d0
return NULL;
#endif
return info;
}
46482: 242e fff8 movel %fp@(-8),%d2 46486: 262e fffc movel %fp@(-4),%d3 4648a: 4e5e unlk %fp 4648c: 4e75 rts
...
00053090 <_Objects_Get_next>:
Objects_Information *information,
Objects_Id id,
Objects_Locations *location_p,
Objects_Id *next_id_p
)
{
53090: 4e56 ffec linkw %fp,#-20 53094: 48d7 3c04 moveml %d2/%a2-%a5,%sp@ 53098: 266e 0008 moveal %fp@(8),%a3 5309c: 242e 000c movel %fp@(12),%d2 530a0: 246e 0010 moveal %fp@(16),%a2 530a4: 286e 0014 moveal %fp@(20),%a4
Objects_Control *object;
Objects_Id next_id;
if ( !information )
530a8: 4a8b tstl %a3 530aa: 6746 beqs 530f2 <_Objects_Get_next+0x62>
return NULL;
if ( !location_p )
530ac: 4a8a tstl %a2 530ae: 6742 beqs 530f2 <_Objects_Get_next+0x62>
return NULL;
if ( !next_id_p )
530b0: 4a8c tstl %a4 530b2: 673e beqs 530f2 <_Objects_Get_next+0x62>
return NULL;
if (_Objects_Get_index(id) == OBJECTS_ID_INITIAL_INDEX)
530b4: 4a42 tstw %d2 530b6: 6604 bnes 530bc <_Objects_Get_next+0x2c>
next_id = information->minimum_id;
530b8: 242b 0006 movel %a3@(6),%d2
*location_p = OBJECTS_ERROR;
goto final;
}
/* try to grab one */
object = _Objects_Get(information, next_id, location_p);
530bc: 4bf9 0004 9e20 lea 49e20 <_Objects_Get>,%a5
else
next_id = id;
do {
/* walked off end of list? */
if (_Objects_Get_index(next_id) > information->maximum)
530c2: 4281 clrl %d1 530c4: 4280 clrl %d0 530c6: 322b 000e movew %a3@(14),%d1 530ca: 3002 movew %d2,%d0 530cc: b081 cmpl %d1,%d0 530ce: 630c blss 530dc <_Objects_Get_next+0x4c>
{
*location_p = OBJECTS_ERROR;
530d0: 7401 moveq #1,%d2
*next_id_p = next_id;
return object;
final:
*next_id_p = OBJECTS_ID_FINAL;
530d2: 72ff moveq #-1,%d1 530d4: 4280 clrl %d0
do {
/* walked off end of list? */
if (_Objects_Get_index(next_id) > information->maximum)
{
*location_p = OBJECTS_ERROR;
530d6: 2482 movel %d2,%a2@
*next_id_p = next_id;
return object;
final:
*next_id_p = OBJECTS_ID_FINAL;
530d8: 2881 movel %d1,%a4@
return 0;
530da: 6018 bras 530f4 <_Objects_Get_next+0x64>
*location_p = OBJECTS_ERROR;
goto final;
}
/* try to grab one */
object = _Objects_Get(information, next_id, location_p);
530dc: 2f0a movel %a2,%sp@- 530de: 2f02 movel %d2,%sp@-
next_id++;
530e0: 5282 addql #1,%d2
*location_p = OBJECTS_ERROR;
goto final;
}
/* try to grab one */
object = _Objects_Get(information, next_id, location_p);
530e2: 2f0b movel %a3,%sp@- 530e4: 4e95 jsr %a5@
next_id++;
} while (*location_p != OBJECTS_LOCAL);
530e6: 4fef 000c lea %sp@(12),%sp 530ea: 4a92 tstl %a2@ 530ec: 66d4 bnes 530c2 <_Objects_Get_next+0x32>
*next_id_p = next_id;
530ee: 2882 movel %d2,%a4@
return object;
530f0: 6002 bras 530f4 <_Objects_Get_next+0x64>
final:
*next_id_p = OBJECTS_ID_FINAL;
return 0;
530f2: 4280 clrl %d0
}
530f4: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 530fa: 4e5e unlk %fp 530fc: 4e75 rts
...
00049e80 <_Objects_Id_to_name>:
*/
Objects_Name_or_id_lookup_errors _Objects_Id_to_name (
Objects_Id id,
Objects_Name *name
)
{
49e80: 4e56 fffc linkw %fp,#-4 49e84: 222e 0008 movel %fp@(8),%d1 49e88: 2f02 movel %d2,%sp@-
/*
* Caller is trusted for name != NULL.
*/
tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id;
49e8a: 4a81 tstl %d1 49e8c: 660a bnes 49e98 <_Objects_Id_to_name+0x18> 49e8e: 2079 0006 85a6 moveal 685a6 <_Thread_Executing>,%a0 49e94: 2228 0008 movel %a0@(8),%d1
*/
RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API(
Objects_Id id
)
{
return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS);
49e98: 7418 moveq #24,%d2 49e9a: 2001 movel %d1,%d0 49e9c: e4a8 lsrl %d2,%d0 49e9e: 143c 0007 moveb #7,%d2 49ea2: c082 andl %d2,%d0
*/
RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid(
uint32_t the_api
)
{
if ( !the_api || the_api > OBJECTS_APIS_LAST )
49ea4: 143c 0003 moveb #3,%d2 49ea8: 2040 moveal %d0,%a0 49eaa: 5388 subql #1,%a0 49eac: b488 cmpl %a0,%d2 49eae: 6540 bcss 49ef0 <_Objects_Id_to_name+0x70> 49eb0: 6048 bras 49efa <_Objects_Id_to_name+0x7a>
if ( !_Objects_Information_table[ the_api ] )
return OBJECTS_INVALID_ID;
the_class = _Objects_Get_class( tmpId );
information = _Objects_Information_table[ the_api ][ the_class ];
49eb2: 2001 movel %d1,%d0 49eb4: 741b moveq #27,%d2 49eb6: e4a8 lsrl %d2,%d0 49eb8: 2070 0c00 moveal %a0@(00000000,%d0:l:4),%a0
if ( !information )
49ebc: 4a88 tstl %a0 49ebe: 6730 beqs 49ef0 <_Objects_Id_to_name+0x70>
return OBJECTS_INVALID_ID;
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
if ( information->is_string )
49ec0: 4a28 0032 tstb %a0@(50) 49ec4: 662a bnes 49ef0 <_Objects_Id_to_name+0x70>
return OBJECTS_INVALID_ID;
#endif
the_object = _Objects_Get( information, tmpId, &ignored_location );
49ec6: 486e fffc pea %fp@(-4) 49eca: 2f01 movel %d1,%sp@- 49ecc: 2f08 movel %a0,%sp@- 49ece: 4eb9 0004 9e20 jsr 49e20 <_Objects_Get>
if ( !the_object )
49ed4: 4fef 000c lea %sp@(12),%sp 49ed8: 4a80 tstl %d0 49eda: 6714 beqs 49ef0 <_Objects_Id_to_name+0x70>
return OBJECTS_INVALID_ID;
*name = the_object->name;
49edc: 206e 000c moveal %fp@(12),%a0 49ee0: 2240 moveal %d0,%a1 49ee2: 20a9 000c movel %a1@(12),%a0@
_Thread_Enable_dispatch();
49ee6: 4eb9 0004 a71e jsr 4a71e <_Thread_Enable_dispatch> 49eec: 4280 clrl %d0
return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL;
49eee: 6002 bras 49ef2 <_Objects_Id_to_name+0x72> 49ef0: 7003 moveq #3,%d0
}
49ef2: 242e fff8 movel %fp@(-8),%d2 49ef6: 4e5e unlk %fp 49ef8: 4e75 rts
the_api = _Objects_Get_API( tmpId );
if ( !_Objects_Is_api_valid( the_api ) )
return OBJECTS_INVALID_ID;
if ( !_Objects_Information_table[ the_api ] )
49efa: 41f9 0006 84a4 lea 684a4 <_Objects_Information_table>,%a0 49f00: 2070 0c00 moveal %a0@(00000000,%d0:l:4),%a0 49f04: 4a88 tstl %a0 49f06: 66aa bnes 49eb2 <_Objects_Id_to_name+0x32> 49f08: 60e6 bras 49ef0 <_Objects_Id_to_name+0x70>
...
00050684 <_Objects_Name_to_id_string>:
Objects_Name_or_id_lookup_errors _Objects_Name_to_id_string(
Objects_Information *information,
const char *name,
Objects_Id *id
)
{
50684: 4e56 ffe4 linkw %fp,#-28 50688: 48d7 3c1c moveml %d2-%d4/%a2-%a5,%sp@ 5068c: 266e 0008 moveal %fp@(8),%a3 50690: 262e 000c movel %fp@(12),%d3 50694: 286e 0010 moveal %fp@(16),%a4
uint32_t index;
uint32_t name_length;
/* ASSERT: information->is_string == true */
if ( !id )
50698: 4a8c tstl %a4 5069a: 6604 bnes 506a0 <_Objects_Name_to_id_string+0x1c> 5069c: 7002 moveq #2,%d0 5069e: 6050 bras 506f0 <_Objects_Name_to_id_string+0x6c>
return OBJECTS_INVALID_ADDRESS;
if ( !name )
506a0: 4a83 tstl %d3 506a2: 674a beqs 506ee <_Objects_Name_to_id_string+0x6a>
return OBJECTS_INVALID_NAME;
if ( information->maximum != 0 ) {
506a4: 382b 000e movew %a3@(14),%d4 506a8: 6744 beqs 506ee <_Objects_Name_to_id_string+0x6a> 506aa: 7401 moveq #1,%d2
continue;
if ( !the_object->name.name_p )
continue;
if (!strncmp( name, the_object->name.name_p, information->name_length)) {
506ac: 4bf9 0005 4274 lea 54274 <strncmp>,%a5
return OBJECTS_INVALID_NAME;
if ( information->maximum != 0 ) {
name_length = information->name_length;
for ( index = 1; index <= information->maximum; index++ ) {
506b2: 0284 0000 ffff andil #65535,%d4 506b8: 6030 bras 506ea <_Objects_Name_to_id_string+0x66>
the_object = information->local_table[ index ];
506ba: 206b 0018 moveal %a3@(24),%a0 506be: 2470 2c00 moveal %a0@(00000000,%d2:l:4),%a2
return OBJECTS_INVALID_NAME;
if ( information->maximum != 0 ) {
name_length = information->name_length;
for ( index = 1; index <= information->maximum; index++ ) {
506c2: 5282 addql #1,%d2
the_object = information->local_table[ index ];
if ( !the_object )
506c4: 4a8a tstl %a2 506c6: 6722 beqs 506ea <_Objects_Name_to_id_string+0x66>
continue;
if ( !the_object->name.name_p )
506c8: 202a 000c movel %a2@(12),%d0 506cc: 671c beqs 506ea <_Objects_Name_to_id_string+0x66>
continue;
if (!strncmp( name, the_object->name.name_p, information->name_length)) {
506ce: 4281 clrl %d1 506d0: 322b 0034 movew %a3@(52),%d1 506d4: 2f01 movel %d1,%sp@- 506d6: 2f00 movel %d0,%sp@- 506d8: 2f03 movel %d3,%sp@- 506da: 4e95 jsr %a5@ 506dc: 4fef 000c lea %sp@(12),%sp 506e0: 4a80 tstl %d0 506e2: 6606 bnes 506ea <_Objects_Name_to_id_string+0x66>
*id = the_object->id;
506e4: 28aa 0008 movel %a2@(8),%a4@
return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL;
506e8: 6006 bras 506f0 <_Objects_Name_to_id_string+0x6c>
return OBJECTS_INVALID_NAME;
if ( information->maximum != 0 ) {
name_length = information->name_length;
for ( index = 1; index <= information->maximum; index++ ) {
506ea: b882 cmpl %d2,%d4 506ec: 64cc bccs 506ba <_Objects_Name_to_id_string+0x36> 506ee: 7001 moveq #1,%d0
}
}
}
return OBJECTS_INVALID_NAME;
}
506f0: 4cee 3c1c ffe4 moveml %fp@(-28),%d2-%d4/%a2-%a5 506f6: 4e5e unlk %fp 506f8: 4e75 rts
...
00046a50 <_Objects_Set_name>:
{
size_t length;
const char *s;
s = name;
length = strnlen( name, information->name_length );
46a50: 4280 clrl %d0
bool _Objects_Set_name(
Objects_Information *information,
Objects_Control *the_object,
const char *name
)
{
46a52: 4e56 ffe0 linkw %fp,#-32 46a56: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 46a5a: 2a6e 0008 moveal %fp@(8),%a5
size_t length;
const char *s;
s = name;
length = strnlen( name, information->name_length );
46a5e: 302d 0034 movew %a5@(52),%d0
bool _Objects_Set_name(
Objects_Information *information,
Objects_Control *the_object,
const char *name
)
{
46a62: 246e 0010 moveal %fp@(16),%a2
size_t length;
const char *s;
s = name;
length = strnlen( name, information->name_length );
46a66: 2f00 movel %d0,%sp@-
bool _Objects_Set_name(
Objects_Information *information,
Objects_Control *the_object,
const char *name
)
{
46a68: 286e 000c moveal %fp@(12),%a4
size_t length;
const char *s;
s = name;
length = strnlen( name, information->name_length );
46a6c: 2f0a movel %a2,%sp@- 46a6e: 4eb9 0004 e554 jsr 4e554 <strnlen>
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
if ( information->is_string ) {
46a74: 508f addql #8,%sp
{
size_t length;
const char *s;
s = name;
length = strnlen( name, information->name_length );
46a76: 2640 moveal %d0,%a3
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
if ( information->is_string ) {
46a78: 4a2d 0032 tstb %a5@(50) 46a7c: 6748 beqs 46ac6 <_Objects_Set_name+0x76>
char *d;
d = _Workspace_Allocate( length + 1 );
46a7e: 486b 0001 pea %a3@(1) 46a82: 4eb9 0004 82d4 jsr 482d4 <_Workspace_Allocate>
if ( !d )
46a88: 588f addql #4,%sp
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
if ( information->is_string ) {
char *d;
d = _Workspace_Allocate( length + 1 );
46a8a: 2a40 moveal %d0,%a5
if ( !d )
46a8c: 4a80 tstl %d0 46a8e: 6604 bnes 46a94 <_Objects_Set_name+0x44>
46a90: 4200 clrb %d0 <== NOT EXECUTED 46a92: 6076 bras 46b0a <_Objects_Set_name+0xba> <== NOT EXECUTED
return false;
if ( the_object->name.name_p ) {
46a94: 202c 000c movel %a4@(12),%d0 46a98: 670e beqs 46aa8 <_Objects_Set_name+0x58>
_Workspace_Free( (void *)the_object->name.name_p );
46a9a: 2f00 movel %d0,%sp@- 46a9c: 4eb9 0004 82f0 jsr 482f0 <_Workspace_Free>
the_object->name.name_p = NULL;
46aa2: 588f addql #4,%sp 46aa4: 42ac 000c clrl %a4@(12)
}
strncpy( d, name, length );
46aa8: 2f0b movel %a3,%sp@- 46aaa: 2f0a movel %a2,%sp@- 46aac: 2f0d movel %a5,%sp@- 46aae: 4eb9 0004 e4cc jsr 4e4cc <strncpy>
d[length] = '\0';
the_object->name.name_p = d;
46ab4: 4fef 000c lea %sp@(12),%sp
_Workspace_Free( (void *)the_object->name.name_p );
the_object->name.name_p = NULL;
}
strncpy( d, name, length );
d[length] = '\0';
46ab8: 4200 clrb %d0 46aba: 1b80 b800 moveb %d0,%a5@(00000000,%a3:l)
the_object->name.name_p = d;
46abe: 7001 moveq #1,%d0 46ac0: 294d 000c movel %a5,%a4@(12) 46ac4: 6044 bras 46b0a <_Objects_Set_name+0xba>
} else
#endif
{
the_object->name.name_u32 = _Objects_Build_name(
46ac6: 7201 moveq #1,%d1 46ac8: 1012 moveb %a2@,%d0 46aca: b28b cmpl %a3,%d1 46acc: 6446 bccs 46b14 <_Objects_Set_name+0xc4> 46ace: 7602 moveq #2,%d3 46ad0: 142a 0001 moveb %a2@(1),%d2 46ad4: 49c2 extbl %d2 46ad6: 4842 swap %d2 46ad8: 4242 clrw %d2 46ada: b68b cmpl %a3,%d3 46adc: 643a bccs 46b18 <_Objects_Set_name+0xc8> 46ade: 7a03 moveq #3,%d5 46ae0: 122a 0002 moveb %a2@(2),%d1 46ae4: 49c1 extbl %d1 46ae6: e189 lsll #8,%d1 46ae8: ba8b cmpl %a3,%d5 46aea: 6506 bcss 46af2 <_Objects_Set_name+0xa2> 46aec: 163c 0020 moveb #32,%d3 46af0: 6006 bras 46af8 <_Objects_Set_name+0xa8> 46af2: 162a 0003 moveb %a2@(3),%d3 46af6: 49c3 extbl %d3 46af8: 2800 movel %d0,%d4 46afa: 7a18 moveq #24,%d5 46afc: ebac lsll %d5,%d4 46afe: 7001 moveq #1,%d0 46b00: 8484 orl %d4,%d2 46b02: 8481 orl %d1,%d2 46b04: 8483 orl %d3,%d2 46b06: 2942 000c movel %d2,%a4@(12)
);
}
return true;
}
46b0a: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 46b10: 4e5e unlk %fp 46b12: 4e75 rts
d[length] = '\0';
the_object->name.name_p = d;
} else
#endif
{
the_object->name.name_u32 = _Objects_Build_name(
46b14: 7420 moveq #32,%d2 46b16: 4842 swap %d2 46b18: 223c 0000 2000 movel #8192,%d1 46b1e: 7620 moveq #32,%d3 46b20: 60d6 bras 46af8 <_Objects_Set_name+0xa8>
...
000466e0 <_Objects_Shrink_information>:
/*
* 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) /
466e0: 4280 clrl %d0 466e2: 4281 clrl %d1
*/
void _Objects_Shrink_information(
Objects_Information *information
)
{
466e4: 4e56 ffec linkw %fp,#-20 466e8: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 466ec: 246e 0008 moveal %fp@(8),%a2
/*
* Search the list to find block or chunk with all objects inactive.
*/
index_base = _Objects_Get_index( information->minimum_id );
466f0: 4283 clrl %d3
block_count = (information->maximum - index_base) /
466f2: 4284 clrl %d4
/*
* Search the list to find block or chunk with all objects inactive.
*/
index_base = _Objects_Get_index( information->minimum_id );
466f4: 362a 0008 movew %a2@(8),%d3
block_count = (information->maximum - index_base) /
466f8: 302a 000e movew %a2@(14),%d0 466fc: 322a 0012 movew %a2@(18),%d1 46700: 9083 subl %d3,%d0 46702: 4c41 0000 remul %d1,%d0,%d0
information->allocation_size;
for ( block = 0; block < block_count; block++ ) {
46706: 6070 bras 46778 <_Objects_Shrink_information+0x98> 46708: 2404 movel %d4,%d2 4670a: 5284 addql #1,%d4 4670c: e58a lsll #2,%d2
if ( information->inactive_per_block[ block ] ==
4670e: 206a 002a moveal %a2@(42),%a0 46712: b2b0 2800 cmpl %a0@(00000000,%d2:l),%d1 46716: 665e bnes 46776 <_Objects_Shrink_information+0x96>
information->allocation_size ) {
/*
* Assume the Inactive chain is never empty at this point
*/
the_object = (Objects_Control *) information->Inactive.first;
46718: 206a 001c moveal %a2@(28),%a0
*/
extract_me = the_object;
the_object = (Objects_Control *) the_object->Node.next;
if ((index >= index_base) &&
(index < (index_base + information->allocation_size))) {
_Chain_Extract( &extract_me->Node );
4671c: 47f9 0004 9fe0 lea 49fe0 <_Chain_Extract>,%a3
* Assume the Inactive chain is never empty at this point
*/
the_object = (Objects_Control *) information->Inactive.first;
do {
index = _Objects_Get_index( the_object->id );
46722: 4280 clrl %d0 46724: 3028 000a movew %a0@(10),%d0
/*
* Get the next node before the node is extracted
*/
extract_me = the_object;
the_object = (Objects_Control *) the_object->Node.next;
46728: 2810 movel %a0@,%d4
if ((index >= index_base) &&
4672a: b680 cmpl %d0,%d3 4672c: 6212 bhis 46740 <_Objects_Shrink_information+0x60>
(index < (index_base + information->allocation_size))) {
4672e: 4281 clrl %d1 46730: 322a 0012 movew %a2@(18),%d1 46734: d283 addl %d3,%d1 46736: b280 cmpl %d0,%d1 46738: 6306 blss 46740 <_Objects_Shrink_information+0x60>
_Chain_Extract( &extract_me->Node );
4673a: 2f08 movel %a0,%sp@- 4673c: 4e93 jsr %a3@ 4673e: 588f addql #4,%sp
}
}
while ( the_object );
46740: 2044 moveal %d4,%a0 46742: 4a84 tstl %d4 46744: 66dc bnes 46722 <_Objects_Shrink_information+0x42>
/*
* Free the memory and reset the structures in the object' information
*/
_Workspace_Free( information->object_blocks[ block ] );
46746: 206a 002e moveal %a2@(46),%a0 4674a: 2f30 2800 movel %a0@(00000000,%d2:l),%sp@- 4674e: 4eb9 0004 7eac jsr 47eac <_Workspace_Free>
information->object_blocks[ block ] = NULL;
46754: 206a 002e moveal %a2@(46),%a0
information->inactive_per_block[ block ] = 0;
information->inactive -= information->allocation_size;
return;
46758: 588f addql #4,%sp
* Free the memory and reset the structures in the object' information
*/
_Workspace_Free( information->object_blocks[ block ] );
information->object_blocks[ block ] = NULL;
information->inactive_per_block[ block ] = 0;
4675a: 226a 002a moveal %a2@(42),%a1
information->inactive -= information->allocation_size;
4675e: 302a 0028 movew %a2@(40),%d0 46762: 322a 0012 movew %a2@(18),%d1
* Free the memory and reset the structures in the object' information
*/
_Workspace_Free( information->object_blocks[ block ] );
information->object_blocks[ block ] = NULL;
information->inactive_per_block[ block ] = 0;
46766: 42b1 2800 clrl %a1@(00000000,%d2:l)
information->inactive -= information->allocation_size;
4676a: 9081 subl %d1,%d0
/*
* Free the memory and reset the structures in the object' information
*/
_Workspace_Free( information->object_blocks[ block ] );
information->object_blocks[ block ] = NULL;
4676c: 42b0 2800 clrl %a0@(00000000,%d2:l)
information->inactive_per_block[ block ] = 0;
information->inactive -= information->allocation_size;
46770: 3540 0028 movew %d0,%a2@(40)
return;
46774: 6006 bras 4677c <_Objects_Shrink_information+0x9c>
}
index_base += information->allocation_size;
46776: d681 addl %d1,%d3
index_base = _Objects_Get_index( information->minimum_id );
block_count = (information->maximum - index_base) /
information->allocation_size;
for ( block = 0; block < block_count; block++ ) {
46778: b084 cmpl %d4,%d0 4677a: 628c bhis 46708 <_Objects_Shrink_information+0x28>
return;
}
index_base += information->allocation_size;
}
}
4677c: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 46782: 4e5e unlk %fp 46784: 4e75 rts
...
000495f8 <_POSIX_Barrier_Manager_initialization>:
/**
* @brief _POSIX_Barrier_Manager_initialization
*/
void _POSIX_Barrier_Manager_initialization(void)
{
495f8: 4e56 0000 linkw %fp,#0
_Objects_Initialize_information(
495fc: 4878 00ff pea ff <DBL_MANT_DIG+0xca> 49600: 4878 0001 pea 1 <ADD> 49604: 4878 005c pea 5c <DBL_MANT_DIG+0x27> 49608: 2f39 0005 baf6 movel 5baf6 <Configuration_POSIX_API+0x24>,%sp@- 4960e: 4878 000a pea a <LASTO> 49612: 4878 0003 pea 3 <DIVIDE> 49616: 4879 0005 cfd6 pea 5cfd6 <_POSIX_Barrier_Information> 4961c: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 49622: 4fef 001c lea %sp@(28),%sp
,
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
49626: 4e5e unlk %fp 49628: 4e75 rts
...
0004a76c <_POSIX_Barrier_Translate_core_barrier_return_code>:
int _POSIX_Barrier_Translate_core_barrier_return_code(
CORE_barrier_Status the_barrier_status
)
{
4a76c: 41f9 0005 bcb0 lea 5bcb0 <_POSIX_Barrier_Return_codes>,%a0 4a772: 4e56 0000 linkw %fp,#0
#if defined(RTEMS_DEBUG)
if ( the_barrier_status > CORE_BARRIER_STATUS_LAST )
return EINVAL;
#endif
return _POSIX_Barrier_Return_codes[the_barrier_status];
}
4a776: 202e 0008 movel %fp@(8),%d0 4a77a: 4e5e unlk %fp 4a77c: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4a780: 4e75 rts
...
000459ec <_POSIX_Condition_variables_Get>:
POSIX_Condition_variables_Control *_POSIX_Condition_variables_Get (
pthread_cond_t *cond,
Objects_Locations *location
)
{
459ec: 4e56 0000 linkw %fp,#0 459f0: 2f0b movel %a3,%sp@- 459f2: 266e 000c moveal %fp@(12),%a3 459f6: 2f0a movel %a2,%sp@- 459f8: 246e 0008 moveal %fp@(8),%a2
int status;
if ( !cond ) {
459fc: 4a8a tstl %a2 459fe: 6716 beqs 45a16 <_POSIX_Condition_variables_Get+0x2a>
*location = OBJECTS_ERROR;
return (POSIX_Condition_variables_Control *) 0;
}
if ( *cond == PTHREAD_COND_INITIALIZER ) {
45a00: 70ff moveq #-1,%d0 45a02: b092 cmpl %a2@,%d0 45a04: 6618 bnes 45a1e <_POSIX_Condition_variables_Get+0x32>
/*
* Do an "auto-create" here.
*/
status = pthread_cond_init( cond, 0 );
45a06: 42a7 clrl %sp@- 45a08: 2f0a movel %a2,%sp@- 45a0a: 4eb9 0004 5a40 jsr 45a40 <pthread_cond_init>
if ( status ) {
45a10: 508f addql #8,%sp 45a12: 4a80 tstl %d0 45a14: 6708 beqs 45a1e <_POSIX_Condition_variables_Get+0x32>
*location = OBJECTS_ERROR;
45a16: 7001 moveq #1,%d0 45a18: 2680 movel %d0,%a3@ 45a1a: 4280 clrl %d0
return (POSIX_Condition_variables_Control *) 0;
45a1c: 6014 bras 45a32 <_POSIX_Condition_variables_Get+0x46>
}
/*
* Now call Objects_Get()
*/
return (POSIX_Condition_variables_Control *)_Objects_Get(
45a1e: 2f0b movel %a3,%sp@- 45a20: 2f12 movel %a2@,%sp@- 45a22: 4879 0005 f592 pea 5f592 <_POSIX_Condition_variables_Information> 45a28: 4eb9 0004 821c jsr 4821c <_Objects_Get> 45a2e: 4fef 000c lea %sp@(12),%sp
&_POSIX_Condition_variables_Information,
(Objects_Id) *cond,
location
);
}
45a32: 246e fff8 moveal %fp@(-8),%a2 45a36: 266e fffc moveal %fp@(-4),%a3 45a3a: 4e5e unlk %fp 45a3c: 4e75 rts
...
000494d0 <_POSIX_Condition_variables_Manager_initialization>:
*
* Output parameters: NONE
*/
void _POSIX_Condition_variables_Manager_initialization(void)
{
494d0: 4e56 0000 linkw %fp,#0
_Objects_Initialize_information(
494d4: 4878 00ff pea ff <DBL_MANT_DIG+0xca> 494d8: 4878 0001 pea 1 <ADD> 494dc: 4878 0058 pea 58 <DBL_MANT_DIG+0x23> 494e0: 2f39 0005 bada movel 5bada <Configuration_POSIX_API+0x8>,%sp@- 494e6: 4878 0008 pea 8 <DIVIDE_BY_ZERO> 494ea: 4878 0003 pea 3 <DIVIDE> 494ee: 4879 0005 d062 pea 5d062 <_POSIX_Condition_variables_Information> 494f4: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 494fa: 4fef 001c lea %sp@(28),%sp
,
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
494fe: 4e5e unlk %fp 49500: 4e75 rts
...
00045af8 <_POSIX_Condition_variables_Signal_support>:
int _POSIX_Condition_variables_Signal_support(
pthread_cond_t *cond,
bool is_broadcast
)
{
45af8: 4e56 ffec linkw %fp,#-20 45afc: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@
register POSIX_Condition_variables_Control *the_cond;
Objects_Locations location;
Thread_Control *the_thread;
the_cond = _POSIX_Condition_variables_Get( cond, &location );
45b00: 486e fffc pea %fp@(-4) 45b04: 2f2e 0008 movel %fp@(8),%sp@-
int _POSIX_Condition_variables_Signal_support(
pthread_cond_t *cond,
bool is_broadcast
)
{
45b08: 162e 000f moveb %fp@(15),%d3
register POSIX_Condition_variables_Control *the_cond;
Objects_Locations location;
Thread_Control *the_thread;
the_cond = _POSIX_Condition_variables_Get( cond, &location );
45b0c: 4eb9 0004 59ec jsr 459ec <_POSIX_Condition_variables_Get>
switch ( location ) {
45b12: 508f addql #8,%sp
{
register POSIX_Condition_variables_Control *the_cond;
Objects_Locations location;
Thread_Control *the_thread;
the_cond = _POSIX_Condition_variables_Get( cond, &location );
45b14: 2440 moveal %d0,%a2
switch ( location ) {
45b16: 4aae fffc tstl %fp@(-4) 45b1a: 6704 beqs 45b20 <_POSIX_Condition_variables_Signal_support+0x28> 45b1c: 7016 moveq #22,%d0 45b1e: 602c bras 45b4c <_POSIX_Condition_variables_Signal_support+0x54>
case OBJECTS_LOCAL:
do {
the_thread = _Thread_queue_Dequeue( &the_cond->Wait_queue );
45b20: 2400 movel %d0,%d2 45b22: 0682 0000 0018 addil #24,%d2 45b28: 47f9 0004 8cf0 lea 48cf0 <_Thread_queue_Dequeue>,%a3 45b2e: 2f02 movel %d2,%sp@- 45b30: 4e93 jsr %a3@
if ( !the_thread )
45b32: 588f addql #4,%sp 45b34: 4a80 tstl %d0 45b36: 6604 bnes 45b3c <_POSIX_Condition_variables_Signal_support+0x44>
the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX;
45b38: 42aa 0014 clrl %a2@(20)
} while ( is_broadcast && the_thread );
45b3c: 4a03 tstb %d3 45b3e: 6704 beqs 45b44 <_POSIX_Condition_variables_Signal_support+0x4c> 45b40: 4a80 tstl %d0 45b42: 66ea bnes 45b2e <_POSIX_Condition_variables_Signal_support+0x36>
_Thread_Enable_dispatch();
45b44: 4eb9 0004 89a6 jsr 489a6 <_Thread_Enable_dispatch> 45b4a: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
45b4c: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 45b52: 4e5e unlk %fp 45b54: 4e75 rts
...
00049504 <_POSIX_Key_Manager_initialization>:
*
* Output parameters: NONE
*/
void _POSIX_Key_Manager_initialization(void)
{
49504: 4e56 0000 linkw %fp,#0
_Objects_Initialize_information(
49508: 4878 00ff pea ff <DBL_MANT_DIG+0xca> 4950c: 4878 0001 pea 1 <ADD> 49510: 4878 0028 pea 28 <OPER2+0x14> 49514: 2f39 0005 bade movel 5bade <Configuration_POSIX_API+0xc>,%sp@- 4951a: 4878 0002 pea 2 <DOUBLE_FLOAT> 4951e: 4878 0003 pea 3 <DIVIDE> 49522: 4879 0005 d028 pea 5d028 <_POSIX_Keys_Information> 49528: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 4952e: 4fef 001c lea %sp@(28),%sp
,
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
49532: 4e5e unlk %fp 49534: 4e75 rts
...
0004b794 <_POSIX_Keys_Run_destructors>:
*/
RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API(
Objects_Id id
)
{
return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS);
4b794: 7218 moveq #24,%d1
*/
void _POSIX_Keys_Run_destructors(
Thread_Control *thread
)
{
4b796: 4e56 ffe8 linkw %fp,#-24
uint32_t iterations;
bool are_all_null;
POSIX_Keys_Control *the_key;
void *value;
thread_index = _Objects_Get_index( thread->Object.id );
4b79a: 206e 0008 moveal %fp@(8),%a0
*/
void _POSIX_Keys_Run_destructors(
Thread_Control *thread
)
{
4b79e: 48d7 047c moveml %d2-%d6/%a2,%sp@
uint32_t iterations;
bool are_all_null;
POSIX_Keys_Control *the_key;
void *value;
thread_index = _Objects_Get_index( thread->Object.id );
4b7a2: 2428 0008 movel %a0@(8),%d2 4b7a6: 2002 movel %d2,%d0 4b7a8: e2a8 lsrl %d1,%d0 4b7aa: 123c 0007 moveb #7,%d1
if ( !the_key )
continue;
if ( !the_key->destructor )
continue;
value = the_key->Values[ thread_api ][ thread_index ];
4b7ae: 4284 clrl %d4 4b7b0: 0282 0000 ffff andil #65535,%d2 4b7b6: c081 andl %d1,%d0 4b7b8: e58a lsll #2,%d2 4b7ba: 2c00 movel %d0,%d6 4b7bc: 5a86 addql #5,%d6 4b7be: 7601 moveq #1,%d3 4b7c0: 7a01 moveq #1,%d5
for ( ; ; ) {
are_all_null = true;
for ( index=1 ; index <= _POSIX_Keys_Information.maximum ; index++ ) {
4b7c2: 6034 bras 4b7f8 <_POSIX_Keys_Run_destructors+0x64>
the_key = (POSIX_Keys_Control *)
4b7c4: 2079 0005 d040 moveal 5d040 <_POSIX_Keys_Information+0x18>,%a0 4b7ca: 2470 3c00 moveal %a0@(00000000,%d3:l:4),%a2
for ( ; ; ) {
are_all_null = true;
for ( index=1 ; index <= _POSIX_Keys_Information.maximum ; index++ ) {
4b7ce: 5283 addql #1,%d3
the_key = (POSIX_Keys_Control *)
_POSIX_Keys_Information.local_table[ index ];
if ( !the_key )
4b7d0: 4a8a tstl %a2 4b7d2: 6724 beqs 4b7f8 <_POSIX_Keys_Run_destructors+0x64>
continue;
if ( !the_key->destructor )
4b7d4: 206a 0010 moveal %a2@(16),%a0 4b7d8: 4a88 tstl %a0 4b7da: 671c beqs 4b7f8 <_POSIX_Keys_Run_destructors+0x64>
continue;
value = the_key->Values[ thread_api ][ thread_index ];
4b7dc: 2272 6c00 moveal %a2@(00000000,%d6:l:4),%a1 4b7e0: 2031 2800 movel %a1@(00000000,%d2:l),%d0
if ( value ) {
4b7e4: 6712 beqs 4b7f8 <_POSIX_Keys_Run_destructors+0x64>
(*the_key->destructor)( value );
4b7e6: 2f00 movel %d0,%sp@- 4b7e8: 4e90 jsr %a0@
if ( the_key->Values[ thread_api ][ thread_index ] )
4b7ea: 588f addql #4,%sp 4b7ec: 2072 6c00 moveal %a2@(00000000,%d6:l:4),%a0 4b7f0: 4ab0 2800 tstl %a0@(00000000,%d2:l) 4b7f4: 57c0 seq %d0 4b7f6: ca80 andl %d0,%d5
for ( ; ; ) {
are_all_null = true;
for ( index=1 ; index <= _POSIX_Keys_Information.maximum ; index++ ) {
4b7f8: 4280 clrl %d0 4b7fa: 3039 0005 d036 movew 5d036 <_POSIX_Keys_Information+0xe>,%d0 4b800: b083 cmpl %d3,%d0 4b802: 64c0 bccs 4b7c4 <_POSIX_Keys_Run_destructors+0x30>
if ( the_key->Values[ thread_api ][ thread_index ] )
are_all_null = false;
}
}
if ( are_all_null == true )
4b804: 4a05 tstb %d5 4b806: 6608 bnes 4b810 <_POSIX_Keys_Run_destructors+0x7c>
return;
iterations++;
4b808: 5284 addql #1,%d4
* loop. It seems rude to unnecessarily lock up a system.
*
* Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99.
*/
if ( iterations >= PTHREAD_DESTRUCTOR_ITERATIONS )
4b80a: 7004 moveq #4,%d0 4b80c: b084 cmpl %d4,%d0 4b80e: 66ae bnes 4b7be <_POSIX_Keys_Run_destructors+0x2a>
return;
}
}
4b810: 4cee 047c ffe8 moveml %fp@(-24),%d2-%d6/%a2 4b816: 4e5e unlk %fp 4b818: 4e75 rts
...
00049134 <_POSIX_Message_queue_Delete>:
*/
void _POSIX_Message_queue_Delete(
POSIX_Message_queue_Control *the_mq
)
{
49134: 4e56 0000 linkw %fp,#0 49138: 2f0a movel %a2,%sp@- 4913a: 246e 0008 moveal %fp@(8),%a2
if ( !the_mq->linked && !the_mq->open_count ) {
4913e: 4a2a 0015 tstb %a2@(21) 49142: 6636 bnes 4917a <_POSIX_Message_queue_Delete+0x46> 49144: 4aaa 0016 tstl %a2@(22) 49148: 6630 bnes 4917a <_POSIX_Message_queue_Delete+0x46>
);
_Workspace_Free( (void *)the_object->name.name_p );
}
#endif
_Objects_Close( &_POSIX_Message_queue_Information, the_object );
4914a: 2f0a movel %a2,%sp@- 4914c: 4879 0006 4e7e pea 64e7e <_POSIX_Message_queue_Information> 49152: 4eb9 0004 bdbc jsr 4bdbc <_Objects_Close>
_CORE_message_queue_Close(
49158: 4878 0005 pea 5 <COMPARE> 4915c: 42a7 clrl %sp@- 4915e: 486a 001a pea %a2@(26) 49162: 4eb9 0004 b234 jsr 4b234 <_CORE_message_queue_Close>
RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free (
POSIX_Message_queue_Control *the_mq
)
{
_Objects_Free( &_POSIX_Message_queue_Information, &the_mq->Object );
49168: 2f0a movel %a2,%sp@- 4916a: 4879 0006 4e7e pea 64e7e <_POSIX_Message_queue_Information> 49170: 4eb9 0004 c030 jsr 4c030 <_Objects_Free> 49176: 4fef 001c lea %sp@(28),%sp
);
_POSIX_Message_queue_Free( the_mq );
}
}
4917a: 246e fffc moveal %fp@(-4),%a2 4917e: 4e5e unlk %fp 49180: 4e75 rts
...
0004948c <_POSIX_Message_queue_Receive_support>:
size_t msg_len,
unsigned int *msg_prio,
bool wait,
Watchdog_Interval timeout
)
{
4948c: 4e56 ffe4 linkw %fp,#-28 49490: 48d7 043c moveml %d2-%d5/%a2,%sp@
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(
49494: 486e fffc pea %fp@(-4) 49498: 242e 0008 movel %fp@(8),%d2 4949c: 2f02 movel %d2,%sp@- 4949e: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 494a4: 246e 0014 moveal %fp@(20),%a2 494a8: 262e 0018 movel %fp@(24),%d3 494ac: 4eb9 0004 c188 jsr 4c188 <_Objects_Get>
Objects_Locations location;
size_t length_out;
bool do_wait;
the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location );
switch ( location ) {
494b2: 4fef 000c lea %sp@(12),%sp 494b6: 4aae fffc tstl %fp@(-4) 494ba: 6600 00c4 bnew 49580 <_POSIX_Message_queue_Receive_support+0xf4>
case OBJECTS_LOCAL:
if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) {
494be: 2040 moveal %d0,%a0 494c0: 7803 moveq #3,%d4 494c2: 7a01 moveq #1,%d5 494c4: 2228 0014 movel %a0@(20),%d1 494c8: c881 andl %d1,%d4 494ca: ba84 cmpl %d4,%d5 494cc: 660a bnes 494d8 <_POSIX_Message_queue_Receive_support+0x4c>
_Thread_Enable_dispatch();
494ce: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> 494d4: 6000 00aa braw 49580 <_POSIX_Message_queue_Receive_support+0xf4>
rtems_set_errno_and_return_minus_one( EBADF );
}
the_mq = the_mq_fd->Queue;
494d8: 2240 moveal %d0,%a1 494da: 2069 0010 moveal %a1@(16),%a0
if ( msg_len < the_mq->Message_queue.maximum_message_size ) {
494de: 2028 0066 movel %a0@(102),%d0 494e2: b0ae 0010 cmpl %fp@(16),%d0 494e6: 6318 blss 49500 <_POSIX_Message_queue_Receive_support+0x74>
_Thread_Enable_dispatch();
494e8: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( EMSGSIZE );
494ee: 747a moveq #122,%d2 494f0: 4eb9 0005 2858 jsr 52858 <__errno> 494f6: 72ff moveq #-1,%d1 494f8: 2040 moveal %d0,%a0 494fa: 2082 movel %d2,%a0@ 494fc: 6000 0090 braw 4958e <_POSIX_Message_queue_Receive_support+0x102>
length_out = -1;
/*
* A timed receive with a bad time will do a poll regardless.
*/
if ( wait )
49500: 4a03 tstb %d3 49502: 6604 bnes 49508 <_POSIX_Message_queue_Receive_support+0x7c>
49504: 4200 clrb %d0 <== NOT EXECUTED 49506: 600c bras 49514 <_POSIX_Message_queue_Receive_support+0x88><== NOT EXECUTED
do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true;
49508: 2001 movel %d1,%d0 4950a: 760e moveq #14,%d3 4950c: 7a01 moveq #1,%d5 4950e: e6a8 lsrl %d3,%d0 49510: bb80 eorl %d5,%d0 49512: c085 andl %d5,%d0
do_wait = wait;
/*
* Now perform the actual message receive
*/
_CORE_message_queue_Seize(
49514: 2f2e 001c movel %fp@(28),%sp@- 49518: 7201 moveq #1,%d1
/*
* Now if something goes wrong, we return a "length" of -1
* to indicate an error.
*/
length_out = -1;
4951a: 76ff moveq #-1,%d3
do_wait = wait;
/*
* Now perform the actual message receive
*/
_CORE_message_queue_Seize(
4951c: c280 andl %d0,%d1
/*
* Now if something goes wrong, we return a "length" of -1
* to indicate an error.
*/
length_out = -1;
4951e: 2d43 fff8 movel %d3,%fp@(-8)
do_wait = wait;
/*
* Now perform the actual message receive
*/
_CORE_message_queue_Seize(
49522: 2f01 movel %d1,%sp@- 49524: 486e fff8 pea %fp@(-8) 49528: 2f2e 000c movel %fp@(12),%sp@- 4952c: 2f02 movel %d2,%sp@- 4952e: 4868 001a pea %a0@(26) 49532: 4eb9 0004 b2d0 jsr 4b2d0 <_CORE_message_queue_Seize>
&length_out,
do_wait,
timeout
);
_Thread_Enable_dispatch();
49538: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch>
*msg_prio =
_POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count);
4953e: 2079 0006 4c6a moveal 64c6a <_Thread_Executing>,%a0
do_wait,
timeout
);
_Thread_Enable_dispatch();
*msg_prio =
49544: 24a8 0024 movel %a0@(36),%a2@ 49548: 6c06 bges 49550 <_POSIX_Message_queue_Receive_support+0xc4> 4954a: 2a12 movel %a2@,%d5 4954c: 4485 negl %d5 4954e: 2485 movel %d5,%a2@
_POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count);
if ( !_Thread_Executing->Wait.return_code )
49550: 4fef 0018 lea %sp@(24),%sp 49554: 4aa8 0034 tstl %a0@(52) 49558: 6606 bnes 49560 <_POSIX_Message_queue_Receive_support+0xd4>
return length_out;
4955a: 222e fff8 movel %fp@(-8),%d1 4955e: 602e bras 4958e <_POSIX_Message_queue_Receive_support+0x102>
rtems_set_errno_and_return_minus_one(
49560: 4eb9 0005 2858 jsr 52858 <__errno> 49566: 2079 0006 4c6a moveal 64c6a <_Thread_Executing>,%a0 4956c: 2440 moveal %d0,%a2 4956e: 2f28 0034 movel %a0@(52),%sp@- 49572: 4eb9 0004 97b8 jsr 497b8 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 49578: 588f addql #4,%sp 4957a: 72ff moveq #-1,%d1 4957c: 2480 movel %d0,%a2@ 4957e: 600e bras 4958e <_POSIX_Message_queue_Receive_support+0x102>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EBADF );
49580: 4eb9 0005 2858 jsr 52858 <__errno> 49586: 72ff moveq #-1,%d1 49588: 2040 moveal %d0,%a0 4958a: 7009 moveq #9,%d0 4958c: 2080 movel %d0,%a0@
}
4958e: 2001 movel %d1,%d0 49590: 4cee 043c ffe4 moveml %fp@(-28),%d2-%d5/%a2 49596: 4e5e unlk %fp 49598: 4e75 rts
...
000495c0 <_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 )
495c0: 7020 moveq #32,%d0
size_t msg_len,
uint32_t msg_prio,
bool wait,
Watchdog_Interval timeout
)
{
495c2: 4e56 ffe8 linkw %fp,#-24 495c6: 48d7 043c moveml %d2-%d5/%a2,%sp@ 495ca: 242e 0008 movel %fp@(8),%d2 495ce: 262e 0014 movel %fp@(20),%d3 495d2: 282e 0018 movel %fp@(24),%d4
/*
* Validate the priority.
* XXX - Do not validate msg_prio is not less than 0.
*/
if ( msg_prio > MQ_PRIO_MAX )
495d6: b083 cmpl %d3,%d0 495d8: 6412 bccs 495ec <_POSIX_Message_queue_Send_support+0x2c>
rtems_set_errno_and_return_minus_one( EINVAL );
495da: 4eb9 0005 2858 jsr 52858 <__errno> 495e0: 7416 moveq #22,%d2 495e2: 72ff moveq #-1,%d1 495e4: 2040 moveal %d0,%a0 495e6: 2082 movel %d2,%a0@ 495e8: 6000 00bc braw 496a6 <_POSIX_Message_queue_Send_support+0xe6> 495ec: 486e fffc pea %fp@(-4) 495f0: 2f02 movel %d2,%sp@- 495f2: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 495f8: 4eb9 0004 c188 jsr 4c188 <_Objects_Get>
the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location );
switch ( location ) {
495fe: 4fef 000c lea %sp@(12),%sp 49602: 4aae fffc tstl %fp@(-4) 49606: 6600 0090 bnew 49698 <_POSIX_Message_queue_Send_support+0xd8>
case OBJECTS_LOCAL:
if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) {
4960a: 2240 moveal %d0,%a1 4960c: 7a03 moveq #3,%d5 4960e: 2229 0014 movel %a1@(20),%d1 49612: ca81 andl %d1,%d5 49614: 6608 bnes 4961e <_POSIX_Message_queue_Send_support+0x5e>
_Thread_Enable_dispatch();
49616: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> 4961c: 607a bras 49698 <_POSIX_Message_queue_Send_support+0xd8>
rtems_set_errno_and_return_minus_one( EBADF );
}
the_mq = the_mq_fd->Queue;
4961e: 2240 moveal %d0,%a1 49620: 2069 0010 moveal %a1@(16),%a0
/*
* A timed receive with a bad time will do a poll regardless.
*/
if ( wait )
49624: 4a04 tstb %d4 49626: 6604 bnes 4962c <_POSIX_Message_queue_Send_support+0x6c> 49628: 4200 clrb %d0 4962a: 600c bras 49638 <_POSIX_Message_queue_Send_support+0x78>
do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true;
4962c: 2001 movel %d1,%d0 4962e: 780e moveq #14,%d4 49630: 7201 moveq #1,%d1 49632: e8a8 lsrl %d4,%d0 49634: b380 eorl %d1,%d0 49636: c081 andl %d1,%d0
do_wait = wait;
/*
* Now perform the actual message receive
*/
msg_status = _CORE_message_queue_Submit(
49638: 2f2e 001c movel %fp@(28),%sp@- 4963c: 7801 moveq #1,%d4 4963e: 4483 negl %d3 49640: c880 andl %d0,%d4 49642: 2f04 movel %d4,%sp@- 49644: 2f03 movel %d3,%sp@- 49646: 42a7 clrl %sp@- 49648: 2f02 movel %d2,%sp@- 4964a: 2f2e 0010 movel %fp@(16),%sp@- 4964e: 2f2e 000c movel %fp@(12),%sp@- 49652: 4868 001a pea %a0@(26) 49656: 4eb9 0004 b40c jsr 4b40c <_CORE_message_queue_Submit>
_POSIX_Message_queue_Priority_to_core( msg_prio ),
do_wait,
timeout /* no timeout */
);
_Thread_Enable_dispatch();
4965c: 4fef 0020 lea %sp@(32),%sp
do_wait = wait;
/*
* Now perform the actual message receive
*/
msg_status = _CORE_message_queue_Submit(
49660: 2400 movel %d0,%d2
_POSIX_Message_queue_Priority_to_core( msg_prio ),
do_wait,
timeout /* no timeout */
);
_Thread_Enable_dispatch();
49662: 4eb9 0004 c9da jsr 4c9da <_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 )
49668: 7007 moveq #7,%d0 4966a: b082 cmpl %d2,%d0 4966c: 660a bnes 49678 <_POSIX_Message_queue_Send_support+0xb8>
msg_status = _Thread_Executing->Wait.return_code;
4966e: 2079 0006 4c6a moveal 64c6a <_Thread_Executing>,%a0 49674: 2428 0034 movel %a0@(52),%d2
if ( !msg_status )
49678: 4a82 tstl %d2 4967a: 6604 bnes 49680 <_POSIX_Message_queue_Send_support+0xc0> 4967c: 4281 clrl %d1 4967e: 6026 bras 496a6 <_POSIX_Message_queue_Send_support+0xe6>
return msg_status;
rtems_set_errno_and_return_minus_one(
49680: 4eb9 0005 2858 jsr 52858 <__errno> 49686: 2440 moveal %d0,%a2 49688: 2f02 movel %d2,%sp@- 4968a: 4eb9 0004 97b8 jsr 497b8 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 49690: 588f addql #4,%sp 49692: 72ff moveq #-1,%d1 49694: 2480 movel %d0,%a2@ 49696: 600e bras 496a6 <_POSIX_Message_queue_Send_support+0xe6>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EBADF );
49698: 4eb9 0005 2858 jsr 52858 <__errno> 4969e: 72ff moveq #-1,%d1 496a0: 2040 moveal %d0,%a0 496a2: 7009 moveq #9,%d0 496a4: 2080 movel %d0,%a0@
}
496a6: 2001 movel %d1,%d0 496a8: 4cee 043c ffe8 moveml %fp@(-24),%d2-%d5/%a2 496ae: 4e5e unlk %fp 496b0: 4e75 rts
...
000497b8 <_POSIX_Message_queue_Translate_core_message_queue_return_code>:
int _POSIX_Message_queue_Translate_core_message_queue_return_code(
uint32_t the_message_queue_status
)
{
497b8: 41f9 0006 1c98 lea 61c98 <_POSIX_Message_queue_Return_codes>,%a0 497be: 4e56 0000 linkw %fp,#0
#if defined(RTEMS_DEBUG)
if ( the_message_queue_status > CORE_MESSAGE_QUEUE_STATUS_LAST )
return EINVAL;
#endif
return _POSIX_Message_queue_Return_codes[the_message_queue_status];
}
497c2: 202e 0008 movel %fp@(8),%d0 497c6: 4e5e unlk %fp 497c8: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 497cc: 4e75 rts
...
00046c38 <_POSIX_Mutex_Lock_support>:
int _POSIX_Mutex_Lock_support(
pthread_mutex_t *mutex,
bool blocking,
Watchdog_Interval timeout
)
{
46c38: 4e56 fff8 linkw %fp,#-8 46c3c: 2f02 movel %d2,%sp@-
register POSIX_Mutex_Control *the_mutex;
Objects_Locations location;
ISR_Level level;
the_mutex = _POSIX_Mutex_Get_interrupt_disable( mutex, &location, &level );
46c3e: 486e fff8 pea %fp@(-8) 46c42: 486e fffc pea %fp@(-4) 46c46: 2f2e 0008 movel %fp@(8),%sp@-
int _POSIX_Mutex_Lock_support(
pthread_mutex_t *mutex,
bool blocking,
Watchdog_Interval timeout
)
{
46c4a: 142e 000f moveb %fp@(15),%d2
register POSIX_Mutex_Control *the_mutex;
Objects_Locations location;
ISR_Level level;
the_mutex = _POSIX_Mutex_Get_interrupt_disable( mutex, &location, &level );
46c4e: 4eb9 0004 6a14 jsr 46a14 <_POSIX_Mutex_Get_interrupt_disable>
switch ( location ) {
46c54: 4fef 000c lea %sp@(12),%sp 46c58: 4aae fffc tstl %fp@(-4) 46c5c: 6704 beqs 46c62 <_POSIX_Mutex_Lock_support+0x2a> 46c5e: 7016 moveq #22,%d0 46c60: 6034 bras 46c96 <_POSIX_Mutex_Lock_support+0x5e>
case OBJECTS_LOCAL:
_CORE_mutex_Seize(
46c62: 2f2e fff8 movel %fp@(-8),%sp@- 46c66: 2040 moveal %d0,%a0 46c68: 2f2e 0010 movel %fp@(16),%sp@- 46c6c: 0282 0000 00ff andil #255,%d2 46c72: 2f02 movel %d2,%sp@- 46c74: 2f28 0008 movel %a0@(8),%sp@- 46c78: 4868 0014 pea %a0@(20) 46c7c: 4eb9 0004 8698 jsr 48698 <_CORE_mutex_Seize>
the_mutex->Object.id,
blocking,
timeout,
level
);
return _POSIX_Mutex_Translate_core_mutex_return_code(
46c82: 2079 0006 184e moveal 6184e <_Thread_Executing>,%a0 46c88: 2f28 0034 movel %a0@(52),%sp@- 46c8c: 4eb9 0004 6d60 jsr 46d60 <_POSIX_Mutex_Translate_core_mutex_return_code> 46c92: 4fef 0018 lea %sp@(24),%sp
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
46c96: 242e fff4 movel %fp@(-12),%d2 46c9a: 4e5e unlk %fp 46c9c: 4e75 rts
...
00046d60 <_POSIX_Mutex_Translate_core_mutex_return_code>:
int _POSIX_Mutex_Translate_core_mutex_return_code(
CORE_mutex_Status the_mutex_status
)
{
46d60: 41f9 0005 ed58 lea 5ed58 <_POSIX_Mutex_Return_codes>,%a0 46d66: 4e56 0000 linkw %fp,#0
#if defined(RTEMS_DEBUG)
if ( the_mutex_status > CORE_MUTEX_STATUS_LAST )
return EINVAL;
#endif
return _POSIX_Mutex_Return_codes[the_mutex_status];
}
46d6a: 202e 0008 movel %fp@(8),%d0 46d6e: 4e5e unlk %fp 46d70: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 46d74: 4e75 rts
...
0004a88c <_POSIX_Priority_Is_valid>:
#include <rtems/posix/priority.h>
bool _POSIX_Priority_Is_valid(
int priority
)
{
4a88c: 4e56 0000 linkw %fp,#0 4a890: 202e 0008 movel %fp@(8),%d0
return ((priority >= POSIX_SCHEDULER_MINIMUM_PRIORITY) &&
4a894: 6e04 bgts 4a89a <_POSIX_Priority_Is_valid+0xe> 4a896: 4280 clrl %d0 4a898: 6010 bras 4a8aa <_POSIX_Priority_Is_valid+0x1e> 4a89a: 4281 clrl %d1 4a89c: 1239 0005 c516 moveb 5c516 <rtems_maximum_priority>,%d1 4a8a2: b081 cmpl %d1,%d0 4a8a4: 5dc0 slt %d0 4a8a6: 49c0 extbl %d0 4a8a8: 4480 negl %d0
(priority <= POSIX_SCHEDULER_MAXIMUM_PRIORITY));
}
4a8aa: 4e5e unlk %fp 4a8ac: 4e75 rts
...
0004962c <_POSIX_RWLock_Manager_initialization>:
/**
* @brief _POSIX_RWLock_Manager_initialization
*/
void _POSIX_RWLock_Manager_initialization(void)
{
4962c: 4e56 0000 linkw %fp,#0
_Objects_Initialize_information(
49630: 4878 00ff pea ff <DBL_MANT_DIG+0xca> 49634: 4878 0001 pea 1 <ADD> 49638: 4878 005c pea 5c <DBL_MANT_DIG+0x27> 4963c: 2f39 0005 bafa movel 5bafa <Configuration_POSIX_API+0x28>,%sp@- 49642: 4878 000b pea b <LASTO+0x1> 49646: 4878 0003 pea 3 <DIVIDE> 4964a: 4879 0005 ce40 pea 5ce40 <_POSIX_RWLock_Information> 49650: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 49656: 4fef 001c lea %sp@(28),%sp
,
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
4965a: 4e5e unlk %fp 4965c: 4e75 rts
...
00045e4c <_POSIX_RWLock_Translate_core_RWLock_return_code>:
int _POSIX_RWLock_Translate_core_RWLock_return_code(
CORE_RWLock_Status the_rwlock_status
)
{
45e4c: 41f9 0005 cd1a lea 5cd1a <_POSIX_RWLock_Return_codes>,%a0 45e52: 4e56 0000 linkw %fp,#0
#if defined(RTEMS_DEBUG)
if ( the_rwlock_status > CORE_RWLOCK_STATUS_LAST )
return EINVAL;
#endif
return _POSIX_RWLock_Return_codes[the_rwlock_status];
}
45e56: 202e 0008 movel %fp@(8),%d0 45e5a: 4e5e unlk %fp 45e5c: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 45e60: 4e75 rts
...
0004d448 <_POSIX_Semaphore_Create_support>:
const char *name,
int pshared,
unsigned int value,
POSIX_Semaphore_Control **the_sem
)
{
4d448: 4e56 0000 linkw %fp,#0 4d44c: 2f0a movel %a2,%sp@- 4d44e: 2f02 movel %d2,%sp@- 4d450: 242e 0008 movel %fp@(8),%d2
POSIX_Semaphore_Control *the_semaphore;
CORE_semaphore_Attributes *the_sem_attr;
char *name_p = (char *)name;
/* Sharing semaphores among processes is not currently supported */
if (pshared != 0)
4d454: 4aae 000c tstl %fp@(12) 4d458: 6712 beqs 4d46c <_POSIX_Semaphore_Create_support+0x24>
rtems_set_errno_and_return_minus_one( ENOSYS );
4d45a: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d460: 72ff moveq #-1,%d1 4d462: 2040 moveal %d0,%a0 4d464: 7058 moveq #88,%d0 4d466: 2080 movel %d0,%a0@ 4d468: 6000 00c6 braw 4d530 <_POSIX_Semaphore_Create_support+0xe8>
if ( name ) {
4d46c: 4a82 tstl %d2 4d46e: 6728 beqs 4d498 <_POSIX_Semaphore_Create_support+0x50>
if ( strnlen( name, NAME_MAX ) >= NAME_MAX )
4d470: 4878 00ff pea ff <DBL_MANT_DIG+0xca> 4d474: 2f02 movel %d2,%sp@- 4d476: 4eb9 0005 1cb0 jsr 51cb0 <strnlen> 4d47c: 508f addql #8,%sp 4d47e: 0c80 0000 00fe cmpil #254,%d0 4d484: 6312 blss 4d498 <_POSIX_Semaphore_Create_support+0x50>
rtems_set_errno_and_return_minus_one( ENAMETOOLONG );
4d486: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d48c: 745b moveq #91,%d2 4d48e: 72ff moveq #-1,%d1 4d490: 2040 moveal %d0,%a0 4d492: 2082 movel %d2,%a0@ 4d494: 6000 009a braw 4d530 <_POSIX_Semaphore_Create_support+0xe8> 4d498: 2039 0006 1a90 movel 61a90 <_Thread_Dispatch_disable_level>,%d0 4d49e: 5280 addql #1,%d0 4d4a0: 23c0 0006 1a90 movel %d0,61a90 <_Thread_Dispatch_disable_level>
* _POSIX_Semaphore_Allocate
*/
RTEMS_INLINE_ROUTINE POSIX_Semaphore_Control *_POSIX_Semaphore_Allocate( void )
{
return (POSIX_Semaphore_Control *)
4d4a6: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 4d4ac: 4eb9 0004 9654 jsr 49654 <_Objects_Allocate>
_Thread_Disable_dispatch();
the_semaphore = _POSIX_Semaphore_Allocate();
if ( !the_semaphore ) {
4d4b2: 588f addql #4,%sp 4d4b4: 2440 moveal %d0,%a2 4d4b6: 4a80 tstl %d0 4d4b8: 6616 bnes 4d4d0 <_POSIX_Semaphore_Create_support+0x88>
_Thread_Enable_dispatch();
4d4ba: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( ENOSPC );
4d4c0: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d4c6: 72ff moveq #-1,%d1 4d4c8: 2040 moveal %d0,%a0 4d4ca: 701c moveq #28,%d0 4d4cc: 2080 movel %d0,%a0@ 4d4ce: 6060 bras 4d530 <_POSIX_Semaphore_Create_support+0xe8>
}
the_semaphore->process_shared = pshared;
4d4d0: 42aa 0010 clrl %a2@(16)
if ( name ) {
4d4d4: 4a82 tstl %d2 4d4d6: 6708 beqs 4d4e0 <_POSIX_Semaphore_Create_support+0x98>
the_semaphore->named = true;
the_semaphore->open_count = 1;
4d4d8: 7001 moveq #1,%d0 4d4da: 2540 0016 movel %d0,%a2@(22) 4d4de: 6006 bras 4d4e6 <_POSIX_Semaphore_Create_support+0x9e>
the_semaphore->linked = true;
} else {
the_semaphore->named = false;
the_semaphore->open_count = 0;
4d4e0: 42aa 0016 clrl %a2@(22)
if ( name ) {
the_semaphore->named = true;
the_semaphore->open_count = 1;
the_semaphore->linked = true;
} else {
the_semaphore->named = false;
4d4e4: 4200 clrb %d0
* blocking tasks on this semaphore should be. It could somehow * be derived from the current scheduling policy. One * thing is certain, no matter what we decide, it won't be * the same as all other POSIX implementations. :) */ the_sem_attr->discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO;
4d4e6: 42aa 005e clrl %a2@(94)
if ( name ) {
the_semaphore->named = true;
the_semaphore->open_count = 1;
the_semaphore->linked = true;
} else {
the_semaphore->named = false;
4d4ea: 1540 0014 moveb %d0,%a2@(20)
the_semaphore->open_count = 0;
the_semaphore->linked = false;
4d4ee: 1540 0015 moveb %d0,%a2@(21)
the_sem_attr->discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO;
/*
* This effectively disables limit checking.
*/
the_sem_attr->maximum_count = 0xFFFFFFFF;
4d4f2: 70ff moveq #-1,%d0 4d4f4: 2540 005a movel %d0,%a2@(90)
_CORE_semaphore_Initialize( &the_semaphore->Semaphore, the_sem_attr, value );
4d4f8: 2f2e 0010 movel %fp@(16),%sp@- 4d4fc: 486a 005a pea %a2@(90) 4d500: 486a 001a pea %a2@(26) 4d504: 4eb9 0004 9184 jsr 49184 <_CORE_semaphore_Initialize>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4d50a: 2079 0006 1d02 moveal 61d02 <_POSIX_Semaphore_Information+0x18>,%a0 4d510: 4280 clrl %d0 4d512: 302a 000a movew %a2@(10),%d0 4d516: 218a 0c00 movel %a2,%a0@(00000000,%d0:l:4)
the_object
);
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
/* ASSERT: information->is_string */
the_object->name.name_p = name;
4d51a: 2542 000c movel %d2,%a2@(12)
&_POSIX_Semaphore_Information,
&the_semaphore->Object,
name_p
);
*the_sem = the_semaphore;
4d51e: 206e 0014 moveal %fp@(20),%a0 4d522: 208a movel %a2,%a0@
_Thread_Enable_dispatch();
4d524: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch>
return 0;
4d52a: 4fef 000c lea %sp@(12),%sp
name_p
);
*the_sem = the_semaphore;
_Thread_Enable_dispatch();
4d52e: 4281 clrl %d1
return 0; }
4d530: 242e fff8 movel %fp@(-8),%d2 4d534: 2001 movel %d1,%d0 4d536: 246e fffc moveal %fp@(-4),%a2 4d53a: 4e5e unlk %fp 4d53c: 4e75 rts
...
0004d540 <_POSIX_Semaphore_Delete>:
*/
void _POSIX_Semaphore_Delete(
POSIX_Semaphore_Control *the_semaphore
)
{
4d540: 4e56 0000 linkw %fp,#0 4d544: 2f0a movel %a2,%sp@- 4d546: 246e 0008 moveal %fp@(8),%a2
if ( !the_semaphore->linked && !the_semaphore->open_count ) {
4d54a: 4a2a 0015 tstb %a2@(21) 4d54e: 6636 bnes 4d586 <_POSIX_Semaphore_Delete+0x46> 4d550: 4aaa 0016 tstl %a2@(22) 4d554: 6630 bnes 4d586 <_POSIX_Semaphore_Delete+0x46>
_Objects_Close( &_POSIX_Semaphore_Information, &the_semaphore->Object );
4d556: 2f0a movel %a2,%sp@- 4d558: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 4d55e: 4eb9 0004 96d4 jsr 496d4 <_Objects_Close>
_CORE_semaphore_Flush(
4d564: 4878 ffff pea ffffffff <LESS> 4d568: 42a7 clrl %sp@- 4d56a: 486a 001a pea %a2@(26) 4d56e: 4eb9 0004 9178 jsr 49178 <_CORE_semaphore_Flush>
RTEMS_INLINE_ROUTINE void _POSIX_Semaphore_Free (
POSIX_Semaphore_Control *the_semaphore
)
{
_Objects_Free( &_POSIX_Semaphore_Information, &the_semaphore->Object );
4d574: 2f0a movel %a2,%sp@- 4d576: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 4d57c: 4eb9 0004 9948 jsr 49948 <_Objects_Free> 4d582: 4fef 001c lea %sp@(28),%sp
-1
);
_POSIX_Semaphore_Free( the_semaphore );
}
}
4d586: 246e fffc moveal %fp@(-4),%a2 4d58a: 4e5e unlk %fp 4d58c: 4e75 rts
...
00049b20 <_POSIX_Semaphore_Manager_initialization>:
*
* Output parameters: NONE
*/
void _POSIX_Semaphore_Manager_initialization(void)
{
49b20: 4e56 0000 linkw %fp,#0
_Objects_Initialize_information(
49b24: 4878 00ff pea ff <DBL_MANT_DIG+0xca> 49b28: 4878 0001 pea 1 <ADD> 49b2c: 4878 0066 pea 66 <DBL_MANT_DIG+0x31> 49b30: 2f39 0005 baf2 movel 5baf2 <Configuration_POSIX_API+0x20>,%sp@- 49b36: 4878 0007 pea 7 <TRUNCDFSF> 49b3a: 4878 0003 pea 3 <DIVIDE> 49b3e: 4879 0005 ceee pea 5ceee <_POSIX_Semaphore_Information> 49b44: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 49b4a: 4fef 001c lea %sp@(28),%sp
,
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
49b4e: 4e5e unlk %fp 49b50: 4e75 rts
...
0004f7b4 <_POSIX_Semaphore_Translate_core_semaphore_return_code>:
int _POSIX_Semaphore_Translate_core_semaphore_return_code(
CORE_semaphore_Status the_semaphore_status
)
{
4f7b4: 41f9 0005 f610 lea 5f610 <_POSIX_Semaphore_Return_codes>,%a0 4f7ba: 4e56 0000 linkw %fp,#0
#if defined(RTEMS_DEBUG)
if ( the_semaphore_status > CORE_SEMAPHORE_STATUS_LAST )
return EINVAL;
#endif
return _POSIX_Semaphore_Return_codes[the_semaphore_status];
}
4f7be: 202e 0008 movel %fp@(8),%d0 4f7c2: 4e5e unlk %fp 4f7c4: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4f7c8: 4e75 rts
...
0004d604 <_POSIX_Semaphore_Wait_support>:
int _POSIX_Semaphore_Wait_support(
sem_t *sem,
bool blocking,
Watchdog_Interval timeout
)
{
4d604: 4e56 fffc linkw %fp,#-4 4d608: 206e 0008 moveal %fp@(8),%a0 4d60c: 2f0a movel %a2,%sp@- 4d60e: 2f02 movel %d2,%sp@-
RTEMS_INLINE_ROUTINE POSIX_Semaphore_Control *_POSIX_Semaphore_Get (
sem_t *id,
Objects_Locations *location
)
{
return (POSIX_Semaphore_Control *)
4d610: 486e fffc pea %fp@(-4) 4d614: 2f10 movel %a0@,%sp@- 4d616: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 4d61c: 142e 000f moveb %fp@(15),%d2 4d620: 4eb9 0004 9aa0 jsr 49aa0 <_Objects_Get>
POSIX_Semaphore_Control *the_semaphore;
Objects_Locations location;
the_semaphore = _POSIX_Semaphore_Get( sem, &location );
switch ( location ) {
4d626: 4fef 000c lea %sp@(12),%sp 4d62a: 4aae fffc tstl %fp@(-4) 4d62e: 6656 bnes 4d686 <_POSIX_Semaphore_Wait_support+0x82>
case OBJECTS_LOCAL:
_CORE_semaphore_Seize(
4d630: 2f2e 0010 movel %fp@(16),%sp@- 4d634: 2040 moveal %d0,%a0 4d636: 0282 0000 00ff andil #255,%d2 4d63c: 2f02 movel %d2,%sp@- 4d63e: 2f28 0008 movel %a0@(8),%sp@- 4d642: 4868 001a pea %a0@(26) 4d646: 4eb9 0004 dcc0 jsr 4dcc0 <_CORE_semaphore_Seize>
&the_semaphore->Semaphore,
the_semaphore->Object.id,
blocking,
timeout
);
_Thread_Enable_dispatch();
4d64c: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch>
if ( !_Thread_Executing->Wait.return_code )
4d652: 2079 0006 1b4a moveal 61b4a <_Thread_Executing>,%a0 4d658: 4fef 0010 lea %sp@(16),%sp 4d65c: 4aa8 0034 tstl %a0@(52) 4d660: 6604 bnes 4d666 <_POSIX_Semaphore_Wait_support+0x62> 4d662: 4281 clrl %d1 4d664: 602e bras 4d694 <_POSIX_Semaphore_Wait_support+0x90>
return 0;
rtems_set_errno_and_return_minus_one(
4d666: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d66c: 2079 0006 1b4a moveal 61b4a <_Thread_Executing>,%a0 4d672: 2440 moveal %d0,%a2 4d674: 2f28 0034 movel %a0@(52),%sp@- 4d678: 4eb9 0004 f7b4 jsr 4f7b4 <_POSIX_Semaphore_Translate_core_semaphore_return_code> 4d67e: 588f addql #4,%sp 4d680: 72ff moveq #-1,%d1 4d682: 2480 movel %d0,%a2@ 4d684: 600e bras 4d694 <_POSIX_Semaphore_Wait_support+0x90>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EINVAL );
4d686: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d68c: 72ff moveq #-1,%d1 4d68e: 2040 moveal %d0,%a0 4d690: 7016 moveq #22,%d0 4d692: 2080 movel %d0,%a0@
}
4d694: 242e fff4 movel %fp@(-12),%d2 4d698: 2001 movel %d1,%d0 4d69a: 246e fff8 moveal %fp@(-8),%a2 4d69e: 4e5e unlk %fp 4d6a0: 4e75 rts
...
000497e4 <_POSIX_Spinlock_Manager_initialization>:
/**
* @brief _POSIX_Spinlock_Manager_initialization
*/
void _POSIX_Spinlock_Manager_initialization(void)
{
497e4: 4e56 0000 linkw %fp,#0
_Objects_Initialize_information(
497e8: 4878 00ff pea ff <DBL_MANT_DIG+0xca> 497ec: 4878 0001 pea 1 <ADD> 497f0: 4878 0020 pea 20 <OPER2+0xc> 497f4: 2f39 0005 bafe movel 5bafe <Configuration_POSIX_API+0x2c>,%sp@- 497fa: 4878 000b pea b <LASTO+0x1> 497fe: 4878 0003 pea 3 <DIVIDE> 49802: 4879 0005 ceb4 pea 5ceb4 <_POSIX_Spinlock_Information> 49808: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 4980e: 4fef 001c lea %sp@(28),%sp
,
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
49812: 4e5e unlk %fp 49814: 4e75 rts
...
00045178 <_POSIX_Spinlock_Translate_core_spinlock_return_code>:
int _POSIX_Spinlock_Translate_core_spinlock_return_code(
CORE_spinlock_Status the_spinlock_status
)
{
45178: 41f9 0005 b356 lea 5b356 <_POSIX_Spinlock_Return_codes>,%a0 4517e: 4e56 0000 linkw %fp,#0
#if defined(RTEMS_DEBUG)
if ( the_spinlock_status > CORE_SPINLOCK_STATUS_LAST )
return EINVAL;
#endif
return _POSIX_Spinlock_Return_codes[the_spinlock_status];
}
45182: 202e 0008 movel %fp@(8),%d0 45186: 4e5e unlk %fp 45188: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4518c: 4e75 rts
...
0004a8b0 <_POSIX_Thread_Translate_sched_param>:
int policy,
struct sched_param *param,
Thread_CPU_budget_algorithms *budget_algorithm,
Thread_CPU_budget_algorithm_callout *budget_callout
)
{
4a8b0: 4e56 ffec linkw %fp,#-20 4a8b4: 48d7 3c04 moveml %d2/%a2-%a5,%sp@ 4a8b8: 246e 000c moveal %fp@(12),%a2
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
4a8bc: 2f12 movel %a2@,%sp@-
int policy,
struct sched_param *param,
Thread_CPU_budget_algorithms *budget_algorithm,
Thread_CPU_budget_algorithm_callout *budget_callout
)
{
4a8be: 242e 0008 movel %fp@(8),%d2 4a8c2: 266e 0010 moveal %fp@(16),%a3 4a8c6: 286e 0014 moveal %fp@(20),%a4
if ( !_POSIX_Priority_Is_valid( param->sched_priority ) )
4a8ca: 4eb9 0004 a88c jsr 4a88c <_POSIX_Priority_Is_valid> 4a8d0: 588f addql #4,%sp 4a8d2: 4a00 tstb %d0 4a8d4: 677c beqs 4a952 <_POSIX_Thread_Translate_sched_param+0xa2>
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
4a8d6: 4293 clrl %a3@
*budget_callout = NULL;
4a8d8: 4294 clrl %a4@
if ( policy == SCHED_OTHER ) {
4a8da: 4a82 tstl %d2 4a8dc: 6608 bnes 4a8e6 <_POSIX_Thread_Translate_sched_param+0x36>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE;
4a8de: 7201 moveq #1,%d1 4a8e0: 4280 clrl %d0 4a8e2: 2681 movel %d1,%a3@
return 0;
4a8e4: 606e bras 4a954 <_POSIX_Thread_Translate_sched_param+0xa4>
}
if ( policy == SCHED_FIFO ) {
4a8e6: 7001 moveq #1,%d0 4a8e8: b082 cmpl %d2,%d0 4a8ea: 6604 bnes 4a8f0 <_POSIX_Thread_Translate_sched_param+0x40>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
4a8ec: 4293 clrl %a3@ 4a8ee: 6008 bras 4a8f8 <_POSIX_Thread_Translate_sched_param+0x48>
return 0;
}
if ( policy == SCHED_RR ) {
4a8f0: 7002 moveq #2,%d0 4a8f2: b082 cmpl %d2,%d0 4a8f4: 6606 bnes 4a8fc <_POSIX_Thread_Translate_sched_param+0x4c>
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE;
4a8f6: 2680 movel %d0,%a3@ 4a8f8: 4200 clrb %d0
return 0;
4a8fa: 6058 bras 4a954 <_POSIX_Thread_Translate_sched_param+0xa4>
}
if ( policy == SCHED_SPORADIC ) {
4a8fc: 7004 moveq #4,%d0 4a8fe: b082 cmpl %d2,%d0 4a900: 6650 bnes 4a952 <_POSIX_Thread_Translate_sched_param+0xa2>
if ( (param->sched_ss_repl_period.tv_sec == 0) &&
4a902: 4aaa 0008 tstl %a2@(8) 4a906: 6606 bnes 4a90e <_POSIX_Thread_Translate_sched_param+0x5e>
(param->sched_ss_repl_period.tv_nsec == 0) )
4a908: 4aaa 000c tstl %a2@(12) 4a90c: 6744 beqs 4a952 <_POSIX_Thread_Translate_sched_param+0xa2>
return EINVAL;
if ( (param->sched_ss_init_budget.tv_sec == 0) &&
4a90e: 4aaa 0010 tstl %a2@(16) 4a912: 6606 bnes 4a91a <_POSIX_Thread_Translate_sched_param+0x6a>
(param->sched_ss_init_budget.tv_nsec == 0) )
4a914: 4aaa 0014 tstl %a2@(20) 4a918: 6738 beqs 4a952 <_POSIX_Thread_Translate_sched_param+0xa2>
return EINVAL;
if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) <
4a91a: 486a 0008 pea %a2@(8) 4a91e: 4bf9 0004 88d4 lea 488d4 <_Timespec_To_ticks>,%a5 4a924: 4e95 jsr %a5@ 4a926: 486a 0010 pea %a2@(16) 4a92a: 2400 movel %d0,%d2 4a92c: 4e95 jsr %a5@ 4a92e: 508f addql #8,%sp 4a930: b082 cmpl %d2,%d0 4a932: 621e bhis 4a952 <_POSIX_Thread_Translate_sched_param+0xa2>
_Timespec_To_ticks( ¶m->sched_ss_init_budget ) )
return EINVAL;
if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) )
4a934: 2f2a 0004 movel %a2@(4),%sp@- 4a938: 4eb9 0004 a88c jsr 4a88c <_POSIX_Priority_Is_valid> 4a93e: 588f addql #4,%sp 4a940: 4a00 tstb %d0 4a942: 670e beqs 4a952 <_POSIX_Thread_Translate_sched_param+0xa2>
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT;
4a944: 7003 moveq #3,%d0
*budget_callout = _POSIX_Threads_Sporadic_budget_callout;
4a946: 28bc 0004 5568 movel #284008,%a4@
return EINVAL;
if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) )
return EINVAL;
*budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT;
4a94c: 2680 movel %d0,%a3@
*budget_callout = _POSIX_Threads_Sporadic_budget_callout;
4a94e: 4280 clrl %d0
return 0;
4a950: 6002 bras 4a954 <_POSIX_Thread_Translate_sched_param+0xa4> 4a952: 7016 moveq #22,%d0
}
return EINVAL;
}
4a954: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 4a95a: 4e5e unlk %fp 4a95c: 4e75 rts
...
0004b730 <_POSIX_Threads_cancel_run>:
thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ];
handler_stack = &thread_support->Cancellation_Handlers;
thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE;
4b730: 7001 moveq #1,%d0
#include <rtems/posix/threadsup.h>
void _POSIX_Threads_cancel_run(
Thread_Control *the_thread
)
{
4b732: 4e56 ffec linkw %fp,#-20
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 ];
4b736: 206e 0008 moveal %fp@(8),%a0
#include <rtems/posix/threadsup.h>
void _POSIX_Threads_cancel_run(
Thread_Control *the_thread
)
{
4b73a: 48d7 3c04 moveml %d2/%a2-%a5,%sp@
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 ];
4b73e: 2468 010e moveal %a0@(270),%a2
handler_stack = &thread_support->Cancellation_Handlers;
thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE;
while ( !_Chain_Is_empty( handler_stack ) ) {
_ISR_Disable( level );
4b742: 243c 0000 0700 movel #1792,%d2
_Chain_Extract_unprotected( &handler->Node );
_ISR_Enable( level );
(*handler->routine)( handler->arg );
_Workspace_Free( handler );
4b748: 49f9 0004 7eac lea 47eac <_Workspace_Free>,%a4
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
4b74e: 47ea 00e4 lea %a2@(228),%a3
thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ];
handler_stack = &thread_support->Cancellation_Handlers;
thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE;
4b752: 2540 00d4 movel %d0,%a2@(212)
while ( !_Chain_Is_empty( handler_stack ) ) {
4b756: 6028 bras 4b780 <_POSIX_Threads_cancel_run+0x50>
_ISR_Disable( level );
4b758: 40c1 movew %sr,%d1 4b75a: 8081 orl %d1,%d0 4b75c: 46c0 movew %d0,%sr
handler = (POSIX_Cancel_Handler_control *)
4b75e: 2a6b 0004 moveal %a3@(4),%a5
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
4b762: 2055 moveal %a5@,%a0
previous = the_node->previous;
4b764: 226d 0004 moveal %a5@(4),%a1
next->previous = previous; previous->next = next;
4b768: 2288 movel %a0,%a1@
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
next->previous = previous;
4b76a: 2149 0004 movel %a1,%a0@(4)
_Chain_Tail( handler_stack )->previous;
_Chain_Extract_unprotected( &handler->Node );
_ISR_Enable( level );
4b76e: 46c1 movew %d1,%sr
(*handler->routine)( handler->arg );
4b770: 2f2d 000c movel %a5@(12),%sp@- 4b774: 206d 0008 moveal %a5@(8),%a0 4b778: 4e90 jsr %a0@
_Workspace_Free( handler );
4b77a: 2f0d movel %a5,%sp@- 4b77c: 4e94 jsr %a4@ 4b77e: 508f addql #8,%sp
handler_stack = &thread_support->Cancellation_Handlers;
thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE;
while ( !_Chain_Is_empty( handler_stack ) ) {
_ISR_Disable( level );
4b780: 2002 movel %d2,%d0
POSIX_API_Control *thread_support;
ISR_Level level;
thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ];
handler_stack = &thread_support->Cancellation_Handlers;
4b782: b7ea 00e0 cmpal %a2@(224),%a3 4b786: 66d0 bnes 4b758 <_POSIX_Threads_cancel_run+0x28>
(*handler->routine)( handler->arg );
_Workspace_Free( handler );
}
}
4b788: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 4b78e: 4e5e unlk %fp 4b790: 4e75 rts
...
0004a3a0 <_POSIX_Timer_Insert_helper>:
Watchdog_Interval ticks,
Objects_Id id,
Watchdog_Service_routine_entry TSR,
void *arg
)
{
4a3a0: 4e56 0000 linkw %fp,#0 4a3a4: 2f0a movel %a2,%sp@- 4a3a6: 246e 0008 moveal %fp@(8),%a2 4a3aa: 2f02 movel %d2,%sp@-
ISR_Level level;
(void) _Watchdog_Remove( timer );
4a3ac: 2f0a movel %a2,%sp@- 4a3ae: 4eb9 0004 84cc jsr 484cc <_Watchdog_Remove>
_ISR_Disable( level );
4a3b4: 203c 0000 0700 movel #1792,%d0 4a3ba: 40c2 movew %sr,%d2 4a3bc: 8082 orl %d2,%d0 4a3be: 46c0 movew %d0,%sr
/*
* Check to see if the watchdog has just been inserted by a
* higher priority interrupt. If so, abandon this insert.
*/
if ( timer->state != WATCHDOG_INACTIVE ) {
4a3c0: 588f addql #4,%sp 4a3c2: 4aaa 0008 tstl %a2@(8) 4a3c6: 6706 beqs 4a3ce <_POSIX_Timer_Insert_helper+0x2e>
_ISR_Enable( level );
4a3c8: 46c2 movew %d2,%sr 4a3ca: 4200 clrb %d0
return false;
4a3cc: 6030 bras 4a3fe <_POSIX_Timer_Insert_helper+0x5e> 4a3ce: 2f0a movel %a2,%sp@- 4a3d0: 4879 0005 d8cc pea 5d8cc <_Watchdog_Ticks_chain>
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
the_watchdog->id = id;
4a3d6: 256e 0010 0020 movel %fp@(16),%a2@(32)
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
4a3dc: 256e 0014 001c movel %fp@(20),%a2@(28)
the_watchdog->id = id; the_watchdog->user_data = user_data;
4a3e2: 256e 0018 0024 movel %fp@(24),%a2@(36)
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
4a3e8: 256e 000c 000c movel %fp@(12),%a2@(12)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
4a3ee: 42aa 0008 clrl %a2@(8)
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
4a3f2: 4eb9 0004 83b0 jsr 483b0 <_Watchdog_Insert>
* OK. Now we now the timer was not rescheduled by an interrupt
* so we can atomically initialize it as in use.
*/
_Watchdog_Initialize( timer, TSR, id, arg );
_Watchdog_Insert_ticks( timer, ticks );
_ISR_Enable( level );
4a3f8: 46c2 movew %d2,%sr
return true;
4a3fa: 508f addql #8,%sp
* OK. Now we now the timer was not rescheduled by an interrupt
* so we can atomically initialize it as in use.
*/
_Watchdog_Initialize( timer, TSR, id, arg );
_Watchdog_Insert_ticks( timer, ticks );
_ISR_Enable( level );
4a3fc: 7001 moveq #1,%d0
return true; }
4a3fe: 242e fff8 movel %fp@(-8),%d2 4a402: 246e fffc moveal %fp@(-4),%a2 4a406: 4e5e unlk %fp 4a408: 4e75 rts
...
00049aec <_POSIX_Timer_Manager_initialization>:
* Initialize the internal structure in which the data of all
* the timers are stored
*/
void _POSIX_Timer_Manager_initialization(void)
{
49aec: 4e56 0000 linkw %fp,#0
_Objects_Initialize_information(
49af0: 4878 00ff pea ff <DBL_MANT_DIG+0xca> 49af4: 4878 0001 pea 1 <ADD> 49af8: 4878 0072 pea 72 <DBL_MANT_DIG+0x3d> 49afc: 2f39 0005 bae2 movel 5bae2 <Configuration_POSIX_API+0x10>,%sp@- 49b02: 4878 0009 pea 9 <DIVIDE_BY_ZERO+0x1> 49b06: 4878 0003 pea 3 <DIVIDE> 49b0a: 4879 0005 cf28 pea 5cf28 <_POSIX_Timer_Information> 49b10: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 49b16: 4fef 001c lea %sp@(28),%sp
,
false, /* true if this is a global object class */
NULL /* Proxy extraction support callout */
#endif
);
}
49b1a: 4e5e unlk %fp 49b1c: 4e75 rts
...
00044e70 <_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)
{
44e70: 4e56 0000 linkw %fp,#0 44e74: 2f0a movel %a2,%sp@- 44e76: 246e 000c moveal %fp@(12),%a2
bool activated;
ptimer = (POSIX_Timer_Control *)data;
/* Increment the number of expirations. */
ptimer->overrun = ptimer->overrun + 1;
44e7a: 52aa 0066 addql #1,%a2@(102)
/* The timer must be reprogrammed */
if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) ||
44e7e: 4aaa 0052 tstl %a2@(82) 44e82: 6606 bnes 44e8a <_POSIX_Timer_TSR+0x1a>
( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) {
44e84: 4aaa 0056 tstl %a2@(86) 44e88: 6732 beqs 44ebc <_POSIX_Timer_TSR+0x4c>
activated = _POSIX_Timer_Insert_helper(
44e8a: 2f0a movel %a2,%sp@- 44e8c: 4879 0004 4e70 pea 44e70 <_POSIX_Timer_TSR> 44e92: 2f2a 0008 movel %a2@(8),%sp@- 44e96: 2f2a 0062 movel %a2@(98),%sp@- 44e9a: 486a 0010 pea %a2@(16) 44e9e: 4eb9 0004 a3a0 jsr 4a3a0 <_POSIX_Timer_Insert_helper>
ptimer->ticks,
ptimer->Object.id,
_POSIX_Timer_TSR,
ptimer
);
if ( !activated )
44ea4: 4fef 0014 lea %sp@(20),%sp 44ea8: 4a00 tstb %d0 44eaa: 672a beqs 44ed6 <_POSIX_Timer_TSR+0x66>
return;
/* Store the time when the timer was started again */
_TOD_Get( &ptimer->time );
44eac: 486a 006a pea %a2@(106) 44eb0: 4eb9 0004 6348 jsr 46348 <_TOD_Get>
/* Increment the number of expirations. */
ptimer->overrun = ptimer->overrun + 1;
/* The timer must be reprogrammed */
if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) ||
44eb6: 588f addql #4,%sp
/* Store the time when the timer was started again */
_TOD_Get( &ptimer->time );
/* The state really did not change but just to be safe */
ptimer->state = POSIX_TIMER_STATE_CREATE_RUN;
44eb8: 7003 moveq #3,%d0 44eba: 6002 bras 44ebe <_POSIX_Timer_TSR+0x4e>
} else {
/* Indicates that the timer is stopped */
ptimer->state = POSIX_TIMER_STATE_CREATE_STOP;
44ebc: 7004 moveq #4,%d0 <== NOT EXECUTED
44ebe: 1540 003c moveb %d0,%a2@(60)
/*
* 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 ) ) {
44ec2: 2f2a 0042 movel %a2@(66),%sp@- 44ec6: 2f2a 0038 movel %a2@(56),%sp@- 44eca: 4eb9 0004 9f80 jsr 49f80 <pthread_kill>
}
/* After the signal handler returns, the count of expirations of the
* timer must be set to 0.
*/
ptimer->overrun = 0;
44ed0: 508f addql #8,%sp 44ed2: 42aa 0066 clrl %a2@(102)
}
44ed6: 246e fffc moveal %fp@(-4),%a2 44eda: 4e5e unlk %fp 44edc: 4e75 rts
...
0004c76c <_POSIX_signals_Clear_process_signals>:
clear_signal = true;
mask = signo_to_mask( signo );
ISR_Level level;
_ISR_Disable( level );
4c76c: 203c 0000 0700 movel #1792,%d0
*/
void _POSIX_signals_Clear_process_signals(
int signo
)
{
4c772: 4e56 0000 linkw %fp,#0 4c776: 222e 0008 movel %fp@(8),%d1 4c77a: 2f03 movel %d3,%sp@- 4c77c: 2f02 movel %d2,%sp@-
clear_signal = true;
mask = signo_to_mask( signo );
ISR_Level level;
_ISR_Disable( level );
4c77e: 40c2 movew %sr,%d2 4c780: 8082 orl %d2,%d0 4c782: 46c0 movew %d0,%sr
if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) {
4c784: 2601 movel %d1,%d3 4c786: 2001 movel %d1,%d0 4c788: 41f9 0005 d142 lea 5d142 <_POSIX_signals_Vectors>,%a0 4c78e: e58b lsll #2,%d3 4c790: e988 lsll #4,%d0 4c792: 9083 subl %d3,%d0 4c794: 7602 moveq #2,%d3 4c796: b6b0 0800 cmpl %a0@(00000000,%d0:l),%d3 4c79a: 6610 bnes 4c7ac <_POSIX_signals_Clear_process_signals+0x40>
if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) )
4c79c: 2040 moveal %d0,%a0 4c79e: d1fc 0005 d33a addal #381754,%a0 4c7a4: 2008 movel %a0,%d0 4c7a6: 5880 addql #4,%d0 4c7a8: b090 cmpl %a0@,%d0 4c7aa: 661c bnes 4c7c8 <_POSIX_signals_Clear_process_signals+0x5c>
clear_signal = false;
}
if ( clear_signal ) {
_POSIX_signals_Pending &= ~mask;
4c7ac: 5381 subql #1,%d1 4c7ae: 7001 moveq #1,%d0 4c7b0: e3a8 lsll %d1,%d0 4c7b2: 4680 notl %d0 4c7b4: c0b9 0005 d336 andl 5d336 <_POSIX_signals_Pending>,%d0 4c7ba: 23c0 0005 d336 movel %d0,5d336 <_POSIX_signals_Pending>
if ( !_POSIX_signals_Pending )
4c7c0: 6606 bnes 4c7c8 <_POSIX_signals_Clear_process_signals+0x5c>
_Thread_Do_post_task_switch_extension--;
4c7c2: 53b9 0005 cd36 subql #1,5cd36 <_Thread_Do_post_task_switch_extension>
}
_ISR_Enable( level );
4c7c8: 46c2 movew %d2,%sr
}
4c7ca: 241f movel %sp@+,%d2 4c7cc: 261f movel %sp@+,%d3 4c7ce: 4e5e unlk %fp 4c7d0: 4e75 rts
...
0004c7d4 <_POSIX_signals_Set_process_signals>:
sigset_t mask
)
{
ISR_Level level;
_ISR_Disable( level );
4c7d4: 203c 0000 0700 movel #1792,%d0
*/
void _POSIX_signals_Set_process_signals(
sigset_t mask
)
{
4c7da: 4e56 0000 linkw %fp,#0
ISR_Level level;
_ISR_Disable( level );
4c7de: 40c1 movew %sr,%d1 4c7e0: 8081 orl %d1,%d0 4c7e2: 46c0 movew %d0,%sr
if ( !_POSIX_signals_Pending )
4c7e4: 2039 0005 d336 movel 5d336 <_POSIX_signals_Pending>,%d0 4c7ea: 6606 bnes 4c7f2 <_POSIX_signals_Set_process_signals+0x1e>
_Thread_Do_post_task_switch_extension++;
4c7ec: 52b9 0005 cd36 addql #1,5cd36 <_Thread_Do_post_task_switch_extension>
_POSIX_signals_Pending |= mask;
4c7f2: 80ae 0008 orl %fp@(8),%d0 4c7f6: 23c0 0005 d336 movel %d0,5d336 <_POSIX_signals_Pending>
_ISR_Enable( level );
4c7fc: 46c1 movew %d1,%sr
}
4c7fe: 4e5e unlk %fp 4c800: 4e75 rts
...
00044e4c <_POSIX_signals_Ualarm_TSR>:
void _POSIX_signals_Ualarm_TSR(
Objects_Id id __attribute__((unused)),
void *argument __attribute__((unused))
)
{
44e4c: 4e56 0000 linkw %fp,#0
/* * Send a SIGALRM but if there is a problem, ignore it. * It's OK, there isn't a way this should fail. */ (void) kill( getpid(), SIGALRM );
44e50: 4eb9 0004 24e8 jsr 424e8 <getpid> 44e56: 4878 000e pea e <OPER1+0x2> 44e5a: 2f00 movel %d0,%sp@- 44e5c: 4eb9 0004 4b6c jsr 44b6c <kill>
RTEMS_INLINE_ROUTINE void _Watchdog_Reset(
Watchdog_Control *the_watchdog
)
{
(void) _Watchdog_Remove( the_watchdog );
44e62: 4879 0005 ec5a pea 5ec5a <_POSIX_signals_Ualarm_timer> 44e68: 4eb9 0004 8330 jsr 48330 <_Watchdog_Remove>
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
44e6e: 4fef 000c lea %sp@(12),%sp 44e72: 203c 0005 ec5a movel #388186,%d0 44e78: 2d40 000c movel %d0,%fp@(12) 44e7c: 203c 0005 e50c movel #386316,%d0 44e82: 2d40 0008 movel %d0,%fp@(8)
/*
* If the reset interval is non-zero, reschedule ourselves.
*/
_Watchdog_Reset( &_POSIX_signals_Ualarm_timer );
}
44e86: 4e5e unlk %fp 44e88: 4ef9 0004 8214 jmp 48214 <_Watchdog_Insert>
...
0004a530 <_Protected_heap_Allocate_aligned_with_boundary>:
Heap_Control *heap,
uintptr_t size,
uintptr_t alignment,
uintptr_t boundary
)
{
4a530: 4e56 fffc linkw %fp,#-4
void *p;
_RTEMS_Lock_allocator();
4a534: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4a53a: 4eb9 0004 583c jsr 4583c <_API_Mutex_Lock>
p = _Heap_Allocate_aligned_with_boundary(
4a540: 2f2e 0014 movel %fp@(20),%sp@- 4a544: 2f2e 0010 movel %fp@(16),%sp@- 4a548: 2f2e 000c movel %fp@(12),%sp@- 4a54c: 2f2e 0008 movel %fp@(8),%sp@- 4a550: 4eb9 0004 a248 jsr 4a248 <_Heap_Allocate_aligned_with_boundary>
heap,
size,
alignment,
boundary
);
_RTEMS_Unlock_allocator();
4a556: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4a55c: 2d40 fffc movel %d0,%fp@(-4) 4a560: 4eb9 0004 589c jsr 4589c <_API_Mutex_Unlock>
return p;
}
4a566: 202e fffc movel %fp@(-4),%d0 4a56a: 4e5e unlk %fp 4a56c: 4e75 rts
...
0004a570 <_Protected_heap_Free>:
bool _Protected_heap_Free(
Heap_Control *the_heap,
void *start_address
)
{
4a570: 4e56 fffc linkw %fp,#-4
bool status;
_RTEMS_Lock_allocator();
4a574: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4a57a: 4eb9 0004 583c jsr 4583c <_API_Mutex_Lock>
status = _Heap_Free( the_heap, start_address );
4a580: 2f2e 000c movel %fp@(12),%sp@- 4a584: 2f2e 0008 movel %fp@(8),%sp@- 4a588: 4eb9 0004 a39c jsr 4a39c <_Heap_Free>
_RTEMS_Unlock_allocator();
4a58e: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4a594: 2d40 fffc movel %d0,%fp@(-4) 4a598: 4eb9 0004 589c jsr 4589c <_API_Mutex_Unlock>
return status; }
4a59e: 202e fffc movel %fp@(-4),%d0 4a5a2: 4e5e unlk %fp 4a5a4: 4e75 rts
...
000596cc <_Protected_heap_Get_block_size>:
bool _Protected_heap_Get_block_size(
Heap_Control *the_heap,
void *starting_address,
uintptr_t *size
)
{
596cc: 4e56 fffc linkw %fp,#-4
bool status;
_RTEMS_Lock_allocator();
596d0: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 596d6: 4eb9 0004 583c jsr 4583c <_API_Mutex_Lock>
status = _Heap_Size_of_alloc_area( the_heap, starting_address, size );
596dc: 2f2e 0010 movel %fp@(16),%sp@- 596e0: 2f2e 000c movel %fp@(12),%sp@- 596e4: 2f2e 0008 movel %fp@(8),%sp@- 596e8: 4eb9 0005 982c jsr 5982c <_Heap_Size_of_alloc_area>
_RTEMS_Unlock_allocator();
596ee: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 596f4: 2d40 fffc movel %d0,%fp@(-4) 596f8: 4eb9 0004 589c jsr 4589c <_API_Mutex_Unlock>
return status; }
596fe: 202e fffc movel %fp@(-4),%d0 59702: 4e5e unlk %fp 59704: 4e75 rts
...
00063da8 <_Protected_heap_Get_information>:
bool _Protected_heap_Get_information(
Heap_Control *the_heap,
Heap_Information_block *the_info
)
{
63da8: 4e56 0000 linkw %fp,#0 63dac: 2f03 movel %d3,%sp@- 63dae: 262e 000c movel %fp@(12),%d3 63db2: 2f02 movel %d2,%sp@- 63db4: 242e 0008 movel %fp@(8),%d2
if ( !the_heap )
63db8: 672e beqs 63de8 <_Protected_heap_Get_information+0x40>
return false;
if ( !the_info )
63dba: 4a83 tstl %d3 63dbc: 672a beqs 63de8 <_Protected_heap_Get_information+0x40>
return false;
_RTEMS_Lock_allocator();
63dbe: 2f39 0009 bd3a movel 9bd3a <_RTEMS_Allocator_Mutex>,%sp@- 63dc4: 4eb9 0004 99e4 jsr 499e4 <_API_Mutex_Lock>
_Heap_Get_information( the_heap, the_info );
63dca: 2f03 movel %d3,%sp@- 63dcc: 2f02 movel %d2,%sp@- 63dce: 4eb9 0007 1e44 jsr 71e44 <_Heap_Get_information>
_RTEMS_Unlock_allocator();
63dd4: 2f39 0009 bd3a movel 9bd3a <_RTEMS_Allocator_Mutex>,%sp@- 63dda: 4eb9 0004 9a44 jsr 49a44 <_API_Mutex_Unlock>
return true;
63de0: 4fef 0010 lea %sp@(16),%sp
if ( !the_info )
return false;
_RTEMS_Lock_allocator();
_Heap_Get_information( the_heap, the_info );
_RTEMS_Unlock_allocator();
63de4: 7001 moveq #1,%d0
return true;
63de6: 6002 bras 63dea <_Protected_heap_Get_information+0x42> 63de8: 4200 clrb %d0
}
63dea: 242e fff8 movel %fp@(-8),%d2 63dee: 262e fffc movel %fp@(-4),%d3 63df2: 4e5e unlk %fp 63df4: 4e75 rts
...
000572f8 <_Region_Process_queue>:
*/
void _Region_Process_queue(
Region_Control *the_region
)
{
572f8: 4e56 ffe4 linkw %fp,#-28 572fc: 2039 0007 53e8 movel 753e8 <_Thread_Dispatch_disable_level>,%d0 57302: 5280 addql #1,%d0 57304: 48d7 3c1c moveml %d2-%d4/%a2-%a5,%sp@ 57308: 266e 0008 moveal %fp@(8),%a3 5730c: 23c0 0007 53e8 movel %d0,753e8 <_Thread_Dispatch_disable_level>
* NOTE: Be sure to disable dispatching before unlocking the mutex * since we do not want to open a window where a context * switch could occur. */ _Thread_Disable_dispatch(); _RTEMS_Unlock_allocator();
57312: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@-
/*
* NOTE: The following loop is O(n) where n is the number of
* threads whose memory request is satisfied.
*/
for ( ; ; ) {
the_thread = _Thread_queue_First( &the_region->Wait_queue );
57318: 240b movel %a3,%d2
RTEMS_INLINE_ROUTINE void *_Region_Allocate_segment (
Region_Control *the_region,
uintptr_t size
)
{
return _Heap_Allocate( &the_region->Memory, size );
5731a: 280b movel %a3,%d4 5731c: 0682 0000 0010 addil #16,%d2 57322: 0684 0000 0068 addil #104,%d4 57328: 4bf9 0005 2a14 lea 52a14 <_Heap_Allocate_aligned_with_boundary>,%a5
if ( the_segment == NULL )
break;
*(void **)the_thread->Wait.return_argument = the_segment;
the_region->number_of_used_blocks += 1;
_Thread_queue_Extract( &the_region->Wait_queue, the_thread );
5732e: 49f9 0005 7a04 lea 57a04 <_Thread_queue_Extract>,%a4
* NOTE: Be sure to disable dispatching before unlocking the mutex * since we do not want to open a window where a context * switch could occur. */ _Thread_Disable_dispatch(); _RTEMS_Unlock_allocator();
57334: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> 5733a: 588f addql #4,%sp
/*
* NOTE: The following loop is O(n) where n is the number of
* threads whose memory request is satisfied.
*/
for ( ; ; ) {
the_thread = _Thread_queue_First( &the_region->Wait_queue );
5733c: 263c 0005 7b08 movel #359176,%d3 57342: 2f02 movel %d2,%sp@- 57344: 2043 moveal %d3,%a0 57346: 4e90 jsr %a0@
if ( the_thread == NULL )
57348: 588f addql #4,%sp
/*
* NOTE: The following loop is O(n) where n is the number of
* threads whose memory request is satisfied.
*/
for ( ; ; ) {
the_thread = _Thread_queue_First( &the_region->Wait_queue );
5734a: 2440 moveal %d0,%a2
if ( the_thread == NULL )
5734c: 4a80 tstl %d0 5734e: 672c beqs 5737c <_Region_Process_queue+0x84> 57350: 42a7 clrl %sp@- 57352: 42a7 clrl %sp@- 57354: 2f2a 0024 movel %a2@(36),%sp@- 57358: 2f04 movel %d4,%sp@- 5735a: 4e95 jsr %a5@
the_segment = (void **) _Region_Allocate_segment(
the_region,
the_thread->Wait.count
);
if ( the_segment == NULL )
5735c: 4fef 0010 lea %sp@(16),%sp 57360: 4a80 tstl %d0 57362: 6718 beqs 5737c <_Region_Process_queue+0x84>
break;
*(void **)the_thread->Wait.return_argument = the_segment;
57364: 206a 0028 moveal %a2@(40),%a0
the_region->number_of_used_blocks += 1;
57368: 52ab 0064 addql #1,%a3@(100)
);
if ( the_segment == NULL )
break;
*(void **)the_thread->Wait.return_argument = the_segment;
5736c: 2080 movel %d0,%a0@
the_region->number_of_used_blocks += 1;
_Thread_queue_Extract( &the_region->Wait_queue, the_thread );
5736e: 2f0a movel %a2,%sp@- 57370: 2f02 movel %d2,%sp@- 57372: 4e94 jsr %a4@
the_thread->Wait.return_code = RTEMS_SUCCESSFUL;
}
57374: 508f addql #8,%sp
break;
*(void **)the_thread->Wait.return_argument = the_segment;
the_region->number_of_used_blocks += 1;
_Thread_queue_Extract( &the_region->Wait_queue, the_thread );
the_thread->Wait.return_code = RTEMS_SUCCESSFUL;
57376: 42aa 0034 clrl %a2@(52)
}
5737a: 60c6 bras 57342 <_Region_Process_queue+0x4a>
_Thread_Enable_dispatch(); }
5737c: 4cee 3c1c ffe4 moveml %fp@(-28),%d2-%d4/%a2-%a5 57382: 4e5e unlk %fp
*(void **)the_thread->Wait.return_argument = the_segment;
the_region->number_of_used_blocks += 1;
_Thread_queue_Extract( &the_region->Wait_queue, the_thread );
the_thread->Wait.return_code = RTEMS_SUCCESSFUL;
}
_Thread_Enable_dispatch();
57384: 4ef9 0005 4012 jmp 54012 <_Thread_Enable_dispatch>
...
0004a170 <_TOD_Get>:
/* assume time checked for NULL by caller */
/* _TOD_Now is the native current time */
nanoseconds = 0;
_ISR_Disable( level );
4a170: 203c 0000 0700 movel #1792,%d0
*/
void _TOD_Get(
struct timespec *time
)
{
4a176: 4e56 fff0 linkw %fp,#-16 4a17a: 2f02 movel %d2,%sp@-
/* assume time checked for NULL by caller */
/* _TOD_Now is the native current time */
nanoseconds = 0;
_ISR_Disable( level );
4a17c: 40c2 movew %sr,%d2 4a17e: 8082 orl %d2,%d0 4a180: 46c0 movew %d0,%sr
now = _TOD_Now;
if ( _Watchdog_Nanoseconds_since_tick_handler )
4a182: 2079 0005 ce20 moveal 5ce20 <_Watchdog_Nanoseconds_since_tick_handler>,%a0
/* assume time checked for NULL by caller */
/* _TOD_Now is the native current time */
nanoseconds = 0;
_ISR_Disable( level );
now = _TOD_Now;
4a188: 2039 0005 cd26 movel 5cd26 <_TOD_Now>,%d0 4a18e: 2239 0005 cd2a movel 5cd2a <_TOD_Now+0x4>,%d1 4a194: 2d40 fff0 movel %d0,%fp@(-16) 4a198: 2d41 fff4 movel %d1,%fp@(-12)
if ( _Watchdog_Nanoseconds_since_tick_handler )
4a19c: 4a88 tstl %a0 4a19e: 6604 bnes 4a1a4 <_TOD_Get+0x34> 4a1a0: 4280 clrl %d0 4a1a2: 6002 bras 4a1a6 <_TOD_Get+0x36>
nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)();
4a1a4: 4e90 jsr %a0@
_ISR_Enable( level );
4a1a6: 46c2 movew %d2,%sr
_Timestamp_Set( &offset, 0, nanoseconds );
_Timestamp_Add_to( &now, &offset );
4a1a8: 486e fff8 pea %fp@(-8) 4a1ac: 486e fff0 pea %fp@(-16)
now = _TOD_Now;
if ( _Watchdog_Nanoseconds_since_tick_handler )
nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)();
_ISR_Enable( level );
_Timestamp_Set( &offset, 0, nanoseconds );
4a1b0: 2d40 fffc movel %d0,%fp@(-4) 4a1b4: 42ae fff8 clrl %fp@(-8)
_Timestamp_Add_to( &now, &offset );
4a1b8: 4eb9 0004 7958 jsr 47958 <_Timespec_Add_to>
_Timestamp_To_timespec( &now, time );
4a1be: 206e 0008 moveal %fp@(8),%a0 4a1c2: 508f addql #8,%sp 4a1c4: 202e fff0 movel %fp@(-16),%d0 4a1c8: 222e fff4 movel %fp@(-12),%d1
}
4a1cc: 242e ffec movel %fp@(-20),%d2 4a1d0: 4e5e unlk %fp
nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)();
_ISR_Enable( level );
_Timestamp_Set( &offset, 0, nanoseconds );
_Timestamp_Add_to( &now, &offset );
_Timestamp_To_timespec( &now, time );
4a1d2: 2080 movel %d0,%a0@ 4a1d4: 2141 0004 movel %d1,%a0@(4)
}
4a1d8: 4e75 rts
...
0004a1dc <_TOD_Get_uptime>:
/* assume time checked for NULL by caller */
/* _TOD_Uptime is in native timestamp format */
nanoseconds = 0;
_ISR_Disable( level );
4a1dc: 203c 0000 0700 movel #1792,%d0
*/
void _TOD_Get_uptime(
Timestamp_Control *uptime
)
{
4a1e2: 4e56 fff0 linkw %fp,#-16 4a1e6: 2f02 movel %d2,%sp@-
/* assume time checked for NULL by caller */
/* _TOD_Uptime is in native timestamp format */
nanoseconds = 0;
_ISR_Disable( level );
4a1e8: 40c2 movew %sr,%d2 4a1ea: 8082 orl %d2,%d0 4a1ec: 46c0 movew %d0,%sr
up = _TOD_Uptime;
if ( _Watchdog_Nanoseconds_since_tick_handler )
4a1ee: 2079 0005 ce20 moveal 5ce20 <_Watchdog_Nanoseconds_since_tick_handler>,%a0
/* assume time checked for NULL by caller */
/* _TOD_Uptime is in native timestamp format */
nanoseconds = 0;
_ISR_Disable( level );
up = _TOD_Uptime;
4a1f4: 2039 0005 cd12 movel 5cd12 <_TOD_Uptime>,%d0 4a1fa: 2239 0005 cd16 movel 5cd16 <_TOD_Uptime+0x4>,%d1 4a200: 2d40 fff0 movel %d0,%fp@(-16) 4a204: 2d41 fff4 movel %d1,%fp@(-12)
if ( _Watchdog_Nanoseconds_since_tick_handler )
4a208: 4a88 tstl %a0 4a20a: 6604 bnes 4a210 <_TOD_Get_uptime+0x34> 4a20c: 4280 clrl %d0 4a20e: 6002 bras 4a212 <_TOD_Get_uptime+0x36>
nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)();
4a210: 4e90 jsr %a0@
_ISR_Enable( level );
4a212: 46c2 movew %d2,%sr
_Timestamp_Set( &offset, 0, nanoseconds );
_Timestamp_Add_to( &up, &offset );
4a214: 486e fff8 pea %fp@(-8) 4a218: 486e fff0 pea %fp@(-16)
up = _TOD_Uptime;
if ( _Watchdog_Nanoseconds_since_tick_handler )
nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)();
_ISR_Enable( level );
_Timestamp_Set( &offset, 0, nanoseconds );
4a21c: 2d40 fffc movel %d0,%fp@(-4) 4a220: 42ae fff8 clrl %fp@(-8)
_Timestamp_Add_to( &up, &offset );
4a224: 4eb9 0004 7958 jsr 47958 <_Timespec_Add_to>
*uptime = up;
4a22a: 206e 0008 moveal %fp@(8),%a0 4a22e: 508f addql #8,%sp 4a230: 202e fff0 movel %fp@(-16),%d0 4a234: 222e fff4 movel %fp@(-12),%d1
}
4a238: 242e ffec movel %fp@(-20),%d2 4a23c: 4e5e unlk %fp
nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)();
_ISR_Enable( level );
_Timestamp_Set( &offset, 0, nanoseconds );
_Timestamp_Add_to( &up, &offset );
*uptime = up;
4a23e: 2080 movel %d0,%a0@ 4a240: 2141 0004 movel %d1,%a0@(4)
}
4a244: 4e75 rts
...
00063834 <_TOD_Get_uptime_as_timespec>:
*/
void _TOD_Get_uptime_as_timespec(
struct timespec *uptime
)
{
63834: 4e56 fff8 linkw %fp,#-8
Timestamp_Control uptime_ts;
/* assume time checked for NULL by caller */
_TOD_Get_uptime( &uptime_ts );
63838: 486e fff8 pea %fp@(-8) 6383c: 4eb9 0006 37c8 jsr 637c8 <_TOD_Get_uptime>
_Timestamp_To_timespec( &uptime_ts, uptime );
63842: 206e 0008 moveal %fp@(8),%a0 63846: 588f addql #4,%sp 63848: 202e fff8 movel %fp@(-8),%d0 6384c: 222e fffc movel %fp@(-4),%d1
}
63850: 4e5e unlk %fp
{
Timestamp_Control uptime_ts;
/* assume time checked for NULL by caller */
_TOD_Get_uptime( &uptime_ts );
_Timestamp_To_timespec( &uptime_ts, uptime );
63852: 2080 movel %d0,%a0@ 63854: 2141 0004 movel %d1,%a0@(4)
}
63858: 4e75 rts
...
00045c5c <_TOD_Handler_initialization>:
*
* Output parameters: NONE
*/
void _TOD_Handler_initialization(void)
{
45c5c: 4e56 0000 linkw %fp,#0
/* Uptime (timespec) */
_Timestamp_Set_to_zero( &_TOD_Uptime );
/* TOD has not been set */
_TOD_Is_set = false;
45c60: 4200 clrb %d0
_TOD_Activate(); }
45c62: 4e5e unlk %fp
/* Uptime (timespec) */
_Timestamp_Set_to_zero( &_TOD_Uptime );
/* TOD has not been set */
_TOD_Is_set = false;
45c64: 13c0 0005 cca8 moveb %d0,5cca8 <_TOD_Is_set>
*/
void _TOD_Handler_initialization(void)
{
/* POSIX format TOD (timespec) */
_Timestamp_Set( &_TOD_Now, TOD_SECONDS_1970_THROUGH_1988, 0 );
45c6a: 203c 21da e500 movel #567993600,%d0 45c70: 42b9 0005 cd2a clrl 5cd2a <_TOD_Now+0x4> 45c76: 23c0 0005 cd26 movel %d0,5cd26 <_TOD_Now>
/* Uptime (timespec) */
_Timestamp_Set_to_zero( &_TOD_Uptime );
45c7c: 42b9 0005 cd12 clrl 5cd12 <_TOD_Uptime> 45c82: 42b9 0005 cd16 clrl 5cd16 <_TOD_Uptime+0x4>
/* TOD has not been set */
_TOD_Is_set = false;
_TOD_Activate();
}
45c88: 4e75 rts
...
00045844 <_TOD_To_seconds>:
*/
uint32_t _TOD_To_seconds(
const rtems_time_of_day *the_tod
)
{
45844: 43f9 0005 c3c2 lea 5c3c2 <_TOD_Days_to_date>,%a1 4584a: 4e56 fff0 linkw %fp,#-16 4584e: 206e 0008 moveal %fp@(8),%a0 45852: 48d7 041c moveml %d2-%d4/%a2,%sp@
uint32_t time;
uint32_t year_mod_4;
time = the_tod->day - 1;
year_mod_4 = the_tod->year & 3;
45856: 2210 movel %a0@,%d1 45858: 7603 moveq #3,%d3
)
{
uint32_t time;
uint32_t year_mod_4;
time = the_tod->day - 1;
4585a: 2028 0008 movel %a0@(8),%d0 4585e: 5380 subql #1,%d0
year_mod_4 = the_tod->year & 3;
45860: c681 andl %d1,%d3
if ( year_mod_4 == 0 )
45862: 660c bnes 45870 <_TOD_To_seconds+0x2c>
time += _TOD_Days_to_date[ 1 ][ the_tod->month ];
45864: 2428 0004 movel %a0@(4),%d2 45868: 0682 0000 000d addil #13,%d2 4586e: 6004 bras 45874 <_TOD_To_seconds+0x30>
else
time += _TOD_Days_to_date[ 0 ][ the_tod->month ];
45870: 2428 0004 movel %a0@(4),%d2
time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) *
45874: 45f9 0005 c3f6 lea 5c3f6 <_TOD_Days_since_last_leap_year>,%a2 4587a: 283c 0000 05b5 movel #1461,%d4
year_mod_4 = the_tod->year & 3;
if ( year_mod_4 == 0 )
time += _TOD_Days_to_date[ 1 ][ the_tod->month ];
else
time += _TOD_Days_to_date[ 0 ][ the_tod->month ];
45880: 3431 2a00 movew %a1@(00000000,%d2:l:2),%d2
time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) *
45884: 3632 3a00 movew %a2@(00000000,%d3:l:2),%d3
year_mod_4 = the_tod->year & 3;
if ( year_mod_4 == 0 )
time += _TOD_Days_to_date[ 1 ][ the_tod->month ];
else
time += _TOD_Days_to_date[ 0 ][ the_tod->month ];
45888: 0282 0000 ffff andil #65535,%d2
time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) *
4588e: 0283 0000 ffff andil #65535,%d3
year_mod_4 = the_tod->year & 3;
if ( year_mod_4 == 0 )
time += _TOD_Days_to_date[ 1 ][ the_tod->month ];
else
time += _TOD_Days_to_date[ 0 ][ the_tod->month ];
45894: 2242 moveal %d2,%a1 45896: d3c0 addal %d0,%a1
time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) *
45898: 2001 movel %d1,%d0 4589a: 0680 ffff f83c addil #-1988,%d0 458a0: e488 lsrl #2,%d0 458a2: 4c04 0800 mulsl %d4,%d0
time *= TOD_SECONDS_PER_DAY;
time += ((the_tod->hour * TOD_MINUTES_PER_HOUR) + the_tod->minute)
* TOD_SECONDS_PER_MINUTE;
time += the_tod->second;
458a6: 2428 000c movel %a0@(12),%d2 458aa: 2202 movel %d2,%d1
if ( year_mod_4 == 0 )
time += _TOD_Days_to_date[ 1 ][ the_tod->month ];
else
time += _TOD_Days_to_date[ 0 ][ the_tod->month ];
time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) *
458ac: d083 addl %d3,%d0
( (TOD_DAYS_PER_YEAR * 4) + 1);
time += _TOD_Days_since_last_leap_year[ year_mod_4 ];
time *= TOD_SECONDS_PER_DAY;
458ae: 263c 0001 5180 movel #86400,%d3
time += _TOD_Days_to_date[ 0 ][ the_tod->month ];
time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) *
( (TOD_DAYS_PER_YEAR * 4) + 1);
time += _TOD_Days_since_last_leap_year[ year_mod_4 ];
458b4: d089 addl %a1,%d0
time *= TOD_SECONDS_PER_DAY;
458b6: 4c03 0800 mulsl %d3,%d0
time += ((the_tod->hour * TOD_MINUTES_PER_HOUR) + the_tod->minute)
* TOD_SECONDS_PER_MINUTE;
time += the_tod->second;
458ba: e58a lsll #2,%d2 458bc: ed89 lsll #6,%d1 458be: 9282 subl %d2,%d1 458c0: d2a8 0010 addl %a0@(16),%d1 458c4: 2401 movel %d1,%d2 458c6: e589 lsll #2,%d1 458c8: ed8a lsll #6,%d2
time += _TOD_Days_since_last_leap_year[ year_mod_4 ];
time *= TOD_SECONDS_PER_DAY;
time += ((the_tod->hour * TOD_MINUTES_PER_HOUR) + the_tod->minute)
458ca: 2068 0014 moveal %a0@(20),%a0
* TOD_SECONDS_PER_MINUTE;
time += the_tod->second;
458ce: 9481 subl %d1,%d2
time += _TOD_Days_since_last_leap_year[ year_mod_4 ];
time *= TOD_SECONDS_PER_DAY;
time += ((the_tod->hour * TOD_MINUTES_PER_HOUR) + the_tod->minute)
458d0: d1fc 21da e500 addal #567993600,%a0
* TOD_SECONDS_PER_MINUTE;
time += the_tod->second;
458d6: d488 addl %a0,%d2
time += TOD_SECONDS_1970_THROUGH_1988;
return( time );
}
458d8: d082 addl %d2,%d0 458da: 4cd7 041c moveml %sp@,%d2-%d4/%a2 458de: 4e5e unlk %fp 458e0: 4e75 rts
...
000458e4 <_TOD_Validate>:
*/
bool _TOD_Validate(
const rtems_time_of_day *the_tod
)
{
458e4: 4e56 0000 linkw %fp,#0 458e8: 206e 0008 moveal %fp@(8),%a0 458ec: 2f03 movel %d3,%sp@-
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick();
458ee: 2039 0005 d630 movel 5d630 <Configuration+0xc>,%d0
*/
bool _TOD_Validate(
const rtems_time_of_day *the_tod
)
{
458f4: 2f02 movel %d2,%sp@-
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick();
if ((!the_tod) ||
458f6: 4a88 tstl %a0 458f8: 6762 beqs 4595c <_TOD_Validate+0x78>
(the_tod->ticks >= ticks_per_second) ||
458fa: 243c 000f 4240 movel #1000000,%d2 45900: 4c40 2002 remul %d0,%d2,%d2 45904: b4a8 0018 cmpl %a0@(24),%d2 45908: 6352 blss 4595c <_TOD_Validate+0x78>
(the_tod->second >= TOD_SECONDS_PER_MINUTE) ||
4590a: 763b moveq #59,%d3 4590c: b6a8 0014 cmpl %a0@(20),%d3 45910: 654a bcss 4595c <_TOD_Validate+0x78>
(the_tod->minute >= TOD_MINUTES_PER_HOUR) ||
45912: b6a8 0010 cmpl %a0@(16),%d3 45916: 6544 bcss 4595c <_TOD_Validate+0x78>
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
45918: 7017 moveq #23,%d0 4591a: b0a8 000c cmpl %a0@(12),%d0 4591e: 653c bcss 4595c <_TOD_Validate+0x78>
(the_tod->month == 0) ||
45920: 2028 0004 movel %a0@(4),%d0
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick();
if ((!the_tod) ||
45924: 6736 beqs 4595c <_TOD_Validate+0x78> 45926: 720c moveq #12,%d1 45928: b280 cmpl %d0,%d1 4592a: 6530 bcss 4595c <_TOD_Validate+0x78>
(the_tod->second >= TOD_SECONDS_PER_MINUTE) ||
(the_tod->minute >= TOD_MINUTES_PER_HOUR) ||
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
(the_tod->month == 0) ||
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
(the_tod->year < TOD_BASE_YEAR) ||
4592c: 2410 movel %a0@,%d2
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick();
if ((!the_tod) ||
4592e: 0c82 0000 07c3 cmpil #1987,%d2 45934: 6326 blss 4595c <_TOD_Validate+0x78>
(the_tod->minute >= TOD_MINUTES_PER_HOUR) ||
(the_tod->hour >= TOD_HOURS_PER_DAY) ||
(the_tod->month == 0) ||
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
(the_tod->year < TOD_BASE_YEAR) ||
(the_tod->day == 0) )
45936: 2228 0008 movel %a0@(8),%d1
uint32_t days_in_month;
uint32_t ticks_per_second;
ticks_per_second = TOD_MICROSECONDS_PER_SECOND /
rtems_configuration_get_microseconds_per_tick();
if ((!the_tod) ||
4593a: 6720 beqs 4595c <_TOD_Validate+0x78>
(the_tod->month > TOD_MONTHS_PER_YEAR) ||
(the_tod->year < TOD_BASE_YEAR) ||
(the_tod->day == 0) )
return false;
if ( (the_tod->year % 4) == 0 )
4593c: 163c 0003 moveb #3,%d3 45940: 41f9 0005 c3fe lea 5c3fe <_TOD_Days_per_month>,%a0 45946: c483 andl %d3,%d2 45948: 6606 bnes 45950 <_TOD_Validate+0x6c>
days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ];
4594a: 2030 0c34 movel %a0@(00000034,%d0:l:4),%d0 4594e: 6004 bras 45954 <_TOD_Validate+0x70>
else
days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ];
45950: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0
* false - if the the_tod is invalid
*
* NOTE: This routine only works for leap-years through 2099.
*/
bool _TOD_Validate(
45954: b081 cmpl %d1,%d0 45956: 54c0 scc %d0 45958: 4480 negl %d0 4595a: 6002 bras 4595e <_TOD_Validate+0x7a> 4595c: 4200 clrb %d0
if ( the_tod->day > days_in_month )
return false;
return true;
}
4595e: 241f movel %sp@+,%d2 45960: 261f movel %sp@+,%d3 45962: 4e5e unlk %fp 45964: 4e75 rts
...
000467e8 <_Thread_Change_priority>:
void _Thread_Change_priority(
Thread_Control *the_thread,
Priority_Control new_priority,
bool prepend_it
)
{
467e8: 4e56 fff0 linkw %fp,#-16 467ec: 48d7 041c moveml %d2-%d4/%a2,%sp@ 467f0: 246e 0008 moveal %fp@(8),%a2
/* * 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 );
467f4: 2f0a movel %a2,%sp@-
void _Thread_Change_priority(
Thread_Control *the_thread,
Priority_Control new_priority,
bool prepend_it
)
{
467f6: 262e 000c movel %fp@(12),%d3
*/
/*
* Save original state
*/
original_state = the_thread->current_state;
467fa: 242a 0010 movel %a2@(16),%d2
void _Thread_Change_priority(
Thread_Control *the_thread,
Priority_Control new_priority,
bool prepend_it
)
{
467fe: 182e 0013 moveb %fp@(19),%d4
/* * 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 );
46802: 4eb9 0004 75e8 jsr 475e8 <_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 )
46808: 588f addql #4,%sp 4680a: b6aa 0014 cmpl %a2@(20),%d3 4680e: 670c beqs 4681c <_Thread_Change_priority+0x34>
_Thread_Set_priority( the_thread, new_priority );
46810: 2f03 movel %d3,%sp@- 46812: 2f0a movel %a2,%sp@- 46814: 4eb9 0004 7490 jsr 47490 <_Thread_Set_priority> 4681a: 508f addql #8,%sp
_ISR_Disable( level );
4681c: 223c 0000 0700 movel #1792,%d1 46822: 40c0 movew %sr,%d0 46824: 8280 orl %d0,%d1 46826: 46c1 movew %d1,%sr 46828: 7604 moveq #4,%d3
/*
* 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;
4682a: 222a 0010 movel %a2@(16),%d1 4682e: c483 andl %d3,%d2
if ( state != STATES_TRANSIENT ) {
46830: b681 cmpl %d1,%d3 46832: 6730 beqs 46864 <_Thread_Change_priority+0x7c>
/* Only clear the transient state if it wasn't set already */
if ( ! _States_Is_transient( original_state ) )
46834: 4a82 tstl %d2 46836: 6608 bnes 46840 <_Thread_Change_priority+0x58>
the_thread->current_state = _States_Clear( STATES_TRANSIENT, state );
46838: 74fb moveq #-5,%d2 4683a: c481 andl %d1,%d2 4683c: 2542 0010 movel %d2,%a2@(16)
_ISR_Enable( level );
46840: 46c0 movew %d0,%sr
if ( _States_Is_waiting_on_thread_queue( state ) ) {
46842: 0281 0003 bee0 andil #245472,%d1 46848: 6700 00d2 beqw 4691c <_Thread_Change_priority+0x134>
_Thread_queue_Requeue( the_thread->Wait.queue, the_thread );
4684c: 2d4a 000c movel %a2,%fp@(12) 46850: 2d6a 0044 0008 movel %a2@(68),%fp@(8)
if ( !_Thread_Is_executing_also_the_heir() &&
_Thread_Executing->is_preemptible )
_Context_Switch_necessary = true;
_ISR_Enable( level );
}
46856: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 4685c: 4e5e unlk %fp
/* 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 );
_ISR_Enable( level );
if ( _States_Is_waiting_on_thread_queue( state ) ) {
_Thread_queue_Requeue( the_thread->Wait.queue, the_thread );
4685e: 4ef9 0004 73f4 jmp 473f4 <_Thread_queue_Requeue>
}
return;
}
/* Only clear the transient state if it wasn't set already */
if ( ! _States_Is_transient( original_state ) ) {
46864: 4a82 tstl %d2 46866: 6650 bnes 468b8 <_Thread_Change_priority+0xd0>
RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map (
Priority_Information *the_priority_map
)
{
*the_priority_map->minor |= the_priority_map->ready_minor;
46868: 226a 008e moveal %a2@(142),%a1 4686c: 322a 0094 movew %a2@(148),%d1 46870: 3411 movew %a1@,%d2 46872: 206a 008a moveal %a2@(138),%a0 46876: 8282 orl %d2,%d1
* 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 );
46878: 42aa 0010 clrl %a2@(16) 4687c: 3281 movew %d1,%a1@
_Priority_Major_bit_map |= the_priority_map->ready_major;
4687e: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 46884: 342a 0092 movew %a2@(146),%d2 46888: 8282 orl %d2,%d1 4688a: 33c1 0005 cd44 movew %d1,5cd44 <_Priority_Major_bit_map>
_Priority_Add_to_bit_map( &the_thread->Priority_map );
if ( prepend_it )
46890: 4a04 tstb %d4 46892: 6710 beqs 468a4 <_Thread_Change_priority+0xbc>
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
46894: 2250 moveal %a0@,%a1
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
46896: 2548 0004 movel %a0,%a2@(4)
before_node = after_node->next; after_node->next = the_node;
4689a: 208a movel %a2,%a0@
the_node->next = before_node; before_node->previous = the_node;
4689c: 234a 0004 movel %a2,%a1@(4)
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
468a0: 2489 movel %a1,%a2@ 468a2: 6014 bras 468b8 <_Thread_Change_priority+0xd0>
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
468a4: 2608 movel %a0,%d3 468a6: 5883 addql #4,%d3 468a8: 2483 movel %d3,%a2@
old_last_node = the_chain->last;
468aa: 2268 0008 moveal %a0@(8),%a1
the_chain->last = the_node;
468ae: 214a 0008 movel %a2,%a0@(8)
old_last_node->next = the_node; the_node->previous = old_last_node;
468b2: 2549 0004 movel %a1,%a2@(4)
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
468b6: 228a movel %a2,%a1@
_Chain_Prepend_unprotected( the_thread->ready, &the_thread->Object.Node );
else
_Chain_Append_unprotected( the_thread->ready, &the_thread->Object.Node );
}
_ISR_Flash( level );
468b8: 223c 0000 0700 movel #1792,%d1 468be: 46c0 movew %d0,%sr 468c0: 8280 orl %d0,%d1 468c2: 46c1 movew %d1,%sr
RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void )
{
Priority_Bit_map_control minor;
Priority_Bit_map_control major;
_Bitfield_Find_first_bit( _Priority_Major_bit_map, major );
468c4: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 468ca: 4841 swap %d1 468cc: 04c1 ff1 %d1
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
468ce: 4282 clrl %d2 468d0: 41f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a0 468d6: 3401 movew %d1,%d2 468d8: 3230 2a00 movew %a0@(00000000,%d2:l:2),%d1 468dc: 4841 swap %d1 468de: 04c1 ff1 %d1
* ready thread.
*/
RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void )
{
_Thread_Heir = (Thread_Control *)
468e0: 4283 clrl %d3 468e2: e98a lsll #4,%d2 468e4: 3601 movew %d1,%d3 468e6: 2279 0005 cc40 moveal 5cc40 <_Thread_Ready_chain>,%a1 468ec: 2202 movel %d2,%d1 468ee: d283 addl %d3,%d1 468f0: 2401 movel %d1,%d2 468f2: e58a lsll #2,%d2 468f4: e989 lsll #4,%d1
* is also the heir thread, and false otherwise.
*/
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void )
{
return ( _Thread_Executing == _Thread_Heir );
468f6: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0
* ready thread.
*/
RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void )
{
_Thread_Heir = (Thread_Control *)
468fc: 93c2 subal %d2,%a1 468fe: 2231 1800 movel %a1@(00000000,%d1:l),%d1 46902: 23c1 0005 cd22 movel %d1,5cd22 <_Thread_Heir>
* We altered the set of thread priorities. So let's figure out
* who is the heir and if we need to switch to them.
*/
_Thread_Calculate_heir();
if ( !_Thread_Is_executing_also_the_heir() &&
46908: b288 cmpl %a0,%d1 4690a: 670e beqs 4691a <_Thread_Change_priority+0x132>
_Thread_Executing->is_preemptible )
4690c: 4a28 0075 tstb %a0@(117) 46910: 6708 beqs 4691a <_Thread_Change_priority+0x132>
_Context_Switch_necessary = true;
46912: 7201 moveq #1,%d1 46914: 13c1 0005 cd5e moveb %d1,5cd5e <_Context_Switch_necessary>
_ISR_Enable( level );
4691a: 46c0 movew %d0,%sr
}
4691c: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 46922: 4e5e unlk %fp 46924: 4e75 rts
...
00046928 <_Thread_Clear_state>:
void _Thread_Clear_state(
Thread_Control *the_thread,
States_Control state
)
{
46928: 4e56 ffec linkw %fp,#-20 4692c: 206e 0008 moveal %fp@(8),%a0 46930: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@
ISR_Level level;
States_Control current_state;
_ISR_Disable( level );
46934: 263c 0000 0700 movel #1792,%d3 4693a: 2203 movel %d3,%d1
void _Thread_Clear_state(
Thread_Control *the_thread,
States_Control state
)
{
4693c: 202e 000c movel %fp@(12),%d0
ISR_Level level;
States_Control current_state;
_ISR_Disable( level );
46940: 40c2 movew %sr,%d2 46942: 8282 orl %d2,%d1 46944: 46c1 movew %d1,%sr
current_state = the_thread->current_state;
46946: 2228 0010 movel %a0@(16),%d1
if ( current_state & state ) {
4694a: 2800 movel %d0,%d4 4694c: c881 andl %d1,%d4 4694e: 6778 beqs 469c8 <_Thread_Clear_state+0xa0>
RTEMS_INLINE_ROUTINE States_Control _States_Clear (
States_Control states_to_clear,
States_Control current_state
)
{
return (current_state & ~states_to_clear);
46950: 4680 notl %d0 46952: c081 andl %d1,%d0
current_state =
46954: 2140 0010 movel %d0,%a0@(16)
the_thread->current_state = _States_Clear( state, current_state );
if ( _States_Is_ready( current_state ) ) {
46958: 666e bnes 469c8 <_Thread_Clear_state+0xa0>
RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map (
Priority_Information *the_priority_map
)
{
*the_priority_map->minor |= the_priority_map->ready_minor;
4695a: 2668 008e moveal %a0@(142),%a3 4695e: 3028 0094 movew %a0@(148),%d0 46962: 3213 movew %a3@,%d1
_Priority_Add_to_bit_map( &the_thread->Priority_map );
_Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node);
46964: 2268 008a moveal %a0@(138),%a1
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
46968: 2809 movel %a1,%d4 4696a: 5884 addql #4,%d4 4696c: 8081 orl %d1,%d0 4696e: 2084 movel %d4,%a0@
old_last_node = the_chain->last;
46970: 2469 0008 moveal %a1@(8),%a2 46974: 3680 movew %d0,%a3@
the_chain->last = the_node;
46976: 2348 0008 movel %a0,%a1@(8)
_Priority_Major_bit_map |= the_priority_map->ready_major;
4697a: 3039 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d0 46980: 3228 0092 movew %a0@(146),%d1
old_last_node->next = the_node; the_node->previous = old_last_node;
46984: 214a 0004 movel %a2,%a0@(4) 46988: 8081 orl %d1,%d0
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
4698a: 2488 movel %a0,%a2@ 4698c: 33c0 0005 cd44 movew %d0,5cd44 <_Priority_Major_bit_map>
_ISR_Flash( level );
46992: 2003 movel %d3,%d0 46994: 46c2 movew %d2,%sr 46996: 8082 orl %d2,%d0 46998: 46c0 movew %d0,%sr
* a context switch.
* Pseudo-ISR case:
* Even if the thread isn't preemptible, if the new heir is
* a pseudo-ISR system task, we need to do a context switch.
*/
if ( the_thread->current_priority < _Thread_Heir->current_priority ) {
4699a: 2028 0014 movel %a0@(20),%d0 4699e: 2279 0005 cd22 moveal 5cd22 <_Thread_Heir>,%a1 469a4: b0a9 0014 cmpl %a1@(20),%d0 469a8: 641e bccs 469c8 <_Thread_Clear_state+0xa0>
_Thread_Heir = the_thread;
469aa: 23c8 0005 cd22 movel %a0,5cd22 <_Thread_Heir>
if ( _Thread_Executing->is_preemptible ||
469b0: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 469b6: 4a28 0075 tstb %a0@(117) 469ba: 6604 bnes 469c0 <_Thread_Clear_state+0x98> 469bc: 4a80 tstl %d0 469be: 6608 bnes 469c8 <_Thread_Clear_state+0xa0>
the_thread->current_priority == 0 )
_Context_Switch_necessary = true;
469c0: 7001 moveq #1,%d0 469c2: 13c0 0005 cd5e moveb %d0,5cd5e <_Context_Switch_necessary>
}
}
}
_ISR_Enable( level );
469c8: 46c2 movew %d2,%sr
}
469ca: 4cd7 0c1c moveml %sp@,%d2-%d4/%a2-%a3 469ce: 4e5e unlk %fp 469d0: 4e75 rts
...
00046aa4 <_Thread_Create_idle>:
*
* _Thread_Create_idle
*/
void _Thread_Create_idle( void )
{
46aa4: 4e56 0000 linkw %fp,#0 46aa8: 2f02 movel %d2,%sp@-
* This routine allocates an internal thread.
*/
RTEMS_INLINE_ROUTINE Thread_Control *_Thread_Internal_allocate( void )
{
return (Thread_Control *) _Objects_Allocate( &_Thread_Internal_information );
46aaa: 4879 0005 cde2 pea 5cde2 <_Thread_Internal_information> 46ab0: 4eb9 0004 609c jsr 4609c <_Objects_Allocate>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
46ab6: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 46abc: 5281 addql #1,%d1
/* * The entire workspace is zeroed during its initialization. Thus, all * fields not explicitly assigned were explicitly zeroed by * _Workspace_Initialization. */ _Thread_Idle = _Thread_Internal_allocate();
46abe: 23c0 0005 ce24 movel %d0,5ce24 <_Thread_Idle> 46ac4: 23c1 0005 cc94 movel %d1,5cc94 <_Thread_Dispatch_disable_level>
* that when _Thread_Initialize unnests dispatch that we do not
* do anything stupid.
*/
_Thread_Disable_dispatch();
_Thread_Initialize(
46aca: 4282 clrl %d2 46acc: 1439 0005 b4e2 moveb 5b4e2 <rtems_maximum_priority>,%d2 46ad2: 2f3c 4944 4c45 movel #1229212741,%sp@- 46ad8: 2239 0005 b4fc movel 5b4fc <Configuration+0x18>,%d1 46ade: 42a7 clrl %sp@- 46ae0: 2039 0005 b4de movel 5b4de <rtems_minimum_stack_size>,%d0 46ae6: 42a7 clrl %sp@- 46ae8: 42a7 clrl %sp@- 46aea: 4878 0001 pea 1 <ADD> 46aee: 2f02 movel %d2,%sp@- 46af0: 42a7 clrl %sp@- 46af2: b280 cmpl %d0,%d1 46af4: 6302 blss 46af8 <_Thread_Create_idle+0x54> 46af6: 2001 movel %d1,%d0 46af8: 2f00 movel %d0,%sp@- 46afa: 42a7 clrl %sp@- 46afc: 2f39 0005 ce24 movel 5ce24 <_Thread_Idle>,%sp@- 46b02: 4879 0005 cde2 pea 5cde2 <_Thread_Internal_information> 46b08: 4eb9 0004 6d94 jsr 46d94 <_Thread_Initialize>
* MUST be done before _Thread_Start is invoked.
*/
_Thread_Heir =
_Thread_Executing = _Thread_Idle;
_Thread_Start(
46b0e: 4fef 002c lea %sp@(44),%sp 46b12: 4297 clrl %sp@
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
46b14: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 46b1a: 5381 subql #1,%d1 46b1c: 42a7 clrl %sp@- 46b1e: 2f39 0005 b4f8 movel 5b4f8 <Configuration+0x14>,%sp@-
/* * WARNING!!! This is necessary to "kick" start the system and * MUST be done before _Thread_Start is invoked. */ _Thread_Heir = _Thread_Executing = _Thread_Idle;
46b24: 2039 0005 ce24 movel 5ce24 <_Thread_Idle>,%d0
_Thread_Start(
46b2a: 42a7 clrl %sp@- 46b2c: 23c1 0005 cc94 movel %d1,5cc94 <_Thread_Dispatch_disable_level> 46b32: 2f00 movel %d0,%sp@-
/*
* WARNING!!! This is necessary to "kick" start the system and
* MUST be done before _Thread_Start is invoked.
*/
_Thread_Heir =
46b34: 23c0 0005 cd4e movel %d0,5cd4e <_Thread_Executing> 46b3a: 23c0 0005 cd22 movel %d0,5cd22 <_Thread_Heir>
_Thread_Executing = _Thread_Idle;
_Thread_Start(
46b40: 4eb9 0004 7734 jsr 47734 <_Thread_Start>
Configuration.idle_task,
NULL,
0
);
}
46b46: 242e fffc movel %fp@(-4),%d2
* MUST be done before _Thread_Start is invoked.
*/
_Thread_Heir =
_Thread_Executing = _Thread_Idle;
_Thread_Start(
46b4a: 4fef 0014 lea %sp@(20),%sp
Configuration.idle_task,
NULL,
0
);
}
46b4e: 4e5e unlk %fp 46b50: 4e75 rts
...
0004c028 <_Thread_Evaluate_mode>:
*
* XXX
*/
bool _Thread_Evaluate_mode( void )
{
4c028: 4e56 0000 linkw %fp,#0
Thread_Control *executing;
executing = _Thread_Executing;
4c02c: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0
if ( !_States_Is_ready( executing->current_state ) ||
4c032: 4aa8 0010 tstl %a0@(16) 4c036: 660e bnes 4c046 <_Thread_Evaluate_mode+0x1e> 4c038: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 4c03e: 6710 beqs 4c050 <_Thread_Evaluate_mode+0x28>
( !_Thread_Is_heir( executing ) && executing->is_preemptible ) ) {
4c040: 4a28 0075 tstb %a0@(117) 4c044: 670a beqs 4c050 <_Thread_Evaluate_mode+0x28>
_Context_Switch_necessary = true;
4c046: 7001 moveq #1,%d0 4c048: 13c0 0005 cd5e moveb %d0,5cd5e <_Context_Switch_necessary>
return true;
4c04e: 6002 bras 4c052 <_Thread_Evaluate_mode+0x2a> 4c050: 4200 clrb %d0
}
return false;
}
4c052: 4e5e unlk %fp 4c054: 4e75 rts
...
0004a84c <_Thread_Ready>:
*/
void _Thread_Ready(
Thread_Control *the_thread
)
{
4a84c: 4e56 ffec linkw %fp,#-20 4a850: 206e 0008 moveal %fp@(8),%a0 4a854: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@
ISR_Level level;
Thread_Control *heir;
_ISR_Disable( level );
4a858: 243c 0000 0700 movel #1792,%d2 4a85e: 2002 movel %d2,%d0 4a860: 40c1 movew %sr,%d1 4a862: 8081 orl %d1,%d0 4a864: 46c0 movew %d0,%sr
RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map (
Priority_Information *the_priority_map
)
{
*the_priority_map->minor |= the_priority_map->ready_minor;
4a866: 2668 008e moveal %a0@(142),%a3 4a86a: 3028 0094 movew %a0@(148),%d0 4a86e: 3613 movew %a3@,%d3
the_thread->current_state = STATES_READY;
_Priority_Add_to_bit_map( &the_thread->Priority_map );
_Chain_Append_unprotected( the_thread->ready, &the_thread->Object.Node );
4a870: 2268 008a moveal %a0@(138),%a1
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
4a874: 2809 movel %a1,%d4 4a876: 5884 addql #4,%d4 4a878: 8083 orl %d3,%d0 4a87a: 2084 movel %d4,%a0@
old_last_node = the_chain->last;
4a87c: 2469 0008 moveal %a1@(8),%a2 4a880: 3680 movew %d0,%a3@
the_chain->last = the_node;
4a882: 2348 0008 movel %a0,%a1@(8)
_Priority_Major_bit_map |= the_priority_map->ready_major;
4a886: 3039 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d0 4a88c: 3628 0092 movew %a0@(146),%d3
old_last_node->next = the_node; the_node->previous = old_last_node;
4a890: 214a 0004 movel %a2,%a0@(4) 4a894: 8083 orl %d3,%d0
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
4a896: 2488 movel %a0,%a2@ 4a898: 33c0 0005 cd44 movew %d0,5cd44 <_Priority_Major_bit_map>
ISR_Level level;
Thread_Control *heir;
_ISR_Disable( level );
the_thread->current_state = STATES_READY;
4a89e: 42a8 0010 clrl %a0@(16)
_Priority_Add_to_bit_map( &the_thread->Priority_map );
_Chain_Append_unprotected( the_thread->ready, &the_thread->Object.Node );
_ISR_Flash( level );
4a8a2: 2002 movel %d2,%d0 4a8a4: 46c1 movew %d1,%sr 4a8a6: 8081 orl %d1,%d0 4a8a8: 46c0 movew %d0,%sr
RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void )
{
Priority_Bit_map_control minor;
Priority_Bit_map_control major;
_Bitfield_Find_first_bit( _Priority_Major_bit_map, major );
4a8aa: 3039 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d0 4a8b0: 4840 swap %d0 4a8b2: 04c0 ff1 %d0
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
4a8b4: 4282 clrl %d2 4a8b6: 41f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a0 4a8bc: 3400 movew %d0,%d2 4a8be: 3030 2a00 movew %a0@(00000000,%d2:l:2),%d0 4a8c2: 4840 swap %d0 4a8c4: 04c0 ff1 %d0
* ready thread.
*/
RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void )
{
_Thread_Heir = (Thread_Control *)
4a8c6: 4283 clrl %d3 4a8c8: e98a lsll #4,%d2 4a8ca: 3600 movew %d0,%d3 4a8cc: 2279 0005 cc40 moveal 5cc40 <_Thread_Ready_chain>,%a1 4a8d2: 2002 movel %d2,%d0 4a8d4: d083 addl %d3,%d0 4a8d6: 2400 movel %d0,%d2 4a8d8: e58a lsll #2,%d2 4a8da: e988 lsll #4,%d0
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Executing );
4a8dc: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0
* ready thread.
*/
RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void )
{
_Thread_Heir = (Thread_Control *)
4a8e2: 93c2 subal %d2,%a1 4a8e4: 2031 0800 movel %a1@(00000000,%d0:l),%d0 4a8e8: 23c0 0005 cd22 movel %d0,5cd22 <_Thread_Heir>
_Thread_Calculate_heir();
heir = _Thread_Heir;
if ( !_Thread_Is_executing( heir ) && _Thread_Executing->is_preemptible )
4a8ee: b1c0 cmpal %d0,%a0 4a8f0: 670e beqs 4a900 <_Thread_Ready+0xb4> 4a8f2: 4a28 0075 tstb %a0@(117) 4a8f6: 6708 beqs 4a900 <_Thread_Ready+0xb4>
_Context_Switch_necessary = true;
4a8f8: 7001 moveq #1,%d0 4a8fa: 13c0 0005 cd5e moveb %d0,5cd5e <_Context_Switch_necessary>
_ISR_Enable( level );
4a900: 46c1 movew %d1,%sr
}
4a902: 4cd7 0c1c moveml %sp@,%d2-%d4/%a2-%a3 4a906: 4e5e unlk %fp 4a908: 4e75 rts
...
00047c04 <_Thread_Restart>:
Thread_Control *the_thread,
void *pointer_argument,
Thread_Entry_numeric_type numeric_argument
)
{
if ( !_States_Is_dormant( the_thread->current_state ) ) {
47c04: 7001 moveq #1,%d0
bool _Thread_Restart(
Thread_Control *the_thread,
void *pointer_argument,
Thread_Entry_numeric_type numeric_argument
)
{
47c06: 4e56 0000 linkw %fp,#0 47c0a: 2f0a movel %a2,%sp@- 47c0c: 246e 0008 moveal %fp@(8),%a2
if ( !_States_Is_dormant( the_thread->current_state ) ) {
47c10: c0aa 0010 andl %a2@(16),%d0 47c14: 4a00 tstb %d0 47c16: 6704 beqs 47c1c <_Thread_Restart+0x18> 47c18: 4200 clrb %d0 47c1a: 6064 bras 47c80 <_Thread_Restart+0x7c>
_Thread_Set_transient( the_thread );
47c1c: 2f0a movel %a2,%sp@- 47c1e: 4eb9 0004 7de0 jsr 47de0 <_Thread_Set_transient>
_Thread_Reset( the_thread, pointer_argument, numeric_argument );
47c24: 2f2e 0010 movel %fp@(16),%sp@- 47c28: 2f2e 000c movel %fp@(12),%sp@- 47c2c: 2f0a movel %a2,%sp@- 47c2e: 4eb9 0004 b144 jsr 4b144 <_Thread_Reset>
_Thread_Load_environment( the_thread );
47c34: 2f0a movel %a2,%sp@- 47c36: 4eb9 0004 ade0 jsr 4ade0 <_Thread_Load_environment>
_Thread_Ready( the_thread );
47c3c: 2f0a movel %a2,%sp@- 47c3e: 4eb9 0004 b084 jsr 4b084 <_Thread_Ready>
_User_extensions_Thread_restart( the_thread );
47c44: 2f0a movel %a2,%sp@- 47c46: 4eb9 0004 83c8 jsr 483c8 <_User_extensions_Thread_restart>
if ( _Thread_Is_executing ( the_thread ) )
47c4c: 4fef 001c lea %sp@(28),%sp 47c50: b5f9 0005 d826 cmpal 5d826 <_Thread_Executing>,%a2 47c56: 6626 bnes 47c7e <_Thread_Restart+0x7a>
*/
RTEMS_INLINE_ROUTINE void _Thread_Restart_self( void )
{
#if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE )
if ( _Thread_Executing->fp_context != NULL )
47c58: 4aaa 0102 tstl %a2@(258) 47c5c: 670c beqs 47c6a <_Thread_Restart+0x66>
_Context_Restore_fp( &_Thread_Executing->fp_context );
47c5e: 486a 0102 pea %a2@(258) 47c62: 4eb9 0004 88b8 jsr 488b8 <_CPU_Context_restore_fp> 47c68: 588f addql #4,%sp
#endif
_CPU_Context_Restart_self( &_Thread_Executing->Registers );
47c6a: 2079 0005 d826 moveal 5d826 <_Thread_Executing>,%a0 47c70: 41e8 00ce lea %a0@(206),%a0 47c74: 2f08 movel %a0,%sp@- 47c76: 4eb9 0004 8776 jsr 48776 <_CPU_Context_Restart_self>
47c7c: 588f addql #4,%sp <== NOT EXECUTED
47c7e: 7001 moveq #1,%d0
return true;
}
return false;
}
47c80: 246e fffc moveal %fp@(-4),%a2 47c84: 4e5e unlk %fp 47c86: 4e75 rts
0004abe4 <_Thread_Resume>:
void _Thread_Resume(
Thread_Control *the_thread,
bool force
)
{
4abe4: 4e56 ffec linkw %fp,#-20 4abe8: 206e 0008 moveal %fp@(8),%a0 4abec: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@
ISR_Level level;
States_Control current_state;
_ISR_Disable( level );
4abf0: 243c 0000 0700 movel #1792,%d2 4abf6: 2002 movel %d2,%d0 4abf8: 40c1 movew %sr,%d1 4abfa: 8081 orl %d1,%d0 4abfc: 46c0 movew %d0,%sr
_ISR_Enable( level );
return;
}
#endif
current_state = the_thread->current_state;
4abfe: 2028 0010 movel %a0@(16),%d0
if ( current_state & STATES_SUSPENDED ) {
4ac02: 0800 0001 btst #1,%d0 4ac06: 6778 beqs 4ac80 <_Thread_Resume+0x9c> 4ac08: 76fd moveq #-3,%d3 4ac0a: c083 andl %d3,%d0
current_state =
4ac0c: 2140 0010 movel %d0,%a0@(16)
the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state);
if ( _States_Is_ready( current_state ) ) {
4ac10: 666e bnes 4ac80 <_Thread_Resume+0x9c>
RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map (
Priority_Information *the_priority_map
)
{
*the_priority_map->minor |= the_priority_map->ready_minor;
4ac12: 2668 008e moveal %a0@(142),%a3 4ac16: 3028 0094 movew %a0@(148),%d0 4ac1a: 3613 movew %a3@,%d3
_Priority_Add_to_bit_map( &the_thread->Priority_map );
_Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node);
4ac1c: 2268 008a moveal %a0@(138),%a1
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
4ac20: 2809 movel %a1,%d4 4ac22: 5884 addql #4,%d4 4ac24: 8083 orl %d3,%d0 4ac26: 2084 movel %d4,%a0@
old_last_node = the_chain->last;
4ac28: 2469 0008 moveal %a1@(8),%a2 4ac2c: 3680 movew %d0,%a3@
the_chain->last = the_node;
4ac2e: 2348 0008 movel %a0,%a1@(8)
_Priority_Major_bit_map |= the_priority_map->ready_major;
4ac32: 3039 0006 1e6c movew 61e6c <_Priority_Major_bit_map>,%d0 4ac38: 3628 0092 movew %a0@(146),%d3
old_last_node->next = the_node; the_node->previous = old_last_node;
4ac3c: 214a 0004 movel %a2,%a0@(4) 4ac40: 8083 orl %d3,%d0
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
4ac42: 2488 movel %a0,%a2@ 4ac44: 33c0 0006 1e6c movew %d0,61e6c <_Priority_Major_bit_map>
_ISR_Flash( level );
4ac4a: 2002 movel %d2,%d0 4ac4c: 46c1 movew %d1,%sr 4ac4e: 8081 orl %d1,%d0 4ac50: 46c0 movew %d0,%sr
if ( the_thread->current_priority < _Thread_Heir->current_priority ) {
4ac52: 2028 0014 movel %a0@(20),%d0 4ac56: 2279 0006 1e4a moveal 61e4a <_Thread_Heir>,%a1 4ac5c: b0a9 0014 cmpl %a1@(20),%d0 4ac60: 641e bccs 4ac80 <_Thread_Resume+0x9c>
_Thread_Heir = the_thread;
4ac62: 23c8 0006 1e4a movel %a0,61e4a <_Thread_Heir>
if ( _Thread_Executing->is_preemptible ||
4ac68: 2079 0006 1e76 moveal 61e76 <_Thread_Executing>,%a0 4ac6e: 4a28 0075 tstb %a0@(117) 4ac72: 6604 bnes 4ac78 <_Thread_Resume+0x94> 4ac74: 4a80 tstl %d0 4ac76: 6608 bnes 4ac80 <_Thread_Resume+0x9c>
the_thread->current_priority == 0 )
_Context_Switch_necessary = true;
4ac78: 7001 moveq #1,%d0 4ac7a: 13c0 0006 1e86 moveb %d0,61e86 <_Context_Switch_necessary>
}
}
}
_ISR_Enable( level );
4ac80: 46c1 movew %d1,%sr
}
4ac82: 4cd7 0c1c moveml %sp@,%d2-%d4/%a2-%a3 4ac86: 4e5e unlk %fp 4ac88: 4e75 rts
...
00047500 <_Thread_Set_state>:
{
ISR_Level level;
Chain_Control *ready;
ready = the_thread->ready;
_ISR_Disable( level );
47500: 223c 0000 0700 movel #1792,%d1
void _Thread_Set_state(
Thread_Control *the_thread,
States_Control state
)
{
47506: 4e56 fff4 linkw %fp,#-12 4750a: 206e 0008 moveal %fp@(8),%a0 4750e: 48d7 040c moveml %d2-%d3/%a2,%sp@ 47512: 242e 000c movel %fp@(12),%d2
ISR_Level level;
Chain_Control *ready;
ready = the_thread->ready;
47516: 2268 008a moveal %a0@(138),%a1
_ISR_Disable( level );
4751a: 40c0 movew %sr,%d0 4751c: 8280 orl %d0,%d1 4751e: 46c1 movew %d1,%sr
if ( !_States_Is_ready( the_thread->current_state ) ) {
47520: 2228 0010 movel %a0@(16),%d1 47524: 670c beqs 47532 <_Thread_Set_state+0x32>
the_thread->current_state =
47526: 8481 orl %d1,%d2 47528: 2142 0010 movel %d2,%a0@(16)
_States_Set( state, the_thread->current_state );
_ISR_Enable( level );
4752c: 46c0 movew %d0,%sr
return;
4752e: 6000 00ae braw 475de <_Thread_Set_state+0xde>
}
the_thread->current_state = state;
if ( _Chain_Has_only_one_node( ready ) ) {
47532: 2229 0008 movel %a1@(8),%d1
_States_Set( state, the_thread->current_state );
_ISR_Enable( level );
return;
}
the_thread->current_state = state;
47536: 2142 0010 movel %d2,%a0@(16)
if ( _Chain_Has_only_one_node( ready ) ) {
4753a: b291 cmpl %a1@,%d1 4753c: 6632 bnes 47570 <_Thread_Set_state+0x70>
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
4753e: 2209 movel %a1,%d1 47540: 5881 addql #4,%d1
RTEMS_INLINE_ROUTINE void _Priority_Remove_from_bit_map (
Priority_Information *the_priority_map
)
{
*the_priority_map->minor &= the_priority_map->block_minor;
47542: 2468 008e moveal %a0@(142),%a2 47546: 2281 movel %d1,%a1@ 47548: 3412 movew %a2@,%d2 4754a: 3228 0098 movew %a0@(152),%d1
the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain);
4754e: 2349 0008 movel %a1,%a1@(8) 47552: c282 andl %d2,%d1
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
the_chain->permanent_null = NULL;
47554: 42a9 0004 clrl %a1@(4) 47558: 3481 movew %d1,%a2@
_Chain_Initialize_empty( ready );
_Priority_Remove_from_bit_map( &the_thread->Priority_map );
4755a: 6620 bnes 4757c <_Thread_Set_state+0x7c>
if ( *the_priority_map->minor == 0 )
_Priority_Major_bit_map &= the_priority_map->block_major;
4755c: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 47562: 3428 0096 movew %a0@(150),%d2 47566: c282 andl %d2,%d1 47568: 33c1 0005 cd44 movew %d1,5cd44 <_Priority_Major_bit_map> 4756e: 600c bras 4757c <_Thread_Set_state+0x7c>
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
47570: 2250 moveal %a0@,%a1
previous = the_node->previous;
47572: 2468 0004 moveal %a0@(4),%a2
next->previous = previous; previous->next = next;
47576: 2489 movel %a1,%a2@
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
next->previous = previous;
47578: 234a 0004 movel %a2,%a1@(4)
} else
_Chain_Extract_unprotected( &the_thread->Object.Node );
_ISR_Flash( level );
4757c: 223c 0000 0700 movel #1792,%d1 47582: 46c0 movew %d0,%sr 47584: 8280 orl %d0,%d1 47586: 46c1 movew %d1,%sr
if ( _Thread_Is_heir( the_thread ) )
47588: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 4758e: 663c bnes 475cc <_Thread_Set_state+0xcc>
RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void )
{
Priority_Bit_map_control minor;
Priority_Bit_map_control major;
_Bitfield_Find_first_bit( _Priority_Major_bit_map, major );
47590: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 47596: 4841 swap %d1 47598: 04c1 ff1 %d1
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
4759a: 4282 clrl %d2 4759c: 43f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a1 475a2: 3401 movew %d1,%d2 475a4: 3231 2a00 movew %a1@(00000000,%d2:l:2),%d1 475a8: 4841 swap %d1 475aa: 04c1 ff1 %d1
* ready thread.
*/
RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void )
{
_Thread_Heir = (Thread_Control *)
475ac: 4283 clrl %d3 475ae: e98a lsll #4,%d2 475b0: 3601 movew %d1,%d3 475b2: 2279 0005 cc40 moveal 5cc40 <_Thread_Ready_chain>,%a1 475b8: 2202 movel %d2,%d1 475ba: d283 addl %d3,%d1 475bc: 2401 movel %d1,%d2 475be: e58a lsll #2,%d2 475c0: e989 lsll #4,%d1 475c2: 93c2 subal %d2,%a1 475c4: d3c1 addal %d1,%a1 475c6: 23d1 0005 cd22 movel %a1@,5cd22 <_Thread_Heir>
_Thread_Calculate_heir();
if ( _Thread_Is_executing( the_thread ) )
475cc: b1f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a0 475d2: 6608 bnes 475dc <_Thread_Set_state+0xdc>
_Context_Switch_necessary = true;
475d4: 7201 moveq #1,%d1 475d6: 13c1 0005 cd5e moveb %d1,5cd5e <_Context_Switch_necessary>
_ISR_Enable( level );
475dc: 46c0 movew %d0,%sr
}
475de: 4cd7 040c moveml %sp@,%d2-%d3/%a2 475e2: 4e5e unlk %fp 475e4: 4e75 rts
...
00047664 <_Thread_Stack_Allocate>:
size_t _Thread_Stack_Allocate(
Thread_Control *the_thread,
size_t stack_size
)
{
47664: 4e56 0000 linkw %fp,#0 47668: 2039 0005 b4de movel 5b4de <rtems_minimum_stack_size>,%d0 4766e: 2f02 movel %d2,%sp@- 47670: 242e 000c movel %fp@(12),%d2 47674: b082 cmpl %d2,%d0 47676: 6302 blss 4767a <_Thread_Stack_Allocate+0x16> 47678: 2400 movel %d0,%d2
* Call ONLY the CPU table stack allocate hook, _or_ the
* the RTEMS workspace allocate. This is so the stack free
* routine can call the correct deallocation routine.
*/
if ( Configuration.stack_allocate_hook ) {
4767a: 2079 0005 b504 moveal 5b504 <Configuration+0x20>,%a0 47680: 4a88 tstl %a0 47682: 6706 beqs 4768a <_Thread_Stack_Allocate+0x26>
stack_addr = (*Configuration.stack_allocate_hook)( the_stack_size );
47684: 2f02 movel %d2,%sp@- 47686: 4e90 jsr %a0@ 47688: 6008 bras 47692 <_Thread_Stack_Allocate+0x2e>
* get and keep the stack adjust factor, the stack alignment, and
* the context initialization sequence in sync.
*/
the_stack_size = _Stack_Adjust_size( the_stack_size );
stack_addr = _Workspace_Allocate( the_stack_size );
4768a: 2f02 movel %d2,%sp@- 4768c: 4eb9 0004 7e90 jsr 47e90 <_Workspace_Allocate>
}
if ( !stack_addr )
47692: 4a80 tstl %d0 47694: 56c1 sne %d1
the_stack_size = 0;
the_thread->Start.stack = stack_addr;
47696: 206e 0008 moveal %fp@(8),%a0
* get and keep the stack adjust factor, the stack alignment, and
* the context initialization sequence in sync.
*/
the_stack_size = _Stack_Adjust_size( the_stack_size );
stack_addr = _Workspace_Allocate( the_stack_size );
4769a: 588f addql #4,%sp
}
if ( !stack_addr )
the_stack_size = 0;
the_thread->Start.stack = stack_addr;
4769c: 2140 00ca movel %d0,%a0@(202)
the_stack_size = _Stack_Adjust_size( the_stack_size );
stack_addr = _Workspace_Allocate( the_stack_size );
}
if ( !stack_addr )
476a0: 1001 moveb %d1,%d0 476a2: 49c0 extbl %d0
the_stack_size = 0;
the_thread->Start.stack = stack_addr;
return the_stack_size;
}
476a4: c082 andl %d2,%d0 476a6: 242e fffc movel %fp@(-4),%d2 476aa: 4e5e unlk %fp 476ac: 4e75 rts
...
00047784 <_Thread_Suspend>:
{
ISR_Level level;
Chain_Control *ready;
ready = the_thread->ready;
_ISR_Disable( level );
47784: 223c 0000 0700 movel #1792,%d1
*/
void _Thread_Suspend(
Thread_Control *the_thread
)
{
4778a: 4e56 fff4 linkw %fp,#-12 4778e: 206e 0008 moveal %fp@(8),%a0 47792: 48d7 040c moveml %d2-%d3/%a2,%sp@
ISR_Level level;
Chain_Control *ready;
ready = the_thread->ready;
47796: 2268 008a moveal %a0@(138),%a1
_ISR_Disable( level );
4779a: 40c0 movew %sr,%d0 4779c: 8280 orl %d0,%d1 4779e: 46c1 movew %d1,%sr
#if defined(RTEMS_ITRON_API)
the_thread->suspend_count++;
#endif
if ( !_States_Is_ready( the_thread->current_state ) ) {
477a0: 2228 0010 movel %a0@(16),%d1 477a4: 670e beqs 477b4 <_Thread_Suspend+0x30>
the_thread->current_state =
477a6: 7402 moveq #2,%d2 477a8: 8481 orl %d1,%d2 477aa: 2142 0010 movel %d2,%a0@(16)
_States_Set( STATES_SUSPENDED, the_thread->current_state );
_ISR_Enable( level );
477ae: 46c0 movew %d0,%sr
return;
477b0: 6000 00b0 braw 47862 <_Thread_Suspend+0xde>
}
the_thread->current_state = STATES_SUSPENDED;
477b4: 7202 moveq #2,%d1
if ( _Chain_Has_only_one_node( ready ) ) {
477b6: 2429 0008 movel %a1@(8),%d2
_States_Set( STATES_SUSPENDED, the_thread->current_state );
_ISR_Enable( level );
return;
}
the_thread->current_state = STATES_SUSPENDED;
477ba: 2141 0010 movel %d1,%a0@(16)
if ( _Chain_Has_only_one_node( ready ) ) {
477be: b491 cmpl %a1@,%d2 477c0: 6632 bnes 477f4 <_Thread_Suspend+0x70>
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
477c2: 2209 movel %a1,%d1 477c4: 5881 addql #4,%d1
RTEMS_INLINE_ROUTINE void _Priority_Remove_from_bit_map (
Priority_Information *the_priority_map
)
{
*the_priority_map->minor &= the_priority_map->block_minor;
477c6: 2468 008e moveal %a0@(142),%a2 477ca: 2281 movel %d1,%a1@ 477cc: 3412 movew %a2@,%d2 477ce: 3228 0098 movew %a0@(152),%d1
the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain);
477d2: 2349 0008 movel %a1,%a1@(8) 477d6: c282 andl %d2,%d1
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
the_chain->permanent_null = NULL;
477d8: 42a9 0004 clrl %a1@(4) 477dc: 3481 movew %d1,%a2@
_Chain_Initialize_empty( ready );
_Priority_Remove_from_bit_map( &the_thread->Priority_map );
477de: 6620 bnes 47800 <_Thread_Suspend+0x7c>
if ( *the_priority_map->minor == 0 )
_Priority_Major_bit_map &= the_priority_map->block_major;
477e0: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 477e6: 3428 0096 movew %a0@(150),%d2 477ea: c282 andl %d2,%d1 477ec: 33c1 0005 cd44 movew %d1,5cd44 <_Priority_Major_bit_map> 477f2: 600c bras 47800 <_Thread_Suspend+0x7c>
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
477f4: 2250 moveal %a0@,%a1
previous = the_node->previous;
477f6: 2468 0004 moveal %a0@(4),%a2
next->previous = previous; previous->next = next;
477fa: 2489 movel %a1,%a2@
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
next->previous = previous;
477fc: 234a 0004 movel %a2,%a1@(4)
} else
_Chain_Extract_unprotected( &the_thread->Object.Node );
_ISR_Flash( level );
47800: 223c 0000 0700 movel #1792,%d1 47806: 46c0 movew %d0,%sr 47808: 8280 orl %d0,%d1 4780a: 46c1 movew %d1,%sr
if ( _Thread_Is_heir( the_thread ) )
4780c: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 47812: 663c bnes 47850 <_Thread_Suspend+0xcc>
RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void )
{
Priority_Bit_map_control minor;
Priority_Bit_map_control major;
_Bitfield_Find_first_bit( _Priority_Major_bit_map, major );
47814: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 4781a: 4841 swap %d1 4781c: 04c1 ff1 %d1
_Bitfield_Find_first_bit( _Priority_Bit_map[major], minor );
4781e: 4282 clrl %d2 47820: 43f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a1 47826: 3401 movew %d1,%d2 47828: 3231 2a00 movew %a1@(00000000,%d2:l:2),%d1 4782c: 4841 swap %d1 4782e: 04c1 ff1 %d1 47830: 4283 clrl %d3 47832: e98a lsll #4,%d2 47834: 3601 movew %d1,%d3 47836: 2279 0005 cc40 moveal 5cc40 <_Thread_Ready_chain>,%a1 4783c: 2202 movel %d2,%d1 4783e: d283 addl %d3,%d1 47840: 2401 movel %d1,%d2 47842: e58a lsll #2,%d2 47844: e989 lsll #4,%d1 47846: 93c2 subal %d2,%a1 47848: d3c1 addal %d1,%a1 4784a: 23d1 0005 cd22 movel %a1@,5cd22 <_Thread_Heir>
_Thread_Calculate_heir();
if ( _Thread_Is_executing( the_thread ) )
47850: b1f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a0 47856: 6608 bnes 47860 <_Thread_Suspend+0xdc>
_Context_Switch_necessary = true;
47858: 7401 moveq #1,%d2 4785a: 13c2 0005 cd5e moveb %d2,5cd5e <_Context_Switch_necessary>
_ISR_Enable( level );
47860: 46c0 movew %d0,%sr
}
47862: 4cd7 040c moveml %sp@,%d2-%d3/%a2 47866: 4e5e unlk %fp 47868: 4e75 rts
...
000478dc <_Thread_Yield_processor>:
* ready chain
* select heir
*/
void _Thread_Yield_processor( void )
{
478dc: 4e56 fff4 linkw %fp,#-12
ISR_Level level;
Thread_Control *executing;
Chain_Control *ready;
executing = _Thread_Executing;
478e0: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0
* ready chain
* select heir
*/
void _Thread_Yield_processor( void )
{
478e6: 48d7 0c04 moveml %d2/%a2-%a3,%sp@
Thread_Control *executing;
Chain_Control *ready;
executing = _Thread_Executing;
ready = executing->ready;
_ISR_Disable( level );
478ea: 243c 0000 0700 movel #1792,%d2 478f0: 2002 movel %d2,%d0
ISR_Level level;
Thread_Control *executing;
Chain_Control *ready;
executing = _Thread_Executing;
ready = executing->ready;
478f2: 2268 008a moveal %a0@(138),%a1
_ISR_Disable( level );
478f6: 40c1 movew %sr,%d1 478f8: 8081 orl %d1,%d0 478fa: 46c0 movew %d0,%sr
if ( !_Chain_Has_only_one_node( ready ) ) {
478fc: 2029 0008 movel %a1@(8),%d0 47900: b091 cmpl %a1@,%d0 47902: 6738 beqs 4793c <_Thread_Yield_processor+0x60>
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
47904: 2450 moveal %a0@,%a2
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
47906: 2009 movel %a1,%d0 47908: 5880 addql #4,%d0
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
4790a: 2668 0004 moveal %a0@(4),%a3
next->previous = previous; previous->next = next;
4790e: 268a movel %a2,%a3@
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
next->previous = previous;
47910: 254b 0004 movel %a3,%a2@(4)
Chain_Node *the_node
)
{
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
47914: 2080 movel %d0,%a0@
old_last_node = the_chain->last;
47916: 2469 0008 moveal %a1@(8),%a2
the_chain->last = the_node;
4791a: 2348 0008 movel %a0,%a1@(8)
old_last_node->next = the_node; the_node->previous = old_last_node;
4791e: 214a 0004 movel %a2,%a0@(4)
Chain_Node *old_last_node;
the_node->next = _Chain_Tail(the_chain);
old_last_node = the_chain->last;
the_chain->last = the_node;
old_last_node->next = the_node;
47922: 2488 movel %a0,%a2@
_Chain_Extract_unprotected( &executing->Object.Node );
_Chain_Append_unprotected( ready, &executing->Object.Node );
_ISR_Flash( level );
47924: 2002 movel %d2,%d0 47926: 46c1 movew %d1,%sr 47928: 8081 orl %d1,%d0 4792a: 46c0 movew %d0,%sr
if ( _Thread_Is_heir( executing ) )
4792c: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 47932: 6610 bnes 47944 <_Thread_Yield_processor+0x68>
_Thread_Heir = (Thread_Control *) ready->first;
47934: 23d1 0005 cd22 movel %a1@,5cd22 <_Thread_Heir> 4793a: 6008 bras 47944 <_Thread_Yield_processor+0x68>
_Context_Switch_necessary = true;
}
else if ( !_Thread_Is_heir( executing ) )
4793c: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 47942: 6708 beqs 4794c <_Thread_Yield_processor+0x70>
_Context_Switch_necessary = true;
47944: 7001 moveq #1,%d0 47946: 13c0 0005 cd5e moveb %d0,5cd5e <_Context_Switch_necessary>
_ISR_Enable( level );
4794c: 46c1 movew %d1,%sr
}
4794e: 4cd7 0c04 moveml %sp@,%d2/%a2-%a3 47952: 4e5e unlk %fp 47954: 4e75 rts
...
00046798 <_Thread_blocking_operation_Cancel>:
/*
* If the sync state is timed out, this is very likely not needed.
* But better safe than sorry when it comes to critical sections.
*/
if ( _Watchdog_Is_active( &the_thread->Timer ) ) {
46798: 7202 moveq #2,%d1
Thread_blocking_operation_States sync_state __attribute__((unused)),
#endif
Thread_Control *the_thread,
ISR_Level level
)
{
4679a: 4e56 0000 linkw %fp,#0 4679e: 202e 0010 movel %fp@(16),%d0 467a2: 2f0a movel %a2,%sp@- 467a4: 246e 000c moveal %fp@(12),%a2
#endif
/*
* The thread is not waiting on anything after this completes.
*/
the_thread->Wait.queue = NULL;
467a8: 42aa 0044 clrl %a2@(68)
/*
* If the sync state is timed out, this is very likely not needed.
* But better safe than sorry when it comes to critical sections.
*/
if ( _Watchdog_Is_active( &the_thread->Timer ) ) {
467ac: b2aa 0050 cmpl %a2@(80),%d1 467b0: 6618 bnes 467ca <_Thread_blocking_operation_Cancel+0x32>
RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_REMOVE_IT;
467b2: 123c 0003 moveb #3,%d1 467b6: 2541 0050 movel %d1,%a2@(80)
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
467ba: 46c0 movew %d0,%sr
(void) _Watchdog_Remove( &the_thread->Timer );
467bc: 486a 0048 pea %a2@(72) 467c0: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 467c6: 588f addql #4,%sp 467c8: 6002 bras 467cc <_Thread_blocking_operation_Cancel+0x34>
} else
_ISR_Enable( level );
467ca: 46c0 movew %d0,%sr
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
467cc: 2d4a 0008 movel %a2,%fp@(8)
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
_Thread_MP_Free_proxy( the_thread );
#endif
}
467d0: 246e fffc moveal %fp@(-4),%a2 467d4: 203c 1003 fff8 movel #268697592,%d0 467da: 2d40 000c movel %d0,%fp@(12) 467de: 4e5e unlk %fp 467e0: 4ef9 0004 6928 jmp 46928 <_Thread_Clear_state>
...
0004702c <_Thread_queue_Dequeue>:
Thread_Control *(*dequeue_p)( Thread_queue_Control * );
Thread_Control *the_thread;
ISR_Level level;
Thread_blocking_operation_States sync_state;
if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY )
4702c: 41f9 0004 7088 lea 47088 <_Thread_queue_Dequeue_priority>,%a0 47032: 7001 moveq #1,%d0
*/
Thread_Control *_Thread_queue_Dequeue(
Thread_queue_Control *the_thread_queue
)
{
47034: 4e56 fff4 linkw %fp,#-12 47038: 48d7 040c moveml %d2-%d3/%a2,%sp@ 4703c: 246e 0008 moveal %fp@(8),%a2
Thread_Control *(*dequeue_p)( Thread_queue_Control * );
Thread_Control *the_thread;
ISR_Level level;
Thread_blocking_operation_States sync_state;
if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY )
47040: b0aa 0034 cmpl %a2@(52),%d0 47044: 6706 beqs 4704c <_Thread_queue_Dequeue+0x20> 47046: 41f9 0004 a62c lea 4a62c <_Thread_queue_Dequeue_fifo>,%a0
dequeue_p = _Thread_queue_Dequeue_priority;
else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */
dequeue_p = _Thread_queue_Dequeue_fifo;
the_thread = (*dequeue_p)( the_thread_queue );
4704c: 2f0a movel %a2,%sp@- 4704e: 4e90 jsr %a0@
_ISR_Disable( level );
47050: 223c 0000 0700 movel #1792,%d1 47056: 40c2 movew %sr,%d2 47058: 8282 orl %d2,%d1 4705a: 46c1 movew %d1,%sr
if ( !the_thread ) {
4705c: 588f addql #4,%sp 4705e: 4a80 tstl %d0 47060: 6618 bnes 4707a <_Thread_queue_Dequeue+0x4e>
sync_state = the_thread_queue->sync_state;
47062: 222a 0030 movel %a2@(48),%d1 47066: 7601 moveq #1,%d3 47068: 5381 subql #1,%d1 4706a: b681 cmpl %d1,%d3 4706c: 650c bcss 4707a <_Thread_queue_Dequeue+0x4e>
if ( (sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
(sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ) {
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SATISFIED;
4706e: 7203 moveq #3,%d1
the_thread = _Thread_Executing;
47070: 2039 0005 cd4e movel 5cd4e <_Thread_Executing>,%d0
_ISR_Disable( level );
if ( !the_thread ) {
sync_state = the_thread_queue->sync_state;
if ( (sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) ||
(sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ) {
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SATISFIED;
47076: 2541 0030 movel %d1,%a2@(48)
the_thread = _Thread_Executing;
}
}
_ISR_Enable( level );
4707a: 46c2 movew %d2,%sr
return the_thread; }
4707c: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 47082: 4e5e unlk %fp 47084: 4e75 rts
...
0004a62c <_Thread_queue_Dequeue_fifo>:
)
{
ISR_Level level;
Thread_Control *the_thread;
_ISR_Disable( level );
4a62c: 223c 0000 0700 movel #1792,%d1
*/
Thread_Control *_Thread_queue_Dequeue_fifo(
Thread_queue_Control *the_thread_queue
)
{
4a632: 4e56 fff4 linkw %fp,#-12 4a636: 206e 0008 moveal %fp@(8),%a0 4a63a: 48d7 1c00 moveml %a2-%a4,%sp@
ISR_Level level;
Thread_Control *the_thread;
_ISR_Disable( level );
4a63e: 40c0 movew %sr,%d0 4a640: 8280 orl %d0,%d1 4a642: 46c1 movew %d1,%sr
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
Chain_Control *the_chain
)
{
return (the_chain->first == _Chain_Tail(the_chain));
4a644: 2248 moveal %a0,%a1 4a646: 2459 moveal %a1@+,%a2
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
4a648: b3ca cmpal %a2,%a1 4a64a: 674e beqs 4a69a <_Thread_queue_Dequeue_fifo+0x6e>
{
Chain_Node *return_node;
Chain_Node *new_first;
return_node = the_chain->first;
new_first = return_node->next;
4a64c: 2252 moveal %a2@,%a1
if ( !_Chain_Is_empty( &the_thread_queue->Queues.Fifo ) ) {
the_thread = (Thread_Control *)
4a64e: 264a moveal %a2,%a3 4a650: 49f9 0004 6928 lea 46928 <_Thread_Clear_state>,%a4
_Chain_Get_first_unprotected( &the_thread_queue->Queues.Fifo );
the_thread->Wait.queue = NULL;
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
4a656: 7202 moveq #2,%d1
the_chain->first = new_first;
4a658: 2089 movel %a1,%a0@
new_first->previous = _Chain_Head(the_chain);
4a65a: 2348 0004 movel %a0,%a1@(4)
if ( !_Chain_Is_empty( &the_thread_queue->Queues.Fifo ) ) {
the_thread = (Thread_Control *)
_Chain_Get_first_unprotected( &the_thread_queue->Queues.Fifo );
the_thread->Wait.queue = NULL;
4a65e: 42aa 0044 clrl %a2@(68)
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
4a662: b2aa 0050 cmpl %a2@(80),%d1 4a666: 6710 beqs 4a678 <_Thread_queue_Dequeue_fifo+0x4c>
_ISR_Enable( level );
4a668: 46c0 movew %d0,%sr
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
4a66a: 2f3c 1003 fff8 movel #268697592,%sp@- 4a670: 2f0a movel %a2,%sp@- 4a672: 4e94 jsr %a4@ 4a674: 508f addql #8,%sp 4a676: 6026 bras 4a69e <_Thread_queue_Dequeue_fifo+0x72>
RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_REMOVE_IT;
4a678: 7203 moveq #3,%d1 4a67a: 2541 0050 movel %d1,%a2@(80)
_Thread_Unblock( the_thread );
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
4a67e: 46c0 movew %d0,%sr
(void) _Watchdog_Remove( &the_thread->Timer );
4a680: 486a 0048 pea %a2@(72) 4a684: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 4a68a: 2f3c 1003 fff8 movel #268697592,%sp@- 4a690: 2f0a movel %a2,%sp@- 4a692: 4e94 jsr %a4@ 4a694: 4fef 000c lea %sp@(12),%sp 4a698: 6004 bras 4a69e <_Thread_queue_Dequeue_fifo+0x72>
#endif
return the_thread;
}
_ISR_Enable( level );
4a69a: 46c0 movew %d0,%sr 4a69c: 97cb subal %a3,%a3
return NULL; }
4a69e: 200b movel %a3,%d0 4a6a0: 4cee 1c00 fff4 moveml %fp@(-12),%a2-%a4 4a6a6: 4e5e unlk %fp 4a6a8: 4e75 rts
...
00047088 <_Thread_queue_Dequeue_priority>:
Chain_Node *new_second_node;
Chain_Node *last_node;
Chain_Node *next_node;
Chain_Node *previous_node;
_ISR_Disable( level );
47088: 203c 0000 0700 movel #1792,%d0
*/
Thread_Control *_Thread_queue_Dequeue_priority(
Thread_queue_Control *the_thread_queue
)
{
4708e: 4e56 ffec linkw %fp,#-20 47092: 226e 0008 moveal %fp@(8),%a1 47096: 48d7 3c04 moveml %d2/%a2-%a5,%sp@
Chain_Node *new_second_node;
Chain_Node *last_node;
Chain_Node *next_node;
Chain_Node *previous_node;
_ISR_Disable( level );
4709a: 40c1 movew %sr,%d1 4709c: 8081 orl %d1,%d0 4709e: 46c0 movew %d0,%sr 470a0: 4280 clrl %d0 470a2: 2049 moveal %a1,%a0
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
470a4: 2408 movel %a0,%d2 470a6: 5882 addql #4,%d2 470a8: b490 cmpl %a0@,%d2 470aa: 6728 beqs 470d4 <_Thread_queue_Dequeue_priority+0x4c>
for( index=0 ;
index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ;
index++ ) {
if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) {
the_thread = (Thread_Control *)
470ac: 2400 movel %d0,%d2 470ae: e588 lsll #2,%d0 470b0: e98a lsll #4,%d2 470b2: 9480 subl %d0,%d2 470b4: 2471 2800 moveal %a1@(00000000,%d2:l),%a2 470b8: 200a movel %a2,%d0 470ba: 0680 0000 003c addil #60,%d0
_ISR_Enable( level );
return NULL;
dequeue:
the_thread->Wait.queue = NULL;
new_first_node = the_thread->Wait.Block2n.first;
470c0: 206a 0038 moveal %a2@(56),%a0
new_first_thread = (Thread_Control *) new_first_node; next_node = the_thread->Object.Node.next;
470c4: 2652 moveal %a2@,%a3
previous_node = the_thread->Object.Node.previous;
470c6: 226a 0004 moveal %a2@(4),%a1
*/
_ISR_Enable( level );
return NULL;
dequeue:
the_thread->Wait.queue = NULL;
470ca: 42aa 0044 clrl %a2@(68) 470ce: b088 cmpl %a0,%d0 470d0: 6614 bnes 470e6 <_Thread_queue_Dequeue_priority+0x5e> 470d2: 6046 bras 4711a <_Thread_queue_Dequeue_priority+0x92>
Chain_Node *previous_node;
_ISR_Disable( level );
for( index=0 ;
index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ;
index++ ) {
470d4: 5280 addql #1,%d0 470d6: 41e8 000c lea %a0@(12),%a0
Chain_Node *last_node;
Chain_Node *next_node;
Chain_Node *previous_node;
_ISR_Disable( level );
for( index=0 ;
470da: 7404 moveq #4,%d2 470dc: b480 cmpl %d0,%d2 470de: 66c4 bnes 470a4 <_Thread_queue_Dequeue_priority+0x1c>
}
/*
* We did not find a thread to unblock.
*/
_ISR_Enable( level );
470e0: 46c1 movew %d1,%sr 470e2: 95ca subal %a2,%a2
return NULL;
470e4: 6078 bras 4715e <_Thread_queue_Dequeue_priority+0xd6>
new_first_thread = (Thread_Control *) new_first_node;
next_node = the_thread->Object.Node.next;
previous_node = the_thread->Object.Node.previous;
if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) {
last_node = the_thread->Wait.Block2n.last;
470e6: 286a 0040 moveal %a2@(64),%a4
new_second_node = new_first_node->next;
470ea: 2a50 moveal %a0@,%a5
previous_node->next = new_first_node;
next_node->previous = new_first_node;
470ec: 2748 0004 movel %a0,%a3@(4)
if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) {
last_node = the_thread->Wait.Block2n.last;
new_second_node = new_first_node->next;
previous_node->next = new_first_node;
470f0: 2288 movel %a0,%a1@
next_node->previous = new_first_node;
new_first_node->next = next_node;
new_first_node->previous = previous_node;
470f2: 2149 0004 movel %a1,%a0@(4)
last_node = the_thread->Wait.Block2n.last;
new_second_node = new_first_node->next;
previous_node->next = new_first_node;
next_node->previous = new_first_node;
new_first_node->next = next_node;
470f6: 208b movel %a3,%a0@
new_first_node->previous = previous_node;
if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) {
470f8: 226a 0040 moveal %a2@(64),%a1 470fc: b3ea 0038 cmpal %a2@(56),%a1 47100: 671e beqs 47120 <_Thread_queue_Dequeue_priority+0x98>
/* > two threads on 2-n */
new_second_node->previous =
47102: 43e8 0038 lea %a0@(56),%a1 47106: 2b49 0004 movel %a1,%a5@(4)
_Chain_Head( &new_first_thread->Wait.Block2n );
new_first_thread->Wait.Block2n.first = new_second_node;
4710a: 214d 0038 movel %a5,%a0@(56)
new_first_thread->Wait.Block2n.last = last_node;
4710e: 214c 0040 movel %a4,%a0@(64)
last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n );
47112: 41e8 003c lea %a0@(60),%a0 47116: 2888 movel %a0,%a4@ 47118: 6006 bras 47120 <_Thread_queue_Dequeue_priority+0x98>
}
} else {
previous_node->next = next_node;
next_node->previous = previous_node;
4711a: 2749 0004 movel %a1,%a3@(4)
new_first_thread->Wait.Block2n.last = last_node;
last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n );
}
} else {
previous_node->next = next_node;
4711e: 228b movel %a3,%a1@ 47120: 47f9 0004 6928 lea 46928 <_Thread_Clear_state>,%a3
next_node->previous = previous_node;
}
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
47126: 7002 moveq #2,%d0 47128: b0aa 0050 cmpl %a2@(80),%d0 4712c: 6710 beqs 4713e <_Thread_queue_Dequeue_priority+0xb6>
_ISR_Enable( level );
4712e: 46c1 movew %d1,%sr
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
47130: 2f3c 1003 fff8 movel #268697592,%sp@- 47136: 2f0a movel %a2,%sp@- 47138: 4e93 jsr %a3@ 4713a: 508f addql #8,%sp 4713c: 6020 bras 4715e <_Thread_queue_Dequeue_priority+0xd6>
RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_REMOVE_IT;
4713e: 7403 moveq #3,%d2 47140: 2542 0050 movel %d2,%a2@(80)
_Thread_Unblock( the_thread );
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
47144: 46c1 movew %d1,%sr
(void) _Watchdog_Remove( &the_thread->Timer );
47146: 486a 0048 pea %a2@(72) 4714a: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 47150: 2f3c 1003 fff8 movel #268697592,%sp@- 47156: 2f0a movel %a2,%sp@- 47158: 4e93 jsr %a3@ 4715a: 4fef 000c lea %sp@(12),%sp
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
_Thread_MP_Free_proxy( the_thread );
#endif
return( the_thread );
}
4715e: 200a movel %a2,%d0 47160: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 47166: 4e5e unlk %fp 47168: 4e75 rts
...
00047204 <_Thread_queue_Enqueue_priority>:
Thread_blocking_operation_States _Thread_queue_Enqueue_priority (
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread,
ISR_Level *level_p
)
{
47204: 4e56 ffe4 linkw %fp,#-28 47208: 206e 000c moveal %fp@(12),%a0
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
4720c: 43e8 003c lea %a0@(60),%a1
Priority_Control priority;
States_Control block_state;
_Chain_Initialize_empty( &the_thread->Wait.Block2n );
priority = the_thread->current_priority;
47210: 2028 0014 movel %a0@(20),%d0
Thread_blocking_operation_States _Thread_queue_Enqueue_priority (
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread,
ISR_Level *level_p
)
{
47214: 48d7 0c7c moveml %d2-%d6/%a2-%a3,%sp@
_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 ];
47218: 2400 movel %d0,%d2 4721a: ec8a lsrl #6,%d2 4721c: 2202 movel %d2,%d1
return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
restart_reverse_search:
search_priority = PRIORITY_MAXIMUM + 1;
_ISR_Disable( level );
4721e: 283c 0000 0700 movel #1792,%d4
_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 ];
47224: e989 lsll #4,%d1 47226: e58a lsll #2,%d2
Thread_blocking_operation_States _Thread_queue_Enqueue_priority (
Thread_queue_Control *the_thread_queue,
Thread_Control *the_thread,
ISR_Level *level_p
)
{
47228: 246e 0008 moveal %fp@(8),%a2
_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 ];
4722c: 9282 subl %d2,%d1 4722e: 47f2 1800 lea %a2@(00000000,%d1:l),%a3 47232: 2149 0038 movel %a1,%a0@(56)
the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain);
47236: 43e8 0038 lea %a0@(56),%a1
block_state = the_thread_queue->state;
4723a: 2a2a 0038 movel %a2@(56),%d5 4723e: 2149 0040 movel %a1,%a0@(64)
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
the_chain->permanent_null = NULL;
47242: 42a8 003c clrl %a0@(60)
if ( _Thread_queue_Is_reverse_search( priority ) )
47246: 0800 0005 btst #5,%d0 4724a: 6660 bnes 472ac <_Thread_queue_Enqueue_priority+0xa8>
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
4724c: 2c0b movel %a3,%d6 4724e: 5886 addql #4,%d6
goto restart_reverse_search;
restart_forward_search:
search_priority = PRIORITY_MINIMUM - 1;
_ISR_Disable( level );
47250: 2404 movel %d4,%d2 47252: 40c1 movew %sr,%d1 47254: 8481 orl %d1,%d2 47256: 46c2 movew %d2,%sr
search_thread = (Thread_Control *) header->first;
47258: 2253 moveal %a3@,%a1 4725a: 76ff moveq #-1,%d3
while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) {
4725c: 601e bras 4727c <_Thread_queue_Enqueue_priority+0x78>
search_priority = search_thread->current_priority;
4725e: 2629 0014 movel %a1@(20),%d3
if ( priority <= search_priority )
47262: b680 cmpl %d0,%d3 47264: 641a bccs 47280 <_Thread_queue_Enqueue_priority+0x7c>
break;
search_priority = search_thread->current_priority;
if ( priority <= search_priority )
break;
#endif
_ISR_Flash( level );
47266: 2404 movel %d4,%d2 47268: 46c1 movew %d1,%sr 4726a: 8481 orl %d1,%d2 4726c: 46c2 movew %d2,%sr
if ( !_States_Are_set( search_thread->current_state, block_state) ) {
4726e: 2405 movel %d5,%d2 47270: c4a9 0010 andl %a1@(16),%d2 47274: 6604 bnes 4727a <_Thread_queue_Enqueue_priority+0x76>
_ISR_Enable( level );
47276: 46c1 movew %d1,%sr <== NOT EXECUTED
goto restart_forward_search;
47278: 60d6 bras 47250 <_Thread_queue_Enqueue_priority+0x4c><== NOT EXECUTED
}
search_thread =
(Thread_Control *)search_thread->Object.Node.next;
4727a: 2251 moveal %a1@,%a1
restart_forward_search:
search_priority = PRIORITY_MINIMUM - 1;
_ISR_Disable( level );
search_thread = (Thread_Control *) header->first;
while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) {
4727c: bc89 cmpl %a1,%d6 4727e: 66de bnes 4725e <_Thread_queue_Enqueue_priority+0x5a> 47280: 2401 movel %d1,%d2
}
search_thread =
(Thread_Control *)search_thread->Object.Node.next;
}
if ( the_thread_queue->sync_state !=
47282: 7801 moveq #1,%d4 47284: b8aa 0030 cmpl %a2@(48),%d4 47288: 6600 00a4 bnew 4732e <_Thread_queue_Enqueue_priority+0x12a>
THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
goto synchronize;
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
4728c: 42aa 0030 clrl %a2@(48)
if ( priority == search_priority )
47290: b680 cmpl %d0,%d3 47292: 677e beqs 47312 <_Thread_queue_Enqueue_priority+0x10e>
goto equal_priority;
search_node = (Chain_Node *) search_thread;
previous_node = search_node->previous;
47294: 2669 0004 moveal %a1@(4),%a3
the_node = (Chain_Node *) the_thread;
the_node->next = search_node;
47298: 2089 movel %a1,%a0@
the_node->previous = previous_node;
4729a: 214b 0004 movel %a3,%a0@(4)
previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue;
4729e: 214a 0044 movel %a2,%a0@(68)
previous_node = search_node->previous;
the_node = (Chain_Node *) the_thread;
the_node->next = search_node;
the_node->previous = previous_node;
previous_node->next = the_node;
472a2: 2688 movel %a0,%a3@
search_node->previous = the_node;
472a4: 2348 0004 movel %a0,%a1@(4)
the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level );
472a8: 46c1 movew %d1,%sr 472aa: 6062 bras 4730e <_Thread_queue_Enqueue_priority+0x10a>
return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
restart_reverse_search:
search_priority = PRIORITY_MAXIMUM + 1;
472ac: 4283 clrl %d3 472ae: 1639 0005 b4e2 moveb 5b4e2 <rtems_maximum_priority>,%d3
_ISR_Disable( level );
472b4: 2404 movel %d4,%d2
the_thread->Wait.queue = the_thread_queue;
_ISR_Enable( level );
return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
restart_reverse_search:
search_priority = PRIORITY_MAXIMUM + 1;
472b6: 5283 addql #1,%d3
_ISR_Disable( level );
472b8: 40c1 movew %sr,%d1 472ba: 8481 orl %d1,%d2 472bc: 46c2 movew %d2,%sr
search_thread = (Thread_Control *) header->last;
472be: 226b 0008 moveal %a3@(8),%a1
while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) {
472c2: 6020 bras 472e4 <_Thread_queue_Enqueue_priority+0xe0>
search_priority = search_thread->current_priority;
472c4: 2629 0014 movel %a1@(20),%d3
if ( priority >= search_priority )
472c8: b680 cmpl %d0,%d3 472ca: 631c blss 472e8 <_Thread_queue_Enqueue_priority+0xe4>
break;
search_priority = search_thread->current_priority;
if ( priority >= search_priority )
break;
#endif
_ISR_Flash( level );
472cc: 2404 movel %d4,%d2 472ce: 46c1 movew %d1,%sr 472d0: 8481 orl %d1,%d2 472d2: 46c2 movew %d2,%sr
if ( !_States_Are_set( search_thread->current_state, block_state) ) {
472d4: 2405 movel %d5,%d2 472d6: c4a9 0010 andl %a1@(16),%d2 472da: 6604 bnes 472e0 <_Thread_queue_Enqueue_priority+0xdc>
_ISR_Enable( level );
472dc: 46c1 movew %d1,%sr
goto restart_reverse_search;
472de: 60cc bras 472ac <_Thread_queue_Enqueue_priority+0xa8>
}
search_thread = (Thread_Control *)
472e0: 2269 0004 moveal %a1@(4),%a1
restart_reverse_search:
search_priority = PRIORITY_MAXIMUM + 1;
_ISR_Disable( level );
search_thread = (Thread_Control *) header->last;
while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) {
472e4: b7c9 cmpal %a1,%a3 472e6: 66dc bnes 472c4 <_Thread_queue_Enqueue_priority+0xc0> 472e8: 2401 movel %d1,%d2
}
search_thread = (Thread_Control *)
search_thread->Object.Node.previous;
}
if ( the_thread_queue->sync_state !=
472ea: 7801 moveq #1,%d4 472ec: b8aa 0030 cmpl %a2@(48),%d4 472f0: 663c bnes 4732e <_Thread_queue_Enqueue_priority+0x12a>
THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
goto synchronize;
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
472f2: 42aa 0030 clrl %a2@(48)
if ( priority == search_priority )
472f6: b680 cmpl %d0,%d3 472f8: 6718 beqs 47312 <_Thread_queue_Enqueue_priority+0x10e>
goto equal_priority;
search_node = (Chain_Node *) search_thread;
next_node = search_node->next;
472fa: 2651 moveal %a1@,%a3
the_node = (Chain_Node *) the_thread;
the_node->next = next_node;
the_node->previous = search_node;
472fc: 2149 0004 movel %a1,%a0@(4)
search_node = (Chain_Node *) search_thread;
next_node = search_node->next;
the_node = (Chain_Node *) the_thread;
the_node->next = next_node;
47300: 208b movel %a3,%a0@
the_node->previous = search_node; search_node->next = the_node; next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue;
47302: 214a 0044 movel %a2,%a0@(68)
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;
47306: 2288 movel %a0,%a1@
next_node->previous = the_node;
47308: 2748 0004 movel %a0,%a3@(4)
the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level );
4730c: 46c1 movew %d1,%sr 4730e: 7001 moveq #1,%d0
return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
47310: 6026 bras 47338 <_Thread_queue_Enqueue_priority+0x134> 47312: 43e9 003c lea %a1@(60),%a1
equal_priority: /* add at end of priority group */
search_node = _Chain_Tail( &search_thread->Wait.Block2n );
previous_node = search_node->previous;
47316: 2669 0004 moveal %a1@(4),%a3
the_node = (Chain_Node *) the_thread;
the_node->next = search_node;
4731a: 2089 movel %a1,%a0@
the_node->previous = previous_node;
4731c: 214b 0004 movel %a3,%a0@(4)
previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue;
47320: 214a 0044 movel %a2,%a0@(68)
previous_node = search_node->previous;
the_node = (Chain_Node *) the_thread;
the_node->next = search_node;
the_node->previous = previous_node;
previous_node->next = the_node;
47324: 2688 movel %a0,%a3@
search_node->previous = the_node;
47326: 2348 0004 movel %a0,%a1@(4)
the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level );
4732a: 46c2 movew %d2,%sr 4732c: 60e0 bras 4730e <_Thread_queue_Enqueue_priority+0x10a>
* 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;
4732e: 206e 0010 moveal %fp@(16),%a0
return the_thread_queue->sync_state;
47332: 202a 0030 movel %a2@(48),%d0
* 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;
47336: 2082 movel %d2,%a0@
return the_thread_queue->sync_state; }
47338: 4cd7 0c7c moveml %sp@,%d2-%d6/%a2-%a3 4733c: 4e5e unlk %fp 4733e: 4e75 rts
0004c100 <_Thread_queue_Extract_fifo>:
Thread_Control *the_thread
)
{
ISR_Level level;
_ISR_Disable( level );
4c100: 223c 0000 0700 movel #1792,%d1
void _Thread_queue_Extract_fifo(
Thread_queue_Control *the_thread_queue __attribute__((unused)),
Thread_Control *the_thread
)
{
4c106: 4e56 0000 linkw %fp,#0 4c10a: 2f0a movel %a2,%sp@- 4c10c: 246e 000c moveal %fp@(12),%a2
ISR_Level level;
_ISR_Disable( level );
4c110: 40c0 movew %sr,%d0 4c112: 8280 orl %d0,%d1 4c114: 46c1 movew %d1,%sr
if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) {
4c116: 222a 0010 movel %a2@(16),%d1 4c11a: 0281 0003 bee0 andil #245472,%d1 4c120: 660a bnes 4c12c <_Thread_queue_Extract_fifo+0x2c>
_ISR_Enable( level );
4c122: 46c0 movew %d0,%sr
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
_Thread_MP_Free_proxy( the_thread );
#endif
}
4c124: 246e fffc moveal %fp@(-4),%a2 4c128: 4e5e unlk %fp 4c12a: 4e75 rts
)
{
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
4c12c: 2052 moveal %a2@,%a0
_Chain_Extract_unprotected( &the_thread->Object.Node );
the_thread->Wait.queue = NULL;
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
4c12e: 7202 moveq #2,%d1
previous = the_node->previous;
4c130: 226a 0004 moveal %a2@(4),%a1
return;
}
_Chain_Extract_unprotected( &the_thread->Object.Node );
the_thread->Wait.queue = NULL;
4c134: 42aa 0044 clrl %a2@(68)
next->previous = previous; previous->next = next;
4c138: 2288 movel %a0,%a1@
Chain_Node *next;
Chain_Node *previous;
next = the_node->next;
previous = the_node->previous;
next->previous = previous;
4c13a: 2149 0004 movel %a1,%a0@(4)
if ( !_Watchdog_Is_active( &the_thread->Timer ) ) {
4c13e: b2aa 0050 cmpl %a2@(80),%d1 4c142: 6704 beqs 4c148 <_Thread_queue_Extract_fifo+0x48>
_ISR_Enable( level );
4c144: 46c0 movew %d0,%sr 4c146: 6014 bras 4c15c <_Thread_queue_Extract_fifo+0x5c> 4c148: 7203 moveq #3,%d1 4c14a: 2541 0050 movel %d1,%a2@(80)
} else {
_Watchdog_Deactivate( &the_thread->Timer );
_ISR_Enable( level );
4c14e: 46c0 movew %d0,%sr
(void) _Watchdog_Remove( &the_thread->Timer );
4c150: 486a 0048 pea %a2@(72) 4c154: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 4c15a: 588f addql #4,%sp
RTEMS_INLINE_ROUTINE void _Thread_Unblock (
Thread_Control *the_thread
)
{
_Thread_Clear_state( the_thread, STATES_BLOCKED );
4c15c: 2d4a 0008 movel %a2,%fp@(8)
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
_Thread_MP_Free_proxy( the_thread );
#endif
}
4c160: 246e fffc moveal %fp@(-4),%a2 4c164: 203c 1003 fff8 movel #268697592,%d0 4c16a: 2d40 000c movel %d0,%fp@(12) 4c16e: 4e5e unlk %fp 4c170: 4ef9 0004 6928 jmp 46928 <_Thread_Clear_state>
...
00047368 <_Thread_queue_Flush>:
#else
Thread_queue_Flush_callout remote_extract_callout __attribute__((unused)),
#endif
uint32_t status
)
{
47368: 4e56 fff4 linkw %fp,#-12 4736c: 48d7 040c moveml %d2-%d3/%a2,%sp@ 47370: 262e 0008 movel %fp@(8),%d3
Thread_Control *the_thread;
while ( (the_thread = _Thread_queue_Dequeue( the_thread_queue )) ) {
47374: 45f9 0004 702c lea 4702c <_Thread_queue_Dequeue>,%a2
#else
Thread_queue_Flush_callout remote_extract_callout __attribute__((unused)),
#endif
uint32_t status
)
{
4737a: 242e 0010 movel %fp@(16),%d2
Thread_Control *the_thread;
while ( (the_thread = _Thread_queue_Dequeue( the_thread_queue )) ) {
4737e: 6006 bras 47386 <_Thread_queue_Flush+0x1e>
#if defined(RTEMS_MULTIPROCESSING)
if ( !_Objects_Is_local_id( the_thread->Object.id ) )
( *remote_extract_callout )( the_thread );
else
#endif
the_thread->Wait.return_code = status;
47380: 2040 moveal %d0,%a0 47382: 2142 0034 movel %d2,%a0@(52)
uint32_t status
)
{
Thread_Control *the_thread;
while ( (the_thread = _Thread_queue_Dequeue( the_thread_queue )) ) {
47386: 2f03 movel %d3,%sp@- 47388: 4e92 jsr %a2@ 4738a: 588f addql #4,%sp 4738c: 4a80 tstl %d0 4738e: 66f0 bnes 47380 <_Thread_queue_Flush+0x18>
( *remote_extract_callout )( the_thread );
else
#endif
the_thread->Wait.return_code = status;
}
}
47390: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 47396: 4e5e unlk %fp 47398: 4e75 rts
...
0004a804 <_Thread_queue_Process_timeout>:
#include <rtems/score/tqdata.h>
void _Thread_queue_Process_timeout(
Thread_Control *the_thread
)
{
4a804: 4e56 0000 linkw %fp,#0 4a808: 206e 0008 moveal %fp@(8),%a0
Thread_queue_Control *the_thread_queue = the_thread->Wait.queue;
4a80c: 2268 0044 moveal %a0@(68),%a1
* If it is not satisfied, then it is "nothing happened" and
* this is the "timeout" transition. After a request is satisfied,
* a timeout is not allowed to occur.
*/
if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED &&
4a810: 2029 0030 movel %a1@(48),%d0 4a814: 671c beqs 4a832 <_Thread_queue_Process_timeout+0x2e> 4a816: b1f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a0 4a81c: 6614 bnes 4a832 <_Thread_queue_Process_timeout+0x2e>
_Thread_Is_executing( the_thread ) ) {
if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) {
4a81e: 7203 moveq #3,%d1 4a820: b280 cmpl %d0,%d1 4a822: 6722 beqs 4a846 <_Thread_queue_Process_timeout+0x42>
the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status;
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT;
4a824: 7002 moveq #2,%d0
*/
if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED &&
_Thread_Is_executing( the_thread ) ) {
if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) {
the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status;
4a826: 2169 003c 0034 movel %a1@(60),%a0@(52)
the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT;
4a82c: 2340 0030 movel %d0,%a1@(48) 4a830: 6014 bras 4a846 <_Thread_queue_Process_timeout+0x42>
}
} else {
the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status;
4a832: 2169 003c 0034 movel %a1@(60),%a0@(52)
_Thread_queue_Extract( the_thread->Wait.queue, the_thread );
4a838: 2f08 movel %a0,%sp@- 4a83a: 2f28 0044 movel %a0@(68),%sp@- 4a83e: 4eb9 0004 a700 jsr 4a700 <_Thread_queue_Extract> 4a844: 508f addql #8,%sp
} }
4a846: 4e5e unlk %fp 4a848: 4e75 rts
...
00047458 <_Thread_queue_Timeout>:
void _Thread_queue_Timeout(
Objects_Id id,
void *ignored __attribute__((unused))
)
{
47458: 4e56 fffc linkw %fp,#-4
Thread_Control *the_thread;
Objects_Locations location;
the_thread = _Thread_Get( id, &location );
4745c: 486e fffc pea %fp@(-4) 47460: 2f2e 0008 movel %fp@(8),%sp@- 47464: 4eb9 0004 6d08 jsr 46d08 <_Thread_Get>
switch ( location ) {
4746a: 508f addql #8,%sp 4746c: 4aae fffc tstl %fp@(-4) 47470: 6618 bnes 4748a <_Thread_queue_Timeout+0x32>
#if defined(RTEMS_MULTIPROCESSING)
case OBJECTS_REMOTE: /* impossible */
#endif
break;
case OBJECTS_LOCAL:
_Thread_queue_Process_timeout( the_thread );
47472: 2f00 movel %d0,%sp@- 47474: 4eb9 0004 a804 jsr 4a804 <_Thread_queue_Process_timeout>
*/
RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void )
{
RTEMS_COMPILER_MEMORY_BARRIER();
_Thread_Dispatch_disable_level -= 1;
4747a: 588f addql #4,%sp 4747c: 2039 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d0 47482: 5380 subql #1,%d0 47484: 23c0 0005 cc94 movel %d0,5cc94 <_Thread_Dispatch_disable_level>
_Thread_Unnest_dispatch();
break;
}
}
4748a: 4e5e unlk %fp 4748c: 4e75 rts
...
00049ca8 <_Timer_Manager_initialization>:
*
* Output parameters: NONE
*/
void _Timer_Manager_initialization(void)
{
49ca8: 4e56 0000 linkw %fp,#0
_Objects_Initialize_information(
49cac: 4878 0004 pea 4 <CONTEXT_ARG> 49cb0: 42a7 clrl %sp@- 49cb2: 4878 003c pea 3c <DBL_MANT_DIG+0x7> 49cb6: 2f39 0005 b4b6 movel 5b4b6 <Configuration_RTEMS_API+0x6>,%sp@- 49cbc: 4878 0002 pea 2 <DOUBLE_FLOAT> 49cc0: 4878 0002 pea 2 <DOUBLE_FLOAT> 49cc4: 4879 0005 d684 pea 5d684 <_Timer_Information> 49cca: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information>
/*
* Initialize the pointer to the default timer server control block to NULL
* indicating that task-based timer support is not initialized.
*/
_Timer_server = NULL;
49cd0: 4fef 001c lea %sp@(28),%sp
}
49cd4: 4e5e unlk %fp
/*
* Initialize the pointer to the default timer server control block to NULL
* indicating that task-based timer support is not initialized.
*/
_Timer_server = NULL;
49cd6: 42b9 0005 d6be clrl 5d6be <_Timer_server>
}
49cdc: 4e75 rts
...
00051644 <_Timer_server_Body>:
* @a arg points to the corresponding timer server control block.
*/
static rtems_task _Timer_server_Body(
rtems_task_argument arg
)
{
51644: 4e56 ffb4 linkw %fp,#-76 51648: 200e movel %fp,%d0 5164a: 0680 ffff fff4 addil #-12,%d0 51650: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 51654: 246e 0008 moveal %fp@(8),%a2 51658: 240e movel %fp,%d2 5165a: 2a0e movel %fp,%d5 5165c: 260e movel %fp,%d3 5165e: 0682 ffff ffe8 addil #-24,%d2 51664: 5185 subql #8,%d5 51666: 0683 ffff ffec addil #-20,%d3
static void _Timer_server_Stop_interval_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
5166c: 41ea 0008 lea %a2@(8),%a0
static void _Timer_server_Stop_tod_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
51670: 4bea 0040 lea %a2@(64),%a5
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
51674: 2e0a movel %a2,%d7
/*
* 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 );
51676: 280a movel %a2,%d4
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
51678: 0687 0000 0030 addil #48,%d7
/*
* 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 );
5167e: 0684 0000 0068 addil #104,%d4
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
watchdogs->last_snapshot = snapshot;
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
51684: 49f9 0005 51f4 lea 551f4 <_Watchdog_Adjust_to_chain>,%a4
)
{
if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
} else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
_Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
5168a: 47f9 0005 5284 lea 55284 <_Watchdog_Insert>,%a3
static void _Timer_server_Stop_interval_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
51690: 2d48 ffe4 movel %a0,%fp@(-28)
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
51694: 2d45 fff4 movel %d5,%fp@(-12)
the_chain->permanent_null = NULL;
51698: 42ae fff8 clrl %fp@(-8)
the_chain->last = _Chain_Head(the_chain);
5169c: 2d40 fffc movel %d0,%fp@(-4)
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
516a0: 2d43 ffe8 movel %d3,%fp@(-24)
the_chain->permanent_null = NULL;
516a4: 42ae ffec clrl %fp@(-20)
the_chain->last = _Chain_Head(the_chain);
516a8: 2d42 fff0 movel %d2,%fp@(-16) 516ac: 2d4d ffe0 movel %a5,%fp@(-32)
{
/*
* 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;
516b0: 41ee fff4 lea %fp@(-12),%a0
* of zero it will be processed in the next iteration of the timer server
* body loop.
*/
_Timer_server_Process_insertions( ts );
_ISR_Disable( level );
516b4: 3a7c 0700 moveaw #1792,%a5
{
/*
* 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;
516b8: 2548 0078 movel %a0,%a2@(120)
static void _Timer_server_Process_interval_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
516bc: 2039 0007 552c movel 7552c <_Watchdog_Ticks_since_boot>,%d0
/*
* We assume adequate unsigned arithmetic here.
*/
Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
516c2: 222a 003c movel %a2@(60),%d1
watchdogs->last_snapshot = snapshot;
516c6: 2540 003c movel %d0,%a2@(60)
_Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
516ca: 486e ffe8 pea %fp@(-24) 516ce: 9081 subl %d1,%d0 516d0: 2f00 movel %d0,%sp@- 516d2: 2f07 movel %d7,%sp@- 516d4: 4e94 jsr %a4@
static void _Timer_server_Process_tod_watchdogs(
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
516d6: 2039 0007 547a movel 7547a <_TOD_Now>,%d0
/*
* 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 ) {
516dc: 4fef 000c lea %sp@(12),%sp
Timer_server_Watchdogs *watchdogs,
Chain_Control *fire_chain
)
{
Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
Watchdog_Interval last_snapshot = watchdogs->last_snapshot;
516e0: 222a 0074 movel %a2@(116),%d1
/*
* 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 ) {
516e4: b280 cmpl %d0,%d1 516e6: 6414 bccs 516fc <_Timer_server_Body+0xb8>
/*
* 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 );
516e8: 486e ffe8 pea %fp@(-24) 516ec: 2c00 movel %d0,%d6 516ee: 9c81 subl %d1,%d6 516f0: 2f06 movel %d6,%sp@- 516f2: 2d40 ffdc movel %d0,%fp@(-36) 516f6: 2f04 movel %d4,%sp@- 516f8: 4e94 jsr %a4@ 516fa: 6018 bras 51714 <_Timer_server_Body+0xd0>
} else if ( snapshot < last_snapshot ) {
516fc: b280 cmpl %d0,%d1 516fe: 631c blss 5171c <_Timer_server_Body+0xd8>
/*
* 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 );
51700: 9280 subl %d0,%d1 51702: 2f01 movel %d1,%sp@- 51704: 4878 0001 pea 1 <ADD> 51708: 2d40 ffdc movel %d0,%fp@(-36) 5170c: 2f04 movel %d4,%sp@- 5170e: 4eb9 0005 5174 jsr 55174 <_Watchdog_Adjust> 51714: 202e ffdc movel %fp@(-36),%d0 51718: 4fef 000c lea %sp@(12),%sp
}
watchdogs->last_snapshot = snapshot;
5171c: 2540 0074 movel %d0,%a2@(116)
}
static void _Timer_server_Process_insertions( Timer_server_Control *ts )
{
while ( true ) {
Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain );
51720: 202a 0078 movel %a2@(120),%d0 51724: 2f00 movel %d0,%sp@- 51726: 4eb9 0005 2014 jsr 52014 <_Chain_Get>
if ( timer == NULL ) {
5172c: 588f addql #4,%sp
}
static void _Timer_server_Process_insertions( Timer_server_Control *ts )
{
while ( true ) {
Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain );
5172e: 2040 moveal %d0,%a0
if ( timer == NULL ) {
51730: 4a80 tstl %d0 51732: 6724 beqs 51758 <_Timer_server_Body+0x114>
static void _Timer_server_Insert_timer(
Timer_server_Control *ts,
Timer_Control *timer
)
{
if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
51734: 2028 0038 movel %a0@(56),%d0 51738: 7201 moveq #1,%d1 5173a: b280 cmpl %d0,%d1 5173c: 6608 bnes 51746 <_Timer_server_Body+0x102>
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
5173e: 4868 0010 pea %a0@(16) 51742: 2f07 movel %d7,%sp@- 51744: 600c bras 51752 <_Timer_server_Body+0x10e>
} else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
51746: 7c03 moveq #3,%d6 51748: bc80 cmpl %d0,%d6 5174a: 66d4 bnes 51720 <_Timer_server_Body+0xdc>
_Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
5174c: 4868 0010 pea %a0@(16) 51750: 2f04 movel %d4,%sp@- 51752: 4e93 jsr %a3@ 51754: 508f addql #8,%sp 51756: 60c8 bras 51720 <_Timer_server_Body+0xdc>
* of zero it will be processed in the next iteration of the timer server
* body loop.
*/
_Timer_server_Process_insertions( ts );
_ISR_Disable( level );
51758: 200d movel %a5,%d0 5175a: 40c1 movew %sr,%d1 5175c: 8081 orl %d1,%d0 5175e: 46c0 movew %d0,%sr
if ( _Chain_Is_empty( insert_chain ) ) {
51760: baae fff4 cmpl %fp@(-12),%d5 51764: 6612 bnes 51778 <_Timer_server_Body+0x134>
ts->insert_chain = NULL;
51766: 42aa 0078 clrl %a2@(120)
_ISR_Enable( level );
5176a: 46c1 movew %d1,%sr
/*
* It is essential that interrupts are disable here since an interrupt
* service routine may remove a watchdog from the chain.
*/
_ISR_Disable( level );
5176c: 3a7c 0700 moveaw #1792,%a5
_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 ) ) {
51770: b6ae ffe8 cmpl %fp@(-24),%d3 51774: 6608 bnes 5177e <_Timer_server_Body+0x13a> 51776: 6042 bras 517ba <_Timer_server_Body+0x176>
ts->insert_chain = NULL;
_ISR_Enable( level );
break;
} else {
_ISR_Enable( level );
51778: 46c1 movew %d1,%sr <== NOT EXECUTED 5177a: 6000 ff40 braw 516bc <_Timer_server_Body+0x78> <== NOT EXECUTED
/*
* It is essential that interrupts are disable here since an interrupt
* service routine may remove a watchdog from the chain.
*/
_ISR_Disable( level );
5177e: 220d movel %a5,%d1 51780: 40c0 movew %sr,%d0 51782: 8280 orl %d0,%d1 51784: 46c1 movew %d1,%sr
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
Chain_Control *the_chain
)
{
return (the_chain->first == _Chain_Tail(the_chain));
51786: 206e ffe8 moveal %fp@(-24),%a0
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected(
Chain_Control *the_chain
)
{
if ( !_Chain_Is_empty(the_chain))
5178a: b688 cmpl %a0,%d3 5178c: 6726 beqs 517b4 <_Timer_server_Body+0x170>
{
Chain_Node *return_node;
Chain_Node *new_first;
return_node = the_chain->first;
new_first = return_node->next;
5178e: 2250 moveal %a0@,%a1
the_chain->first = new_first;
51790: 2d49 ffe8 movel %a1,%fp@(-24)
new_first->previous = _Chain_Head(the_chain);
51794: 2342 0004 movel %d2,%a1@(4)
watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain );
if ( watchdog != NULL ) {
51798: 4a88 tstl %a0 5179a: 6718 beqs 517b4 <_Timer_server_Body+0x170>
watchdog->state = WATCHDOG_INACTIVE;
5179c: 42a8 0008 clrl %a0@(8)
_ISR_Enable( level );
517a0: 46c0 movew %d0,%sr
/*
* 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 );
517a2: 2f28 0024 movel %a0@(36),%sp@- 517a6: 2f28 0020 movel %a0@(32),%sp@- 517aa: 2068 001c moveal %a0@(28),%a0 517ae: 4e90 jsr %a0@
}
517b0: 508f addql #8,%sp 517b2: 60ca bras 5177e <_Timer_server_Body+0x13a>
watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain );
if ( watchdog != NULL ) {
watchdog->state = WATCHDOG_INACTIVE;
_ISR_Enable( level );
} else {
_ISR_Enable( level );
517b4: 46c0 movew %d0,%sr 517b6: 6000 fef8 braw 516b0 <_Timer_server_Body+0x6c>
* the active flag of the timer server is true.
*/
(*watchdog->routine)( watchdog->id, watchdog->user_data );
}
} else {
ts->active = false;
517ba: 4200 clrb %d0 517bc: 1540 007c moveb %d0,%a2@(124) 517c0: 2039 0007 53e8 movel 753e8 <_Thread_Dispatch_disable_level>,%d0 517c6: 5280 addql #1,%d0 517c8: 23c0 0007 53e8 movel %d0,753e8 <_Thread_Dispatch_disable_level>
/*
* Block until there is something to do.
*/
_Thread_Disable_dispatch();
_Thread_Set_state( ts->thread, STATES_DELAYING );
517ce: 4878 0008 pea 8 <DIVIDE_BY_ZERO>
static void _Timer_server_Stop_interval_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
517d2: 4bf9 0005 53a0 lea 553a0 <_Watchdog_Remove>,%a5
/*
* Block until there is something to do.
*/
_Thread_Disable_dispatch();
_Thread_Set_state( ts->thread, STATES_DELAYING );
517d8: 2f12 movel %a2@,%sp@- 517da: 4eb9 0005 498c jsr 5498c <_Thread_Set_state>
_Timer_server_Reset_interval_system_watchdog( ts );
517e0: 2f0a movel %a2,%sp@- 517e2: 4eba fd9c jsr %pc@(51580 <_Timer_server_Reset_interval_system_watchdog>)
_Timer_server_Reset_tod_system_watchdog( ts );
517e6: 2f0a movel %a2,%sp@- 517e8: 4eba fdf6 jsr %pc@(515e0 <_Timer_server_Reset_tod_system_watchdog>)
_Thread_Enable_dispatch();
517ec: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch>
ts->active = true;
517f2: 7201 moveq #1,%d1 517f4: 1541 007c moveb %d1,%a2@(124)
static void _Timer_server_Stop_interval_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
517f8: 2f2e ffe4 movel %fp@(-28),%sp@- 517fc: 4e95 jsr %a5@
static void _Timer_server_Stop_tod_system_watchdog(
Timer_server_Control *ts
)
{
_Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
517fe: 2f2e ffe0 movel %fp@(-32),%sp@- 51802: 4e95 jsr %a5@ 51804: 4fef 0018 lea %sp@(24),%sp 51808: 6000 fea6 braw 516b0 <_Timer_server_Body+0x6c>
0005180c <_Timer_server_Schedule_operation_method>:
static void _Timer_server_Schedule_operation_method(
Timer_server_Control *ts,
Timer_Control *timer
)
{
5180c: 4e56 fff0 linkw %fp,#-16 51810: 206e 000c moveal %fp@(12),%a0 51814: 48d7 041c moveml %d2-%d4/%a2,%sp@ 51818: 246e 0008 moveal %fp@(8),%a2
if ( ts->insert_chain == NULL ) {
5181c: 202a 0078 movel %a2@(120),%d0 51820: 6600 00f8 bnew 5191a <_Timer_server_Schedule_operation_method+0x10e> 51824: 2039 0007 53e8 movel 753e8 <_Thread_Dispatch_disable_level>,%d0 5182a: 5280 addql #1,%d0 5182c: 23c0 0007 53e8 movel %d0,753e8 <_Thread_Dispatch_disable_level>
* being inserted. This could result in an integer overflow.
*/
_Thread_Disable_dispatch();
if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
51832: 2028 0038 movel %a0@(56),%d0 51836: 7201 moveq #1,%d1 51838: b280 cmpl %d0,%d1 5183a: 6660 bnes 5189c <_Timer_server_Schedule_operation_method+0x90>
/*
* We have to advance the last known ticks value of the server and update
* the watchdog chain accordingly.
*/
_ISR_Disable( level );
5183c: 203c 0000 0700 movel #1792,%d0 51842: 40c3 movew %sr,%d3 51844: 8083 orl %d3,%d0 51846: 46c0 movew %d0,%sr
snapshot = _Watchdog_Ticks_since_boot;
51848: 2039 0007 552c movel 7552c <_Watchdog_Ticks_since_boot>,%d0
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
5184e: 220a movel %a2,%d1 51850: 0681 0000 0034 addil #52,%d1
last_snapshot = ts->Interval_watchdogs.last_snapshot;
51856: 242a 003c movel %a2@(60),%d2
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
Chain_Control *the_chain
)
{
return (the_chain->first == _Chain_Tail(the_chain));
5185a: 226a 0030 moveal %a2@(48),%a1
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
5185e: b289 cmpl %a1,%d1 51860: 6716 beqs 51878 <_Timer_server_Schedule_operation_method+0x6c>
first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain );
/*
* We assume adequate unsigned arithmetic here.
*/
delta = snapshot - last_snapshot;
51862: 2800 movel %d0,%d4 51864: 9882 subl %d2,%d4
delta_interval = first_watchdog->delta_interval;
51866: 2229 0010 movel %a1@(16),%d1
if (delta_interval > delta) {
5186a: b881 cmpl %d1,%d4 5186c: 6504 bcss 51872 <_Timer_server_Schedule_operation_method+0x66> 5186e: 4281 clrl %d1 51870: 6002 bras 51874 <_Timer_server_Schedule_operation_method+0x68>
delta_interval -= delta;
51872: 9284 subl %d4,%d1
} else {
delta_interval = 0;
}
first_watchdog->delta_interval = delta_interval;
51874: 2341 0010 movel %d1,%a1@(16)
}
ts->Interval_watchdogs.last_snapshot = snapshot;
51878: 2540 003c movel %d0,%a2@(60)
_ISR_Enable( level );
5187c: 46c3 movew %d3,%sr
_Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
5187e: 4868 0010 pea %a0@(16) 51882: 486a 0030 pea %a2@(48) 51886: 4eb9 0005 5284 jsr 55284 <_Watchdog_Insert>
if ( !ts->active ) {
5188c: 508f addql #8,%sp 5188e: 102a 007c moveb %a2@(124),%d0 51892: 6678 bnes 5190c <_Timer_server_Schedule_operation_method+0x100>
_Timer_server_Reset_interval_system_watchdog( ts );
51894: 2f0a movel %a2,%sp@- 51896: 4eba fce8 jsr %pc@(51580 <_Timer_server_Reset_interval_system_watchdog>) 5189a: 606e bras 5190a <_Timer_server_Schedule_operation_method+0xfe>
}
} else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
5189c: 7203 moveq #3,%d1 5189e: b280 cmpl %d0,%d1 518a0: 666a bnes 5190c <_Timer_server_Schedule_operation_method+0x100>
/*
* We have to advance the last known seconds value of the server and update
* the watchdog chain accordingly.
*/
_ISR_Disable( level );
518a2: 203c 0000 0700 movel #1792,%d0 518a8: 40c3 movew %sr,%d3 518aa: 8083 orl %d3,%d0 518ac: 46c0 movew %d0,%sr 518ae: 200a movel %a2,%d0 518b0: 0680 0000 006c addil #108,%d0
snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
518b6: 2239 0007 547a movel 7547a <_TOD_Now>,%d1
last_snapshot = ts->TOD_watchdogs.last_snapshot;
518bc: 242a 0074 movel %a2@(116),%d2
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
Chain_Control *the_chain
)
{
return (the_chain->first == _Chain_Tail(the_chain));
518c0: 226a 0068 moveal %a2@(104),%a1
*/
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
Chain_Control *the_chain
)
{
return (Chain_Node *) &the_chain->permanent_null;
518c4: b089 cmpl %a1,%d0 518c6: 6720 beqs 518e8 <_Timer_server_Schedule_operation_method+0xdc>
if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) {
first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain );
delta_interval = first_watchdog->delta_interval;
518c8: 2029 0010 movel %a1@(16),%d0
if ( snapshot > last_snapshot ) {
518cc: b481 cmpl %d1,%d2 518ce: 6410 bccs 518e0 <_Timer_server_Schedule_operation_method+0xd4>
/*
* We advanced in time.
*/
delta = snapshot - last_snapshot;
518d0: 2801 movel %d1,%d4 518d2: 9882 subl %d2,%d4
if (delta_interval > delta) {
518d4: b880 cmpl %d0,%d4 518d6: 6504 bcss 518dc <_Timer_server_Schedule_operation_method+0xd0>
518d8: 4280 clrl %d0 <== NOT EXECUTED 518da: 6008 bras 518e4 <_Timer_server_Schedule_operation_method+0xd8><== NOT EXECUTED
delta_interval -= delta;
518dc: 9084 subl %d4,%d0 518de: 6004 bras 518e4 <_Timer_server_Schedule_operation_method+0xd8>
}
} else {
/*
* Someone put us in the past.
*/
delta = last_snapshot - snapshot;
518e0: d082 addl %d2,%d0
delta_interval += delta;
518e2: 9081 subl %d1,%d0
}
first_watchdog->delta_interval = delta_interval;
518e4: 2340 0010 movel %d0,%a1@(16)
}
ts->TOD_watchdogs.last_snapshot = snapshot;
518e8: 2541 0074 movel %d1,%a2@(116)
_ISR_Enable( level );
518ec: 46c3 movew %d3,%sr
_Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
518ee: 4868 0010 pea %a0@(16) 518f2: 486a 0068 pea %a2@(104) 518f6: 4eb9 0005 5284 jsr 55284 <_Watchdog_Insert>
if ( !ts->active ) {
518fc: 508f addql #8,%sp 518fe: 102a 007c moveb %a2@(124),%d0 51902: 6608 bnes 5190c <_Timer_server_Schedule_operation_method+0x100>
_Timer_server_Reset_tod_system_watchdog( ts );
51904: 2f0a movel %a2,%sp@- 51906: 4eba fcd8 jsr %pc@(515e0 <_Timer_server_Reset_tod_system_watchdog>) 5190a: 588f addql #4,%sp
* 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 );
}
}
5190c: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 51912: 4e5e unlk %fp
if ( !ts->active ) {
_Timer_server_Reset_tod_system_watchdog( ts );
}
}
_Thread_Enable_dispatch();
51914: 4ef9 0005 4012 jmp 54012 <_Thread_Enable_dispatch>
* 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 );
5191a: 202a 0078 movel %a2@(120),%d0 5191e: 2d48 000c movel %a0,%fp@(12)
} }
51922: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2
* 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 );
51928: 2d40 0008 movel %d0,%fp@(8)
} }
5192c: 4e5e unlk %fp
* 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 );
5192e: 4ef9 0005 1fdc jmp 51fdc <_Chain_Append>
00047958 <_Timespec_Add_to>:
uint32_t _Timespec_Add_to(
struct timespec *time,
const struct timespec *add
)
{
47958: 4e56 0000 linkw %fp,#0 4795c: 206e 0008 moveal %fp@(8),%a0 47960: 2f0a movel %a2,%sp@- 47962: 246e 000c moveal %fp@(12),%a2
uint32_t seconds = add->tv_sec;
/* Add the basics */
time->tv_sec += add->tv_sec;
time->tv_nsec += add->tv_nsec;
47966: 226a 0004 moveal %a2@(4),%a1 4796a: d3e8 0004 addal %a0@(4),%a1 4796e: 2209 movel %a1,%d1
uint32_t _Timespec_Add_to(
struct timespec *time,
const struct timespec *add
)
{
uint32_t seconds = add->tv_sec;
47970: 2012 movel %a2@,%d0
/* Add the basics */
time->tv_sec += add->tv_sec;
47972: d190 addl %d0,%a0@
time->tv_nsec += add->tv_nsec;
47974: 2149 0004 movel %a1,%a0@(4)
/* Now adjust it so nanoseconds is in range */
while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) {
47978: 600a bras 47984 <_Timespec_Add_to+0x2c>
time->tv_nsec -= TOD_NANOSECONDS_PER_SECOND;
time->tv_sec++;
4797a: 5290 addql #1,%a0@
seconds++;
4797c: 5280 addql #1,%d0 4797e: 0681 c465 3600 addil #-1000000000,%d1
/* Add the basics */
time->tv_sec += add->tv_sec;
time->tv_nsec += add->tv_nsec;
/* Now adjust it so nanoseconds is in range */
while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) {
47984: 0c81 3b9a c9ff cmpil #999999999,%d1 4798a: 62ee bhis 4797a <_Timespec_Add_to+0x22>
time->tv_sec++;
seconds++;
}
return seconds;
}
4798c: 245f moveal %sp@+,%a2 4798e: 4e5e unlk %fp
/* Add the basics */
time->tv_sec += add->tv_sec;
time->tv_nsec += add->tv_nsec;
/* Now adjust it so nanoseconds is in range */
while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) {
47990: 2141 0004 movel %d1,%a0@(4)
time->tv_sec++;
seconds++;
}
return seconds;
}
47994: 4e75 rts
...
0004a980 <_Timespec_To_ticks>:
*/
uint32_t _Timespec_To_ticks(
const struct timespec *time
)
{
4a980: 4e56 fff4 linkw %fp,#-12 4a984: 48d7 040c moveml %d2-%d3/%a2,%sp@ 4a988: 246e 0008 moveal %fp@(8),%a2
uint32_t ticks;
if ( (time->tv_sec == 0) && (time->tv_nsec == 0) )
4a98c: 2412 movel %a2@,%d2 4a98e: 660a bnes 4a99a <_Timespec_To_ticks+0x1a> 4a990: 4aaa 0004 tstl %a2@(4) 4a994: 6604 bnes 4a99a <_Timespec_To_ticks+0x1a> 4a996: 4280 clrl %d0 4a998: 602a bras 4a9c4 <_Timespec_To_ticks+0x44>
return 0;
ticks = time->tv_sec * TOD_TICKS_PER_SECOND;
4a99a: 4eb9 0004 c010 jsr 4c010 <TOD_TICKS_PER_SECOND_method>
ticks += time->tv_nsec / rtems_configuration_get_nanoseconds_per_tick();
4a9a0: 2239 0005 b4f0 movel 5b4f0 <Configuration+0xc>,%d1 4a9a6: 263c 0000 03e8 movel #1000,%d3 4a9ac: 4c03 1800 mulsl %d3,%d1
uint32_t ticks;
if ( (time->tv_sec == 0) && (time->tv_nsec == 0) )
return 0;
ticks = time->tv_sec * TOD_TICKS_PER_SECOND;
4a9b0: 4c02 0800 mulsl %d2,%d0
ticks += time->tv_nsec / rtems_configuration_get_nanoseconds_per_tick();
4a9b4: 262a 0004 movel %a2@(4),%d3 4a9b8: 4c41 3003 remul %d1,%d3,%d3 4a9bc: d083 addl %d3,%d0
if (ticks)
4a9be: 6604 bnes 4a9c4 <_Timespec_To_ticks+0x44> 4a9c0: 103c 0001 moveb #1,%d0
return ticks;
return 1;
}
4a9c4: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 4a9ca: 4e5e unlk %fp 4a9cc: 4e75 rts
...
0004a9d0 <_User_extensions_Add_set>:
#include <rtems/score/userext.h>
void _User_extensions_Add_set(
User_extensions_Control *the_extension
)
{
4a9d0: 4e56 0000 linkw %fp,#0 4a9d4: 2f0b movel %a3,%sp@-
_Chain_Append( &_User_extensions_List, &the_extension->Node );
4a9d6: 47f9 0004 58d0 lea 458d0 <_Chain_Append>,%a3
#include <rtems/score/userext.h>
void _User_extensions_Add_set(
User_extensions_Control *the_extension
)
{
4a9dc: 2f0a movel %a2,%sp@- 4a9de: 246e 0008 moveal %fp@(8),%a2
_Chain_Append( &_User_extensions_List, &the_extension->Node );
4a9e2: 2f0a movel %a2,%sp@- 4a9e4: 4879 0005 ce28 pea 5ce28 <_User_extensions_List> 4a9ea: 4e93 jsr %a3@
/*
* If a switch handler is present, append it to the switch chain.
*/
if ( the_extension->Callouts.thread_switch != NULL ) {
4a9ec: 202a 0024 movel %a2@(36),%d0 4a9f0: 508f addql #8,%sp 4a9f2: 6712 beqs 4aa06 <_User_extensions_Add_set+0x36>
the_extension->Switch.thread_switch =
the_extension->Callouts.thread_switch;
_Chain_Append(
4a9f4: 486a 0008 pea %a2@(8) 4a9f8: 4879 0005 cc98 pea 5cc98 <_User_extensions_Switches_list>
/*
* If a switch handler is present, append it to the switch chain.
*/
if ( the_extension->Callouts.thread_switch != NULL ) {
the_extension->Switch.thread_switch =
4a9fe: 2540 0010 movel %d0,%a2@(16)
the_extension->Callouts.thread_switch;
_Chain_Append(
4aa02: 4e93 jsr %a3@ 4aa04: 508f addql #8,%sp
&_User_extensions_Switches_list,
&the_extension->Switch.Node
);
}
}
4aa06: 246e fff8 moveal %fp@(-8),%a2 4aa0a: 266e fffc moveal %fp@(-4),%a3 4aa0e: 4e5e unlk %fp 4aa10: 4e75 rts
...
00047b02 <_User_extensions_Fatal>:
void _User_extensions_Fatal (
Internal_errors_Source the_source,
bool is_internal,
Internal_errors_t the_error
)
{
47b02: 4e56 fff0 linkw %fp,#-16 47b06: 48d7 041c moveml %d2-%d4/%a2,%sp@
the_node = the_node->previous ) {
the_extension = (User_extensions_Control *) the_node;
if ( the_extension->Callouts.fatal != NULL )
(*the_extension->Callouts.fatal)( the_source, is_internal, the_error );
47b0a: 4282 clrl %d2 47b0c: 142e 000f moveb %fp@(15),%d2
void _User_extensions_Fatal (
Internal_errors_Source the_source,
bool is_internal,
Internal_errors_t the_error
)
{
47b10: 282e 0008 movel %fp@(8),%d4 47b14: 262e 0010 movel %fp@(16),%d3
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
47b18: 2479 0005 ce30 moveal 5ce30 <_User_extensions_List+0x8>,%a2 47b1e: 6018 bras 47b38 <_User_extensions_Fatal+0x36>
!_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 )
47b20: 206a 0030 moveal %a2@(48),%a0 47b24: 4a88 tstl %a0 47b26: 670c beqs 47b34 <_User_extensions_Fatal+0x32>
(*the_extension->Callouts.fatal)( the_source, is_internal, the_error );
47b28: 2f03 movel %d3,%sp@- 47b2a: 2f02 movel %d2,%sp@- 47b2c: 2f04 movel %d4,%sp@- 47b2e: 4e90 jsr %a0@ 47b30: 4fef 000c lea %sp@(12),%sp
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
!_Chain_Is_head( &_User_extensions_List, the_node ) ;
the_node = the_node->previous ) {
47b34: 246a 0004 moveal %a2@(4),%a2
{
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.last ;
!_Chain_Is_head( &_User_extensions_List, the_node ) ;
47b38: b5fc 0005 ce28 cmpal #380456,%a2 47b3e: 66e0 bnes 47b20 <_User_extensions_Fatal+0x1e>
the_extension = (User_extensions_Control *) the_node;
if ( the_extension->Callouts.fatal != NULL )
(*the_extension->Callouts.fatal)( the_source, is_internal, the_error );
}
}
47b40: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 47b46: 4e5e unlk %fp 47b48: 4e75 rts
...
000479e0 <_User_extensions_Handler_initialization>:
#include <rtems/score/userext.h>
#include <rtems/score/wkspace.h>
#include <string.h>
void _User_extensions_Handler_initialization(void)
{
479e0: 4e56 ffe4 linkw %fp,#-28
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
479e4: 203c 0005 ce2c movel #380460,%d0 479ea: 23c0 0005 ce28 movel %d0,5ce28 <_User_extensions_List>
the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain);
479f0: 203c 0005 ce28 movel #380456,%d0 479f6: 23c0 0005 ce30 movel %d0,5ce30 <_User_extensions_List+0x8>
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
479fc: 203c 0005 cc9c movel #380060,%d0 47a02: 23c0 0005 cc98 movel %d0,5cc98 <_User_extensions_Switches_list>
the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain);
47a08: 203c 0005 cc98 movel #380056,%d0
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
the_chain->permanent_null = NULL;
47a0e: 42b9 0005 ce2c clrl 5ce2c <_User_extensions_List+0x4> 47a14: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@
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;
47a18: 2a39 0005 b51a movel 5b51a <Configuration+0x36>,%d5
initial_extensions = Configuration.User_extension_table;
47a1e: 2639 0005 b51e movel 5b51e <Configuration+0x3a>,%d3 47a24: 42b9 0005 cc9c clrl 5cc9c <_User_extensions_Switches_list+0x4>
the_chain->last = _Chain_Head(the_chain);
47a2a: 23c0 0005 cca0 movel %d0,5cca0 <_User_extensions_Switches_list+0x8>
_Chain_Initialize_empty( &_User_extensions_List );
_Chain_Initialize_empty( &_User_extensions_Switches_list );
if ( initial_extensions ) {
47a30: 4a83 tstl %d3 47a32: 6750 beqs 47a84 <_User_extensions_Handler_initialization+0xa4>
extension = (User_extensions_Control *)
47a34: 7834 moveq #52,%d4 47a36: 4c05 4800 mulsl %d5,%d4
_Workspace_Allocate_or_fatal_error(
number_of_extensions * sizeof( User_extensions_Control )
);
memset (
47a3a: 4282 clrl %d2
RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table(
User_extensions_Control *extension,
const User_extensions_Table *extension_table
)
{
extension->Callouts = *extension_table;
47a3c: 49f9 0004 d23c lea 4d23c <memcpy>,%a4
_User_extensions_Add_set( extension );
47a42: 47f9 0004 a9d0 lea 4a9d0 <_User_extensions_Add_set>,%a3
_Chain_Initialize_empty( &_User_extensions_List );
_Chain_Initialize_empty( &_User_extensions_Switches_list );
if ( initial_extensions ) {
extension = (User_extensions_Control *)
47a48: 2f04 movel %d4,%sp@- 47a4a: 4eb9 0004 7e5c jsr 47e5c <_Workspace_Allocate_or_fatal_error> 47a50: 2440 moveal %d0,%a2
_Workspace_Allocate_or_fatal_error(
number_of_extensions * sizeof( User_extensions_Control )
);
memset (
47a52: 2f04 movel %d4,%sp@- 47a54: 42a7 clrl %sp@- 47a56: 2f00 movel %d0,%sp@- 47a58: 4eb9 0004 d2ac jsr 4d2ac <memset> 47a5e: 601c bras 47a7c <_User_extensions_Handler_initialization+0x9c>
RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table(
User_extensions_Control *extension,
const User_extensions_Table *extension_table
)
{
extension->Callouts = *extension_table;
47a60: 4878 0020 pea 20 <OPER2+0xc>
extension,
0,
number_of_extensions * sizeof( User_extensions_Control )
);
for ( i = 0 ; i < number_of_extensions ; i++ ) {
47a64: 5282 addql #1,%d2 47a66: 2f03 movel %d3,%sp@- 47a68: 486a 0014 pea %a2@(20) 47a6c: 0683 0000 0020 addil #32,%d3 47a72: 4e94 jsr %a4@
_User_extensions_Add_set( extension );
47a74: 2f0a movel %a2,%sp@-
_User_extensions_Add_set_with_table (extension, &initial_extensions[i]);
extension++;
47a76: 45ea 0034 lea %a2@(52),%a2 47a7a: 4e93 jsr %a3@
extension,
0,
number_of_extensions * sizeof( User_extensions_Control )
);
for ( i = 0 ; i < number_of_extensions ; i++ ) {
47a7c: 4fef 0010 lea %sp@(16),%sp 47a80: ba82 cmpl %d2,%d5 47a82: 62dc bhis 47a60 <_User_extensions_Handler_initialization+0x80>
_User_extensions_Add_set_with_table (extension, &initial_extensions[i]);
extension++;
}
}
}
47a84: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 47a8a: 4e5e unlk %fp 47a8c: 4e75 rts
...
000483c8 <_User_extensions_Thread_restart>:
#include <rtems/score/userext.h>
void _User_extensions_Thread_restart (
Thread_Control *the_thread
)
{
483c8: 4e56 0000 linkw %fp,#0 483cc: 2f0a movel %a2,%sp@-
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.first ;
483ce: 2479 0005 d900 moveal 5d900 <_User_extensions_List>,%a2
#include <rtems/score/userext.h>
void _User_extensions_Thread_restart (
Thread_Control *the_thread
)
{
483d4: 2f02 movel %d2,%sp@- 483d6: 242e 0008 movel %fp@(8),%d2
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.first ;
483da: 6016 bras 483f2 <_User_extensions_Thread_restart+0x2a>
!_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 )
483dc: 206a 001c moveal %a2@(28),%a0 483e0: 4a88 tstl %a0 483e2: 670c beqs 483f0 <_User_extensions_Thread_restart+0x28>
(*the_extension->Callouts.thread_restart)(
483e4: 2f02 movel %d2,%sp@- 483e6: 2f39 0005 d826 movel 5d826 <_Thread_Executing>,%sp@- 483ec: 4e90 jsr %a0@ 483ee: 508f addql #8,%sp
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.first ;
!_Chain_Is_tail( &_User_extensions_List, the_node ) ;
the_node = the_node->next ) {
483f0: 2452 moveal %a2@,%a2 483f2: b5fc 0005 d904 cmpal #383236,%a2 483f8: 66e2 bnes 483dc <_User_extensions_Thread_restart+0x14>
(*the_extension->Callouts.thread_restart)(
_Thread_Executing,
the_thread
);
}
}
483fa: 242e fff8 movel %fp@(-8),%d2 483fe: 246e fffc moveal %fp@(-4),%a2 48402: 4e5e unlk %fp 48404: 4e75 rts
...
00047bd0 <_User_extensions_Thread_start>:
#include <rtems/score/userext.h>
void _User_extensions_Thread_start (
Thread_Control *the_thread
)
{
47bd0: 4e56 0000 linkw %fp,#0 47bd4: 2f0a movel %a2,%sp@-
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.first ;
47bd6: 2479 0005 ce28 moveal 5ce28 <_User_extensions_List>,%a2
#include <rtems/score/userext.h>
void _User_extensions_Thread_start (
Thread_Control *the_thread
)
{
47bdc: 2f02 movel %d2,%sp@- 47bde: 242e 0008 movel %fp@(8),%d2
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.first ;
47be2: 6016 bras 47bfa <_User_extensions_Thread_start+0x2a>
!_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 )
47be4: 206a 0018 moveal %a2@(24),%a0 47be8: 4a88 tstl %a0 47bea: 670c beqs 47bf8 <_User_extensions_Thread_start+0x28>
(*the_extension->Callouts.thread_start)(
47bec: 2f02 movel %d2,%sp@- 47bee: 2f39 0005 cd4e movel 5cd4e <_Thread_Executing>,%sp@- 47bf4: 4e90 jsr %a0@ 47bf6: 508f addql #8,%sp
Chain_Node *the_node;
User_extensions_Control *the_extension;
for ( the_node = _User_extensions_List.first ;
!_Chain_Is_tail( &_User_extensions_List, the_node ) ;
the_node = the_node->next ) {
47bf8: 2452 moveal %a2@,%a2 47bfa: b5fc 0005 ce2c cmpal #380460,%a2 47c00: 66e2 bnes 47be4 <_User_extensions_Thread_start+0x14>
(*the_extension->Callouts.thread_start)(
_Thread_Executing,
the_thread
);
}
}
47c02: 242e fff8 movel %fp@(-8),%d2 47c06: 246e fffc moveal %fp@(-4),%a2 47c0a: 4e5e unlk %fp 47c0c: 4e75 rts
...
00047d18 <_Watchdog_Handler_initialization>:
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
47d18: 43f9 0005 cd6c lea 5cd6c <_Watchdog_Ticks_chain>,%a1 47d1e: 41f9 0005 cd60 lea 5cd60 <_Watchdog_Seconds_chain>,%a0
*
* Output parameters: NONE
*/
void _Watchdog_Handler_initialization( void )
{
47d24: 4e56 0000 linkw %fp,#0
_Watchdog_Sync_level = 0;
_Watchdog_Ticks_since_boot = 0;
_Chain_Initialize_empty( &_Watchdog_Ticks_chain );
_Chain_Initialize_empty( &_Watchdog_Seconds_chain );
}
47d28: 4e5e unlk %fp
* Output parameters: NONE
*/
void _Watchdog_Handler_initialization( void )
{
_Watchdog_Sync_count = 0;
47d2a: 42b9 0005 cdd4 clrl 5cdd4 <_Watchdog_Sync_count>
_Watchdog_Sync_level = 0;
47d30: 42b9 0005 cd4a clrl 5cd4a <_Watchdog_Sync_level>
the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain);
47d36: 23c9 0005 cd74 movel %a1,5cd74 <_Watchdog_Ticks_chain+0x8> 47d3c: 23c8 0005 cd68 movel %a0,5cd68 <_Watchdog_Seconds_chain+0x8>
_Watchdog_Ticks_since_boot = 0;
47d42: 42b9 0005 cdd8 clrl 5cdd8 <_Watchdog_Ticks_since_boot>
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
47d48: 22bc 0005 cd70 movel #380272,%a1@
the_chain->permanent_null = NULL;
47d4e: 42b9 0005 cd70 clrl 5cd70 <_Watchdog_Ticks_chain+0x4>
*/
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
Chain_Control *the_chain
)
{
the_chain->first = _Chain_Tail(the_chain);
47d54: 20bc 0005 cd64 movel #380260,%a0@
the_chain->permanent_null = NULL;
47d5a: 42b9 0005 cd64 clrl 5cd64 <_Watchdog_Seconds_chain+0x4>
_Chain_Initialize_empty( &_Watchdog_Ticks_chain );
_Chain_Initialize_empty( &_Watchdog_Seconds_chain );
}
47d60: 4e75 rts
...
00047c48 <_Watchdog_Insert>:
Watchdog_Interval delta_interval;
insert_isr_nest_level = _ISR_Nest_level;
_ISR_Disable( level );
47c48: 327c 0700 moveaw #1792,%a1 47c4c: 2009 movel %a1,%d0
void _Watchdog_Insert(
Chain_Control *header,
Watchdog_Control *the_watchdog
)
{
47c4e: 4e56 ffec linkw %fp,#-20 47c52: 206e 000c moveal %fp@(12),%a0 47c56: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 47c5a: 266e 0008 moveal %fp@(8),%a3
Watchdog_Control *after;
uint32_t insert_isr_nest_level;
Watchdog_Interval delta_interval;
insert_isr_nest_level = _ISR_Nest_level;
47c5e: 2439 0005 cd2e movel 5cd2e <_ISR_Nest_level>,%d2
_ISR_Disable( level );
47c64: 40c1 movew %sr,%d1 47c66: 8081 orl %d1,%d0 47c68: 46c0 movew %d0,%sr
/*
* 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 ) {
47c6a: 4aa8 0008 tstl %a0@(8) 47c6e: 6706 beqs 47c76 <_Watchdog_Insert+0x2e>
_ISR_Enable( level );
47c70: 46c1 movew %d1,%sr
return;
47c72: 6000 009a braw 47d0e <_Watchdog_Insert+0xc6>
}
the_watchdog->state = WATCHDOG_BEING_INSERTED;
_Watchdog_Sync_count++;
47c76: 2039 0005 cdd4 movel 5cdd4 <_Watchdog_Sync_count>,%d0 47c7c: 5280 addql #1,%d0
* used around this flash point allowed interrupts to execute
* which violated the design assumptions. The critical section
* mechanism used here WAS redesigned to address this.
*/
_ISR_Flash( level );
47c7e: 2449 moveal %a1,%a2
_ISR_Enable( level );
return;
}
the_watchdog->state = WATCHDOG_BEING_INSERTED;
_Watchdog_Sync_count++;
47c80: 23c0 0005 cdd4 movel %d0,5cdd4 <_Watchdog_Sync_count>
if ( the_watchdog->state != WATCHDOG_INACTIVE ) {
_ISR_Enable( level );
return;
}
the_watchdog->state = WATCHDOG_BEING_INSERTED;
47c86: 7001 moveq #1,%d0 47c88: 2140 0008 movel %d0,%a0@(8)
_Watchdog_Sync_count++;
restart:
delta_interval = the_watchdog->initial;
47c8c: 2028 000c movel %a0@(12),%d0
* cache *header!! * * Till Straumann, 7/2003 (gcc-3.2.2 -O4 on powerpc) * */ for ( after = (Watchdog_Control *) ((volatile Chain_Control *)header)->first ;
47c90: 2253 moveal %a3@,%a1
;
after = _Watchdog_Next( after ) ) {
if ( delta_interval == 0 || !_Watchdog_Next( after ) )
47c92: 4a80 tstl %d0 47c94: 673c beqs 47cd2 <_Watchdog_Insert+0x8a> 47c96: 4a91 tstl %a1@ 47c98: 6738 beqs 47cd2 <_Watchdog_Insert+0x8a>
break;
if ( delta_interval < after->delta_interval ) {
47c9a: 2629 0010 movel %a1@(16),%d3 47c9e: b680 cmpl %d0,%d3 47ca0: 6308 blss 47caa <_Watchdog_Insert+0x62>
after->delta_interval -= delta_interval;
47ca2: 9680 subl %d0,%d3 47ca4: 2343 0010 movel %d3,%a1@(16)
break;
47ca8: 6028 bras 47cd2 <_Watchdog_Insert+0x8a>
* used around this flash point allowed interrupts to execute
* which violated the design assumptions. The critical section
* mechanism used here WAS redesigned to address this.
*/
_ISR_Flash( level );
47caa: 280a movel %a2,%d4 47cac: 46c1 movew %d1,%sr 47cae: 8881 orl %d1,%d4 47cb0: 46c4 movew %d4,%sr
if ( delta_interval < after->delta_interval ) {
after->delta_interval -= delta_interval;
break;
}
delta_interval -= after->delta_interval;
47cb2: 9083 subl %d3,%d0
* mechanism used here WAS redesigned to address this.
*/
_ISR_Flash( level );
if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) {
47cb4: 7601 moveq #1,%d3 47cb6: b6a8 0008 cmpl %a0@(8),%d3 47cba: 663c bnes 47cf8 <_Watchdog_Insert+0xb0>
goto exit_insert;
}
if ( _Watchdog_Sync_level > insert_isr_nest_level ) {
47cbc: 2639 0005 cd4a movel 5cd4a <_Watchdog_Sync_level>,%d3 47cc2: b483 cmpl %d3,%d2 47cc4: 6408 bccs 47cce <_Watchdog_Insert+0x86>
_Watchdog_Sync_level = insert_isr_nest_level;
47cc6: 23c2 0005 cd4a movel %d2,5cd4a <_Watchdog_Sync_level>
goto restart;
47ccc: 60be bras 47c8c <_Watchdog_Insert+0x44>
RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_Next(
Watchdog_Control *the_watchdog
)
{
return ( (Watchdog_Control *) the_watchdog->Node.next );
47cce: 2251 moveal %a1@,%a1
}
}
47cd0: 60c0 bras 47c92 <_Watchdog_Insert+0x4a>
_Watchdog_Activate( the_watchdog );
the_watchdog->delta_interval = delta_interval;
_Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node );
47cd2: 2269 0004 moveal %a1@(4),%a1
the_watchdog->start_time = _Watchdog_Ticks_since_boot;
47cd6: 2639 0005 cdd8 movel 5cdd8 <_Watchdog_Ticks_since_boot>,%d3
)
{
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
47cdc: 2451 moveal %a1@,%a2
Chain_Node *the_node
)
{
Chain_Node *before_node;
the_node->previous = after_node;
47cde: 2149 0004 movel %a1,%a0@(4)
before_node = after_node->next; after_node->next = the_node;
47ce2: 2288 movel %a0,%a1@
}
}
_Watchdog_Activate( the_watchdog );
the_watchdog->delta_interval = delta_interval;
47ce4: 2140 0010 movel %d0,%a0@(16)
RTEMS_INLINE_ROUTINE void _Watchdog_Activate(
Watchdog_Control *the_watchdog
)
{
the_watchdog->state = WATCHDOG_ACTIVE;
47ce8: 7002 moveq #2,%d0
_Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node );
the_watchdog->start_time = _Watchdog_Ticks_since_boot;
47cea: 2143 0014 movel %d3,%a0@(20)
the_node->next = before_node; before_node->previous = the_node;
47cee: 2548 0004 movel %a0,%a2@(4) 47cf2: 2140 0008 movel %d0,%a0@(8)
Chain_Node *before_node;
the_node->previous = after_node;
before_node = after_node->next;
after_node->next = the_node;
the_node->next = before_node;
47cf6: 208a movel %a2,%a0@
exit_insert:
_Watchdog_Sync_level = insert_isr_nest_level;
47cf8: 23c2 0005 cd4a movel %d2,5cd4a <_Watchdog_Sync_level>
_Watchdog_Sync_count--;
47cfe: 2039 0005 cdd4 movel 5cdd4 <_Watchdog_Sync_count>,%d0 47d04: 5380 subql #1,%d0 47d06: 23c0 0005 cdd4 movel %d0,5cdd4 <_Watchdog_Sync_count>
_ISR_Enable( level );
47d0c: 46c1 movew %d1,%sr
}
47d0e: 4cd7 0c1c moveml %sp@,%d2-%d4/%a2-%a3 47d12: 4e5e unlk %fp 47d14: 4e75 rts
...
00047de0 <_Watchdog_Tickle>:
* See the comment in watchdoginsert.c and watchdogadjust.c
* about why it's safe not to declare header a pointer to
* volatile data - till, 2003/7
*/
_ISR_Disable( level );
47de0: 203c 0000 0700 movel #1792,%d0
*/
void _Watchdog_Tickle(
Chain_Control *header
)
{
47de6: 4e56 ffe8 linkw %fp,#-24 47dea: 48d7 3c0c moveml %d2-%d3/%a2-%a5,%sp@ 47dee: 286e 0008 moveal %fp@(8),%a4
* See the comment in watchdoginsert.c and watchdogadjust.c
* about why it's safe not to declare header a pointer to
* volatile data - till, 2003/7
*/
_ISR_Disable( level );
47df2: 40c2 movew %sr,%d2 47df4: 8082 orl %d2,%d0 47df6: 46c0 movew %d0,%sr
*/
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
Chain_Control *the_chain
)
{
return (the_chain->first == _Chain_Tail(the_chain));
47df8: 264c moveal %a4,%a3 47dfa: 245b moveal %a3@+,%a2
if ( _Chain_Is_empty( header ) )
47dfc: b7ca cmpal %a2,%a3 47dfe: 674e beqs 47e4e <_Watchdog_Tickle+0x6e>
* to be inserted has already had its delta_interval adjusted to 0, and
* so is added to the head of the chain with a delta_interval of 0.
*
* Steven Johnson - 12/2005 (gcc-3.2.3 -O3 on powerpc)
*/
if (the_watchdog->delta_interval != 0) {
47e00: 202a 0010 movel %a2@(16),%d0 47e04: 6708 beqs 47e0e <_Watchdog_Tickle+0x2e>
the_watchdog->delta_interval--;
47e06: 5380 subql #1,%d0 47e08: 2540 0010 movel %d0,%a2@(16)
if ( the_watchdog->delta_interval != 0 )
47e0c: 6640 bnes 47e4e <_Watchdog_Tickle+0x6e>
goto leave;
}
do {
watchdog_state = _Watchdog_Remove( the_watchdog );
47e0e: 4bf9 0004 7d64 lea 47d64 <_Watchdog_Remove>,%a5
case WATCHDOG_REMOVE_IT:
break;
}
_ISR_Disable( level );
47e14: 263c 0000 0700 movel #1792,%d3
if ( the_watchdog->delta_interval != 0 )
goto leave;
}
do {
watchdog_state = _Watchdog_Remove( the_watchdog );
47e1a: 2f0a movel %a2,%sp@- 47e1c: 4e95 jsr %a5@
_ISR_Enable( level );
47e1e: 46c2 movew %d2,%sr
switch( watchdog_state ) {
47e20: 7202 moveq #2,%d1 47e22: 588f addql #4,%sp 47e24: b280 cmpl %d0,%d1 47e26: 6610 bnes 47e38 <_Watchdog_Tickle+0x58>
case WATCHDOG_ACTIVE:
(*the_watchdog->routine)(
47e28: 2f2a 0024 movel %a2@(36),%sp@- 47e2c: 2f2a 0020 movel %a2@(32),%sp@- 47e30: 206a 001c moveal %a2@(28),%a0 47e34: 4e90 jsr %a0@ 47e36: 508f addql #8,%sp
case WATCHDOG_REMOVE_IT:
break;
}
_ISR_Disable( level );
47e38: 2003 movel %d3,%d0 47e3a: 40c2 movew %sr,%d2 47e3c: 8082 orl %d2,%d0 47e3e: 46c0 movew %d0,%sr
RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First(
Chain_Control *header
)
{
return ( (Watchdog_Control *) header->first );
47e40: 2014 movel %a4@,%d0 47e42: 2440 moveal %d0,%a2
the_watchdog = _Watchdog_First( header );
} while ( !_Chain_Is_empty( header ) &&
(the_watchdog->delta_interval == 0) );
47e44: b7c0 cmpal %d0,%a3 47e46: 6706 beqs 47e4e <_Watchdog_Tickle+0x6e> 47e48: 4aaa 0010 tstl %a2@(16) 47e4c: 67cc beqs 47e1a <_Watchdog_Tickle+0x3a>
leave:
_ISR_Enable(level);
47e4e: 46c2 movew %d2,%sr
}
47e50: 4cee 3c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a5 47e56: 4e5e unlk %fp 47e58: 4e75 rts
...
0005a41c <_execve>:
int _execve(
const char *path __attribute__((unused)),
char *const argv[] __attribute__((unused)),
char *const envp[] __attribute__((unused))
)
{
5a41c: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
5a420: 4eb9 0004 d430 jsr 4d430 <__errno> 5a426: 7258 moveq #88,%d1 5a428: 2040 moveal %d0,%a0
}
5a42a: 70ff moveq #-1,%d0 5a42c: 4e5e unlk %fp
const char *path __attribute__((unused)),
char *const argv[] __attribute__((unused)),
char *const envp[] __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
5a42e: 2081 movel %d1,%a0@
}
5a430: 4e75 rts
...
00044e40 <aio_cancel>:
int aio_cancel(
int filedes __attribute__((unused)),
struct aiocb *aiocbp __attribute__((unused))
)
{
44e40: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44e44: 4eb9 0004 d430 jsr 4d430 <__errno> 44e4a: 7258 moveq #88,%d1 44e4c: 2040 moveal %d0,%a0
}
44e4e: 70ff moveq #-1,%d0 44e50: 4e5e unlk %fp
int aio_cancel(
int filedes __attribute__((unused)),
struct aiocb *aiocbp __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44e52: 2081 movel %d1,%a0@
}
44e54: 4e75 rts
...
00044e58 <aio_error>:
#include <rtems/seterr.h>
int aio_error(
const struct aiocb *aiocbp __attribute__((unused))
)
{
44e58: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44e5c: 4eb9 0004 d430 jsr 4d430 <__errno> 44e62: 7258 moveq #88,%d1 44e64: 2040 moveal %d0,%a0
}
44e66: 70ff moveq #-1,%d0 44e68: 4e5e unlk %fp
int aio_error(
const struct aiocb *aiocbp __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44e6a: 2081 movel %d1,%a0@
}
44e6c: 4e75 rts
...
00044e70 <aio_fsync>:
int aio_fsync(
int op __attribute__((unused)),
struct aiocb *aiocbp __attribute__((unused))
)
{
44e70: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44e74: 4eb9 0004 d430 jsr 4d430 <__errno> 44e7a: 7258 moveq #88,%d1 44e7c: 2040 moveal %d0,%a0
}
44e7e: 70ff moveq #-1,%d0 44e80: 4e5e unlk %fp
int aio_fsync(
int op __attribute__((unused)),
struct aiocb *aiocbp __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44e82: 2081 movel %d1,%a0@
}
44e84: 4e75 rts
...
00044e88 <aio_read>:
#include <rtems/seterr.h>
int aio_read(
struct aiocb *aiocbp __attribute__((unused))
)
{
44e88: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44e8c: 4eb9 0004 d430 jsr 4d430 <__errno> 44e92: 7258 moveq #88,%d1 44e94: 2040 moveal %d0,%a0
}
44e96: 70ff moveq #-1,%d0 44e98: 4e5e unlk %fp
int aio_read(
struct aiocb *aiocbp __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44e9a: 2081 movel %d1,%a0@
}
44e9c: 4e75 rts
...
00044ea0 <aio_return>:
#include <rtems/seterr.h>
int aio_return(
const struct aiocb *aiocbp __attribute__((unused))
)
{
44ea0: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44ea4: 4eb9 0004 d430 jsr 4d430 <__errno> 44eaa: 7258 moveq #88,%d1 44eac: 2040 moveal %d0,%a0
}
44eae: 70ff moveq #-1,%d0 44eb0: 4e5e unlk %fp
int aio_return(
const struct aiocb *aiocbp __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44eb2: 2081 movel %d1,%a0@
}
44eb4: 4e75 rts
...
00044eb8 <aio_suspend>:
int aio_suspend(
const struct aiocb * const list[] __attribute__((unused)),
int nent __attribute__((unused)),
const struct timespec *timeout __attribute__((unused))
)
{
44eb8: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44ebc: 4eb9 0004 d430 jsr 4d430 <__errno> 44ec2: 7258 moveq #88,%d1 44ec4: 2040 moveal %d0,%a0
}
44ec6: 70ff moveq #-1,%d0 44ec8: 4e5e unlk %fp
const struct aiocb * const list[] __attribute__((unused)),
int nent __attribute__((unused)),
const struct timespec *timeout __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44eca: 2081 movel %d1,%a0@
}
44ecc: 4e75 rts
...
00044ed0 <aio_write>:
#include <rtems/seterr.h>
int aio_write(
struct aiocb *aiocbp __attribute__((unused))
)
{
44ed0: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44ed4: 4eb9 0004 d430 jsr 4d430 <__errno> 44eda: 7258 moveq #88,%d1 44edc: 2040 moveal %d0,%a0
}
44ede: 70ff moveq #-1,%d0 44ee0: 4e5e unlk %fp
int aio_write(
struct aiocb *aiocbp __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44ee2: 2081 movel %d1,%a0@
}
44ee4: 4e75 rts
...
00044ee8 <clock_getcpuclockid>:
int clock_getcpuclockid(
pid_t pid,
clockid_t *clock_id
)
{
44ee8: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44eec: 4eb9 0004 d430 jsr 4d430 <__errno> 44ef2: 7258 moveq #88,%d1 44ef4: 2040 moveal %d0,%a0
}
44ef6: 70ff moveq #-1,%d0 44ef8: 4e5e unlk %fp
int clock_getcpuclockid(
pid_t pid,
clockid_t *clock_id
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44efa: 2081 movel %d1,%a0@
}
44efc: 4e75 rts
...
00044f00 <clock_getenable_attr>:
int clock_getenable_attr(
clockid_t clock_id,
int *attr
)
{
44f00: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44f04: 4eb9 0004 d430 jsr 4d430 <__errno> 44f0a: 7258 moveq #88,%d1 44f0c: 2040 moveal %d0,%a0
}
44f0e: 70ff moveq #-1,%d0 44f10: 4e5e unlk %fp
int clock_getenable_attr(
clockid_t clock_id,
int *attr
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44f12: 2081 movel %d1,%a0@
}
44f14: 4e75 rts
...
00044f18 <clock_setenable_attr>:
int clock_setenable_attr(
clockid_t clock_id,
int attr
)
{
44f18: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44f1c: 4eb9 0004 d430 jsr 4d430 <__errno> 44f22: 7258 moveq #88,%d1 44f24: 2040 moveal %d0,%a0
}
44f26: 70ff moveq #-1,%d0 44f28: 4e5e unlk %fp
int clock_setenable_attr(
clockid_t clock_id,
int attr
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44f2a: 2081 movel %d1,%a0@
}
44f2c: 4e75 rts
...
00044f30 <devctl>:
int filedes __attribute__((unused)),
void *dev_data_ptr __attribute__((unused)),
size_t nbyte __attribute__((unused)),
int *dev_info_ptr __attribute__((unused))
)
{
44f30: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44f34: 4eb9 0004 d430 jsr 4d430 <__errno> 44f3a: 7258 moveq #88,%d1 44f3c: 2040 moveal %d0,%a0
}
44f3e: 70ff moveq #-1,%d0 44f40: 4e5e unlk %fp
void *dev_data_ptr __attribute__((unused)),
size_t nbyte __attribute__((unused)),
int *dev_info_ptr __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44f42: 2081 movel %d1,%a0@
}
44f44: 4e75 rts
...
00044f48 <fork>:
#include <errno.h>
#include <rtems/seterr.h>
int fork( void )
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44f48: 4e56 0000 linkw %fp,#0 44f4c: 4eb9 0004 d430 jsr 4d430 <__errno> 44f52: 7258 moveq #88,%d1 44f54: 2040 moveal %d0,%a0
}
44f56: 70ff moveq #-1,%d0 44f58: 4e5e unlk %fp
#include <errno.h>
#include <rtems/seterr.h>
int fork( void )
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44f5a: 2081 movel %d1,%a0@
}
44f5c: 4e75 rts
...
00044bc0 <getitimer>:
int getitimer(
int which,
struct itimerval *value
)
{
44bc0: 4e56 0000 linkw %fp,#0
if ( !value )
44bc4: 4aae 000c tstl %fp@(12) 44bc8: 660e bnes 44bd8 <getitimer+0x18>
rtems_set_errno_and_return_minus_one( EFAULT );
44bca: 4eb9 0004 d024 jsr 4d024 <__errno> 44bd0: 2040 moveal %d0,%a0 44bd2: 700e moveq #14,%d0 44bd4: 2080 movel %d0,%a0@ 44bd6: 6020 bras 44bf8 <getitimer+0x38> 44bd8: 41f9 0004 d024 lea 4d024 <__errno>,%a0
switch ( which ) {
44bde: 7002 moveq #2,%d0 44be0: b0ae 0008 cmpl %fp@(8),%d0 44be4: 650a bcss 44bf0 <getitimer+0x30>
case ITIMER_REAL:
case ITIMER_VIRTUAL:
case ITIMER_PROF:
rtems_set_errno_and_return_minus_one( ENOSYS );
44be6: 4e90 jsr %a0@ 44be8: 7258 moveq #88,%d1 44bea: 2040 moveal %d0,%a0 44bec: 2081 movel %d1,%a0@ 44bee: 6008 bras 44bf8 <getitimer+0x38>
default:
break;
}
rtems_set_errno_and_return_minus_one( EINVAL );
44bf0: 4e90 jsr %a0@ 44bf2: 2040 moveal %d0,%a0 44bf4: 7016 moveq #22,%d0 44bf6: 2080 movel %d0,%a0@
}
44bf8: 70ff moveq #-1,%d0 44bfa: 4e5e unlk %fp 44bfc: 4e75 rts
...
00044f60 <lio_listio>:
int mode __attribute__((unused)),
struct aiocb * const list[] __attribute__((unused)),
int nent __attribute__((unused)),
struct sigevent *sig __attribute__((unused))
)
{
44f60: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44f64: 4eb9 0004 d430 jsr 4d430 <__errno> 44f6a: 7258 moveq #88,%d1 44f6c: 2040 moveal %d0,%a0
}
44f6e: 70ff moveq #-1,%d0 44f70: 4e5e unlk %fp
struct aiocb * const list[] __attribute__((unused)),
int nent __attribute__((unused)),
struct sigevent *sig __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44f72: 2081 movel %d1,%a0@
}
44f74: 4e75 rts
...
00044f78 <mprotect>:
const void *addr __attribute__((unused)),
size_t len __attribute__((unused)),
int prot __attribute__((unused)) )
{
return 0;
}
44f78: 4280 clrl %d0
int mprotect(
const void *addr __attribute__((unused)),
size_t len __attribute__((unused)),
int prot __attribute__((unused)) )
{
44f7a: 4e56 0000 linkw %fp,#0
return 0; }
44f7e: 4e5e unlk %fp 44f80: 4e75 rts
...
000490bc <mq_close>:
*/
int mq_close(
mqd_t mqdes
)
{
490bc: 4e56 fffc linkw %fp,#-4 490c0: 2f0a movel %a2,%sp@-
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(
490c2: 486e fffc pea %fp@(-4) 490c6: 2f2e 0008 movel %fp@(8),%sp@- 490ca: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 490d0: 4eb9 0004 c188 jsr 4c188 <_Objects_Get>
POSIX_Message_queue_Control *the_mq;
POSIX_Message_queue_Control_fd *the_mq_fd;
Objects_Locations location;
the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location );
if ( location == OBJECTS_LOCAL ) {
490d6: 4fef 000c lea %sp@(12),%sp 490da: 2440 moveal %d0,%a2 490dc: 4aae fffc tstl %fp@(-4) 490e0: 663a bnes 4911c <mq_close+0x60>
* First update the actual message queue to reflect this descriptor
* being disassociated. This may result in the queue being really
* deleted.
*/
the_mq = the_mq_fd->Queue;
490e2: 206a 0010 moveal %a2@(16),%a0
the_mq->open_count -= 1;
490e6: 53a8 0016 subql #1,%a0@(22)
_POSIX_Message_queue_Delete( the_mq );
490ea: 2f08 movel %a0,%sp@- 490ec: 4eb9 0004 9134 jsr 49134 <_POSIX_Message_queue_Delete>
/*
* Now close this file descriptor.
*/
_Objects_Close(
490f2: 2f0a movel %a2,%sp@- 490f4: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 490fa: 4eb9 0004 bdbc jsr 4bdbc <_Objects_Close>
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 );
49100: 2f0a movel %a2,%sp@- 49102: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 49108: 4eb9 0004 c030 jsr 4c030 <_Objects_Free>
&_POSIX_Message_queue_Information_fds, &the_mq_fd->Object );
_POSIX_Message_queue_Free_fd( the_mq_fd );
_Thread_Enable_dispatch();
4910e: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch>
return 0;
49114: 4fef 0014 lea %sp@(20),%sp
_Objects_Close(
&_POSIX_Message_queue_Information_fds, &the_mq_fd->Object );
_POSIX_Message_queue_Free_fd( the_mq_fd );
_Thread_Enable_dispatch();
49118: 4280 clrl %d0
return 0;
4911a: 600e bras 4912a <mq_close+0x6e>
/*
* OBJECTS_REMOTE:
* OBJECTS_ERROR:
*/
rtems_set_errno_and_return_minus_one( EBADF );
4911c: 4eb9 0005 2858 jsr 52858 <__errno> 49122: 7209 moveq #9,%d1 49124: 2040 moveal %d0,%a0 49126: 70ff moveq #-1,%d0 49128: 2081 movel %d1,%a0@
}
4912a: 246e fff8 moveal %fp@(-8),%a2 4912e: 4e5e unlk %fp 49130: 4e75 rts
...
00049184 <mq_getattr>:
int mq_getattr(
mqd_t mqdes,
struct mq_attr *mqstat
)
{
49184: 4e56 fffc linkw %fp,#-4 49188: 2f0a movel %a2,%sp@- 4918a: 246e 000c moveal %fp@(12),%a2
POSIX_Message_queue_Control *the_mq;
POSIX_Message_queue_Control_fd *the_mq_fd;
Objects_Locations location;
CORE_message_queue_Attributes *the_mq_attr;
if ( !mqstat )
4918e: 4a8a tstl %a2 49190: 6610 bnes 491a2 <mq_getattr+0x1e>
rtems_set_errno_and_return_minus_one( EINVAL );
49192: 4eb9 0005 2858 jsr 52858 <__errno> 49198: 72ff moveq #-1,%d1 4919a: 2040 moveal %d0,%a0 4919c: 7016 moveq #22,%d0 4919e: 2080 movel %d0,%a0@ 491a0: 6052 bras 491f4 <mq_getattr+0x70>
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(
491a2: 486e fffc pea %fp@(-4) 491a6: 2f2e 0008 movel %fp@(8),%sp@- 491aa: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 491b0: 4eb9 0004 c188 jsr 4c188 <_Objects_Get>
the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location );
switch ( location ) {
491b6: 4fef 000c lea %sp@(12),%sp 491ba: 4aae fffc tstl %fp@(-4) 491be: 6626 bnes 491e6 <mq_getattr+0x62>
* Return the old values.
*/
the_mq_attr = &the_mq->Message_queue.Attributes;
mqstat->mq_flags = the_mq_fd->oflag;
491c0: 2240 moveal %d0,%a1 491c2: 24a9 0014 movel %a1@(20),%a2@
the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location );
switch ( location ) {
case OBJECTS_LOCAL:
the_mq = the_mq_fd->Queue;
491c6: 2069 0010 moveal %a1@(16),%a0
*/
the_mq_attr = &the_mq->Message_queue.Attributes;
mqstat->mq_flags = the_mq_fd->oflag;
mqstat->mq_msgsize = the_mq->Message_queue.maximum_message_size;
491ca: 2568 0066 0008 movel %a0@(102),%a2@(8)
mqstat->mq_maxmsg = the_mq->Message_queue.maximum_pending_messages;
491d0: 2568 005e 0004 movel %a0@(94),%a2@(4)
mqstat->mq_curmsgs = the_mq->Message_queue.number_of_pending_messages;
491d6: 2568 0062 000c movel %a0@(98),%a2@(12)
_Thread_Enable_dispatch();
491dc: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> 491e2: 4281 clrl %d1
return 0;
491e4: 600e bras 491f4 <mq_getattr+0x70>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EBADF );
491e6: 4eb9 0005 2858 jsr 52858 <__errno> 491ec: 72ff moveq #-1,%d1 491ee: 2040 moveal %d0,%a0 491f0: 7009 moveq #9,%d0 491f2: 2080 movel %d0,%a0@
}
491f4: 246e fff8 moveal %fp@(-8),%a2 491f8: 2001 movel %d1,%d0 491fa: 4e5e unlk %fp 491fc: 4e75 rts
...
000492e0 <mq_open>:
int oflag,
...
/* mode_t mode, */
/* struct mq_attr attr */
)
{
492e0: 4e56 ffdc linkw %fp,#-36
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
492e4: 2039 0006 4bb0 movel 64bb0 <_Thread_Dispatch_disable_level>,%d0 492ea: 5280 addql #1,%d0 492ec: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 492f0: 23c0 0006 4bb0 movel %d0,64bb0 <_Thread_Dispatch_disable_level> 492f6: 262e 0008 movel %fp@(8),%d3 492fa: 242e 000c movel %fp@(12),%d2
POSIX_Message_queue_Control_fd *the_mq_fd;
Objects_Locations location;
_Thread_Disable_dispatch();
if ( oflag & O_CREAT ) {
492fe: 2a02 movel %d2,%d5 49300: 0285 0000 0200 andil #512,%d5 49306: 6604 bnes 4930c <mq_open+0x2c> 49308: 4284 clrl %d4 4930a: 6004 bras 49310 <mq_open+0x30>
va_start(arg, oflag);
mode = (mode_t) va_arg( arg, unsigned int );
attr = (struct mq_attr *) va_arg( arg, struct mq_attr * );
4930c: 282e 0014 movel %fp@(20),%d4
*/
RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd *
_POSIX_Message_queue_Allocate_fd( void )
{
return (POSIX_Message_queue_Control_fd *)
49310: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 49316: 4eb9 0004 bd3c jsr 4bd3c <_Objects_Allocate>
va_end(arg);
}
the_mq_fd = _POSIX_Message_queue_Allocate_fd();
if ( !the_mq_fd ) {
4931c: 588f addql #4,%sp 4931e: 2440 moveal %d0,%a2 49320: 4a80 tstl %d0 49322: 6618 bnes 4933c <mq_open+0x5c>
_Thread_Enable_dispatch();
49324: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( ENFILE );
4932a: 7417 moveq #23,%d2 4932c: 4eb9 0005 2858 jsr 52858 <__errno> 49332: 72ff moveq #-1,%d1 49334: 2040 moveal %d0,%a0 49336: 2082 movel %d2,%a0@ 49338: 6000 0120 braw 4945a <mq_open+0x17a>
} the_mq_fd->oflag = oflag;
4933c: 2542 0014 movel %d2,%a2@(20)
status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id );
49340: 486e fffc pea %fp@(-4) 49344: 2f03 movel %d3,%sp@- 49346: 4eb9 0004 f524 jsr 4f524 <_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 ) {
4934c: 508f addql #8,%sp
_Thread_Enable_dispatch();
rtems_set_errno_and_return_minus_one( ENFILE );
}
the_mq_fd->oflag = oflag;
status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id );
4934e: 2640 moveal %d0,%a3
* 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 ) {
49350: 4a80 tstl %d0 49352: 6732 beqs 49386 <mq_open+0xa6>
/*
* 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) ) ) {
49354: 7002 moveq #2,%d0 49356: b08b cmpl %a3,%d0 49358: 6606 bnes 49360 <mq_open+0x80> 4935a: 4a85 tstl %d5 4935c: 6600 00a4 bnew 49402 <mq_open+0x122>
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 );
49360: 2f0a movel %a2,%sp@- 49362: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 49368: 4eb9 0004 c030 jsr 4c030 <_Objects_Free>
_POSIX_Message_queue_Free_fd( the_mq_fd );
_Thread_Enable_dispatch();
4936e: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one_cast( status, mqd_t );
49374: 4eb9 0005 2858 jsr 52858 <__errno> 4937a: 508f addql #8,%sp 4937c: 72ff moveq #-1,%d1 4937e: 2040 moveal %d0,%a0 49380: 208b movel %a3,%a0@ 49382: 6000 00d6 braw 4945a <mq_open+0x17a> 49386: 47f9 0004 c9da lea 4c9da <_Thread_Enable_dispatch>,%a3
} else { /* name -> ID translation succeeded */
/*
* Check for existence with creation.
*/
if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) {
4938c: 0282 0000 0a00 andil #2560,%d2 49392: 0c82 0000 0a00 cmpil #2560,%d2 49398: 6624 bnes 493be <mq_open+0xde> 4939a: 2f0a movel %a2,%sp@- 4939c: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 493a2: 4eb9 0004 c030 jsr 4c030 <_Objects_Free>
_POSIX_Message_queue_Free_fd( the_mq_fd );
_Thread_Enable_dispatch();
493a8: 4e93 jsr %a3@
rtems_set_errno_and_return_minus_one_cast( EEXIST, mqd_t );
493aa: 4eb9 0005 2858 jsr 52858 <__errno> 493b0: 508f addql #8,%sp 493b2: 72ff moveq #-1,%d1 493b4: 2040 moveal %d0,%a0 493b6: 7011 moveq #17,%d0 493b8: 2080 movel %d0,%a0@ 493ba: 6000 009e braw 4945a <mq_open+0x17a>
RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control *_POSIX_Message_queue_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (POSIX_Message_queue_Control *)
493be: 486e fff4 pea %fp@(-12) 493c2: 2f2e fffc movel %fp@(-4),%sp@- 493c6: 4879 0006 4e7e pea 64e7e <_POSIX_Message_queue_Information> 493cc: 4eb9 0004 c188 jsr 4c188 <_Objects_Get>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
493d2: 4281 clrl %d1
/*
* 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;
493d4: 2040 moveal %d0,%a0 493d6: 52a8 0016 addql #1,%a0@(22) 493da: 2079 0006 5004 moveal 65004 <_POSIX_Message_queue_Information_fds+0x18>,%a0 493e0: 322a 000a movew %a2@(10),%d1
/*
* 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 );
493e4: 2d40 fff8 movel %d0,%fp@(-8) 493e8: 218a 1c00 movel %a2,%a0@(00000000,%d1:l:4)
the_mq->open_count += 1;
the_mq_fd->Queue = the_mq;
493ec: 2540 0010 movel %d0,%a2@(16)
the_object
);
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
/* ASSERT: information->is_string */
the_object->name.name_p = name;
493f0: 42aa 000c clrl %a2@(12)
_Objects_Open_string(
&_POSIX_Message_queue_Information_fds,
&the_mq_fd->Object,
NULL
);
_Thread_Enable_dispatch();
493f4: 4e93 jsr %a3@
_Thread_Enable_dispatch();
493f6: 4e93 jsr %a3@
return (mqd_t)the_mq_fd->Object.id;
493f8: 222a 0008 movel %a2@(8),%d1 493fc: 4fef 000c lea %sp@(12),%sp 49400: 6058 bras 4945a <mq_open+0x17a>
/*
* 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(
49402: 486e fff8 pea %fp@(-8) 49406: 47f9 0004 c9da lea 4c9da <_Thread_Enable_dispatch>,%a3 4940c: 2f04 movel %d4,%sp@- 4940e: 4878 0001 pea 1 <ADD> 49412: 2f03 movel %d3,%sp@- 49414: 4eb9 0004 f3b0 jsr 4f3b0 <_POSIX_Message_queue_Create_support>
);
/*
* errno was set by Create_support, so don't set it again.
*/
if ( status == -1 ) {
4941a: 4fef 0010 lea %sp@(16),%sp 4941e: 72ff moveq #-1,%d1 49420: b280 cmpl %d0,%d1 49422: 6616 bnes 4943a <mq_open+0x15a>
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 );
49424: 2f0a movel %a2,%sp@- 49426: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 4942c: 4eb9 0004 c030 jsr 4c030 <_Objects_Free>
_POSIX_Message_queue_Free_fd( the_mq_fd );
_Thread_Enable_dispatch();
49432: 4e93 jsr %a3@
return (mqd_t) -1;
49434: 508f addql #8,%sp
/*
* 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();
49436: 72ff moveq #-1,%d1
return (mqd_t) -1;
49438: 6020 bras 4945a <mq_open+0x17a>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4943a: 4280 clrl %d0 4943c: 2079 0006 5004 moveal 65004 <_POSIX_Message_queue_Information_fds+0x18>,%a0 49442: 302a 000a movew %a2@(10),%d0
}
the_mq_fd->Queue = the_mq;
49446: 256e fff8 0010 movel %fp@(-8),%a2@(16) 4944c: 218a 0c00 movel %a2,%a0@(00000000,%d0:l:4)
the_object
);
#if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES)
/* ASSERT: information->is_string */
the_object->name.name_p = name;
49450: 42aa 000c clrl %a2@(12)
&_POSIX_Message_queue_Information_fds,
&the_mq_fd->Object,
NULL
);
_Thread_Enable_dispatch();
49454: 4e93 jsr %a3@
return (mqd_t) the_mq_fd->Object.id;
49456: 222a 0008 movel %a2@(8),%d1
}
4945a: 2001 movel %d1,%d0 4945c: 4cee 0c3c ffdc moveml %fp@(-36),%d2-%d5/%a2-%a3 49462: 4e5e unlk %fp 49464: 4e75 rts
...
000497d0 <mq_unlink>:
*/
int mq_unlink(
const char *name
)
{
497d0: 4e56 fff0 linkw %fp,#-16 497d4: 2039 0006 4bb0 movel 64bb0 <_Thread_Dispatch_disable_level>,%d0 497da: 5280 addql #1,%d0 497dc: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 497e0: 23c0 0006 4bb0 movel %d0,64bb0 <_Thread_Dispatch_disable_level>
register POSIX_Message_queue_Control *the_mq;
Objects_Id the_mq_id;
_Thread_Disable_dispatch();
status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id );
497e6: 486e fffc pea %fp@(-4) 497ea: 45f9 0004 c9da lea 4c9da <_Thread_Enable_dispatch>,%a2 497f0: 2f2e 0008 movel %fp@(8),%sp@- 497f4: 4eb9 0004 f524 jsr 4f524 <_POSIX_Message_queue_Name_to_id>
if ( status != 0 ) {
497fa: 508f addql #8,%sp
register POSIX_Message_queue_Control *the_mq;
Objects_Id the_mq_id;
_Thread_Disable_dispatch();
status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id );
497fc: 2400 movel %d0,%d2
if ( status != 0 ) {
497fe: 6710 beqs 49810 <mq_unlink+0x40>
_Thread_Enable_dispatch();
49800: 4e92 jsr %a2@
rtems_set_errno_and_return_minus_one( status );
49802: 4eb9 0005 2858 jsr 52858 <__errno> 49808: 2040 moveal %d0,%a0 4980a: 70ff moveq #-1,%d0 4980c: 2082 movel %d2,%a0@ 4980e: 6034 bras 49844 <mq_unlink+0x74>
}
the_mq = (POSIX_Message_queue_Control *) _Objects_Get_local_object(
49810: 4280 clrl %d0 49812: 2079 0006 4e96 moveal 64e96 <_POSIX_Message_queue_Information+0x18>,%a0 49818: 302e fffe movew %fp@(-2),%d0 4981c: 2670 0c00 moveal %a0@(00000000,%d0:l:4),%a3
&_POSIX_Message_queue_Information,
_Objects_Get_index( the_mq_id )
);
the_mq->linked = false;
49820: 4200 clrb %d0 49822: 1740 0015 moveb %d0,%a3@(21)
RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Namespace_remove (
POSIX_Message_queue_Control *the_mq
)
{
_Objects_Namespace_remove(
49826: 2f0b movel %a3,%sp@- 49828: 4879 0006 4e7e pea 64e7e <_POSIX_Message_queue_Information> 4982e: 4eb9 0004 c2e0 jsr 4c2e0 <_Objects_Namespace_remove>
_POSIX_Message_queue_Namespace_remove( the_mq ); _POSIX_Message_queue_Delete( the_mq );
49834: 2f0b movel %a3,%sp@- 49836: 4eb9 0004 9134 jsr 49134 <_POSIX_Message_queue_Delete>
_Thread_Enable_dispatch();
4983c: 4e92 jsr %a2@
return 0;
4983e: 4fef 000c lea %sp@(12),%sp
the_mq->linked = false;
_POSIX_Message_queue_Namespace_remove( the_mq );
_POSIX_Message_queue_Delete( the_mq );
_Thread_Enable_dispatch();
49842: 4280 clrl %d0
return 0; }
49844: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 4984a: 4e5e unlk %fp 4984c: 4e75 rts
...
00062240 <nanosleep>:
int nanosleep(
const struct timespec *rqtp,
struct timespec *rmtp
)
{
62240: 4e56 fff4 linkw %fp,#-12 62244: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 62248: 266e 0008 moveal %fp@(8),%a3 6224c: 246e 000c moveal %fp@(12),%a2
Watchdog_Interval ticks;
if ( !_Timespec_Is_valid( rqtp ) )
62250: 2f0b movel %a3,%sp@- 62252: 4eb9 0006 2390 jsr 62390 <_Timespec_Is_valid> 62258: 588f addql #4,%sp 6225a: 4a00 tstb %d0 6225c: 670a beqs 62268 <nanosleep+0x28>
* Return EINVAL if the delay interval is negative. * * NOTE: This behavior is beyond the POSIX specification. * FSU and GNU/Linux pthreads shares this behavior. */ if ( rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 )
6225e: 4a93 tstl %a3@ 62260: 6d06 blts 62268 <nanosleep+0x28> 62262: 4aab 0004 tstl %a3@(4) 62266: 6c12 bges 6227a <nanosleep+0x3a>
rtems_set_errno_and_return_minus_one( EINVAL );
62268: 4eb9 0005 3ac4 jsr 53ac4 <__errno> 6226e: 7416 moveq #22,%d2 62270: 72ff moveq #-1,%d1 62272: 2040 moveal %d0,%a0 62274: 2082 movel %d2,%a0@ 62276: 6000 00ce braw 62346 <nanosleep+0x106>
ticks = _Timespec_To_ticks( rqtp );
6227a: 2f0b movel %a3,%sp@- 6227c: 47f9 0004 a71e lea 4a71e <_Thread_Enable_dispatch>,%a3 62282: 4eb9 0005 0ce8 jsr 50ce8 <_Timespec_To_ticks>
* A nanosleep for zero time is implemented as a yield.
* This behavior is also beyond the POSIX specification but is
* consistent with the RTEMS API and yields desirable behavior.
*/
if ( !ticks ) {
62288: 588f addql #4,%sp
* FSU and GNU/Linux pthreads shares this behavior.
*/
if ( rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 )
rtems_set_errno_and_return_minus_one( EINVAL );
ticks = _Timespec_To_ticks( rqtp );
6228a: 2400 movel %d0,%d2
* A nanosleep for zero time is implemented as a yield.
* This behavior is also beyond the POSIX specification but is
* consistent with the RTEMS API and yields desirable behavior.
*/
if ( !ticks ) {
6228c: 6628 bnes 622b6 <nanosleep+0x76>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
6228e: 2039 0006 84ec movel 684ec <_Thread_Dispatch_disable_level>,%d0 62294: 5280 addql #1,%d0 62296: 23c0 0006 84ec movel %d0,684ec <_Thread_Dispatch_disable_level>
_Thread_Disable_dispatch();
_Thread_Yield_processor();
6229c: 4eb9 0004 b348 jsr 4b348 <_Thread_Yield_processor>
_Thread_Enable_dispatch();
622a2: 4e93 jsr %a3@
if ( rmtp ) {
622a4: 4a8a tstl %a2 622a6: 6700 009c beqw 62344 <nanosleep+0x104>
rmtp->tv_sec = 0;
rmtp->tv_nsec = 0;
622aa: 42aa 0004 clrl %a2@(4) 622ae: 4281 clrl %d1
if ( !ticks ) {
_Thread_Disable_dispatch();
_Thread_Yield_processor();
_Thread_Enable_dispatch();
if ( rmtp ) {
rmtp->tv_sec = 0;
622b0: 4292 clrl %a2@ 622b2: 6000 0092 braw 62346 <nanosleep+0x106> 622b6: 2039 0006 84ec movel 684ec <_Thread_Dispatch_disable_level>,%d0 622bc: 5280 addql #1,%d0 622be: 23c0 0006 84ec movel %d0,684ec <_Thread_Dispatch_disable_level>
/*
* Block for the desired amount of time
*/
_Thread_Disable_dispatch();
_Thread_Set_state(
622c4: 2f3c 1000 0008 movel #268435464,%sp@- 622ca: 2f39 0006 85a6 movel 685a6 <_Thread_Executing>,%sp@- 622d0: 4eb9 0004 af6c jsr 4af6c <_Thread_Set_state>
STATES_DELAYING | STATES_INTERRUPTIBLE_BY_SIGNAL
);
_Watchdog_Initialize(
&_Thread_Executing->Timer,
_Thread_Delay_ended,
_Thread_Executing->Object.id,
622d6: 2079 0006 85a6 moveal 685a6 <_Thread_Executing>,%a0
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
622dc: 203c 0004 a590 movel #304528,%d0 622e2: 2140 0064 movel %d0,%a0@(100)
_Thread_Disable_dispatch();
_Thread_Set_state(
_Thread_Executing,
STATES_DELAYING | STATES_INTERRUPTIBLE_BY_SIGNAL
);
_Watchdog_Initialize(
622e6: 2028 0008 movel %a0@(8),%d0
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
622ea: 42a8 0050 clrl %a0@(80)
the_watchdog->routine = routine; the_watchdog->id = id;
622ee: 2140 0068 movel %d0,%a0@(104)
the_watchdog->user_data = user_data;
622f2: 42a8 006c clrl %a0@(108)
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
622f6: 2142 0054 movel %d2,%a0@(84)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
622fa: 4868 0048 pea %a0@(72) 622fe: 4879 0006 85c4 pea 685c4 <_Watchdog_Ticks_chain> 62304: 4eb9 0004 b72c jsr 4b72c <_Watchdog_Insert>
_Thread_Delay_ended,
_Thread_Executing->Object.id,
NULL
);
_Watchdog_Insert_ticks( &_Thread_Executing->Timer, ticks );
_Thread_Enable_dispatch();
6230a: 4e93 jsr %a3@
/* calculate time remaining */
if ( rmtp ) {
6230c: 4fef 0010 lea %sp@(16),%sp 62310: 4a8a tstl %a2 62312: 6730 beqs 62344 <nanosleep+0x104>
ticks -=
_Thread_Executing->Timer.stop_time - _Thread_Executing->Timer.start_time;
62314: 2079 0006 85a6 moveal 685a6 <_Thread_Executing>,%a0
_Thread_Enable_dispatch();
/* calculate time remaining */
if ( rmtp ) {
ticks -=
6231a: 2028 005c movel %a0@(92),%d0 6231e: 90a8 0060 subl %a0@(96),%d0 62322: d480 addl %d0,%d2
_Thread_Executing->Timer.stop_time - _Thread_Executing->Timer.start_time;
_Timespec_From_ticks( ticks, rmtp );
62324: 2f0a movel %a2,%sp@- 62326: 2f02 movel %d2,%sp@- 62328: 4eb9 0006 2354 jsr 62354 <_Timespec_From_ticks>
*/
#if defined(RTEMS_POSIX_API)
/*
* If there is time remaining, then we were interrupted by a signal.
*/
if ( ticks )
6232e: 508f addql #8,%sp 62330: 4a82 tstl %d2 62332: 6710 beqs 62344 <nanosleep+0x104>
rtems_set_errno_and_return_minus_one( EINTR );
62334: 4eb9 0005 3ac4 jsr 53ac4 <__errno> 6233a: 72ff moveq #-1,%d1 6233c: 2040 moveal %d0,%a0 6233e: 7004 moveq #4,%d0 62340: 2080 movel %d0,%a0@ 62342: 6002 bras 62346 <nanosleep+0x106> 62344: 4281 clrl %d1
#endif
}
return 0;
}
62346: 2001 movel %d1,%d0 62348: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 6234e: 4e5e unlk %fp 62350: 4e75 rts
...
00046818 <pause>:
/*
* 3.4.2 Suspend Process Execution, P1003.1b-1993, p. 81
*/
int pause( void )
{
46818: 4e56 fffc linkw %fp,#-4 4681c: 2f02 movel %d2,%sp@-
sigset_t all_signals;
int status;
(void) sigfillset( &all_signals );
4681e: 240e movel %fp,%d2 46820: 5982 subql #4,%d2 46822: 2f02 movel %d2,%sp@- 46824: 4eb9 0004 729c jsr 4729c <sigfillset>
status = sigtimedwait( &all_signals, NULL, NULL );
4682a: 42a7 clrl %sp@- 4682c: 42a7 clrl %sp@- 4682e: 2f02 movel %d2,%sp@- 46830: 4eb9 0004 7414 jsr 47414 <sigtimedwait>
return status;
}
46836: 242e fff8 movel %fp@(-8),%d2 4683a: 4e5e unlk %fp 4683c: 4e75 rts
...
00044f84 <pthread_atfork>:
int pthread_atfork(
void (*prepare)(void) __attribute__((unused)),
void (*parent)(void) __attribute__((unused)),
void (*child)(void) __attribute__((unused))
)
{
44f84: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44f88: 4eb9 0004 d430 jsr 4d430 <__errno> 44f8e: 7258 moveq #88,%d1 44f90: 2040 moveal %d0,%a0
}
44f92: 70ff moveq #-1,%d0 44f94: 4e5e unlk %fp
void (*prepare)(void) __attribute__((unused)),
void (*parent)(void) __attribute__((unused)),
void (*child)(void) __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44f96: 2081 movel %d1,%a0@
}
44f98: 4e75 rts
...
000494bc <pthread_attr_getcputime>:
int pthread_attr_getcputime(
pthread_attr_t *attr,
int *clock_allowed
)
{
494bc: 4e56 0000 linkw %fp,#0 494c0: 206e 0008 moveal %fp@(8),%a0 494c4: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !clock_allowed )
494c8: 4a88 tstl %a0 494ca: 6710 beqs 494dc <pthread_attr_getcputime+0x20> 494cc: 4a90 tstl %a0@ 494ce: 670c beqs 494dc <pthread_attr_getcputime+0x20> 494d0: 4a89 tstl %a1 494d2: 6708 beqs 494dc <pthread_attr_getcputime+0x20>
return EINVAL;
*clock_allowed = attr->cputime_clock_allowed;
494d4: 22a8 0034 movel %a0@(52),%a1@ 494d8: 4280 clrl %d0
return 0;
494da: 6002 bras 494de <pthread_attr_getcputime+0x22> 494dc: 7016 moveq #22,%d0
}
494de: 4e5e unlk %fp 494e0: 4e75 rts
...
00048f74 <pthread_attr_getdetachstate>:
int pthread_attr_getdetachstate(
const pthread_attr_t *attr,
int *detachstate
)
{
48f74: 4e56 0000 linkw %fp,#0 48f78: 206e 0008 moveal %fp@(8),%a0 48f7c: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !detachstate )
48f80: 4a88 tstl %a0 48f82: 6710 beqs 48f94 <pthread_attr_getdetachstate+0x20> 48f84: 4a90 tstl %a0@ 48f86: 670c beqs 48f94 <pthread_attr_getdetachstate+0x20> 48f88: 4a89 tstl %a1 48f8a: 6708 beqs 48f94 <pthread_attr_getdetachstate+0x20>
return EINVAL;
*detachstate = attr->detachstate;
48f8c: 22a8 0038 movel %a0@(56),%a1@ 48f90: 4280 clrl %d0
return 0;
48f92: 6002 bras 48f96 <pthread_attr_getdetachstate+0x22> 48f94: 7016 moveq #22,%d0
}
48f96: 4e5e unlk %fp 48f98: 4e75 rts
...
00048f9c <pthread_attr_getinheritsched>:
int pthread_attr_getinheritsched(
const pthread_attr_t *attr,
int *inheritsched
)
{
48f9c: 4e56 0000 linkw %fp,#0 48fa0: 206e 0008 moveal %fp@(8),%a0 48fa4: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !inheritsched )
48fa8: 4a88 tstl %a0 48faa: 6710 beqs 48fbc <pthread_attr_getinheritsched+0x20> 48fac: 4a90 tstl %a0@ 48fae: 670c beqs 48fbc <pthread_attr_getinheritsched+0x20> 48fb0: 4a89 tstl %a1 48fb2: 6708 beqs 48fbc <pthread_attr_getinheritsched+0x20>
return EINVAL;
*inheritsched = attr->inheritsched;
48fb4: 22a8 0010 movel %a0@(16),%a1@ 48fb8: 4280 clrl %d0
return 0;
48fba: 6002 bras 48fbe <pthread_attr_getinheritsched+0x22> 48fbc: 7016 moveq #22,%d0
}
48fbe: 4e5e unlk %fp 48fc0: 4e75 rts
...
00048fc4 <pthread_attr_getschedparam>:
int pthread_attr_getschedparam(
const pthread_attr_t *attr,
struct sched_param *param
)
{
48fc4: 4e56 0000 linkw %fp,#0 48fc8: 206e 0008 moveal %fp@(8),%a0 48fcc: 202e 000c movel %fp@(12),%d0
if ( !attr || !attr->is_initialized || !param )
48fd0: 4a88 tstl %a0 48fd2: 6720 beqs 48ff4 <pthread_attr_getschedparam+0x30> 48fd4: 4a90 tstl %a0@ 48fd6: 671c beqs 48ff4 <pthread_attr_getschedparam+0x30> 48fd8: 4a80 tstl %d0 48fda: 6718 beqs 48ff4 <pthread_attr_getschedparam+0x30>
return EINVAL;
*param = attr->schedparam;
48fdc: 4878 001c pea 1c <OPER2+0x8> 48fe0: 4868 0018 pea %a0@(24) 48fe4: 2f00 movel %d0,%sp@- 48fe6: 4eb9 0005 2120 jsr 52120 <memcpy>
return 0;
48fec: 4fef 000c lea %sp@(12),%sp
)
{
if ( !attr || !attr->is_initialized || !param )
return EINVAL;
*param = attr->schedparam;
48ff0: 4280 clrl %d0
return 0;
48ff2: 6002 bras 48ff6 <pthread_attr_getschedparam+0x32> 48ff4: 7016 moveq #22,%d0
}
48ff6: 4e5e unlk %fp 48ff8: 4e75 rts
...
00048ffc <pthread_attr_getschedpolicy>:
int pthread_attr_getschedpolicy(
const pthread_attr_t *attr,
int *policy
)
{
48ffc: 4e56 0000 linkw %fp,#0 49000: 206e 0008 moveal %fp@(8),%a0 49004: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !policy )
49008: 4a88 tstl %a0 4900a: 6710 beqs 4901c <pthread_attr_getschedpolicy+0x20> 4900c: 4a90 tstl %a0@ 4900e: 670c beqs 4901c <pthread_attr_getschedpolicy+0x20> 49010: 4a89 tstl %a1 49012: 6708 beqs 4901c <pthread_attr_getschedpolicy+0x20>
return EINVAL;
*policy = attr->schedpolicy;
49014: 22a8 0014 movel %a0@(20),%a1@ 49018: 4280 clrl %d0
return 0;
4901a: 6002 bras 4901e <pthread_attr_getschedpolicy+0x22> 4901c: 7016 moveq #22,%d0
}
4901e: 4e5e unlk %fp 49020: 4e75 rts
...
00049024 <pthread_attr_getscope>:
int pthread_attr_getscope(
const pthread_attr_t *attr,
int *contentionscope
)
{
49024: 4e56 0000 linkw %fp,#0 49028: 206e 0008 moveal %fp@(8),%a0 4902c: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !contentionscope )
49030: 4a88 tstl %a0 49032: 6710 beqs 49044 <pthread_attr_getscope+0x20> 49034: 4a90 tstl %a0@ 49036: 670c beqs 49044 <pthread_attr_getscope+0x20> 49038: 4a89 tstl %a1 4903a: 6708 beqs 49044 <pthread_attr_getscope+0x20>
return EINVAL;
*contentionscope = attr->contentionscope;
4903c: 22a8 000c movel %a0@(12),%a1@ 49040: 4280 clrl %d0
return 0;
49042: 6002 bras 49046 <pthread_attr_getscope+0x22> 49044: 7016 moveq #22,%d0
}
49046: 4e5e unlk %fp 49048: 4e75 rts
...
0004904c <pthread_attr_getstackaddr>:
int pthread_attr_getstackaddr(
const pthread_attr_t *attr,
void **stackaddr
)
{
4904c: 4e56 0000 linkw %fp,#0 49050: 206e 0008 moveal %fp@(8),%a0 49054: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !stackaddr )
49058: 4a88 tstl %a0 4905a: 6710 beqs 4906c <pthread_attr_getstackaddr+0x20> 4905c: 4a90 tstl %a0@ 4905e: 670c beqs 4906c <pthread_attr_getstackaddr+0x20> 49060: 4a89 tstl %a1 49062: 6708 beqs 4906c <pthread_attr_getstackaddr+0x20>
return EINVAL;
*stackaddr = attr->stackaddr;
49064: 22a8 0004 movel %a0@(4),%a1@ 49068: 4280 clrl %d0
return 0;
4906a: 6002 bras 4906e <pthread_attr_getstackaddr+0x22> 4906c: 7016 moveq #22,%d0
}
4906e: 4e5e unlk %fp 49070: 4e75 rts
...
00049074 <pthread_attr_getstacksize>:
int pthread_attr_getstacksize(
const pthread_attr_t *attr,
size_t *stacksize
)
{
49074: 4e56 0000 linkw %fp,#0 49078: 206e 0008 moveal %fp@(8),%a0 4907c: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !stacksize )
49080: 4a88 tstl %a0 49082: 6710 beqs 49094 <pthread_attr_getstacksize+0x20> 49084: 4a90 tstl %a0@ 49086: 670c beqs 49094 <pthread_attr_getstacksize+0x20> 49088: 4a89 tstl %a1 4908a: 6708 beqs 49094 <pthread_attr_getstacksize+0x20>
return EINVAL;
*stacksize = attr->stacksize;
4908c: 22a8 0008 movel %a0@(8),%a1@ 49090: 4280 clrl %d0
return 0;
49092: 6002 bras 49096 <pthread_attr_getstacksize+0x22> 49094: 7016 moveq #22,%d0
}
49096: 4e5e unlk %fp 49098: 4e75 rts
...
0004a98c <pthread_attr_setinheritsched>:
int pthread_attr_setinheritsched(
pthread_attr_t *attr,
int inheritsched
)
{
4a98c: 4e56 0000 linkw %fp,#0 4a990: 206e 0008 moveal %fp@(8),%a0 4a994: 222e 000c movel %fp@(12),%d1 4a998: 2f02 movel %d2,%sp@-
if ( !attr || !attr->is_initialized )
4a99a: 4a88 tstl %a0 4a99c: 671c beqs 4a9ba <pthread_attr_setinheritsched+0x2e> 4a99e: 4a90 tstl %a0@ 4a9a0: 6718 beqs 4a9ba <pthread_attr_setinheritsched+0x2e>
return EINVAL;
switch ( inheritsched ) {
4a9a2: 2241 moveal %d1,%a1 4a9a4: 5389 subql #1,%a1 4a9a6: 203c 0000 0086 movel #134,%d0 4a9ac: 7401 moveq #1,%d2 4a9ae: b489 cmpl %a1,%d2 4a9b0: 650a bcss 4a9bc <pthread_attr_setinheritsched+0x30>
case PTHREAD_INHERIT_SCHED:
case PTHREAD_EXPLICIT_SCHED:
attr->inheritsched = inheritsched;
4a9b2: 2141 0010 movel %d1,%a0@(16) 4a9b6: 4200 clrb %d0
return 0;
4a9b8: 6002 bras 4a9bc <pthread_attr_setinheritsched+0x30> 4a9ba: 7016 moveq #22,%d0
default:
return ENOTSUP;
}
}
4a9bc: 241f movel %sp@+,%d2 4a9be: 4e5e unlk %fp 4a9c0: 4e75 rts
...
00049128 <pthread_attr_setschedparam>:
int pthread_attr_setschedparam(
pthread_attr_t *attr,
const struct sched_param *param
)
{
49128: 4e56 0000 linkw %fp,#0 4912c: 206e 0008 moveal %fp@(8),%a0 49130: 202e 000c movel %fp@(12),%d0
if ( !attr || !attr->is_initialized || !param )
49134: 4a88 tstl %a0 49136: 6720 beqs 49158 <pthread_attr_setschedparam+0x30> 49138: 4a90 tstl %a0@ 4913a: 671c beqs 49158 <pthread_attr_setschedparam+0x30> 4913c: 4a80 tstl %d0 4913e: 6718 beqs 49158 <pthread_attr_setschedparam+0x30>
return EINVAL;
attr->schedparam = *param;
49140: 4878 001c pea 1c <OPER2+0x8> 49144: 2f00 movel %d0,%sp@- 49146: 4868 0018 pea %a0@(24) 4914a: 4eb9 0005 2120 jsr 52120 <memcpy>
return 0;
49150: 4fef 000c lea %sp@(12),%sp
)
{
if ( !attr || !attr->is_initialized || !param )
return EINVAL;
attr->schedparam = *param;
49154: 4280 clrl %d0
return 0;
49156: 6002 bras 4915a <pthread_attr_setschedparam+0x32> 49158: 7016 moveq #22,%d0
}
4915a: 4e5e unlk %fp 4915c: 4e75 rts
...
000452b4 <pthread_barrier_init>:
int pthread_barrier_init(
pthread_barrier_t *barrier,
const pthread_barrierattr_t *attr,
unsigned int count
)
{
452b4: 4e56 ffe0 linkw %fp,#-32 452b8: 206e 000c moveal %fp@(12),%a0 452bc: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 452c0: 266e 0008 moveal %fp@(8),%a3 452c4: 246e 0010 moveal %fp@(16),%a2
const pthread_barrierattr_t *the_attr;
/*
* Error check parameters
*/
if ( !barrier )
452c8: 4a8b tstl %a3 452ca: 6700 008e beqw 4535a <pthread_barrier_init+0xa6>
return EINVAL;
if ( count == 0 )
452ce: 4a8a tstl %a2 452d0: 6700 0088 beqw 4535a <pthread_barrier_init+0xa6>
return EINVAL;
/*
* If the user passed in NULL, use the default attributes
*/
if ( attr ) {
452d4: 4a88 tstl %a0 452d6: 6614 bnes 452ec <pthread_barrier_init+0x38>
the_attr = attr;
} else {
(void) pthread_barrierattr_init( &my_attr );
452d8: 240e movel %fp,%d2 452da: 0682 ffff fff0 addil #-16,%d2 452e0: 2f02 movel %d2,%sp@- 452e2: 4eb9 0004 51f8 jsr 451f8 <pthread_barrierattr_init> 452e8: 588f addql #4,%sp 452ea: 2042 moveal %d2,%a0
}
/*
* Now start error checking the attributes that we are going to use
*/
if ( !the_attr->is_initialized )
452ec: 4a90 tstl %a0@ 452ee: 676a beqs 4535a <pthread_barrier_init+0xa6>
return EINVAL;
switch ( the_attr->process_shared ) {
452f0: 4aa8 0004 tstl %a0@(4) 452f4: 6664 bnes 4535a <pthread_barrier_init+0xa6>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
452f6: 2039 0005 e158 movel 5e158 <_Thread_Dispatch_disable_level>,%d0 452fc: 5280 addql #1,%d0
/*
* Convert from POSIX attributes to Core Barrier attributes
*/
the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE;
the_attributes.maximum_count = count;
452fe: 2d4a fffc movel %a2,%fp@(-4) 45302: 23c0 0005 e158 movel %d0,5e158 <_Thread_Dispatch_disable_level>
}
/*
* Convert from POSIX attributes to Core Barrier attributes
*/
the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE;
45308: 42ae fff8 clrl %fp@(-8)
* This function allocates a barrier control block from
* the inactive chain of free barrier control blocks.
*/
RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void )
{
return (POSIX_Barrier_Control *)
4530c: 4879 0005 e49a pea 5e49a <_POSIX_Barrier_Information> 45312: 45f9 0004 7ca2 lea 47ca2 <_Thread_Enable_dispatch>,%a2 45318: 4eb9 0004 70cc jsr 470cc <_Objects_Allocate>
*/
_Thread_Disable_dispatch(); /* prevents deletion */
the_barrier = _POSIX_Barrier_Allocate();
if ( !the_barrier ) {
4531e: 588f addql #4,%sp 45320: 2840 moveal %d0,%a4 45322: 4a80 tstl %d0 45324: 6606 bnes 4532c <pthread_barrier_init+0x78>
_Thread_Enable_dispatch();
45326: 4e92 jsr %a2@ 45328: 700b moveq #11,%d0
return EAGAIN;
4532a: 6030 bras 4535c <pthread_barrier_init+0xa8>
}
_CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes );
4532c: 486e fff8 pea %fp@(-8) 45330: 486c 0010 pea %a4@(16) 45334: 4eb9 0004 6868 jsr 46868 <_CORE_barrier_Initialize>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4533a: 202c 0008 movel %a4@(8),%d0 4533e: 4281 clrl %d1 45340: 2079 0005 e4b2 moveal 5e4b2 <_POSIX_Barrier_Information+0x18>,%a0 45346: 3200 movew %d0,%d1 45348: 218c 1c00 movel %a4,%a0@(00000000,%d1:l:4)
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
4534c: 42ac 000c clrl %a4@(12)
);
/*
* Exit the critical section and return the user an operational barrier
*/
*barrier = the_barrier->Object.id;
45350: 2680 movel %d0,%a3@
_Thread_Enable_dispatch();
45352: 4e92 jsr %a2@
return 0;
45354: 508f addql #8,%sp
/*
* Exit the critical section and return the user an operational barrier
*/
*barrier = the_barrier->Object.id;
_Thread_Enable_dispatch();
45356: 4280 clrl %d0
return 0;
45358: 6002 bras 4535c <pthread_barrier_init+0xa8> 4535a: 7016 moveq #22,%d0
}
4535c: 4cee 1c04 ffe0 moveml %fp@(-32),%d2/%a2-%a4 45362: 4e5e unlk %fp 45364: 4e75 rts
...
00045368 <pthread_barrier_wait>:
*/
int pthread_barrier_wait(
pthread_barrier_t *barrier
)
{
45368: 4e56 fffc linkw %fp,#-4 4536c: 206e 0008 moveal %fp@(8),%a0
POSIX_Barrier_Control *the_barrier = NULL;
Objects_Locations location;
if ( !barrier )
45370: 4a88 tstl %a0 45372: 6750 beqs 453c4 <pthread_barrier_wait+0x5c>
RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Get (
pthread_barrier_t *barrier,
Objects_Locations *location
)
{
return (POSIX_Barrier_Control *) _Objects_Get(
45374: 486e fffc pea %fp@(-4) 45378: 2f10 movel %a0@,%sp@- 4537a: 4879 0005 e49a pea 5e49a <_POSIX_Barrier_Information> 45380: 4eb9 0004 7518 jsr 47518 <_Objects_Get>
return EINVAL;
the_barrier = _POSIX_Barrier_Get( barrier, &location );
switch ( location ) {
45386: 4fef 000c lea %sp@(12),%sp 4538a: 4aae fffc tstl %fp@(-4) 4538e: 6634 bnes 453c4 <pthread_barrier_wait+0x5c>
case OBJECTS_LOCAL:
_CORE_barrier_Wait(
45390: 42a7 clrl %sp@- 45392: 2040 moveal %d0,%a0 45394: 42a7 clrl %sp@- 45396: 4878 0001 pea 1 <ADD> 4539a: 2f28 0008 movel %a0@(8),%sp@- 4539e: 4868 0010 pea %a0@(16) 453a2: 4eb9 0004 68a4 jsr 468a4 <_CORE_barrier_Wait>
the_barrier->Object.id,
true,
0,
NULL
);
_Thread_Enable_dispatch();
453a8: 4eb9 0004 7ca2 jsr 47ca2 <_Thread_Enable_dispatch>
return _POSIX_Barrier_Translate_core_barrier_return_code(
453ae: 2079 0005 e212 moveal 5e212 <_Thread_Executing>,%a0 453b4: 2f28 0034 movel %a0@(52),%sp@- 453b8: 4eb9 0004 a76c jsr 4a76c <_POSIX_Barrier_Translate_core_barrier_return_code> 453be: 4fef 0018 lea %sp@(24),%sp 453c2: 6002 bras 453c6 <pthread_barrier_wait+0x5e> 453c4: 7016 moveq #22,%d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
453c6: 4e5e unlk %fp 453c8: 4e75 rts
...
000451d4 <pthread_barrierattr_getpshared>:
int pthread_barrierattr_getpshared(
const pthread_barrierattr_t *attr,
int *pshared
)
{
451d4: 4e56 0000 linkw %fp,#0 451d8: 206e 0008 moveal %fp@(8),%a0
if ( !attr )
451dc: 4a88 tstl %a0 451de: 6710 beqs 451f0 <pthread_barrierattr_getpshared+0x1c>
return EINVAL;
if ( !attr->is_initialized )
451e0: 4a90 tstl %a0@ 451e2: 670c beqs 451f0 <pthread_barrierattr_getpshared+0x1c>
return EINVAL;
*pshared = attr->process_shared;
451e4: 226e 000c moveal %fp@(12),%a1 451e8: 4280 clrl %d0 451ea: 22a8 0004 movel %a0@(4),%a1@
return 0;
451ee: 6002 bras 451f2 <pthread_barrierattr_getpshared+0x1e> 451f0: 7016 moveq #22,%d0
}
451f2: 4e5e unlk %fp 451f4: 4e75 rts
...
000451f8 <pthread_barrierattr_init>:
*/
int pthread_barrierattr_init(
pthread_barrierattr_t *attr
)
{
451f8: 4e56 0000 linkw %fp,#0 451fc: 206e 0008 moveal %fp@(8),%a0
if ( !attr )
45200: 4a88 tstl %a0 45202: 6604 bnes 45208 <pthread_barrierattr_init+0x10> 45204: 7016 moveq #22,%d0 45206: 600a bras 45212 <pthread_barrierattr_init+0x1a>
return EINVAL;
attr->is_initialized = true;
45208: 7201 moveq #1,%d1
attr->process_shared = PTHREAD_PROCESS_PRIVATE;
4520a: 4280 clrl %d0 4520c: 42a8 0004 clrl %a0@(4)
)
{
if ( !attr )
return EINVAL;
attr->is_initialized = true;
45210: 2081 movel %d1,%a0@
attr->process_shared = PTHREAD_PROCESS_PRIVATE; return 0; }
45212: 4e5e unlk %fp 45214: 4e75 rts
...
00044a80 <pthread_cancel>:
*/
int pthread_cancel(
pthread_t thread
)
{
44a80: 4e56 fffc linkw %fp,#-4
/*
* Don't even think about deleting a resource from an ISR.
*/
if ( _ISR_Is_in_progress() )
44a84: 2039 0005 d3c2 movel 5d3c2 <_ISR_Nest_level>,%d0 44a8a: 6704 beqs 44a90 <pthread_cancel+0x10> 44a8c: 7047 moveq #71,%d0 44a8e: 603a bras 44aca <pthread_cancel+0x4a>
RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Get (
pthread_t id,
Objects_Locations *location
)
{
return (Thread_Control *)
44a90: 486e fffc pea %fp@(-4) 44a94: 2f2e 0008 movel %fp@(8),%sp@- 44a98: 4879 0005 d50e pea 5d50e <_POSIX_Threads_Information> 44a9e: 4eb9 0004 6884 jsr 46884 <_Objects_Get>
return EPROTO;
the_thread = _POSIX_Threads_Get( thread, &location );
switch ( location ) {
44aa4: 4fef 000c lea %sp@(12),%sp 44aa8: 4aae fffc tstl %fp@(-4) 44aac: 6704 beqs 44ab2 <pthread_cancel+0x32> 44aae: 7016 moveq #22,%d0 44ab0: 6018 bras 44aca <pthread_cancel+0x4a>
case OBJECTS_LOCAL:
thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ];
thread_support->cancelation_requested = 1;
44ab2: 2240 moveal %d0,%a1 44ab4: 7201 moveq #1,%d1 44ab6: 2069 010e moveal %a1@(270),%a0 44aba: 2141 00dc movel %d1,%a0@(220)
/* This enables dispatch implicitly */
_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( the_thread );
44abe: 2f00 movel %d0,%sp@- 44ac0: 4eb9 0004 97fc jsr 497fc <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>
return 0;
44ac6: 588f addql #4,%sp
thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ];
thread_support->cancelation_requested = 1;
/* This enables dispatch implicitly */
_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( the_thread );
44ac8: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
44aca: 4e5e unlk %fp 44acc: 4e75 rts
...
00044cf8 <pthread_cleanup_push>:
void pthread_cleanup_push(
void (*routine)( void * ),
void *arg
)
{
44cf8: 4e56 0000 linkw %fp,#0 44cfc: 2f03 movel %d3,%sp@- 44cfe: 262e 000c movel %fp@(12),%d3 44d02: 2f02 movel %d2,%sp@- 44d04: 242e 0008 movel %fp@(8),%d2
/* * 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 )
44d08: 6754 beqs 44d5e <pthread_cleanup_push+0x66>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
44d0a: 2039 0005 dbd0 movel 5dbd0 <_Thread_Dispatch_disable_level>,%d0 44d10: 5280 addql #1,%d0 44d12: 23c0 0005 dbd0 movel %d0,5dbd0 <_Thread_Dispatch_disable_level>
return;
_Thread_Disable_dispatch();
handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) );
44d18: 4878 0010 pea 10 <INVALID_OPERATION> 44d1c: 4eb9 0004 896c jsr 4896c <_Workspace_Allocate>
if ( handler ) {
44d22: 588f addql #4,%sp 44d24: 4a80 tstl %d0 44d26: 6726 beqs 44d4e <pthread_cleanup_push+0x56>
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
handler_stack = &thread_support->Cancellation_Handlers;
44d28: 2079 0005 dc8a moveal 5dc8a <_Thread_Executing>,%a0 44d2e: 2228 010e movel %a0@(270),%d1
handler->routine = routine;
44d32: 2040 moveal %d0,%a0
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;
44d34: 0681 0000 00e0 addil #224,%d1
handler->routine = routine;
44d3a: 2142 0008 movel %d2,%a0@(8)
handler->arg = arg;
44d3e: 2143 000c movel %d3,%a0@(12)
_Chain_Append( handler_stack, &handler->Node );
44d42: 2f00 movel %d0,%sp@- 44d44: 2f01 movel %d1,%sp@- 44d46: 4eb9 0004 6388 jsr 46388 <_Chain_Append> 44d4c: 508f addql #8,%sp
} _Thread_Enable_dispatch(); }
44d4e: 242e fff8 movel %fp@(-8),%d2 44d52: 262e fffc movel %fp@(-4),%d3 44d56: 4e5e unlk %fp
handler->routine = routine;
handler->arg = arg;
_Chain_Append( handler_stack, &handler->Node );
}
_Thread_Enable_dispatch();
44d58: 4ef9 0004 772a jmp 4772a <_Thread_Enable_dispatch>
}
44d5e: 242e fff8 movel %fp@(-8),%d2 44d62: 262e fffc movel %fp@(-4),%d3 44d66: 4e5e unlk %fp 44d68: 4e75 rts
...
00045964 <pthread_cond_broadcast>:
*/
int pthread_cond_broadcast(
pthread_cond_t *cond
)
{
45964: 4e56 0000 linkw %fp,#0
return _POSIX_Condition_variables_Signal_support( cond, true );
45968: 4878 0001 pea 1 <ADD> 4596c: 2f2e 0008 movel %fp@(8),%sp@- 45970: 4eb9 0004 5af8 jsr 45af8 <_POSIX_Condition_variables_Signal_support>
}
45976: 4e5e unlk %fp 45978: 4e75 rts
...
00045a40 <pthread_cond_init>:
int pthread_cond_init(
pthread_cond_t *cond,
const pthread_condattr_t *attr
)
{
45a40: 4e56 fff4 linkw %fp,#-12 45a44: 202e 000c movel %fp@(12),%d0 45a48: 48d7 1c00 moveml %a2-%a4,%sp@
POSIX_Condition_variables_Control *the_cond;
const pthread_condattr_t *the_attr;
if ( attr ) the_attr = attr;
45a4c: 45f9 0005 c89c lea 5c89c <_POSIX_Condition_variables_Default_attributes>,%a2 45a52: 4a80 tstl %d0 45a54: 6702 beqs 45a58 <pthread_cond_init+0x18> 45a56: 2440 moveal %d0,%a2
/*
* Be careful about attributes when global!!!
*/
if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED )
45a58: 7001 moveq #1,%d0 45a5a: b0aa 0004 cmpl %a2@(4),%d0 45a5e: 6776 beqs 45ad6 <pthread_cond_init+0x96>
return EINVAL;
if ( !the_attr->is_initialized )
45a60: 4a92 tstl %a2@ 45a62: 6772 beqs 45ad6 <pthread_cond_init+0x96>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
45a64: 2039 0005 f1c4 movel 5f1c4 <_Thread_Dispatch_disable_level>,%d0 45a6a: 5280 addql #1,%d0 45a6c: 23c0 0005 f1c4 movel %d0,5f1c4 <_Thread_Dispatch_disable_level>
*/
RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control
*_POSIX_Condition_variables_Allocate( void )
{
return (POSIX_Condition_variables_Control *)
45a72: 4879 0005 f592 pea 5f592 <_POSIX_Condition_variables_Information> 45a78: 47f9 0004 89a6 lea 489a6 <_Thread_Enable_dispatch>,%a3 45a7e: 4eb9 0004 7dd0 jsr 47dd0 <_Objects_Allocate>
_Thread_Disable_dispatch();
the_cond = _POSIX_Condition_variables_Allocate();
if ( !the_cond ) {
45a84: 588f addql #4,%sp 45a86: 2840 moveal %d0,%a4 45a88: 4a80 tstl %d0 45a8a: 6606 bnes 45a92 <pthread_cond_init+0x52>
_Thread_Enable_dispatch();
45a8c: 4e93 jsr %a3@ 45a8e: 700c moveq #12,%d0
return ENOMEM;
45a90: 6046 bras 45ad8 <pthread_cond_init+0x98>
}
the_cond->process_shared = the_attr->process_shared;
the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX;
45a92: 42ac 0014 clrl %a4@(20)
if ( !the_cond ) {
_Thread_Enable_dispatch();
return ENOMEM;
}
the_cond->process_shared = the_attr->process_shared;
45a96: 296a 0004 0010 movel %a2@(4),%a4@(16)
the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX;
/* XXX some more initialization might need to go here */
_Thread_queue_Initialize(
45a9c: 4878 0074 pea 74 <DBL_MANT_DIG+0x3f> 45aa0: 4878 0800 pea 800 <D_MAX_EXP+0x1> 45aa4: 42a7 clrl %sp@- 45aa6: 486c 0018 pea %a4@(24) 45aaa: 4eb9 0004 90b8 jsr 490b8 <_Thread_queue_Initialize>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
45ab0: 202c 0008 movel %a4@(8),%d0 45ab4: 4281 clrl %d1 45ab6: 2079 0005 f5aa moveal 5f5aa <_POSIX_Condition_variables_Information+0x18>,%a0 45abc: 3200 movew %d0,%d1 45abe: 218c 1c00 movel %a4,%a0@(00000000,%d1:l:4)
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
45ac2: 42ac 000c clrl %a4@(12)
&_POSIX_Condition_variables_Information,
&the_cond->Object,
0
);
*cond = the_cond->Object.id;
45ac6: 206e 0008 moveal %fp@(8),%a0 45aca: 2080 movel %d0,%a0@
_Thread_Enable_dispatch();
45acc: 4e93 jsr %a3@
return 0;
45ace: 4fef 0010 lea %sp@(16),%sp
0
);
*cond = the_cond->Object.id;
_Thread_Enable_dispatch();
45ad2: 4280 clrl %d0
return 0;
45ad4: 6002 bras 45ad8 <pthread_cond_init+0x98> 45ad6: 7016 moveq #22,%d0
}
45ad8: 4cee 1c00 fff4 moveml %fp@(-12),%a2-%a4 45ade: 4e5e unlk %fp 45ae0: 4e75 rts
...
00045b58 <pthread_cond_timedwait>:
int pthread_cond_timedwait(
pthread_cond_t *cond,
pthread_mutex_t *mutex,
const struct timespec *abstime
)
{
45b58: 4e56 fffc linkw %fp,#-4
* So we check the abstime provided, and hold on to whether it
* is valid or not. If it isn't correct and in the future,
* then we do a polling operation and convert the UNSATISFIED
* status into the appropriate error.
*/
switch ( _POSIX_Absolute_timeout_to_ticks(abstime, &ticks) ) {
45b5c: 486e fffc pea %fp@(-4) 45b60: 2f2e 0010 movel %fp@(16),%sp@- 45b64: 4eb9 0004 5fc4 jsr 45fc4 <_POSIX_Absolute_timeout_to_ticks> 45b6a: 508f addql #8,%sp 45b6c: 4a80 tstl %d0 45b6e: 6728 beqs 45b98 <pthread_cond_timedwait+0x40> 45b70: 7202 moveq #2,%d1 45b72: b280 cmpl %d0,%d1 45b74: 55c0 scs %d0 45b76: 5280 addql #1,%d0
default: /* only to silence warnings */
already_timedout = false;
break;
}
return _POSIX_Condition_variables_Wait_support(
45b78: 0280 0000 00ff andil #255,%d0 45b7e: 2f00 movel %d0,%sp@- 45b80: 2f2e fffc movel %fp@(-4),%sp@- 45b84: 2f2e 000c movel %fp@(12),%sp@- 45b88: 2f2e 0008 movel %fp@(8),%sp@- 45b8c: 4eb9 0004 5bbc jsr 45bbc <_POSIX_Condition_variables_Wait_support> 45b92: 4fef 0010 lea %sp@(16),%sp 45b96: 6002 bras 45b9a <pthread_cond_timedwait+0x42>
* So we check the abstime provided, and hold on to whether it
* is valid or not. If it isn't correct and in the future,
* then we do a polling operation and convert the UNSATISFIED
* status into the appropriate error.
*/
switch ( _POSIX_Absolute_timeout_to_ticks(abstime, &ticks) ) {
45b98: 7016 moveq #22,%d0
cond,
mutex,
ticks,
already_timedout
);
}
45b9a: 4e5e unlk %fp 45b9c: 4e75 rts
...
00045ba0 <pthread_cond_wait>:
int pthread_cond_wait(
pthread_cond_t *cond,
pthread_mutex_t *mutex
)
{
45ba0: 4e56 0000 linkw %fp,#0
return _POSIX_Condition_variables_Wait_support(
45ba4: 42a7 clrl %sp@- 45ba6: 42a7 clrl %sp@- 45ba8: 2f2e 000c movel %fp@(12),%sp@- 45bac: 2f2e 0008 movel %fp@(8),%sp@- 45bb0: 4eb9 0004 5bbc jsr 45bbc <_POSIX_Condition_variables_Wait_support>
cond,
mutex,
THREAD_QUEUE_WAIT_FOREVER,
false
);
}
45bb6: 4e5e unlk %fp 45bb8: 4e75 rts
...
000458f4 <pthread_condattr_getpshared>:
int pthread_condattr_getpshared(
const pthread_condattr_t *attr,
int *pshared
)
{
458f4: 4e56 0000 linkw %fp,#0 458f8: 206e 0008 moveal %fp@(8),%a0
if ( !attr )
458fc: 4a88 tstl %a0 458fe: 6604 bnes 45904 <pthread_condattr_getpshared+0x10> 45900: 7016 moveq #22,%d0 45902: 600a bras 4590e <pthread_condattr_getpshared+0x1a>
return EINVAL;
*pshared = attr->process_shared;
45904: 226e 000c moveal %fp@(12),%a1 45908: 4280 clrl %d0 4590a: 22a8 0004 movel %a0@(4),%a1@
return 0; }
4590e: 4e5e unlk %fp 45910: 4e75 rts
...
00045228 <pthread_equal>:
int pthread_equal(
pthread_t t1,
pthread_t t2
)
{
45228: 4e56 0000 linkw %fp,#0 4522c: 202e 000c movel %fp@(12),%d0 45230: b0ae 0008 cmpl %fp@(8),%d0 45234: 57c0 seq %d0
break;
}
return status;
#endif
}
45236: 4e5e unlk %fp
int pthread_equal(
pthread_t t1,
pthread_t t2
)
{
45238: 49c0 extbl %d0
break;
}
return status;
#endif
}
4523a: 4480 negl %d0 4523c: 4e75 rts
...
0004ba2c <pthread_exit>:
}
void pthread_exit(
void *value_ptr
)
{
4ba2c: 4e56 0000 linkw %fp,#0
_POSIX_Thread_Exit( _Thread_Executing, value_ptr );
4ba30: 2f2e 0008 movel %fp@(8),%sp@- 4ba34: 2f39 0005 cd4e movel 5cd4e <_Thread_Executing>,%sp@- 4ba3a: 4eb9 0004 b9bc jsr 4b9bc <_POSIX_Thread_Exit>
4ba40: 508f addql #8,%sp <== NOT EXECUTED
}
4ba42: 4e5e unlk %fp <== NOT EXECUTED 4ba44: 4e75 rts <== NOT EXECUTED
...
00044f9c <pthread_getcpuclockid>:
int pthread_getcpuclockid(
pthread_t pid,
clockid_t *clock_id
)
{
44f9c: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
44fa0: 4eb9 0004 d430 jsr 4d430 <__errno> 44fa6: 7258 moveq #88,%d1 44fa8: 2040 moveal %d0,%a0
}
44faa: 70ff moveq #-1,%d0 44fac: 4e5e unlk %fp
int pthread_getcpuclockid(
pthread_t pid,
clockid_t *clock_id
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
44fae: 2081 movel %d1,%a0@
}
44fb0: 4e75 rts
...
000495ec <pthread_join>:
int pthread_join(
pthread_t thread,
void **value_ptr
)
{
495ec: 4e56 fff8 linkw %fp,#-8 495f0: 2f0b movel %a3,%sp@- 495f2: 2f0a movel %a2,%sp@- 495f4: 486e fffc pea %fp@(-4) 495f8: 2f2e 0008 movel %fp@(8),%sp@- 495fc: 4879 0006 49a6 pea 649a6 <_POSIX_Threads_Information> 49602: 246e 000c moveal %fp@(12),%a2 49606: 4eb9 0004 b65c jsr 4b65c <_Objects_Get>
POSIX_API_Control *api;
Objects_Locations location;
void *return_pointer;
the_thread = _POSIX_Threads_Get( thread, &location );
switch ( location ) {
4960c: 4fef 000c lea %sp@(12),%sp 49610: 4aae fffc tstl %fp@(-4) 49614: 6704 beqs 4961a <pthread_join+0x2e> 49616: 7003 moveq #3,%d0 49618: 605c bras 49676 <pthread_join+0x8a>
case OBJECTS_LOCAL:
api = the_thread->API_Extensions[ THREAD_API_POSIX ];
4961a: 2240 moveal %d0,%a1 4961c: 2069 010e moveal %a1@(270),%a0
if ( api->detachstate == PTHREAD_CREATE_DETACHED ) {
49620: 4aa8 003c tstl %a0@(60) 49624: 660a bnes 49630 <pthread_join+0x44>
_Thread_Enable_dispatch();
49626: 4eb9 0004 bde6 jsr 4bde6 <_Thread_Enable_dispatch> 4962c: 7016 moveq #22,%d0
return EINVAL;
4962e: 6046 bras 49676 <pthread_join+0x8a>
RTEMS_INLINE_ROUTINE bool _Thread_Is_executing (
const Thread_Control *the_thread
)
{
return ( the_thread == _Thread_Executing );
49630: 2279 0006 487a moveal 6487a <_Thread_Executing>,%a1 49636: 47f9 0004 bde6 lea 4bde6 <_Thread_Enable_dispatch>,%a3
}
if ( _Thread_Is_executing( the_thread ) ) {
4963c: b3c0 cmpal %d0,%a1 4963e: 6606 bnes 49646 <pthread_join+0x5a>
_Thread_Enable_dispatch();
49640: 4e93 jsr %a3@ 49642: 702d moveq #45,%d0
return EDEADLK;
49644: 6030 bras 49676 <pthread_join+0x8a>
/*
* Put ourself on the threads join list
*/
_Thread_Executing->Wait.return_argument = &return_pointer;
49646: 200e movel %fp,%d0 49648: 5180 subql #8,%d0 4964a: 2340 0028 movel %d0,%a1@(40)
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;
4964e: 7001 moveq #1,%d0 49650: 2140 0070 movel %d0,%a0@(112)
_Thread_queue_Enter_critical_section( &api->Join_List );
_Thread_queue_Enqueue( &api->Join_List, WATCHDOG_NO_TIMEOUT );
49654: 4879 0004 c55c pea 4c55c <_Thread_queue_Timeout> 4965a: 42a7 clrl %sp@- 4965c: 4868 0040 pea %a0@(64) 49660: 4eb9 0004 c270 jsr 4c270 <_Thread_queue_Enqueue_with_handler>
_Thread_Enable_dispatch();
49666: 4e93 jsr %a3@
if ( value_ptr )
49668: 4fef 000c lea %sp@(12),%sp 4966c: 4a8a tstl %a2 4966e: 6704 beqs 49674 <pthread_join+0x88>
*value_ptr = return_pointer;
49670: 24ae fff8 movel %fp@(-8),%a2@ 49674: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return ESRCH;
}
49676: 246e fff0 moveal %fp@(-16),%a2 4967a: 266e fff4 moveal %fp@(-12),%a3 4967e: 4e5e unlk %fp 49680: 4e75 rts
...
00044fc0 <pthread_key_delete>:
*/
int pthread_key_delete(
pthread_key_t key
)
{
44fc0: 4e56 ffec linkw %fp,#-20 44fc4: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@
RTEMS_INLINE_ROUTINE POSIX_Keys_Control *_POSIX_Keys_Get (
pthread_key_t id,
Objects_Locations *location
)
{
return (POSIX_Keys_Control *)
44fc8: 486e fffc pea %fp@(-4) 44fcc: 2f2e 0008 movel %fp@(8),%sp@- 44fd0: 4879 0005 ed18 pea 5ed18 <_POSIX_Keys_Information> 44fd6: 4eb9 0004 729c jsr 4729c <_Objects_Get>
register POSIX_Keys_Control *the_key;
Objects_Locations location;
uint32_t the_api;
the_key = _POSIX_Keys_Get( key, &location );
switch ( location ) {
44fdc: 4fef 000c lea %sp@(12),%sp 44fe0: 2400 movel %d0,%d2 44fe2: 4aae fffc tstl %fp@(-4) 44fe6: 6704 beqs 44fec <pthread_key_delete+0x2c> 44fe8: 7016 moveq #22,%d0 44fea: 604c bras 45038 <pthread_key_delete+0x78>
case OBJECTS_LOCAL:
_Objects_Close( &_POSIX_Keys_Information, &the_key->Object );
44fec: 2f00 movel %d0,%sp@- 44fee: 4879 0005 ed18 pea 5ed18 <_POSIX_Keys_Information> 44ff4: 2440 moveal %d0,%a2 44ff6: 45ea 0018 lea %a2@(24),%a2 44ffa: 7601 moveq #1,%d3
for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ )
if ( the_key->Values[ the_api ] )
_Workspace_Free( the_key->Values[ the_api ] );
44ffc: 47f9 0004 8d04 lea 48d04 <_Workspace_Free>,%a3
the_key = _POSIX_Keys_Get( key, &location );
switch ( location ) {
case OBJECTS_LOCAL:
_Objects_Close( &_POSIX_Keys_Information, &the_key->Object );
45002: 4eb9 0004 6ed0 jsr 46ed0 <_Objects_Close> 45008: 508f addql #8,%sp
for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ )
if ( the_key->Values[ the_api ] )
4500a: 2012 movel %a2@,%d0
switch ( location ) {
case OBJECTS_LOCAL:
_Objects_Close( &_POSIX_Keys_Information, &the_key->Object );
for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ )
4500c: 5283 addql #1,%d3 4500e: 588a addql #4,%a2
if ( the_key->Values[ the_api ] )
45010: 4a80 tstl %d0 45012: 6706 beqs 4501a <pthread_key_delete+0x5a>
_Workspace_Free( the_key->Values[ the_api ] );
45014: 2f00 movel %d0,%sp@- 45016: 4e93 jsr %a3@ 45018: 588f addql #4,%sp
switch ( location ) {
case OBJECTS_LOCAL:
_Objects_Close( &_POSIX_Keys_Information, &the_key->Object );
for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ )
4501a: 7005 moveq #5,%d0 4501c: b083 cmpl %d3,%d0 4501e: 66ea bnes 4500a <pthread_key_delete+0x4a>
*/
RTEMS_INLINE_ROUTINE void _POSIX_Keys_Free (
POSIX_Keys_Control *the_key
)
{
_Objects_Free( &_POSIX_Keys_Information, &the_key->Object );
45020: 2f02 movel %d2,%sp@- 45022: 4879 0005 ed18 pea 5ed18 <_POSIX_Keys_Information> 45028: 4eb9 0004 7144 jsr 47144 <_Objects_Free>
* NOTE: The destructor is not called and it is the responsibility
* of the application to free the memory.
*/
_POSIX_Keys_Free( the_key );
_Thread_Enable_dispatch();
4502e: 4eb9 0004 7a26 jsr 47a26 <_Thread_Enable_dispatch>
return 0;
45034: 508f addql #8,%sp
* NOTE: The destructor is not called and it is the responsibility
* of the application to free the memory.
*/
_POSIX_Keys_Free( the_key );
_Thread_Enable_dispatch();
45036: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
45038: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 4503e: 4e5e unlk %fp 45040: 4e75 rts
...
0004699c <pthread_mutex_destroy>:
*/
int pthread_mutex_destroy(
pthread_mutex_t *mutex
)
{
4699c: 4e56 fffc linkw %fp,#-4 469a0: 2f0b movel %a3,%sp@- 469a2: 2f0a movel %a2,%sp@-
register POSIX_Mutex_Control *the_mutex;
Objects_Locations location;
the_mutex = _POSIX_Mutex_Get( mutex, &location );
469a4: 486e fffc pea %fp@(-4) 469a8: 2f2e 0008 movel %fp@(8),%sp@- 469ac: 4eb9 0004 6a6a jsr 46a6a <_POSIX_Mutex_Get>
switch ( location ) {
469b2: 508f addql #8,%sp
)
{
register POSIX_Mutex_Control *the_mutex;
Objects_Locations location;
the_mutex = _POSIX_Mutex_Get( mutex, &location );
469b4: 2440 moveal %d0,%a2
switch ( location ) {
469b6: 4aae fffc tstl %fp@(-4) 469ba: 6704 beqs 469c0 <pthread_mutex_destroy+0x24> 469bc: 7016 moveq #22,%d0 469be: 6046 bras 46a06 <pthread_mutex_destroy+0x6a> 469c0: 47f9 0004 99be lea 499be <_Thread_Enable_dispatch>,%a3
/*
* XXX: There is an error for the mutex being locked
* or being in use by a condition variable.
*/
if ( _CORE_mutex_Is_locked( &the_mutex->Mutex ) ) {
469c6: 4aaa 0062 tstl %a2@(98) 469ca: 6606 bnes 469d2 <pthread_mutex_destroy+0x36>
_Thread_Enable_dispatch();
469cc: 4e93 jsr %a3@ 469ce: 7010 moveq #16,%d0
return EBUSY;
469d0: 6034 bras 46a06 <pthread_mutex_destroy+0x6a>
}
_Objects_Close( &_POSIX_Mutex_Information, &the_mutex->Object );
469d2: 2f00 movel %d0,%sp@- 469d4: 4879 0006 1a9c pea 61a9c <_POSIX_Mutex_Information> 469da: 4eb9 0004 8e68 jsr 48e68 <_Objects_Close>
_CORE_mutex_Flush( &the_mutex->Mutex, NULL, EINVAL );
469e0: 4878 0016 pea 16 <OPER2+0x2> 469e4: 42a7 clrl %sp@- 469e6: 486a 0014 pea %a2@(20) 469ea: 4eb9 0004 8580 jsr 48580 <_CORE_mutex_Flush>
RTEMS_INLINE_ROUTINE void _POSIX_Mutex_Free (
POSIX_Mutex_Control *the_mutex
)
{
_Objects_Free( &_POSIX_Mutex_Information, &the_mutex->Object );
469f0: 2f0a movel %a2,%sp@- 469f2: 4879 0006 1a9c pea 61a9c <_POSIX_Mutex_Information> 469f8: 4eb9 0004 90dc jsr 490dc <_Objects_Free>
_POSIX_Mutex_Free( the_mutex );
_Thread_Enable_dispatch();
469fe: 4e93 jsr %a3@
return 0;
46a00: 4fef 001c lea %sp@(28),%sp
_Objects_Close( &_POSIX_Mutex_Information, &the_mutex->Object );
_CORE_mutex_Flush( &the_mutex->Mutex, NULL, EINVAL );
_POSIX_Mutex_Free( the_mutex );
_Thread_Enable_dispatch();
46a04: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
46a06: 246e fff4 moveal %fp@(-12),%a2 46a0a: 266e fff8 moveal %fp@(-8),%a3 46a0e: 4e5e unlk %fp 46a10: 4e75 rts
...
00046d78 <pthread_mutex_trylock>:
*/
int pthread_mutex_trylock(
pthread_mutex_t *mutex
)
{
46d78: 4e56 0000 linkw %fp,#0
return _POSIX_Mutex_Lock_support( mutex, false, THREAD_QUEUE_WAIT_FOREVER );
46d7c: 42a7 clrl %sp@- 46d7e: 42a7 clrl %sp@- 46d80: 2f2e 0008 movel %fp@(8),%sp@- 46d84: 4eb9 0004 6c38 jsr 46c38 <_POSIX_Mutex_Lock_support>
}
46d8a: 4e5e unlk %fp 46d8c: 4e75 rts
...
00046d90 <pthread_mutex_unlock>:
*/
int pthread_mutex_unlock(
pthread_mutex_t *mutex
)
{
46d90: 4e56 fffc linkw %fp,#-4 46d94: 2f02 movel %d2,%sp@-
register POSIX_Mutex_Control *the_mutex;
Objects_Locations location;
CORE_mutex_Status status;
the_mutex = _POSIX_Mutex_Get( mutex, &location );
46d96: 486e fffc pea %fp@(-4) 46d9a: 2f2e 0008 movel %fp@(8),%sp@- 46d9e: 4eb9 0004 6a6a jsr 46a6a <_POSIX_Mutex_Get>
switch ( location ) {
46da4: 508f addql #8,%sp 46da6: 4aae fffc tstl %fp@(-4) 46daa: 6704 beqs 46db0 <pthread_mutex_unlock+0x20> 46dac: 7016 moveq #22,%d0 46dae: 6026 bras 46dd6 <pthread_mutex_unlock+0x46>
case OBJECTS_LOCAL:
status = _CORE_mutex_Surrender(
46db0: 2040 moveal %d0,%a0 46db2: 42a7 clrl %sp@- 46db4: 2f28 0008 movel %a0@(8),%sp@- 46db8: 4868 0014 pea %a0@(20) 46dbc: 4eb9 0004 8740 jsr 48740 <_CORE_mutex_Surrender> 46dc2: 2400 movel %d0,%d2
&the_mutex->Mutex,
the_mutex->Object.id,
NULL
);
_Thread_Enable_dispatch();
46dc4: 4eb9 0004 99be jsr 499be <_Thread_Enable_dispatch>
return _POSIX_Mutex_Translate_core_mutex_return_code( status );
46dca: 2f02 movel %d2,%sp@- 46dcc: 4eb9 0004 6d60 jsr 46d60 <_POSIX_Mutex_Translate_core_mutex_return_code> 46dd2: 4fef 0010 lea %sp@(16),%sp
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
46dd6: 242e fff8 movel %fp@(-8),%d2 46dda: 4e5e unlk %fp 46ddc: 4e75 rts
...
0004686c <pthread_mutexattr_getprioceiling>:
int pthread_mutexattr_getprioceiling(
const pthread_mutexattr_t *attr,
int *prioceiling
)
{
4686c: 4e56 0000 linkw %fp,#0 46870: 206e 0008 moveal %fp@(8),%a0 46874: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !prioceiling )
46878: 4a88 tstl %a0 4687a: 6710 beqs 4688c <pthread_mutexattr_getprioceiling+0x20> 4687c: 4a90 tstl %a0@ 4687e: 670c beqs 4688c <pthread_mutexattr_getprioceiling+0x20> 46880: 4a89 tstl %a1 46882: 6708 beqs 4688c <pthread_mutexattr_getprioceiling+0x20>
return EINVAL;
*prioceiling = attr->prio_ceiling;
46884: 22a8 0008 movel %a0@(8),%a1@ 46888: 4280 clrl %d0
return 0;
4688a: 6002 bras 4688e <pthread_mutexattr_getprioceiling+0x22> 4688c: 7016 moveq #22,%d0
}
4688e: 4e5e unlk %fp 46890: 4e75 rts
...
00046894 <pthread_mutexattr_getprotocol>:
int pthread_mutexattr_getprotocol(
const pthread_mutexattr_t *attr,
int *protocol
)
{
46894: 4e56 0000 linkw %fp,#0 46898: 206e 0008 moveal %fp@(8),%a0 4689c: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !protocol )
468a0: 4a88 tstl %a0 468a2: 6710 beqs 468b4 <pthread_mutexattr_getprotocol+0x20> 468a4: 4a90 tstl %a0@ 468a6: 670c beqs 468b4 <pthread_mutexattr_getprotocol+0x20> 468a8: 4a89 tstl %a1 468aa: 6708 beqs 468b4 <pthread_mutexattr_getprotocol+0x20>
return EINVAL;
*protocol = attr->protocol;
468ac: 22a8 000c movel %a0@(12),%a1@ 468b0: 4280 clrl %d0
return 0;
468b2: 6002 bras 468b6 <pthread_mutexattr_getprotocol+0x22> 468b4: 7016 moveq #22,%d0
}
468b6: 4e5e unlk %fp 468b8: 4e75 rts
...
000468bc <pthread_mutexattr_getpshared>:
int pthread_mutexattr_getpshared(
const pthread_mutexattr_t *attr,
int *pshared
)
{
468bc: 4e56 0000 linkw %fp,#0 468c0: 206e 0008 moveal %fp@(8),%a0 468c4: 226e 000c moveal %fp@(12),%a1
if ( !attr || !attr->is_initialized || !pshared )
468c8: 4a88 tstl %a0 468ca: 6710 beqs 468dc <pthread_mutexattr_getpshared+0x20> 468cc: 4a90 tstl %a0@ 468ce: 670c beqs 468dc <pthread_mutexattr_getpshared+0x20> 468d0: 4a89 tstl %a1 468d2: 6708 beqs 468dc <pthread_mutexattr_getpshared+0x20>
return EINVAL;
*pshared = attr->process_shared;
468d4: 22a8 0004 movel %a0@(4),%a1@ 468d8: 4280 clrl %d0
return 0;
468da: 6002 bras 468de <pthread_mutexattr_getpshared+0x22> 468dc: 7016 moveq #22,%d0
}
468de: 4e5e unlk %fp 468e0: 4e75 rts
...
00044b58 <pthread_mutexattr_gettype>:
#if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES)
int pthread_mutexattr_gettype(
const pthread_mutexattr_t *attr,
int *type
)
{
44b58: 4e56 0000 linkw %fp,#0 44b5c: 206e 0008 moveal %fp@(8),%a0 44b60: 226e 000c moveal %fp@(12),%a1
if ( !attr )
44b64: 4a88 tstl %a0 44b66: 6710 beqs 44b78 <pthread_mutexattr_gettype+0x20>
return EINVAL;
if ( !attr->is_initialized )
44b68: 4a90 tstl %a0@ 44b6a: 670c beqs 44b78 <pthread_mutexattr_gettype+0x20>
return EINVAL;
if ( !type )
44b6c: 4a89 tstl %a1 44b6e: 6708 beqs 44b78 <pthread_mutexattr_gettype+0x20>
return EINVAL;
*type = attr->type;
44b70: 22a8 0010 movel %a0@(16),%a1@ 44b74: 4280 clrl %d0
return 0;
44b76: 6002 bras 44b7a <pthread_mutexattr_gettype+0x22> 44b78: 7016 moveq #22,%d0
}
44b7a: 4e5e unlk %fp 44b7c: 4e75 rts
...
00045b74 <pthread_rwlock_destroy>:
*/
int pthread_rwlock_destroy(
pthread_rwlock_t *rwlock
)
{
45b74: 4e56 fffc linkw %fp,#-4 45b78: 206e 0008 moveal %fp@(8),%a0 45b7c: 2f0b movel %a3,%sp@- 45b7e: 2f0a movel %a2,%sp@-
POSIX_RWLock_Control *the_rwlock = NULL;
Objects_Locations location;
if ( !rwlock )
45b80: 4a88 tstl %a0 45b82: 6760 beqs 45be4 <pthread_rwlock_destroy+0x70>
RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Get (
pthread_rwlock_t *RWLock,
Objects_Locations *location
)
{
return (POSIX_RWLock_Control *) _Objects_Get(
45b84: 486e fffc pea %fp@(-4) 45b88: 2f10 movel %a0@,%sp@- 45b8a: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45b90: 4eb9 0004 83dc jsr 483dc <_Objects_Get>
return EINVAL;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
45b96: 4fef 000c lea %sp@(12),%sp 45b9a: 2440 moveal %d0,%a2 45b9c: 4aae fffc tstl %fp@(-4) 45ba0: 6642 bnes 45be4 <pthread_rwlock_destroy+0x70>
case OBJECTS_LOCAL:
/*
* If there is at least one thread waiting, then do not delete it.
*/
if ( _Thread_queue_First( &the_rwlock->RWLock.Wait_queue ) != NULL ) {
45ba2: 486a 0010 pea %a2@(16) 45ba6: 47f9 0004 8b66 lea 48b66 <_Thread_Enable_dispatch>,%a3 45bac: 4eb9 0004 92f0 jsr 492f0 <_Thread_queue_First> 45bb2: 588f addql #4,%sp 45bb4: 4a80 tstl %d0 45bb6: 6706 beqs 45bbe <pthread_rwlock_destroy+0x4a>
_Thread_Enable_dispatch();
45bb8: 4e93 jsr %a3@ 45bba: 7010 moveq #16,%d0
return EBUSY;
45bbc: 6028 bras 45be6 <pthread_rwlock_destroy+0x72>
/*
* POSIX doesn't require behavior when it is locked.
*/
_Objects_Close( &_POSIX_RWLock_Information, &the_rwlock->Object );
45bbe: 2f0a movel %a2,%sp@- 45bc0: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45bc6: 4eb9 0004 8010 jsr 48010 <_Objects_Close>
*/
RTEMS_INLINE_ROUTINE void _POSIX_RWLock_Free (
POSIX_RWLock_Control *the_RWLock
)
{
_Objects_Free( &_POSIX_RWLock_Information, &the_RWLock->Object );
45bcc: 2f0a movel %a2,%sp@- 45bce: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45bd4: 4eb9 0004 8284 jsr 48284 <_Objects_Free>
_POSIX_RWLock_Free( the_rwlock );
_Thread_Enable_dispatch();
45bda: 4e93 jsr %a3@
return 0;
45bdc: 4fef 0010 lea %sp@(16),%sp
_Objects_Close( &_POSIX_RWLock_Information, &the_rwlock->Object );
_POSIX_RWLock_Free( the_rwlock );
_Thread_Enable_dispatch();
45be0: 4280 clrl %d0
return 0;
45be2: 6002 bras 45be6 <pthread_rwlock_destroy+0x72> 45be4: 7016 moveq #22,%d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
45be6: 246e fff4 moveal %fp@(-12),%a2 45bea: 266e fff8 moveal %fp@(-8),%a3 45bee: 4e5e unlk %fp 45bf0: 4e75 rts
...
00045c8c <pthread_rwlock_rdlock>:
*/
int pthread_rwlock_rdlock(
pthread_rwlock_t *rwlock
)
{
45c8c: 4e56 fffc linkw %fp,#-4 45c90: 2f0a movel %a2,%sp@- 45c92: 246e 0008 moveal %fp@(8),%a2
POSIX_RWLock_Control *the_rwlock;
Objects_Locations location;
if ( !rwlock )
45c96: 4a8a tstl %a2 45c98: 674e beqs 45ce8 <pthread_rwlock_rdlock+0x5c>
RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Get (
pthread_rwlock_t *RWLock,
Objects_Locations *location
)
{
return (POSIX_RWLock_Control *) _Objects_Get(
45c9a: 486e fffc pea %fp@(-4) 45c9e: 2f12 movel %a2@,%sp@- 45ca0: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45ca6: 4eb9 0004 83dc jsr 483dc <_Objects_Get>
return EINVAL;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
45cac: 4fef 000c lea %sp@(12),%sp 45cb0: 4aae fffc tstl %fp@(-4) 45cb4: 6632 bnes 45ce8 <pthread_rwlock_rdlock+0x5c>
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_reading(
45cb6: 42a7 clrl %sp@- 45cb8: 2040 moveal %d0,%a0 45cba: 42a7 clrl %sp@- 45cbc: 4878 0001 pea 1 <ADD> 45cc0: 2f12 movel %a2@,%sp@- 45cc2: 4868 0010 pea %a0@(16) 45cc6: 4eb9 0004 77f8 jsr 477f8 <_CORE_RWLock_Obtain_for_reading>
true, /* we are willing to wait forever */
0,
NULL
);
_Thread_Enable_dispatch();
45ccc: 4eb9 0004 8b66 jsr 48b66 <_Thread_Enable_dispatch>
return _POSIX_RWLock_Translate_core_RWLock_return_code(
45cd2: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45cd8: 2f28 0034 movel %a0@(52),%sp@- 45cdc: 4eb9 0004 5e4c jsr 45e4c <_POSIX_RWLock_Translate_core_RWLock_return_code> 45ce2: 4fef 0018 lea %sp@(24),%sp 45ce6: 6002 bras 45cea <pthread_rwlock_rdlock+0x5e> 45ce8: 7016 moveq #22,%d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
45cea: 246e fff8 moveal %fp@(-8),%a2 45cee: 4e5e unlk %fp 45cf0: 4e75 rts
...
00045cf4 <pthread_rwlock_timedrdlock>:
int pthread_rwlock_timedrdlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
45cf4: 4e56 ffec linkw %fp,#-20 45cf8: 48d7 040c moveml %d2-%d3/%a2,%sp@ 45cfc: 246e 0008 moveal %fp@(8),%a2
Objects_Locations location;
Watchdog_Interval ticks;
bool do_wait = true;
POSIX_Absolute_timeout_conversion_results_t status;
if ( !rwlock )
45d00: 4a8a tstl %a2 45d02: 6700 008e beqw 45d92 <pthread_rwlock_timedrdlock+0x9e>
* * 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 );
45d06: 486e fff8 pea %fp@(-8) 45d0a: 2f2e 000c movel %fp@(12),%sp@- 45d0e: 4eb9 0004 b7d4 jsr 4b7d4 <_POSIX_Absolute_timeout_to_ticks> 45d14: 486e fffc pea %fp@(-4) 45d18: 2400 movel %d0,%d2 45d1a: 2f12 movel %a2@,%sp@- 45d1c: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45d22: 4eb9 0004 83dc jsr 483dc <_Objects_Get>
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
do_wait = false;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
45d28: 4fef 0014 lea %sp@(20),%sp 45d2c: 4aae fffc tstl %fp@(-4) 45d30: 6660 bnes 45d92 <pthread_rwlock_timedrdlock+0x9e>
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,
45d32: 7203 moveq #3,%d1 45d34: b282 cmpl %d2,%d1 45d36: 57c3 seq %d3
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_reading(
45d38: 42a7 clrl %sp@- 45d3a: 2f2e fff8 movel %fp@(-8),%sp@- 45d3e: 4483 negl %d3 45d40: 4281 clrl %d1 45d42: 1203 moveb %d3,%d1 45d44: 2040 moveal %d0,%a0 45d46: 2f01 movel %d1,%sp@- 45d48: 2f12 movel %a2@,%sp@- 45d4a: 4868 0010 pea %a0@(16) 45d4e: 4eb9 0004 77f8 jsr 477f8 <_CORE_RWLock_Obtain_for_reading>
do_wait,
ticks,
NULL
);
_Thread_Enable_dispatch();
45d54: 4eb9 0004 8b66 jsr 48b66 <_Thread_Enable_dispatch>
if ( !do_wait ) {
45d5a: 4fef 0014 lea %sp@(20),%sp 45d5e: 4a03 tstb %d3 45d60: 661c bnes 45d7e <pthread_rwlock_timedrdlock+0x8a>
if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) {
45d62: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45d68: 7002 moveq #2,%d0 45d6a: b0a8 0034 cmpl %a0@(52),%d0 45d6e: 660e bnes 45d7e <pthread_rwlock_timedrdlock+0x8a>
switch (status) {
45d70: 4a82 tstl %d2 45d72: 671e beqs 45d92 <pthread_rwlock_timedrdlock+0x9e> 45d74: b082 cmpl %d2,%d0 45d76: 6506 bcss 45d7e <pthread_rwlock_timedrdlock+0x8a> 45d78: 103c 0074 moveb #116,%d0 45d7c: 6016 bras 45d94 <pthread_rwlock_timedrdlock+0xa0>
break;
}
}
}
return _POSIX_RWLock_Translate_core_RWLock_return_code(
45d7e: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45d84: 2f28 0034 movel %a0@(52),%sp@- 45d88: 4eb9 0004 5e4c jsr 45e4c <_POSIX_RWLock_Translate_core_RWLock_return_code> 45d8e: 588f addql #4,%sp 45d90: 6002 bras 45d94 <pthread_rwlock_timedrdlock+0xa0> 45d92: 7016 moveq #22,%d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
45d94: 4cee 040c ffec moveml %fp@(-20),%d2-%d3/%a2 45d9a: 4e5e unlk %fp 45d9c: 4e75 rts
...
00045da0 <pthread_rwlock_timedwrlock>:
int pthread_rwlock_timedwrlock(
pthread_rwlock_t *rwlock,
const struct timespec *abstime
)
{
45da0: 4e56 ffec linkw %fp,#-20 45da4: 48d7 040c moveml %d2-%d3/%a2,%sp@ 45da8: 246e 0008 moveal %fp@(8),%a2
Objects_Locations location;
Watchdog_Interval ticks;
bool do_wait = true;
POSIX_Absolute_timeout_conversion_results_t status;
if ( !rwlock )
45dac: 4a8a tstl %a2 45dae: 6700 008e beqw 45e3e <pthread_rwlock_timedwrlock+0x9e>
* * 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 );
45db2: 486e fff8 pea %fp@(-8) 45db6: 2f2e 000c movel %fp@(12),%sp@- 45dba: 4eb9 0004 b7d4 jsr 4b7d4 <_POSIX_Absolute_timeout_to_ticks> 45dc0: 486e fffc pea %fp@(-4) 45dc4: 2400 movel %d0,%d2 45dc6: 2f12 movel %a2@,%sp@- 45dc8: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45dce: 4eb9 0004 83dc jsr 483dc <_Objects_Get>
if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE )
do_wait = false;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
45dd4: 4fef 0014 lea %sp@(20),%sp 45dd8: 4aae fffc tstl %fp@(-4) 45ddc: 6660 bnes 45e3e <pthread_rwlock_timedwrlock+0x9e>
(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,
45dde: 7203 moveq #3,%d1 45de0: b282 cmpl %d2,%d1 45de2: 57c3 seq %d3
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_writing(
45de4: 42a7 clrl %sp@- 45de6: 2f2e fff8 movel %fp@(-8),%sp@- 45dea: 4483 negl %d3 45dec: 4281 clrl %d1 45dee: 1203 moveb %d3,%d1 45df0: 2040 moveal %d0,%a0 45df2: 2f01 movel %d1,%sp@- 45df4: 2f12 movel %a2@,%sp@- 45df6: 4868 0010 pea %a0@(16) 45dfa: 4eb9 0004 78a8 jsr 478a8 <_CORE_RWLock_Obtain_for_writing>
do_wait,
ticks,
NULL
);
_Thread_Enable_dispatch();
45e00: 4eb9 0004 8b66 jsr 48b66 <_Thread_Enable_dispatch>
if ( !do_wait &&
45e06: 4fef 0014 lea %sp@(20),%sp 45e0a: 4a03 tstb %d3 45e0c: 661c bnes 45e2a <pthread_rwlock_timedwrlock+0x8a>
(_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) {
45e0e: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45e14: 7002 moveq #2,%d0 45e16: b0a8 0034 cmpl %a0@(52),%d0 45e1a: 660e bnes 45e2a <pthread_rwlock_timedwrlock+0x8a>
switch (status) {
45e1c: 4a82 tstl %d2 45e1e: 671e beqs 45e3e <pthread_rwlock_timedwrlock+0x9e> 45e20: b082 cmpl %d2,%d0 45e22: 6506 bcss 45e2a <pthread_rwlock_timedwrlock+0x8a> 45e24: 103c 0074 moveb #116,%d0 45e28: 6016 bras 45e40 <pthread_rwlock_timedwrlock+0xa0>
case POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE:
break;
}
}
return _POSIX_RWLock_Translate_core_RWLock_return_code(
45e2a: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45e30: 2f28 0034 movel %a0@(52),%sp@- 45e34: 4eb9 0004 5e4c jsr 45e4c <_POSIX_RWLock_Translate_core_RWLock_return_code> 45e3a: 588f addql #4,%sp 45e3c: 6002 bras 45e40 <pthread_rwlock_timedwrlock+0xa0> 45e3e: 7016 moveq #22,%d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
45e40: 4cee 040c ffec moveml %fp@(-20),%d2-%d3/%a2 45e46: 4e5e unlk %fp 45e48: 4e75 rts
...
00045f80 <pthread_rwlock_wrlock>:
*/
int pthread_rwlock_wrlock(
pthread_rwlock_t *rwlock
)
{
45f80: 4e56 fffc linkw %fp,#-4 45f84: 2f0a movel %a2,%sp@- 45f86: 246e 0008 moveal %fp@(8),%a2
POSIX_RWLock_Control *the_rwlock;
Objects_Locations location;
if ( !rwlock )
45f8a: 4a8a tstl %a2 45f8c: 674e beqs 45fdc <pthread_rwlock_wrlock+0x5c> 45f8e: 486e fffc pea %fp@(-4) 45f92: 2f12 movel %a2@,%sp@- 45f94: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45f9a: 4eb9 0004 83dc jsr 483dc <_Objects_Get>
return EINVAL;
the_rwlock = _POSIX_RWLock_Get( rwlock, &location );
switch ( location ) {
45fa0: 4fef 000c lea %sp@(12),%sp 45fa4: 4aae fffc tstl %fp@(-4) 45fa8: 6632 bnes 45fdc <pthread_rwlock_wrlock+0x5c>
case OBJECTS_LOCAL:
_CORE_RWLock_Obtain_for_writing(
45faa: 42a7 clrl %sp@- 45fac: 2040 moveal %d0,%a0 45fae: 42a7 clrl %sp@- 45fb0: 4878 0001 pea 1 <ADD> 45fb4: 2f12 movel %a2@,%sp@- 45fb6: 4868 0010 pea %a0@(16) 45fba: 4eb9 0004 78a8 jsr 478a8 <_CORE_RWLock_Obtain_for_writing>
true, /* do not timeout -- wait forever */
0,
NULL
);
_Thread_Enable_dispatch();
45fc0: 4eb9 0004 8b66 jsr 48b66 <_Thread_Enable_dispatch>
return _POSIX_RWLock_Translate_core_RWLock_return_code(
45fc6: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45fcc: 2f28 0034 movel %a0@(52),%sp@- 45fd0: 4eb9 0004 5e4c jsr 45e4c <_POSIX_RWLock_Translate_core_RWLock_return_code> 45fd6: 4fef 0018 lea %sp@(24),%sp 45fda: 6002 bras 45fde <pthread_rwlock_wrlock+0x5e> 45fdc: 7016 moveq #22,%d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
45fde: 246e fff8 moveal %fp@(-8),%a2 45fe2: 4e5e unlk %fp 45fe4: 4e75 rts
...
000464dc <pthread_rwlockattr_getpshared>:
int pthread_rwlockattr_getpshared(
const pthread_rwlockattr_t *attr,
int *pshared
)
{
464dc: 4e56 0000 linkw %fp,#0 464e0: 206e 0008 moveal %fp@(8),%a0
if ( !attr )
464e4: 4a88 tstl %a0 464e6: 6710 beqs 464f8 <pthread_rwlockattr_getpshared+0x1c>
return EINVAL;
if ( !attr->is_initialized )
464e8: 4a90 tstl %a0@ 464ea: 670c beqs 464f8 <pthread_rwlockattr_getpshared+0x1c>
return EINVAL;
*pshared = attr->process_shared;
464ec: 226e 000c moveal %fp@(12),%a1 464f0: 4280 clrl %d0 464f2: 22a8 0004 movel %a0@(4),%a1@
return 0;
464f6: 6002 bras 464fa <pthread_rwlockattr_getpshared+0x1e> 464f8: 7016 moveq #22,%d0
}
464fa: 4e5e unlk %fp 464fc: 4e75 rts
...
00046500 <pthread_rwlockattr_init>:
*/
int pthread_rwlockattr_init(
pthread_rwlockattr_t *attr
)
{
46500: 4e56 0000 linkw %fp,#0 46504: 206e 0008 moveal %fp@(8),%a0
if ( !attr )
46508: 4a88 tstl %a0 4650a: 6604 bnes 46510 <pthread_rwlockattr_init+0x10> 4650c: 7016 moveq #22,%d0 4650e: 600a bras 4651a <pthread_rwlockattr_init+0x1a>
return EINVAL;
attr->is_initialized = true;
46510: 7201 moveq #1,%d1
attr->process_shared = PTHREAD_PROCESS_PRIVATE;
46512: 4280 clrl %d0 46514: 42a8 0004 clrl %a0@(4)
)
{
if ( !attr )
return EINVAL;
attr->is_initialized = true;
46518: 2081 movel %d1,%a0@
attr->process_shared = PTHREAD_PROCESS_PRIVATE; return 0; }
4651a: 4e5e unlk %fp 4651c: 4e75 rts
...
0004c9c0 <pthread_self>:
#include <rtems/system.h>
#include <rtems/score/thread.h>
pthread_t pthread_self( void )
{
4c9c0: 4e56 0000 linkw %fp,#0 4c9c4: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0
return _Thread_Executing->Object.id; }
4c9ca: 4e5e unlk %fp 4c9cc: 2028 0008 movel %a0@(8),%d0 4c9d0: 4e75 rts
...
00044b70 <pthread_setcancelstate>:
int pthread_setcancelstate(
int state,
int *oldstate
)
{
44b70: 4e56 0000 linkw %fp,#0 44b74: 202e 0008 movel %fp@(8),%d0 44b78: 226e 000c moveal %fp@(12),%a1
* 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() )
44b7c: 2239 0005 d3c2 movel 5d3c2 <_ISR_Nest_level>,%d1 44b82: 6704 beqs 44b88 <pthread_setcancelstate+0x18> 44b84: 7047 moveq #71,%d0 44b86: 603e bras 44bc6 <pthread_setcancelstate+0x56>
return EPROTO;
if ( !oldstate )
44b88: 4a89 tstl %a1 44b8a: 6738 beqs 44bc4 <pthread_setcancelstate+0x54>
return EINVAL;
if ( state != PTHREAD_CANCEL_ENABLE && state != PTHREAD_CANCEL_DISABLE )
44b8c: 7201 moveq #1,%d1 44b8e: b280 cmpl %d0,%d1 44b90: 6532 bcss 44bc4 <pthread_setcancelstate+0x54>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
44b92: 2239 0005 d328 movel 5d328 <_Thread_Dispatch_disable_level>,%d1 44b98: 5281 addql #1,%d1
return EINVAL;
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
44b9a: 2079 0005 d3e2 moveal 5d3e2 <_Thread_Executing>,%a0 44ba0: 23c1 0005 d328 movel %d1,5d328 <_Thread_Dispatch_disable_level> 44ba6: 2068 010e moveal %a0@(270),%a0
_Thread_Disable_dispatch();
*oldstate = thread_support->cancelability_state;
44baa: 22a8 00d4 movel %a0@(212),%a1@
thread_support->cancelability_state = state;
44bae: 2140 00d4 movel %d0,%a0@(212)
_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(_Thread_Executing);
44bb2: 2f39 0005 d3e2 movel 5d3e2 <_Thread_Executing>,%sp@- 44bb8: 4eb9 0004 97fc jsr 497fc <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>
/*
* _Thread_Enable_dispatch is invoked by above call.
*/
return 0;
44bbe: 588f addql #4,%sp
_Thread_Disable_dispatch();
*oldstate = thread_support->cancelability_state;
thread_support->cancelability_state = state;
_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(_Thread_Executing);
44bc0: 4280 clrl %d0
/*
* _Thread_Enable_dispatch is invoked by above call.
*/
return 0;
44bc2: 6002 bras 44bc6 <pthread_setcancelstate+0x56> 44bc4: 7016 moveq #22,%d0
}
44bc6: 4e5e unlk %fp 44bc8: 4e75 rts
...
00044bcc <pthread_setcanceltype>:
int pthread_setcanceltype(
int type,
int *oldtype
)
{
44bcc: 4e56 0000 linkw %fp,#0 44bd0: 202e 0008 movel %fp@(8),%d0 44bd4: 226e 000c moveal %fp@(12),%a1
* 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() )
44bd8: 2239 0005 d3c2 movel 5d3c2 <_ISR_Nest_level>,%d1 44bde: 6704 beqs 44be4 <pthread_setcanceltype+0x18> 44be0: 7047 moveq #71,%d0 44be2: 603e bras 44c22 <pthread_setcanceltype+0x56>
return EPROTO;
if ( !oldtype )
44be4: 4a89 tstl %a1 44be6: 6738 beqs 44c20 <pthread_setcanceltype+0x54>
return EINVAL;
if ( type != PTHREAD_CANCEL_DEFERRED && type != PTHREAD_CANCEL_ASYNCHRONOUS )
44be8: 7201 moveq #1,%d1 44bea: b280 cmpl %d0,%d1 44bec: 6532 bcss 44c20 <pthread_setcanceltype+0x54> 44bee: 2239 0005 d328 movel 5d328 <_Thread_Dispatch_disable_level>,%d1 44bf4: 5281 addql #1,%d1
return EINVAL;
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
44bf6: 2079 0005 d3e2 moveal 5d3e2 <_Thread_Executing>,%a0 44bfc: 23c1 0005 d328 movel %d1,5d328 <_Thread_Dispatch_disable_level> 44c02: 2068 010e moveal %a0@(270),%a0
_Thread_Disable_dispatch();
*oldtype = thread_support->cancelability_type;
44c06: 22a8 00d8 movel %a0@(216),%a1@
thread_support->cancelability_type = type;
44c0a: 2140 00d8 movel %d0,%a0@(216)
_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(_Thread_Executing);
44c0e: 2f39 0005 d3e2 movel 5d3e2 <_Thread_Executing>,%sp@- 44c14: 4eb9 0004 97fc jsr 497fc <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>
/*
* _Thread_Enable_dispatch is invoked by above call.
*/
return 0;
44c1a: 588f addql #4,%sp
_Thread_Disable_dispatch();
*oldtype = thread_support->cancelability_type;
thread_support->cancelability_type = type;
_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(_Thread_Executing);
44c1c: 4280 clrl %d0
/*
* _Thread_Enable_dispatch is invoked by above call.
*/
return 0;
44c1e: 6002 bras 44c22 <pthread_setcanceltype+0x56> 44c20: 7016 moveq #22,%d0
}
44c22: 4e5e unlk %fp 44c24: 4e75 rts
...
0004abf4 <pthread_sigmask>:
int pthread_sigmask(
int how,
const sigset_t *set,
sigset_t *oset
)
{
4abf4: 4e56 0000 linkw %fp,#0 4abf8: 202e 0008 movel %fp@(8),%d0 4abfc: 2f0b movel %a3,%sp@- 4abfe: 226e 000c moveal %fp@(12),%a1 4ac02: 2f0a movel %a2,%sp@- 4ac04: 246e 0010 moveal %fp@(16),%a2
POSIX_API_Control *api;
if ( !set && !oset )
4ac08: 4a89 tstl %a1 4ac0a: 6604 bnes 4ac10 <pthread_sigmask+0x1c> 4ac0c: 4a8a tstl %a2 4ac0e: 6742 beqs 4ac52 <pthread_sigmask+0x5e>
rtems_set_errno_and_return_minus_one( EINVAL );
api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
4ac10: 2679 0005 e94e moveal 5e94e <_Thread_Executing>,%a3 4ac16: 206b 010e moveal %a3@(270),%a0
if ( oset )
4ac1a: 4a8a tstl %a2 4ac1c: 6704 beqs 4ac22 <pthread_sigmask+0x2e>
*oset = api->signals_blocked;
4ac1e: 24a8 00cc movel %a0@(204),%a2@
if ( !set )
4ac22: 4a89 tstl %a1 4ac24: 675c beqs 4ac82 <pthread_sigmask+0x8e>
return 0;
switch ( how ) {
4ac26: 7201 moveq #1,%d1 4ac28: b280 cmpl %d0,%d1 4ac2a: 670e beqs 4ac3a <pthread_sigmask+0x46> 4ac2c: 123c 0002 moveb #2,%d1 4ac30: b280 cmpl %d0,%d1 4ac32: 670e beqs 4ac42 <pthread_sigmask+0x4e> 4ac34: 4a80 tstl %d0 4ac36: 6714 beqs 4ac4c <pthread_sigmask+0x58> 4ac38: 6018 bras 4ac52 <pthread_sigmask+0x5e>
case SIG_BLOCK:
api->signals_blocked |= *set;
4ac3a: 2011 movel %a1@,%d0 4ac3c: 81a8 00cc orl %d0,%a0@(204)
break;
4ac40: 6020 bras 4ac62 <pthread_sigmask+0x6e>
case SIG_UNBLOCK:
api->signals_blocked &= ~*set;
4ac42: 2011 movel %a1@,%d0 4ac44: 4680 notl %d0 4ac46: c1a8 00cc andl %d0,%a0@(204)
break;
4ac4a: 6016 bras 4ac62 <pthread_sigmask+0x6e>
case SIG_SETMASK:
api->signals_blocked = *set;
4ac4c: 2151 00cc movel %a1@,%a0@(204)
break;
4ac50: 6010 bras 4ac62 <pthread_sigmask+0x6e>
default:
rtems_set_errno_and_return_minus_one( EINVAL );
4ac52: 4eb9 0004 d714 jsr 4d714 <__errno> 4ac58: 72ff moveq #-1,%d1 4ac5a: 2040 moveal %d0,%a0 4ac5c: 7016 moveq #22,%d0 4ac5e: 2080 movel %d0,%a0@ 4ac60: 6022 bras 4ac84 <pthread_sigmask+0x90>
/* XXX are there critical section problems here? */
/* XXX evaluate the new set */
if ( ~api->signals_blocked &
(api->signals_pending | _POSIX_signals_Pending) ) {
4ac62: 2039 0005 ef36 movel 5ef36 <_POSIX_signals_Pending>,%d0
/* XXX are there critical section problems here? */
/* XXX evaluate the new set */
if ( ~api->signals_blocked &
4ac68: 2228 00cc movel %a0@(204),%d1 4ac6c: 4681 notl %d1
(api->signals_pending | _POSIX_signals_Pending) ) {
4ac6e: 80a8 00d0 orl %a0@(208),%d0
/* XXX are there critical section problems here? */
/* XXX evaluate the new set */
if ( ~api->signals_blocked &
4ac72: c081 andl %d1,%d0 4ac74: 670c beqs 4ac82 <pthread_sigmask+0x8e>
(api->signals_pending | _POSIX_signals_Pending) ) {
_Thread_Executing->do_post_task_switch_extension = true;
4ac76: 7001 moveq #1,%d0 4ac78: 1740 0074 moveb %d0,%a3@(116)
_Thread_Dispatch();
4ac7c: 4eb9 0004 79ac jsr 479ac <_Thread_Dispatch> 4ac82: 4281 clrl %d1
}
return 0;
}
4ac84: 246e fff8 moveal %fp@(-8),%a2 4ac88: 2001 movel %d1,%d0 4ac8a: 266e fffc moveal %fp@(-4),%a3 4ac8e: 4e5e unlk %fp 4ac90: 4e75 rts
...
0004509c <pthread_spin_init>:
int pthread_spin_init(
pthread_spinlock_t *spinlock,
int pshared
)
{
4509c: 4e56 fff0 linkw %fp,#-16 450a0: 48d7 1c00 moveml %a2-%a4,%sp@ 450a4: 266e 0008 moveal %fp@(8),%a3
POSIX_Spinlock_Control *the_spinlock;
CORE_spinlock_Attributes attributes;
if ( !spinlock )
450a8: 4a8b tstl %a3 450aa: 6762 beqs 4510e <pthread_spin_init+0x72>
return EINVAL;
switch ( pshared ) {
450ac: 4aae 000c tstl %fp@(12) 450b0: 665c bnes 4510e <pthread_spin_init+0x72>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
450b2: 2039 0005 dc74 movel 5dc74 <_Thread_Dispatch_disable_level>,%d0 450b8: 5280 addql #1,%d0 450ba: 23c0 0005 dc74 movel %d0,5dc74 <_Thread_Dispatch_disable_level>
* This function allocates a spinlock control block from
* the inactive chain of free spinlock control blocks.
*/
RTEMS_INLINE_ROUTINE POSIX_Spinlock_Control *_POSIX_Spinlock_Allocate( void )
{
return (POSIX_Spinlock_Control *)
450c0: 4879 0005 de94 pea 5de94 <_POSIX_Spinlock_Information> 450c6: 45f9 0004 768e lea 4768e <_Thread_Enable_dispatch>,%a2 450cc: 4eb9 0004 6ab8 jsr 46ab8 <_Objects_Allocate>
_Thread_Disable_dispatch(); /* prevents deletion */
the_spinlock = _POSIX_Spinlock_Allocate();
if ( !the_spinlock ) {
450d2: 588f addql #4,%sp 450d4: 2840 moveal %d0,%a4 450d6: 4a80 tstl %d0 450d8: 6606 bnes 450e0 <pthread_spin_init+0x44>
_Thread_Enable_dispatch();
450da: 4e92 jsr %a2@ 450dc: 700b moveq #11,%d0
return EAGAIN;
450de: 6030 bras 45110 <pthread_spin_init+0x74>
}
_CORE_spinlock_Initialize( &the_spinlock->Spinlock, &attributes );
450e0: 486e fffc pea %fp@(-4) 450e4: 486c 0010 pea %a4@(16) 450e8: 4eb9 0004 6558 jsr 46558 <_CORE_spinlock_Initialize>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
450ee: 202c 0008 movel %a4@(8),%d0 450f2: 4281 clrl %d1 450f4: 2079 0005 deac moveal 5deac <_POSIX_Spinlock_Information+0x18>,%a0 450fa: 3200 movew %d0,%d1 450fc: 218c 1c00 movel %a4,%a0@(00000000,%d1:l:4)
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
45100: 42ac 000c clrl %a4@(12)
_Objects_Open_u32( &_POSIX_Spinlock_Information, &the_spinlock->Object, 0 );
*spinlock = the_spinlock->Object.id;
45104: 2680 movel %d0,%a3@
_Thread_Enable_dispatch();
45106: 4e92 jsr %a2@
return 0;
45108: 508f addql #8,%sp
_Objects_Open_u32( &_POSIX_Spinlock_Information, &the_spinlock->Object, 0 );
*spinlock = the_spinlock->Object.id;
_Thread_Enable_dispatch();
4510a: 4280 clrl %d0
return 0;
4510c: 6002 bras 45110 <pthread_spin_init+0x74> 4510e: 7016 moveq #22,%d0
}
45110: 4cee 1c00 fff0 moveml %fp@(-16),%a2-%a4 45116: 4e5e unlk %fp 45118: 4e75 rts
...
00045190 <pthread_spin_trylock>:
*/
int pthread_spin_trylock(
pthread_spinlock_t *spinlock
)
{
45190: 4e56 fffc linkw %fp,#-4 45194: 206e 0008 moveal %fp@(8),%a0 45198: 2f02 movel %d2,%sp@-
POSIX_Spinlock_Control *the_spinlock = NULL;
Objects_Locations location;
CORE_spinlock_Status status;
if ( !spinlock )
4519a: 4a88 tstl %a0 4519c: 6742 beqs 451e0 <pthread_spin_trylock+0x50> 4519e: 486e fffc pea %fp@(-4) 451a2: 2f10 movel %a0@,%sp@- 451a4: 4879 0005 de94 pea 5de94 <_POSIX_Spinlock_Information> 451aa: 4eb9 0004 6f04 jsr 46f04 <_Objects_Get>
return EINVAL;
the_spinlock = _POSIX_Spinlock_Get( spinlock, &location );
switch ( location ) {
451b0: 4fef 000c lea %sp@(12),%sp 451b4: 4aae fffc tstl %fp@(-4) 451b8: 6626 bnes 451e0 <pthread_spin_trylock+0x50>
case OBJECTS_LOCAL:
status = _CORE_spinlock_Wait( &the_spinlock->Spinlock, false, 0 );
451ba: 42a7 clrl %sp@- 451bc: 2040 moveal %d0,%a0 451be: 42a7 clrl %sp@- 451c0: 4868 0010 pea %a0@(16) 451c4: 4eb9 0004 65c8 jsr 465c8 <_CORE_spinlock_Wait> 451ca: 2400 movel %d0,%d2
_Thread_Enable_dispatch();
451cc: 4eb9 0004 768e jsr 4768e <_Thread_Enable_dispatch>
return _POSIX_Spinlock_Translate_core_spinlock_return_code( status );
451d2: 2f02 movel %d2,%sp@- 451d4: 4eb9 0004 5178 jsr 45178 <_POSIX_Spinlock_Translate_core_spinlock_return_code> 451da: 4fef 0010 lea %sp@(16),%sp 451de: 6002 bras 451e2 <pthread_spin_trylock+0x52> 451e0: 7016 moveq #22,%d0
case OBJECTS_ERROR:
break;
}
return EINVAL;
}
451e2: 242e fff8 movel %fp@(-8),%d2 451e6: 4e5e unlk %fp 451e8: 4e75 rts
...
00045420 <pthread_testcancel>:
*
* 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183
*/
void pthread_testcancel( void )
{
45420: 4e56 0000 linkw %fp,#0
* 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() )
45424: 2039 0005 dc6a movel 5dc6a <_ISR_Nest_level>,%d0
*
* 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183
*/
void pthread_testcancel( void )
{
4542a: 2f02 movel %d2,%sp@-
* 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() )
4542c: 4a80 tstl %d0 4542e: 6646 bnes 45476 <pthread_testcancel+0x56>
return;
thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
45430: 2079 0005 dc8a moveal 5dc8a <_Thread_Executing>,%a0 45436: 2039 0005 dbd0 movel 5dbd0 <_Thread_Dispatch_disable_level>,%d0 4543c: 5280 addql #1,%d0 4543e: 2068 010e moveal %a0@(270),%a0 45442: 23c0 0005 dbd0 movel %d0,5dbd0 <_Thread_Dispatch_disable_level>
_Thread_Disable_dispatch();
if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE &&
45448: 4aa8 00d4 tstl %a0@(212) 4544c: 6704 beqs 45452 <pthread_testcancel+0x32>
4544e: 4202 clrb %d2 <== NOT EXECUTED 45450: 6008 bras 4545a <pthread_testcancel+0x3a> <== NOT EXECUTED
/* Setting Cancelability State, P1003.1c/Draft 10, p. 183 */
int _EXFUN(pthread_setcancelstate, (int __state, int *__oldstate));
int _EXFUN(pthread_setcanceltype, (int __type, int *__oldtype));
void _EXFUN(pthread_testcancel, (void));
45452: 4aa8 00dc tstl %a0@(220) 45456: 56c2 sne %d2 45458: 4482 negl %d2
thread_support->cancelation_requested )
cancel = true;
_Thread_Enable_dispatch();
4545a: 4eb9 0004 772a jsr 4772a <_Thread_Enable_dispatch>
if ( cancel )
45460: 4a02 tstb %d2 45462: 6712 beqs 45476 <pthread_testcancel+0x56>
_POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED );
45464: 4878 ffff pea ffffffff <LESS> 45468: 2f39 0005 dc8a movel 5dc8a <_Thread_Executing>,%sp@- 4546e: 4eb9 0004 a594 jsr 4a594 <_POSIX_Thread_Exit>
45474: 508f addql #8,%sp <== NOT EXECUTED
}
45476: 242e fffc movel %fp@(-4),%d2 4547a: 4e5e unlk %fp 4547c: 4e75 rts
...
0004ba48 <rtems_barrier_create>:
rtems_name name,
rtems_attribute attribute_set,
uint32_t maximum_waiters,
rtems_id *id
)
{
4ba48: 4e56 ffe4 linkw %fp,#-28 4ba4c: 202e 0010 movel %fp@(16),%d0 4ba50: 48d7 1c0c moveml %d2-%d3/%a2-%a4,%sp@ 4ba54: 242e 0008 movel %fp@(8),%d2 4ba58: 262e 000c movel %fp@(12),%d3 4ba5c: 266e 0014 moveal %fp@(20),%a3
Barrier_Control *the_barrier;
CORE_barrier_Attributes the_attributes;
if ( !rtems_is_name_valid( name ) )
4ba60: 4a82 tstl %d2 4ba62: 6606 bnes 4ba6a <rtems_barrier_create+0x22> 4ba64: 7003 moveq #3,%d0 4ba66: 6000 0088 braw 4baf0 <rtems_barrier_create+0xa8>
return RTEMS_INVALID_NAME;
if ( !id )
4ba6a: 4a8b tstl %a3 4ba6c: 6604 bnes 4ba72 <rtems_barrier_create+0x2a> 4ba6e: 7009 moveq #9,%d0 4ba70: 607e bras 4baf0 <rtems_barrier_create+0xa8>
return RTEMS_INVALID_ADDRESS;
/* Initialize core barrier attributes */
if ( _Attributes_Is_barrier_automatic( attribute_set ) ) {
4ba72: 0803 0004 btst #4,%d3 4ba76: 6710 beqs 4ba88 <rtems_barrier_create+0x40>
the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE;
if ( maximum_waiters == 0 )
4ba78: 4a80 tstl %d0 4ba7a: 6606 bnes 4ba82 <rtems_barrier_create+0x3a> 4ba7c: 103c 000a moveb #10,%d0 4ba80: 606e bras 4baf0 <rtems_barrier_create+0xa8>
if ( !id )
return RTEMS_INVALID_ADDRESS;
/* Initialize core barrier attributes */
if ( _Attributes_Is_barrier_automatic( attribute_set ) ) {
the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE;
4ba82: 42ae fff8 clrl %fp@(-8) 4ba86: 6006 bras 4ba8e <rtems_barrier_create+0x46>
if ( maximum_waiters == 0 )
return RTEMS_INVALID_NUMBER;
} else
the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE;
4ba88: 7201 moveq #1,%d1 4ba8a: 2d41 fff8 movel %d1,%fp@(-8) 4ba8e: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 4ba94: 5281 addql #1,%d1
the_attributes.maximum_count = maximum_waiters;
4ba96: 2d40 fffc movel %d0,%fp@(-4) 4ba9a: 23c1 0005 cc94 movel %d1,5cc94 <_Thread_Dispatch_disable_level>
* 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 );
4baa0: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4baa6: 45f9 0004 6ce2 lea 46ce2 <_Thread_Enable_dispatch>,%a2 4baac: 4eb9 0004 609c jsr 4609c <_Objects_Allocate>
_Thread_Disable_dispatch(); /* prevents deletion */
the_barrier = _Barrier_Allocate();
if ( !the_barrier ) {
4bab2: 588f addql #4,%sp 4bab4: 2840 moveal %d0,%a4 4bab6: 4a80 tstl %d0 4bab8: 6606 bnes 4bac0 <rtems_barrier_create+0x78>
_Thread_Enable_dispatch();
4baba: 4e92 jsr %a2@ 4babc: 7005 moveq #5,%d0
return RTEMS_TOO_MANY;
4babe: 6030 bras 4baf0 <rtems_barrier_create+0xa8>
}
the_barrier->attribute_set = attribute_set;
4bac0: 2943 0010 movel %d3,%a4@(16)
_CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes );
4bac4: 486e fff8 pea %fp@(-8) 4bac8: 486c 0014 pea %a4@(20) 4bacc: 4eb9 0004 bf0c jsr 4bf0c <_CORE_barrier_Initialize> 4bad2: 202c 0008 movel %a4@(8),%d0 4bad6: 4281 clrl %d1 4bad8: 2079 0005 d540 moveal 5d540 <_Barrier_Information+0x18>,%a0 4bade: 3200 movew %d0,%d1
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
4bae0: 2942 000c movel %d2,%a4@(12)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4bae4: 218c 1c00 movel %a4,%a0@(00000000,%d1:l:4)
&_Barrier_Information,
&the_barrier->Object,
(Objects_Name) name
);
*id = the_barrier->Object.id;
4bae8: 2680 movel %d0,%a3@
_Thread_Enable_dispatch();
4baea: 4e92 jsr %a2@
return RTEMS_SUCCESSFUL;
4baec: 508f addql #8,%sp
(Objects_Name) name
);
*id = the_barrier->Object.id;
_Thread_Enable_dispatch();
4baee: 4280 clrl %d0
return RTEMS_SUCCESSFUL; }
4baf0: 4cee 1c0c ffe4 moveml %fp@(-28),%d2-%d3/%a2-%a4 4baf6: 4e5e unlk %fp 4baf8: 4e75 rts
...
0004bafc <rtems_barrier_delete>:
*/
rtems_status_code rtems_barrier_delete(
rtems_id id
)
{
4bafc: 4e56 fffc linkw %fp,#-4 4bb00: 2f0a movel %a2,%sp@-
RTEMS_INLINE_ROUTINE Barrier_Control *_Barrier_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Barrier_Control *)
4bb02: 486e fffc pea %fp@(-4) 4bb06: 2f2e 0008 movel %fp@(8),%sp@- 4bb0a: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4bb10: 4eb9 0004 64e8 jsr 464e8 <_Objects_Get>
Barrier_Control *the_barrier;
Objects_Locations location;
the_barrier = _Barrier_Get( id, &location );
switch ( location ) {
4bb16: 4fef 000c lea %sp@(12),%sp 4bb1a: 2440 moveal %d0,%a2 4bb1c: 4aae fffc tstl %fp@(-4) 4bb20: 6704 beqs 4bb26 <rtems_barrier_delete+0x2a> 4bb22: 7004 moveq #4,%d0 4bb24: 6038 bras 4bb5e <rtems_barrier_delete+0x62>
case OBJECTS_LOCAL:
_CORE_barrier_Flush(
4bb26: 4878 0002 pea 2 <DOUBLE_FLOAT> 4bb2a: 42a7 clrl %sp@- 4bb2c: 486a 0014 pea %a2@(20) 4bb30: 4eb9 0004 7368 jsr 47368 <_Thread_queue_Flush>
&the_barrier->Barrier,
NULL,
CORE_BARRIER_WAS_DELETED
);
_Objects_Close( &_Barrier_Information, &the_barrier->Object );
4bb36: 2f0a movel %a2,%sp@- 4bb38: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4bb3e: 4eb9 0004 611c jsr 4611c <_Objects_Close>
*/
RTEMS_INLINE_ROUTINE void _Barrier_Free (
Barrier_Control *the_barrier
)
{
_Objects_Free( &_Barrier_Information, &the_barrier->Object );
4bb44: 2f0a movel %a2,%sp@- 4bb46: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4bb4c: 4eb9 0004 6390 jsr 46390 <_Objects_Free>
_Barrier_Free( the_barrier );
_Thread_Enable_dispatch();
4bb52: 4eb9 0004 6ce2 jsr 46ce2 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
4bb58: 4fef 001c lea %sp@(28),%sp
_Objects_Close( &_Barrier_Information, &the_barrier->Object );
_Barrier_Free( the_barrier );
_Thread_Enable_dispatch();
4bb5c: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4bb5e: 246e fff8 moveal %fp@(-8),%a2 4bb62: 4e5e unlk %fp 4bb64: 4e75 rts
...
0004bb68 <rtems_barrier_release>:
rtems_status_code rtems_barrier_release(
rtems_id id,
uint32_t *released
)
{
4bb68: 4e56 fffc linkw %fp,#-4 4bb6c: 2f0a movel %a2,%sp@- 4bb6e: 246e 000c moveal %fp@(12),%a2 4bb72: 2f02 movel %d2,%sp@- 4bb74: 242e 0008 movel %fp@(8),%d2
Barrier_Control *the_barrier;
Objects_Locations location;
if ( !released )
4bb78: 4a8a tstl %a2 4bb7a: 6604 bnes 4bb80 <rtems_barrier_release+0x18> 4bb7c: 7009 moveq #9,%d0 4bb7e: 603e bras 4bbbe <rtems_barrier_release+0x56>
RTEMS_INLINE_ROUTINE Barrier_Control *_Barrier_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Barrier_Control *)
4bb80: 486e fffc pea %fp@(-4) 4bb84: 2f02 movel %d2,%sp@- 4bb86: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4bb8c: 4eb9 0004 64e8 jsr 464e8 <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_barrier = _Barrier_Get( id, &location );
switch ( location ) {
4bb92: 4fef 000c lea %sp@(12),%sp 4bb96: 4aae fffc tstl %fp@(-4) 4bb9a: 6704 beqs 4bba0 <rtems_barrier_release+0x38> 4bb9c: 7004 moveq #4,%d0 4bb9e: 601e bras 4bbbe <rtems_barrier_release+0x56>
case OBJECTS_LOCAL:
*released = _CORE_barrier_Release( &the_barrier->Barrier, id, NULL );
4bba0: 42a7 clrl %sp@- 4bba2: 2040 moveal %d0,%a0 4bba4: 2f02 movel %d2,%sp@- 4bba6: 4868 0014 pea %a0@(20) 4bbaa: 4eb9 0004 bf48 jsr 4bf48 <_CORE_barrier_Release> 4bbb0: 2480 movel %d0,%a2@
_Thread_Enable_dispatch();
4bbb2: 4eb9 0004 6ce2 jsr 46ce2 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
4bbb8: 4fef 000c lea %sp@(12),%sp
the_barrier = _Barrier_Get( id, &location );
switch ( location ) {
case OBJECTS_LOCAL:
*released = _CORE_barrier_Release( &the_barrier->Barrier, id, NULL );
_Thread_Enable_dispatch();
4bbbc: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4bbbe: 242e fff4 movel %fp@(-12),%d2 4bbc2: 246e fff8 moveal %fp@(-8),%a2 4bbc6: 4e5e unlk %fp 4bbc8: 4e75 rts
...
00046438 <rtems_build_id>:
uint32_t api,
uint32_t class,
uint32_t node,
uint32_t index
)
{
46438: 7218 moveq #24,%d1 4643a: 4e56 0000 linkw %fp,#0 4643e: 202e 000c movel %fp@(12),%d0 46442: 2f02 movel %d2,%sp@- 46444: 242e 0008 movel %fp@(8),%d2 46448: e3aa lsll %d1,%d2 4644a: 123c 001b moveb #27,%d1 4644e: e3a8 lsll %d1,%d0 46450: 222e 0010 movel %fp@(16),%d1 46454: 8082 orl %d2,%d0 46456: 4841 swap %d1 46458: 4241 clrw %d1
return _Objects_Build_id( api, class, node, index ); }
4645a: 241f movel %sp@+,%d2
uint32_t api,
uint32_t class,
uint32_t node,
uint32_t index
)
{
4645c: 80ae 0014 orl %fp@(20),%d0
return _Objects_Build_id( api, class, node, index ); }
46460: 4e5e unlk %fp 46462: 8081 orl %d1,%d0 46464: 4e75 rts
...
00048920 <rtems_clock_get>:
rtems_status_code rtems_clock_get(
rtems_clock_get_options option,
void *time_buffer
)
{
48920: 4e56 0000 linkw %fp,#0 48924: 202e 0008 movel %fp@(8),%d0 48928: 2f0a movel %a2,%sp@- 4892a: 246e 000c moveal %fp@(12),%a2
if ( !time_buffer )
4892e: 4a8a tstl %a2 48930: 6604 bnes 48936 <rtems_clock_get+0x16> 48932: 7209 moveq #9,%d1 48934: 6066 bras 4899c <rtems_clock_get+0x7c>
return RTEMS_INVALID_ADDRESS;
if ( option == RTEMS_CLOCK_GET_TOD )
48936: 4a80 tstl %d0 48938: 6610 bnes 4894a <rtems_clock_get+0x2a>
return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer );
4893a: 2d4a 0008 movel %a2,%fp@(8)
if ( option == RTEMS_CLOCK_GET_TIME_VALUE )
return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer );
return RTEMS_INVALID_NUMBER;
}
4893e: 246e fffc moveal %fp@(-4),%a2 48942: 4e5e unlk %fp
{
if ( !time_buffer )
return RTEMS_INVALID_ADDRESS;
if ( option == RTEMS_CLOCK_GET_TOD )
return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer );
48944: 4ef9 0004 89f8 jmp 489f8 <rtems_clock_get_tod>
if ( option == RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH )
4894a: 7201 moveq #1,%d1 4894c: b280 cmpl %d0,%d1 4894e: 6610 bnes 48960 <rtems_clock_get+0x40>
return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer);
48950: 2d4a 0008 movel %a2,%fp@(8)
if ( option == RTEMS_CLOCK_GET_TIME_VALUE )
return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer );
return RTEMS_INVALID_NUMBER;
}
48954: 246e fffc moveal %fp@(-4),%a2 48958: 4e5e unlk %fp
if ( option == RTEMS_CLOCK_GET_TOD )
return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer );
if ( option == RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH )
return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer);
4895a: 4ef9 0004 89a8 jmp 489a8 <rtems_clock_get_seconds_since_epoch>
if ( option == RTEMS_CLOCK_GET_TICKS_SINCE_BOOT ) {
48960: 7202 moveq #2,%d1 48962: b280 cmpl %d0,%d1 48964: 6608 bnes 4896e <rtems_clock_get+0x4e>
rtems_interval *interval = (rtems_interval *)time_buffer;
*interval = rtems_clock_get_ticks_since_boot();
48966: 4eb9 0004 89e8 jsr 489e8 <rtems_clock_get_ticks_since_boot> 4896c: 600c bras 4897a <rtems_clock_get+0x5a>
return RTEMS_SUCCESSFUL;
}
if ( option == RTEMS_CLOCK_GET_TICKS_PER_SECOND ) {
4896e: 7203 moveq #3,%d1 48970: b280 cmpl %d0,%d1 48972: 660c bnes 48980 <rtems_clock_get+0x60>
rtems_interval *interval = (rtems_interval *)time_buffer;
*interval = rtems_clock_get_ticks_per_second();
48974: 4eb9 0004 89d0 jsr 489d0 <rtems_clock_get_ticks_per_second> 4897a: 2480 movel %d0,%a2@ 4897c: 4281 clrl %d1
return RTEMS_SUCCESSFUL;
4897e: 601c bras 4899c <rtems_clock_get+0x7c>
}
if ( option == RTEMS_CLOCK_GET_TIME_VALUE )
48980: 7204 moveq #4,%d1 48982: b280 cmpl %d0,%d1 48984: 6706 beqs 4898c <rtems_clock_get+0x6c> 48986: 123c 000a moveb #10,%d1 4898a: 6010 bras 4899c <rtems_clock_get+0x7c>
return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer );
4898c: 2d4a 0008 movel %a2,%fp@(8)
return RTEMS_INVALID_NUMBER;
}
48990: 246e fffc moveal %fp@(-4),%a2 48994: 4e5e unlk %fp
*interval = rtems_clock_get_ticks_per_second();
return RTEMS_SUCCESSFUL;
}
if ( option == RTEMS_CLOCK_GET_TIME_VALUE )
return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer );
48996: 4ef9 0004 8aac jmp 48aac <rtems_clock_get_tod_timeval>
return RTEMS_INVALID_NUMBER;
}
4899c: 246e fffc moveal %fp@(-4),%a2 489a0: 2001 movel %d1,%d0 489a2: 4e5e unlk %fp 489a4: 4e75 rts
...
00044910 <rtems_clock_get_ticks_since_boot>:
#include <rtems/score/thread.h>
#include <rtems/score/tod.h>
#include <rtems/score/watchdog.h>
rtems_interval rtems_clock_get_ticks_since_boot(void)
{
44910: 4e56 0000 linkw %fp,#0
return _Watchdog_Ticks_since_boot;
44914: 2039 0005 cdd8 movel 5cdd8 <_Watchdog_Ticks_since_boot>,%d0
}
4491a: 4e5e unlk %fp 4491c: 4e75 rts
...
000456bc <rtems_clock_get_tod>:
#include <rtems/score/watchdog.h>
rtems_status_code rtems_clock_get_tod(
rtems_time_of_day *time_buffer
)
{
456bc: 4e56 ffcc linkw %fp,#-52 456c0: 2f0a movel %a2,%sp@- 456c2: 246e 0008 moveal %fp@(8),%a2 456c6: 2f02 movel %d2,%sp@-
rtems_time_of_day *tmbuf = time_buffer;
struct tm time;
struct timeval now;
if ( !time_buffer )
456c8: 4a8a tstl %a2 456ca: 6606 bnes 456d2 <rtems_clock_get_tod+0x16> 456cc: 7009 moveq #9,%d0 456ce: 6000 0092 braw 45762 <rtems_clock_get_tod+0xa6>
return RTEMS_INVALID_ADDRESS;
if ( !_TOD_Is_set )
456d2: 4a39 0006 6bb8 tstb 66bb8 <_TOD_Is_set> 456d8: 6606 bnes 456e0 <rtems_clock_get_tod+0x24> 456da: 700b moveq #11,%d0 456dc: 6000 0084 braw 45762 <rtems_clock_get_tod+0xa6>
{
ISR_Level level;
struct timespec now;
suseconds_t useconds;
_ISR_Disable(level);
456e0: 203c 0000 0700 movel #1792,%d0 456e6: 40c2 movew %sr,%d2 456e8: 8082 orl %d2,%d0 456ea: 46c0 movew %d0,%sr
_TOD_Get( &now );
456ec: 486e fff0 pea %fp@(-16) 456f0: 4eb9 0004 6e14 jsr 46e14 <_TOD_Get>
_ISR_Enable(level);
456f6: 46c2 movew %d2,%sr
useconds = (suseconds_t)now.tv_nsec;
useconds /= (suseconds_t)TOD_NANOSECONDS_PER_MICROSECOND;
time->tv_sec = now.tv_sec;
time->tv_usec = useconds;
456f8: 243c 0000 03e8 movel #1000,%d2
/* Obtain the current time */
_TOD_Get_timeval( &now );
/* Split it into a closer format */
gmtime_r( &now.tv_sec, &time );
456fe: 486e ffcc pea %fp@(-52)
_ISR_Disable(level);
_TOD_Get( &now );
_ISR_Enable(level);
useconds = (suseconds_t)now.tv_nsec;
45702: 202e fff4 movel %fp@(-12),%d0 45706: 486e fff8 pea %fp@(-8)
useconds /= (suseconds_t)TOD_NANOSECONDS_PER_MICROSECOND;
time->tv_sec = now.tv_sec;
4570a: 2d6e fff0 fff8 movel %fp@(-16),%fp@(-8)
time->tv_usec = useconds;
45710: 4c42 0800 remsl %d2,%d0,%d0 45714: 2d40 fffc movel %d0,%fp@(-4) 45718: 4eb9 0004 e608 jsr 4e608 <gmtime_r>
/* Now adjust it to the RTEMS format */
tmbuf->year = time.tm_year + 1900;
tmbuf->month = time.tm_mon + 1;
4571e: 206e ffdc moveal %fp@(-36),%a0 45722: 5288 addql #1,%a0
tmbuf->minute = time.tm_min;
tmbuf->second = time.tm_sec;
tmbuf->ticks = now.tv_usec /
rtems_configuration_get_microseconds_per_tick();
return RTEMS_SUCCESSFUL;
45724: 4fef 000c lea %sp@(12),%sp
tmbuf->month = time.tm_mon + 1; tmbuf->day = time.tm_mday; tmbuf->hour = time.tm_hour; tmbuf->minute = time.tm_min; tmbuf->second = time.tm_sec; tmbuf->ticks = now.tv_usec /
45728: 4280 clrl %d0
/* Split it into a closer format */
gmtime_r( &now.tv_sec, &time );
/* Now adjust it to the RTEMS format */
tmbuf->year = time.tm_year + 1900;
tmbuf->month = time.tm_mon + 1;
4572a: 2548 0004 movel %a0,%a2@(4)
/* Split it into a closer format */
gmtime_r( &now.tv_sec, &time );
/* Now adjust it to the RTEMS format */
tmbuf->year = time.tm_year + 1900;
4572e: 206e ffe0 moveal %fp@(-32),%a0 45732: 41e8 076c lea %a0@(1900),%a0
tmbuf->month = time.tm_mon + 1; tmbuf->day = time.tm_mday;
45736: 256e ffd8 0008 movel %fp@(-40),%a2@(8)
tmbuf->hour = time.tm_hour;
4573c: 256e ffd4 000c movel %fp@(-44),%a2@(12)
tmbuf->minute = time.tm_min;
45742: 256e ffd0 0010 movel %fp@(-48),%a2@(16)
tmbuf->second = time.tm_sec;
45748: 256e ffcc 0014 movel %fp@(-52),%a2@(20)
/* Split it into a closer format */
gmtime_r( &now.tv_sec, &time );
/* Now adjust it to the RTEMS format */
tmbuf->year = time.tm_year + 1900;
4574e: 2488 movel %a0,%a2@
tmbuf->month = time.tm_mon + 1; tmbuf->day = time.tm_mday; tmbuf->hour = time.tm_hour; tmbuf->minute = time.tm_min; tmbuf->second = time.tm_sec; tmbuf->ticks = now.tv_usec /
45750: 242e fffc movel %fp@(-4),%d2 45754: 41f9 0005 d630 lea 5d630 <Configuration+0xc>,%a0 4575a: 4c50 2002 remul %a0@,%d2,%d2 4575e: 2542 0018 movel %d2,%a2@(24)
rtems_configuration_get_microseconds_per_tick();
return RTEMS_SUCCESSFUL;
}
45762: 242e ffc4 movel %fp@(-60),%d2 45766: 246e ffc8 moveal %fp@(-56),%a2 4576a: 4e5e unlk %fp 4576c: 4e75 rts
...
0004493c <rtems_clock_tick>:
*
* NOTE: This routine only works for leap-years through 2099.
*/
rtems_status_code rtems_clock_tick( void )
{
4493c: 4e56 0000 linkw %fp,#0
_TOD_Tickle_ticks();
44940: 4eb9 0004 5c8c jsr 45c8c <_TOD_Tickle_ticks>
*/
RTEMS_INLINE_ROUTINE void _Watchdog_Tickle_ticks( void )
{
_Watchdog_Tickle( &_Watchdog_Ticks_chain );
44946: 4879 0005 cd6c pea 5cd6c <_Watchdog_Ticks_chain> 4494c: 4eb9 0004 7de0 jsr 47de0 <_Watchdog_Tickle>
_Watchdog_Tickle_ticks();
_Thread_Tickle_timeslice();
44952: 4eb9 0004 786c jsr 4786c <_Thread_Tickle_timeslice>
if ( _Thread_Is_context_switch_necessary() &&
44958: 588f addql #4,%sp
* otherwise.
*/
RTEMS_INLINE_ROUTINE bool _Thread_Is_context_switch_necessary( void )
{
return ( _Context_Switch_necessary );
4495a: 1039 0005 cd5e moveb 5cd5e <_Context_Switch_necessary>,%d0 44960: 670e beqs 44970 <rtems_clock_tick+0x34>
* otherwise.
*/
RTEMS_INLINE_ROUTINE bool _Thread_Is_dispatching_enabled( void )
{
return ( _Thread_Dispatch_disable_level == 0 );
44962: 2039 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d0 44968: 6606 bnes 44970 <rtems_clock_tick+0x34>
_Thread_Is_dispatching_enabled() )
_Thread_Dispatch();
4496a: 4eb9 0004 6b90 jsr 46b90 <_Thread_Dispatch>
return RTEMS_SUCCESSFUL;
}
44970: 4280 clrl %d0 44972: 4e5e unlk %fp 44974: 4e75 rts
...
00049f70 <rtems_debug_is_enabled>:
* rtems_debug_is_enabled
*/
bool rtems_debug_is_enabled(
rtems_debug_control level
)
{
49f70: 4e56 0000 linkw %fp,#0 49f74: 202e 0008 movel %fp@(8),%d0
return (_Debug_Level & level) ? true : false; }
49f78: 4e5e unlk %fp
* rtems_debug_is_enabled
*/
bool rtems_debug_is_enabled(
rtems_debug_control level
)
{
49f7a: c0b9 0005 cd52 andl 5cd52 <_Debug_Level>,%d0 49f80: 56c0 sne %d0
return (_Debug_Level & level) ? true : false; }
49f82: 4480 negl %d0 49f84: 4e75 rts
...
00044978 <rtems_event_receive>:
rtems_event_set event_in,
rtems_option option_set,
rtems_interval ticks,
rtems_event_set *event_out
)
{
44978: 4e56 0000 linkw %fp,#0 4497c: 202e 0008 movel %fp@(8),%d0 44980: 206e 0014 moveal %fp@(20),%a0
RTEMS_API_Control *api;
if ( !event_out )
44984: 4a88 tstl %a0 44986: 6604 bnes 4498c <rtems_event_receive+0x14> 44988: 7009 moveq #9,%d0 4498a: 6046 bras 449d2 <rtems_event_receive+0x5a>
return RTEMS_INVALID_ADDRESS;
api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ];
4498c: 2279 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a1 44992: 2269 010a moveal %a1@(266),%a1
if ( _Event_sets_Is_empty( event_in ) ) {
44996: 4a80 tstl %d0 44998: 6604 bnes 4499e <rtems_event_receive+0x26>
*event_out = api->pending_events;
4499a: 2091 movel %a1@,%a0@
return RTEMS_SUCCESSFUL;
4499c: 6034 bras 449d2 <rtems_event_receive+0x5a>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
4499e: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 449a4: 5281 addql #1,%d1 449a6: 23c1 0005 cc94 movel %d1,5cc94 <_Thread_Dispatch_disable_level>
}
_Thread_Disable_dispatch();
_Event_Seize( event_in, option_set, ticks, event_out );
449ac: 2f08 movel %a0,%sp@- 449ae: 2f2e 0010 movel %fp@(16),%sp@- 449b2: 2f2e 000c movel %fp@(12),%sp@- 449b6: 2f00 movel %d0,%sp@- 449b8: 4eb9 0004 49d8 jsr 449d8 <_Event_Seize>
_Thread_Enable_dispatch();
449be: 4eb9 0004 6ce2 jsr 46ce2 <_Thread_Enable_dispatch>
return( _Thread_Executing->Wait.return_code );
449c4: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 449ca: 4fef 0010 lea %sp@(16),%sp 449ce: 2028 0034 movel %a0@(52),%d0
}
449d2: 4e5e unlk %fp 449d4: 4e75 rts
...
00046ff4 <rtems_get_version_string>:
#endif
#include <rtems/system.h>
const char *rtems_get_version_string(void)
{
46ff4: 4e56 0000 linkw %fp,#0
return _RTEMS_version; }
46ff8: 203c 0005 df0a movel #384778,%d0 46ffe: 4e5e unlk %fp 47000: 4e75 rts
...
000454b2 <rtems_initialize_data_structures>:
#endif
Objects_Information *_Internal_Objects[ OBJECTS_INTERNAL_CLASSES_LAST + 1 ];
void rtems_initialize_data_structures(void)
{
454b2: 4e56 0000 linkw %fp,#0 454b6: 42b9 0005 ce1c clrl 5ce1c <_System_state_Current>
#endif
/*
* Initialize any target architecture specific support as early as possible
*/
_CPU_Initialize();
454bc: 4eb9 0004 7fec jsr 47fec <_CPU_Initialize>
/*
* Do this as early as possible to ensure no debugging output
* is even attempted to be printed.
*/
_Debug_Manager_initialization();
454c2: 4eb9 0004 9f3c jsr 49f3c <_Debug_Manager_initialization>
_API_extensions_Initialization();
454c8: 4eb9 0004 5740 jsr 45740 <_API_extensions_Initialization>
* This routine initializes the thread dispatching subsystem.
*/
RTEMS_INLINE_ROUTINE void _Thread_Dispatch_initialization( void )
{
_Thread_Dispatch_disable_level = 1;
454ce: 7001 moveq #1,%d0 454d0: 23c0 0005 cc94 movel %d0,5cc94 <_Thread_Dispatch_disable_level>
/*
* Before this is called, we are not allowed to allocate memory
* from the Workspace because it is not initialized.
*/
_Workspace_Handler_initialization();
454d6: 4eb9 0004 7ec4 jsr 47ec4 <_Workspace_Handler_initialization>
_User_extensions_Handler_initialization();
454dc: 4eb9 0004 79e0 jsr 479e0 <_User_extensions_Handler_initialization>
_ISR_Handler_initialization();
454e2: 4eb9 0004 6034 jsr 46034 <_ISR_Handler_initialization>
/*
* Initialize the internal support API and allocator Mutex
*/
_Objects_Information_table[OBJECTS_INTERNAL_API] = _Internal_Objects;
_API_Mutex_Initialization( 1 );
454e8: 4878 0001 pea 1 <ADD>
_ISR_Handler_initialization();
/*
* Initialize the internal support API and allocator Mutex
*/
_Objects_Information_table[OBJECTS_INTERNAL_API] = _Internal_Objects;
454ec: 203c 0005 ccaa movel #380074,%d0 454f2: 23c0 0005 cc50 movel %d0,5cc50 <_Objects_Information_table+0x4>
_API_Mutex_Initialization( 1 );
454f8: 4eb9 0004 5870 jsr 45870 <_API_Mutex_Initialization>
_API_Mutex_Allocate( &_RTEMS_Allocator_Mutex );
454fe: 4879 0005 cd46 pea 5cd46 <_RTEMS_Allocator_Mutex> 45504: 4eb9 0004 57d0 jsr 457d0 <_API_Mutex_Allocate>
#include <rtems/itron/itronapi.h>
#endif
Objects_Information *_Internal_Objects[ OBJECTS_INTERNAL_CLASSES_LAST + 1 ];
void rtems_initialize_data_structures(void)
4550a: 508f addql #8,%sp
RTEMS_INLINE_ROUTINE void _Priority_Handler_initialization( void )
{
int index;
_Priority_Major_bit_map = 0;
4550c: 41f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a0 45512: 4240 clrw %d0 45514: 33c0 0005 cd44 movew %d0,5cd44 <_Priority_Major_bit_map>
for ( index=0 ; index <16 ; index++ )
_Priority_Bit_map[ index ] = 0;
4551a: 4258 clrw %a0@+
RTEMS_INLINE_ROUTINE void _Priority_Handler_initialization( void )
{
int index;
_Priority_Major_bit_map = 0;
for ( index=0 ; index <16 ; index++ )
4551c: b1fc 0005 cdd4 cmpal #380372,%a0 45522: 66f6 bnes 4551a <rtems_initialize_data_structures+0x68>
_API_Mutex_Initialization( 1 );
_API_Mutex_Allocate( &_RTEMS_Allocator_Mutex );
_Priority_Handler_initialization();
_Watchdog_Handler_initialization();
45524: 4eb9 0004 7d18 jsr 47d18 <_Watchdog_Handler_initialization>
_TOD_Handler_initialization();
4552a: 4eb9 0004 5c5c jsr 45c5c <_TOD_Handler_initialization>
_Thread_Handler_initialization();
45530: 4eb9 0004 6f50 jsr 46f50 <_Thread_Handler_initialization>
_MPCI_Handler_initialization( RTEMS_TIMEOUT );
#endif
/* MANAGERS */
_RTEMS_API_Initialize();
45536: 4eb9 0004 56ec jsr 456ec <_RTEMS_API_Initialize>
_Extension_Manager_initialization();
4553c: 4eb9 0004 558c jsr 4558c <_Extension_Manager_initialization>
_IO_Manager_initialization();
45542: 4eb9 0004 5604 jsr 45604 <_IO_Manager_initialization>
#ifdef RTEMS_POSIX_API
_POSIX_API_Initialize();
45548: 4eb9 0004 5698 jsr 45698 <_POSIX_API_Initialize>
_Thread_Create_idle();
/*
* Scheduling can properly occur now as long as we avoid dispatching.
*/
}
4554e: 4e5e unlk %fp 45550: 7001 moveq #1,%d0 45552: 23c0 0005 ce1c movel %d0,5ce1c <_System_state_Current>
* _Thread_Executing and _Thread_Heir are not set. * * At this point all API extensions are in place. After the call to * _Thread_Create_idle() _Thread_Executing and _Thread_Heir will be set. */ _Thread_Create_idle();
45558: 4ef9 0004 6aa4 jmp 46aa4 <_Thread_Create_idle>
...
00044cb8 <rtems_interrupt_catch>:
rtems_status_code rtems_interrupt_catch(
rtems_isr_entry new_isr_handler,
rtems_vector_number vector,
rtems_isr_entry *old_isr_handler
)
{
44cb8: 4e56 0000 linkw %fp,#0 44cbc: 222e 0008 movel %fp@(8),%d1 44cc0: 202e 000c movel %fp@(12),%d0 44cc4: 206e 0010 moveal %fp@(16),%a0
if ( !_ISR_Is_vector_number_valid( vector ) )
44cc8: 0c80 0000 00ff cmpil #255,%d0 44cce: 6304 blss 44cd4 <rtems_interrupt_catch+0x1c> 44cd0: 700a moveq #10,%d0 44cd2: 601e bras 44cf2 <rtems_interrupt_catch+0x3a>
return RTEMS_INVALID_NUMBER;
if ( !_ISR_Is_valid_user_handler( (void *) new_isr_handler ) )
44cd4: 4a81 tstl %d1 44cd6: 6718 beqs 44cf0 <rtems_interrupt_catch+0x38>
return RTEMS_INVALID_ADDRESS;
if ( !_ISR_Is_valid_user_handler( (void *) old_isr_handler ) )
44cd8: 4a88 tstl %a0 44cda: 6714 beqs 44cf0 <rtems_interrupt_catch+0x38>
return RTEMS_INVALID_ADDRESS;
_ISR_Install_vector(
44cdc: 2f08 movel %a0,%sp@- 44cde: 2f01 movel %d1,%sp@- 44ce0: 2f00 movel %d0,%sp@- 44ce2: 4eb9 0004 8026 jsr 48026 <_CPU_ISR_install_vector>
vector, (proc_ptr)new_isr_handler, (proc_ptr *)old_isr_handler );
return RTEMS_SUCCESSFUL;
44ce8: 4fef 000c lea %sp@(12),%sp
return RTEMS_INVALID_ADDRESS;
if ( !_ISR_Is_valid_user_handler( (void *) old_isr_handler ) )
return RTEMS_INVALID_ADDRESS;
_ISR_Install_vector(
44cec: 4280 clrl %d0
vector, (proc_ptr)new_isr_handler, (proc_ptr *)old_isr_handler );
return RTEMS_SUCCESSFUL;
44cee: 6002 bras 44cf2 <rtems_interrupt_catch+0x3a> 44cf0: 7009 moveq #9,%d0
}
44cf2: 4e5e unlk %fp 44cf4: 4e75 rts
...
0004527c <rtems_interrupt_level_attribute>:
rtems_attribute rtems_interrupt_level_attribute(
uint32_t level
)
{
return RTEMS_INTERRUPT_LEVEL(level);
}
4527c: 7007 moveq #7,%d0
uint32_t rtems_interrupt_mask = RTEMS_INTERRUPT_MASK;
rtems_attribute rtems_interrupt_level_attribute(
uint32_t level
)
{
4527e: 4e56 0000 linkw %fp,#0
return RTEMS_INTERRUPT_LEVEL(level); }
45282: c0ae 0008 andl %fp@(8),%d0 45286: 4e5e unlk %fp 45288: 4e75 rts
...
00046d4c <rtems_io_register_driver>:
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
)
{
46d4c: 4e56 0000 linkw %fp,#0 46d50: 206e 000c moveal %fp@(12),%a0 46d54: 2f0a movel %a2,%sp@- 46d56: 226e 0010 moveal %fp@(16),%a1 46d5a: 2f02 movel %d2,%sp@- 46d5c: 242e 0008 movel %fp@(8),%d2
rtems_device_major_number major_limit = _IO_Number_of_drivers;
46d60: 2039 0006 28c6 movel 628c6 <_IO_Number_of_drivers>,%d0
if ( rtems_interrupt_is_in_progress() )
46d66: 2239 0006 20a6 movel 620a6 <_ISR_Nest_level>,%d1 46d6c: 6706 beqs 46d74 <rtems_io_register_driver+0x28> 46d6e: 7012 moveq #18,%d0 46d70: 6000 00d6 braw 46e48 <rtems_io_register_driver+0xfc>
return RTEMS_CALLED_FROM_ISR;
if ( registered_major == NULL )
46d74: 4a89 tstl %a1 46d76: 6700 00ce beqw 46e46 <rtems_io_register_driver+0xfa>
return RTEMS_INVALID_ADDRESS;
/* Set it to an invalid value */
*registered_major = major_limit;
46d7a: 2280 movel %d0,%a1@
if ( driver_table == NULL )
46d7c: 4a88 tstl %a0 46d7e: 6700 00c6 beqw 46e46 <rtems_io_register_driver+0xfa>
static inline bool rtems_io_is_empty_table(
const rtems_driver_address_table *table
)
{
return table->initialization_entry == NULL && table->open_entry == NULL;
46d82: 4a90 tstl %a0@ 46d84: 6600 00ce bnew 46e54 <rtems_io_register_driver+0x108> 46d88: 4aa8 0004 tstl %a0@(4) 46d8c: 6600 00c6 bnew 46e54 <rtems_io_register_driver+0x108> 46d90: 6000 00b4 braw 46e46 <rtems_io_register_driver+0xfa>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
46d94: 2039 0006 200c movel 6200c <_Thread_Dispatch_disable_level>,%d0 46d9a: 5280 addql #1,%d0 46d9c: 23c0 0006 200c movel %d0,6200c <_Thread_Dispatch_disable_level>
if ( major >= major_limit )
return RTEMS_INVALID_NUMBER;
_Thread_Disable_dispatch();
if ( major == 0 ) {
46da2: 4a82 tstl %d2 46da4: 662c bnes 46dd2 <rtems_io_register_driver+0x86>
static rtems_status_code rtems_io_obtain_major_number(
rtems_device_major_number *major
)
{
rtems_device_major_number n = _IO_Number_of_drivers;
46da6: 2039 0006 28c6 movel 628c6 <_IO_Number_of_drivers>,%d0 46dac: 2479 0006 28ca moveal 628ca <_IO_Driver_address_table>,%a2 46db2: 6010 bras 46dc4 <rtems_io_register_driver+0x78>
static inline bool rtems_io_is_empty_table(
const rtems_driver_address_table *table
)
{
return table->initialization_entry == NULL && table->open_entry == NULL;
46db4: 4a92 tstl %a2@ 46db6: 6600 00a6 bnew 46e5e <rtems_io_register_driver+0x112> 46dba: 4aaa 0004 tstl %a2@(4) 46dbe: 6600 009e bnew 46e5e <rtems_io_register_driver+0x112> 46dc2: 6004 bras 46dc8 <rtems_io_register_driver+0x7c>
rtems_device_major_number n = _IO_Number_of_drivers;
rtems_device_major_number m = 0;
/* major is error checked by caller */
for ( m = 0; m < n; ++m ) {
46dc4: b082 cmpl %d2,%d0 46dc6: 62ec bhis 46db4 <rtems_io_register_driver+0x68>
if ( rtems_io_is_empty_table( table ) )
break;
}
/* Assigns invalid value in case of failure */
*major = m;
46dc8: 2282 movel %d2,%a1@
if ( m != n )
46dca: b082 cmpl %d2,%d0 46dcc: 6634 bnes 46e02 <rtems_io_register_driver+0xb6> 46dce: 6000 0098 braw 46e68 <rtems_io_register_driver+0x11c>
_Thread_Enable_dispatch();
return sc;
}
major = *registered_major;
} else {
rtems_driver_address_table *const table = _IO_Driver_address_table + major;
46dd2: 2202 movel %d2,%d1 46dd4: 2002 movel %d2,%d0 46dd6: e789 lsll #3,%d1 46dd8: eb88 lsll #5,%d0 46dda: 2479 0006 28ca moveal 628ca <_IO_Driver_address_table>,%a2 46de0: 9081 subl %d1,%d0 46de2: d5c0 addal %d0,%a2
static inline bool rtems_io_is_empty_table(
const rtems_driver_address_table *table
)
{
return table->initialization_entry == NULL && table->open_entry == NULL;
46de4: 4a92 tstl %a2@ 46de6: 660e bnes 46df6 <rtems_io_register_driver+0xaa> 46de8: 4aaa 0004 tstl %a2@(4) 46dec: 57c0 seq %d0 46dee: 49c0 extbl %d0 46df0: 4480 negl %d0
}
major = *registered_major;
} else {
rtems_driver_address_table *const table = _IO_Driver_address_table + major;
if ( !rtems_io_is_empty_table( table ) ) {
46df2: 4a00 tstb %d0 46df4: 660a bnes 46e00 <rtems_io_register_driver+0xb4>
_Thread_Enable_dispatch();
46df6: 4eb9 0004 8672 jsr 48672 <_Thread_Enable_dispatch> 46dfc: 700c moveq #12,%d0
return RTEMS_RESOURCE_IN_USE;
46dfe: 6048 bras 46e48 <rtems_io_register_driver+0xfc>
}
*registered_major = major;
46e00: 2282 movel %d2,%a1@
}
_IO_Driver_address_table [major] = *driver_table;
46e02: 4878 0018 pea 18 <OPER2+0x4> 46e06: 2202 movel %d2,%d1 46e08: 2002 movel %d2,%d0 46e0a: e789 lsll #3,%d1 46e0c: eb88 lsll #5,%d0 46e0e: 2f08 movel %a0,%sp@- 46e10: 9081 subl %d1,%d0 46e12: d0b9 0006 28ca addl 628ca <_IO_Driver_address_table>,%d0 46e18: 2f00 movel %d0,%sp@- 46e1a: 4eb9 0005 1c44 jsr 51c44 <memcpy>
_Thread_Enable_dispatch();
46e20: 4eb9 0004 8672 jsr 48672 <_Thread_Enable_dispatch>
return rtems_io_initialize( major, 0, NULL );
}
46e26: 246e fffc moveal %fp@(-4),%a2
_IO_Driver_address_table [major] = *driver_table;
_Thread_Enable_dispatch();
return rtems_io_initialize( major, 0, NULL );
46e2a: 4fef 000c lea %sp@(12),%sp 46e2e: 2d42 0008 movel %d2,%fp@(8)
}
46e32: 242e fff8 movel %fp@(-8),%d2
_IO_Driver_address_table [major] = *driver_table;
_Thread_Enable_dispatch();
return rtems_io_initialize( major, 0, NULL );
46e36: 42ae 0010 clrl %fp@(16) 46e3a: 42ae 000c clrl %fp@(12)
}
46e3e: 4e5e unlk %fp
_IO_Driver_address_table [major] = *driver_table;
_Thread_Enable_dispatch();
return rtems_io_initialize( major, 0, NULL );
46e40: 4ef9 0004 e908 jmp 4e908 <rtems_io_initialize> 46e46: 7009 moveq #9,%d0
}
46e48: 242e fff8 movel %fp@(-8),%d2 46e4c: 246e fffc moveal %fp@(-4),%a2 46e50: 4e5e unlk %fp 46e52: 4e75 rts
return RTEMS_INVALID_ADDRESS;
if ( rtems_io_is_empty_table( driver_table ) )
return RTEMS_INVALID_ADDRESS;
if ( major >= major_limit )
46e54: b082 cmpl %d2,%d0 46e56: 6200 ff3c bhiw 46d94 <rtems_io_register_driver+0x48> 46e5a: 700a moveq #10,%d0 46e5c: 60ea bras 46e48 <rtems_io_register_driver+0xfc>
rtems_device_major_number n = _IO_Number_of_drivers;
rtems_device_major_number m = 0;
/* major is error checked by caller */
for ( m = 0; m < n; ++m ) {
46e5e: 5282 addql #1,%d2 46e60: 45ea 0018 lea %a2@(24),%a2 46e64: 6000 ff5e braw 46dc4 <rtems_io_register_driver+0x78>
if ( major == 0 ) {
rtems_status_code sc = rtems_io_obtain_major_number( registered_major );
if ( sc != RTEMS_SUCCESSFUL ) {
_Thread_Enable_dispatch();
46e68: 4eb9 0004 8672 jsr 48672 <_Thread_Enable_dispatch> 46e6e: 7005 moveq #5,%d0
return sc;
46e70: 60d6 bras 46e48 <rtems_io_register_driver+0xfc>
...
00046e74 <rtems_io_unregister_driver>:
*/
rtems_status_code rtems_io_unregister_driver(
rtems_device_major_number major
)
{
46e74: 4e56 0000 linkw %fp,#0 46e78: 222e 0008 movel %fp@(8),%d1
if ( rtems_interrupt_is_in_progress() )
46e7c: 2039 0006 20a6 movel 620a6 <_ISR_Nest_level>,%d0 46e82: 6704 beqs 46e88 <rtems_io_unregister_driver+0x14> 46e84: 7012 moveq #18,%d0 46e86: 6042 bras 46eca <rtems_io_unregister_driver+0x56>
return RTEMS_CALLED_FROM_ISR;
if ( major < _IO_Number_of_drivers ) {
46e88: b2b9 0006 28c6 cmpl 628c6 <_IO_Number_of_drivers>,%d1 46e8e: 6504 bcss 46e94 <rtems_io_unregister_driver+0x20> 46e90: 700d moveq #13,%d0 46e92: 6036 bras 46eca <rtems_io_unregister_driver+0x56> 46e94: 2039 0006 200c movel 6200c <_Thread_Dispatch_disable_level>,%d0 46e9a: 5280 addql #1,%d0 46e9c: 23c0 0006 200c movel %d0,6200c <_Thread_Dispatch_disable_level>
_Thread_Disable_dispatch();
memset(
46ea2: 2001 movel %d1,%d0 46ea4: 4878 0018 pea 18 <OPER2+0x4> 46ea8: e789 lsll #3,%d1 46eaa: eb88 lsll #5,%d0 46eac: 42a7 clrl %sp@- 46eae: 9081 subl %d1,%d0 46eb0: d0b9 0006 28ca addl 628ca <_IO_Driver_address_table>,%d0 46eb6: 2f00 movel %d0,%sp@- 46eb8: 4eb9 0005 1cb4 jsr 51cb4 <memset>
&_IO_Driver_address_table[major],
0,
sizeof( rtems_driver_address_table )
);
_Thread_Enable_dispatch();
46ebe: 4eb9 0004 8672 jsr 48672 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
46ec4: 4fef 000c lea %sp@(12),%sp
memset(
&_IO_Driver_address_table[major],
0,
sizeof( rtems_driver_address_table )
);
_Thread_Enable_dispatch();
46ec8: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
}
return RTEMS_UNSATISFIED;
}
46eca: 4e5e unlk %fp 46ecc: 4e75 rts
...
00047394 <rtems_iterate_over_all_threads>:
#include <rtems/system.h>
#include <rtems/score/thread.h>
void rtems_iterate_over_all_threads(rtems_per_thread_routine routine)
{
47394: 4e56 fff0 linkw %fp,#-16 47398: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 4739c: 286e 0008 moveal %fp@(8),%a4
uint32_t i;
uint32_t api_index;
Thread_Control *the_thread;
Objects_Information *information;
if ( !routine )
473a0: 4a8c tstl %a4 473a2: 6740 beqs 473e4 <rtems_iterate_over_all_threads+0x50> 473a4: 45f9 0006 6b60 lea 66b60 <_Objects_Information_table+0x4>,%a2
return;
for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) {
if ( !_Objects_Information_table[ api_index ] )
473aa: 2052 moveal %a2@,%a0 473ac: 4a88 tstl %a0 473ae: 672a beqs 473da <rtems_iterate_over_all_threads+0x46>
continue;
information = _Objects_Information_table[ api_index ][ 1 ];
473b0: 2668 0004 moveal %a0@(4),%a3
if ( !information )
473b4: 4a8b tstl %a3 473b6: 6722 beqs 473da <rtems_iterate_over_all_threads+0x46> 473b8: 7401 moveq #1,%d2 473ba: 6014 bras 473d0 <rtems_iterate_over_all_threads+0x3c>
continue;
for ( i=1 ; i <= information->maximum ; i++ ) {
the_thread = (Thread_Control *)information->local_table[ i ];
473bc: 206b 0018 moveal %a3@(24),%a0 473c0: 2030 2c00 movel %a0@(00000000,%d2:l:4),%d0
information = _Objects_Information_table[ api_index ][ 1 ];
if ( !information )
continue;
for ( i=1 ; i <= information->maximum ; i++ ) {
473c4: 5282 addql #1,%d2
the_thread = (Thread_Control *)information->local_table[ i ];
if ( !the_thread )
473c6: 4a80 tstl %d0 473c8: 6706 beqs 473d0 <rtems_iterate_over_all_threads+0x3c>
continue;
(*routine)(the_thread);
473ca: 2f00 movel %d0,%sp@- 473cc: 4e94 jsr %a4@ 473ce: 588f addql #4,%sp
information = _Objects_Information_table[ api_index ][ 1 ];
if ( !information )
continue;
for ( i=1 ; i <= information->maximum ; i++ ) {
473d0: 4280 clrl %d0 473d2: 302b 000e movew %a3@(14),%d0 473d6: b082 cmpl %d2,%d0 473d8: 64e2 bccs 473bc <rtems_iterate_over_all_threads+0x28> 473da: 588a addql #4,%a2
Objects_Information *information;
if ( !routine )
return;
for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) {
473dc: b5fc 0006 6b70 cmpal #420720,%a2 473e2: 66c6 bnes 473aa <rtems_iterate_over_all_threads+0x16>
(*routine)(the_thread);
}
}
}
473e4: 4cee 1c04 fff0 moveml %fp@(-16),%d2/%a2-%a4 473ea: 4e5e unlk %fp 473ec: 4e75 rts
...
0004ed98 <rtems_message_queue_broadcast>:
rtems_id id,
const void *buffer,
size_t size,
uint32_t *count
)
{
4ed98: 4e56 fff0 linkw %fp,#-16 4ed9c: 48d7 001c moveml %d2-%d4,%sp@ 4eda0: 262e 0008 movel %fp@(8),%d3 4eda4: 242e 000c movel %fp@(12),%d2 4eda8: 282e 0014 movel %fp@(20),%d4
register Message_queue_Control *the_message_queue;
Objects_Locations location;
CORE_message_queue_Status core_status;
if ( !buffer )
4edac: 4a82 tstl %d2 4edae: 6752 beqs 4ee02 <rtems_message_queue_broadcast+0x6a>
return RTEMS_INVALID_ADDRESS;
if ( !count )
4edb0: 4a84 tstl %d4 4edb2: 674e beqs 4ee02 <rtems_message_queue_broadcast+0x6a>
RTEMS_INLINE_ROUTINE Message_queue_Control *_Message_queue_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Message_queue_Control *)
4edb4: 486e fffc pea %fp@(-4) 4edb8: 2f03 movel %d3,%sp@- 4edba: 4879 0007 5c42 pea 75c42 <_Message_queue_Information> 4edc0: 4eb9 0005 378c jsr 5378c <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_message_queue = _Message_queue_Get( id, &location );
switch ( location ) {
4edc6: 4fef 000c lea %sp@(12),%sp 4edca: 4aae fffc tstl %fp@(-4) 4edce: 6704 beqs 4edd4 <rtems_message_queue_broadcast+0x3c> 4edd0: 7004 moveq #4,%d0 4edd2: 6030 bras 4ee04 <rtems_message_queue_broadcast+0x6c>
case OBJECTS_LOCAL:
core_status = _CORE_message_queue_Broadcast(
4edd4: 2f04 movel %d4,%sp@- 4edd6: 2040 moveal %d0,%a0 4edd8: 42a7 clrl %sp@- 4edda: 2f03 movel %d3,%sp@- 4eddc: 2f2e 0010 movel %fp@(16),%sp@- 4ede0: 2f02 movel %d2,%sp@- 4ede2: 4868 0014 pea %a0@(20) 4ede6: 4eb9 0005 2088 jsr 52088 <_CORE_message_queue_Broadcast> 4edec: 2400 movel %d0,%d2
NULL,
#endif
count
);
_Thread_Enable_dispatch();
4edee: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch>
return
_Message_queue_Translate_core_message_queue_return_code( core_status );
4edf4: 2f02 movel %d2,%sp@- 4edf6: 4eb9 0004 f11c jsr 4f11c <_Message_queue_Translate_core_message_queue_return_code>
#endif
count
);
_Thread_Enable_dispatch();
return
4edfc: 4fef 001c lea %sp@(28),%sp 4ee00: 6002 bras 4ee04 <rtems_message_queue_broadcast+0x6c> 4ee02: 7009 moveq #9,%d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4ee04: 4cee 001c fff0 moveml %fp@(-16),%d2-%d4 4ee0a: 4e5e unlk %fp 4ee0c: 4e75 rts
...
0004ca78 <rtems_message_queue_create>:
uint32_t count,
size_t max_message_size,
rtems_attribute attribute_set,
rtems_id *id
)
{
4ca78: 4e56 ffe0 linkw %fp,#-32 4ca7c: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@ 4ca80: 242e 0008 movel %fp@(8),%d2 4ca84: 262e 000c movel %fp@(12),%d3 4ca88: 282e 0010 movel %fp@(16),%d4 4ca8c: 2a2e 0014 movel %fp@(20),%d5 4ca90: 286e 0018 moveal %fp@(24),%a4
CORE_message_queue_Attributes the_msgq_attributes;
#if defined(RTEMS_MULTIPROCESSING)
bool is_global;
#endif
if ( !rtems_is_name_valid( name ) )
4ca94: 4a82 tstl %d2 4ca96: 6606 bnes 4ca9e <rtems_message_queue_create+0x26> 4ca98: 7003 moveq #3,%d0 4ca9a: 6000 00a4 braw 4cb40 <rtems_message_queue_create+0xc8>
return RTEMS_INVALID_NAME;
if ( !id )
4ca9e: 4a8c tstl %a4 4caa0: 6606 bnes 4caa8 <rtems_message_queue_create+0x30> 4caa2: 7009 moveq #9,%d0 4caa4: 6000 009a braw 4cb40 <rtems_message_queue_create+0xc8>
if ( (is_global = _Attributes_Is_global( attribute_set ) ) &&
!_System_state_Is_multiprocessing )
return RTEMS_MP_NOT_CONFIGURED;
#endif
if ( count == 0 )
4caa8: 4a83 tstl %d3 4caaa: 6606 bnes 4cab2 <rtems_message_queue_create+0x3a> 4caac: 700a moveq #10,%d0 4caae: 6000 0090 braw 4cb40 <rtems_message_queue_create+0xc8>
return RTEMS_INVALID_NUMBER;
if ( max_message_size == 0 )
4cab2: 4a84 tstl %d4 4cab4: 6606 bnes 4cabc <rtems_message_queue_create+0x44> 4cab6: 7008 moveq #8,%d0 4cab8: 6000 0086 braw 4cb40 <rtems_message_queue_create+0xc8>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
4cabc: 2039 0006 6248 movel 66248 <_Thread_Dispatch_disable_level>,%d0 4cac2: 5280 addql #1,%d0 4cac4: 23c0 0006 6248 movel %d0,66248 <_Thread_Dispatch_disable_level>
#endif
#endif
_Thread_Disable_dispatch(); /* protects object pointer */
the_message_queue = _Message_queue_Allocate();
4caca: 4eb9 0005 2158 jsr 52158 <_Message_queue_Allocate> 4cad0: 2440 moveal %d0,%a2
if ( !the_message_queue ) {
4cad2: 4a80 tstl %d0 4cad4: 660a bnes 4cae0 <rtems_message_queue_create+0x68>
_Thread_Enable_dispatch();
4cad6: 4eb9 0004 f40a jsr 4f40a <_Thread_Enable_dispatch> 4cadc: 7005 moveq #5,%d0
return RTEMS_TOO_MANY;
4cade: 6060 bras 4cb40 <rtems_message_queue_create+0xc8>
#endif
the_message_queue->attribute_set = attribute_set;
if (_Attributes_Is_priority( attribute_set ) )
the_msgq_attributes.discipline = CORE_MESSAGE_QUEUE_DISCIPLINES_PRIORITY;
4cae0: 204e moveal %fp,%a0 4cae2: 47f9 0004 f40a lea 4f40a <_Thread_Enable_dispatch>,%a3 4cae8: 44c5 movew %d5,%ccr 4caea: 56c0 sne %d0
_Thread_Enable_dispatch();
return RTEMS_TOO_MANY;
}
#endif
the_message_queue->attribute_set = attribute_set;
4caec: 2545 0010 movel %d5,%a2@(16)
if (_Attributes_Is_priority( attribute_set ) )
the_msgq_attributes.discipline = CORE_MESSAGE_QUEUE_DISCIPLINES_PRIORITY;
4caf0: 49c0 extbl %d0 4caf2: 5280 addql #1,%d0 4caf4: 2100 movel %d0,%a0@-
else
the_msgq_attributes.discipline = CORE_MESSAGE_QUEUE_DISCIPLINES_FIFO;
if ( ! _CORE_message_queue_Initialize(
4caf6: 2f04 movel %d4,%sp@- 4caf8: 2f03 movel %d3,%sp@- 4cafa: 2f08 movel %a0,%sp@- 4cafc: 486a 0014 pea %a2@(20) 4cb00: 4eb9 0004 dc30 jsr 4dc30 <_CORE_message_queue_Initialize> 4cb06: 4fef 0010 lea %sp@(16),%sp 4cb0a: 4a00 tstb %d0 4cb0c: 6616 bnes 4cb24 <rtems_message_queue_create+0xac>
*/
RTEMS_INLINE_ROUTINE void _Message_queue_Free (
Message_queue_Control *the_message_queue
)
{
_Objects_Free( &_Message_queue_Information, &the_message_queue->Object );
4cb0e: 2f0a movel %a2,%sp@- 4cb10: 4879 0006 6a8e pea 66a8e <_Message_queue_Information> 4cb16: 4eb9 0004 e9b8 jsr 4e9b8 <_Objects_Free>
_Objects_MP_Close(
&_Message_queue_Information, the_message_queue->Object.id);
#endif
_Message_queue_Free( the_message_queue );
_Thread_Enable_dispatch();
4cb1c: 4e93 jsr %a3@
return RTEMS_UNSATISFIED;
4cb1e: 508f addql #8,%sp
_Objects_MP_Close(
&_Message_queue_Information, the_message_queue->Object.id);
#endif
_Message_queue_Free( the_message_queue );
_Thread_Enable_dispatch();
4cb20: 700d moveq #13,%d0
return RTEMS_UNSATISFIED;
4cb22: 601c bras 4cb40 <rtems_message_queue_create+0xc8>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4cb24: 202a 0008 movel %a2@(8),%d0 4cb28: 4281 clrl %d1 4cb2a: 2079 0006 6aa6 moveal 66aa6 <_Message_queue_Information+0x18>,%a0 4cb30: 3200 movew %d0,%d1
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
4cb32: 2542 000c movel %d2,%a2@(12)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
4cb36: 218a 1c00 movel %a2,%a0@(00000000,%d1:l:4)
&_Message_queue_Information,
&the_message_queue->Object,
(Objects_Name) name
);
*id = the_message_queue->Object.id;
4cb3a: 2880 movel %d0,%a4@
name,
0
);
#endif
_Thread_Enable_dispatch();
4cb3c: 4e93 jsr %a3@ 4cb3e: 4280 clrl %d0
return RTEMS_SUCCESSFUL; }
4cb40: 4cee 1c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a4 4cb46: 4e5e unlk %fp 4cb48: 4e75 rts
...
0004fa24 <rtems_message_queue_delete>:
*/
rtems_status_code rtems_message_queue_delete(
rtems_id id
)
{
4fa24: 4e56 fffc linkw %fp,#-4 4fa28: 2f0a movel %a2,%sp@-
RTEMS_INLINE_ROUTINE Message_queue_Control *_Message_queue_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Message_queue_Control *)
4fa2a: 486e fffc pea %fp@(-4) 4fa2e: 2f2e 0008 movel %fp@(8),%sp@- 4fa32: 4879 0006 8d8c pea 68d8c <_Message_queue_Information> 4fa38: 4eb9 0004 9e20 jsr 49e20 <_Objects_Get>
register Message_queue_Control *the_message_queue;
Objects_Locations location;
the_message_queue = _Message_queue_Get( id, &location );
switch ( location ) {
4fa3e: 4fef 000c lea %sp@(12),%sp 4fa42: 2440 moveal %d0,%a2 4fa44: 4aae fffc tstl %fp@(-4) 4fa48: 6704 beqs 4fa4e <rtems_message_queue_delete+0x2a> 4fa4a: 7004 moveq #4,%d0 4fa4c: 6038 bras 4fa86 <rtems_message_queue_delete+0x62>
case OBJECTS_LOCAL:
_Objects_Close( &_Message_queue_Information,
4fa4e: 2f00 movel %d0,%sp@- 4fa50: 4879 0006 8d8c pea 68d8c <_Message_queue_Information> 4fa56: 4eb9 0004 9a54 jsr 49a54 <_Objects_Close>
&the_message_queue->Object );
_CORE_message_queue_Close(
4fa5c: 4878 0005 pea 5 <COMPARE> 4fa60: 42a7 clrl %sp@- 4fa62: 486a 0014 pea %a2@(20) 4fa66: 4eb9 0005 0010 jsr 50010 <_CORE_message_queue_Close>
*/
RTEMS_INLINE_ROUTINE void _Message_queue_Free (
Message_queue_Control *the_message_queue
)
{
_Objects_Free( &_Message_queue_Information, &the_message_queue->Object );
4fa6c: 2f0a movel %a2,%sp@- 4fa6e: 4879 0006 8d8c pea 68d8c <_Message_queue_Information> 4fa74: 4eb9 0004 9cc8 jsr 49cc8 <_Objects_Free>
0, /* Not used */
0
);
}
#endif
_Thread_Enable_dispatch();
4fa7a: 4eb9 0004 a71e jsr 4a71e <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
4fa80: 4fef 001c lea %sp@(28),%sp
0, /* Not used */
0
);
}
#endif
_Thread_Enable_dispatch();
4fa84: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4fa86: 246e fff8 moveal %fp@(-8),%a2 4fa8a: 4e5e unlk %fp 4fa8c: 4e75 rts
...
0004efa4 <rtems_message_queue_get_number_pending>:
rtems_status_code rtems_message_queue_get_number_pending(
rtems_id id,
uint32_t *count
)
{
4efa4: 4e56 fffc linkw %fp,#-4 4efa8: 2f0a movel %a2,%sp@- 4efaa: 246e 000c moveal %fp@(12),%a2
register Message_queue_Control *the_message_queue;
Objects_Locations location;
if ( !count )
4efae: 4a8a tstl %a2 4efb0: 6604 bnes 4efb6 <rtems_message_queue_get_number_pending+0x12> 4efb2: 7009 moveq #9,%d0 4efb4: 6030 bras 4efe6 <rtems_message_queue_get_number_pending+0x42> 4efb6: 486e fffc pea %fp@(-4) 4efba: 2f2e 0008 movel %fp@(8),%sp@- 4efbe: 4879 0007 5c42 pea 75c42 <_Message_queue_Information> 4efc4: 4eb9 0005 378c jsr 5378c <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_message_queue = _Message_queue_Get( id, &location );
switch ( location ) {
4efca: 4fef 000c lea %sp@(12),%sp 4efce: 4aae fffc tstl %fp@(-4) 4efd2: 6704 beqs 4efd8 <rtems_message_queue_get_number_pending+0x34> 4efd4: 7004 moveq #4,%d0 4efd6: 600e bras 4efe6 <rtems_message_queue_get_number_pending+0x42>
case OBJECTS_LOCAL:
*count = the_message_queue->message_queue.number_of_pending_messages;
4efd8: 2040 moveal %d0,%a0 4efda: 24a8 005c movel %a0@(92),%a2@
_Thread_Enable_dispatch();
4efde: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4efe4: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4efe6: 246e fff8 moveal %fp@(-8),%a2 4efea: 4e5e unlk %fp 4efec: 4e75 rts
...
0004cb4c <rtems_message_queue_ident>:
rtems_status_code rtems_message_queue_ident(
rtems_name name,
uint32_t node,
rtems_id *id
)
{
4cb4c: 4e56 0000 linkw %fp,#0
Objects_Name_or_id_lookup_errors status;
status = _Objects_Name_to_id_u32(
4cb50: 2f2e 0010 movel %fp@(16),%sp@- 4cb54: 2f2e 000c movel %fp@(12),%sp@- 4cb58: 2f2e 0008 movel %fp@(8),%sp@- 4cb5c: 4879 0006 6a8e pea 66a8e <_Message_queue_Information> 4cb62: 4eb9 0004 ec98 jsr 4ec98 <_Objects_Name_to_id_u32> 4cb68: 41f9 0006 3880 lea 63880 <_Status_Object_name_errors_to_status>,%a0
node,
id
);
return _Status_Object_name_errors_to_status[ status ];
}
4cb6e: 4e5e unlk %fp 4cb70: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4cb74: 4e75 rts
...
0004cb78 <rtems_message_queue_receive>:
void *buffer,
size_t *size,
rtems_option option_set,
rtems_interval timeout
)
{
4cb78: 4e56 fff0 linkw %fp,#-16 4cb7c: 48d7 001c moveml %d2-%d4,%sp@ 4cb80: 242e 000c movel %fp@(12),%d2 4cb84: 262e 0010 movel %fp@(16),%d3
register Message_queue_Control *the_message_queue;
Objects_Locations location;
bool wait;
if ( !buffer )
4cb88: 4a82 tstl %d2 4cb8a: 6766 beqs 4cbf2 <rtems_message_queue_receive+0x7a>
return RTEMS_INVALID_ADDRESS;
if ( !size )
4cb8c: 4a83 tstl %d3 4cb8e: 6762 beqs 4cbf2 <rtems_message_queue_receive+0x7a>
RTEMS_INLINE_ROUTINE Message_queue_Control *_Message_queue_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Message_queue_Control *)
4cb90: 486e fffc pea %fp@(-4) 4cb94: 2f2e 0008 movel %fp@(8),%sp@- 4cb98: 4879 0006 6a8e pea 66a8e <_Message_queue_Information> 4cb9e: 4eb9 0004 eb10 jsr 4eb10 <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_message_queue = _Message_queue_Get( id, &location );
switch ( location ) {
4cba4: 4fef 000c lea %sp@(12),%sp 4cba8: 4aae fffc tstl %fp@(-4) 4cbac: 6704 beqs 4cbb2 <rtems_message_queue_receive+0x3a> 4cbae: 7004 moveq #4,%d0 4cbb0: 6042 bras 4cbf4 <rtems_message_queue_receive+0x7c>
if ( _Options_Is_no_wait( option_set ) )
wait = false;
else
wait = true;
_CORE_message_queue_Seize(
4cbb2: 7201 moveq #1,%d1 4cbb4: 7801 moveq #1,%d4 4cbb6: 2040 moveal %d0,%a0 4cbb8: c2ae 0014 andl %fp@(20),%d1 4cbbc: 2f2e 0018 movel %fp@(24),%sp@- 4cbc0: b384 eorl %d1,%d4 4cbc2: 2f04 movel %d4,%sp@- 4cbc4: 2f03 movel %d3,%sp@- 4cbc6: 2f02 movel %d2,%sp@- 4cbc8: 2f28 0008 movel %a0@(8),%sp@- 4cbcc: 4868 0014 pea %a0@(20) 4cbd0: 4eb9 0004 dcec jsr 4dcec <_CORE_message_queue_Seize>
buffer,
size,
wait,
timeout
);
_Thread_Enable_dispatch();
4cbd6: 4eb9 0004 f40a jsr 4f40a <_Thread_Enable_dispatch>
return _Message_queue_Translate_core_message_queue_return_code(
4cbdc: 2079 0006 6302 moveal 66302 <_Thread_Executing>,%a0 4cbe2: 2f28 0034 movel %a0@(52),%sp@- 4cbe6: 4eb9 0004 cc78 jsr 4cc78 <_Message_queue_Translate_core_message_queue_return_code> 4cbec: 4fef 001c lea %sp@(28),%sp 4cbf0: 6002 bras 4cbf4 <rtems_message_queue_receive+0x7c> 4cbf2: 7009 moveq #9,%d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4cbf4: 4cee 001c fff0 moveml %fp@(-16),%d2-%d4 4cbfa: 4e5e unlk %fp 4cbfc: 4e75 rts
...
00046584 <rtems_object_get_class_information>:
rtems_status_code rtems_object_get_class_information(
int the_api,
int the_class,
rtems_object_api_class_information *info
)
{
46584: 4e56 0000 linkw %fp,#0 46588: 2f0a movel %a2,%sp@- 4658a: 246e 0010 moveal %fp@(16),%a2 4658e: 2f02 movel %d2,%sp@-
int i;
/*
* Validate parameters and look up information structure.
*/
if ( !info )
46590: 4a8a tstl %a2 46592: 6604 bnes 46598 <rtems_object_get_class_information+0x14> 46594: 7009 moveq #9,%d0 46596: 6052 bras 465ea <rtems_object_get_class_information+0x66>
return RTEMS_INVALID_ADDRESS;
obj_info = _Objects_Get_information( the_api, the_class );
46598: 2f2e 000c movel %fp@(12),%sp@- 4659c: 2f2e 0008 movel %fp@(8),%sp@- 465a0: 4eb9 0004 7e98 jsr 47e98 <_Objects_Get_information>
if ( !obj_info )
465a6: 508f addql #8,%sp
* Validate parameters and look up information structure.
*/
if ( !info )
return RTEMS_INVALID_ADDRESS;
obj_info = _Objects_Get_information( the_api, the_class );
465a8: 2040 moveal %d0,%a0
if ( !obj_info )
465aa: 4a80 tstl %d0 465ac: 6604 bnes 465b2 <rtems_object_get_class_information+0x2e> 465ae: 700a moveq #10,%d0 465b0: 6038 bras 465ea <rtems_object_get_class_information+0x66>
return RTEMS_INVALID_NUMBER;
/*
* Return information about this object class to the user.
*/
info->minimum_id = obj_info->minimum_id;
465b2: 24a8 0006 movel %a0@(6),%a2@
info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum;
465b6: 4282 clrl %d2 465b8: 7001 moveq #1,%d0 465ba: 4281 clrl %d1
/*
* Return information about this object class to the user.
*/
info->minimum_id = obj_info->minimum_id;
info->maximum_id = obj_info->maximum_id;
465bc: 2568 000a 0004 movel %a0@(10),%a2@(4)
info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum;
465c2: 3428 000e movew %a0@(14),%d2
/* * 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;
465c6: 1568 0010 000c moveb %a0@(16),%a2@(12)
info->maximum = obj_info->maximum;
465cc: 2542 0008 movel %d2,%a2@(8)
for ( unallocated=0, i=1 ; i <= info->maximum ; i++ )
465d0: 600e bras 465e0 <rtems_object_get_class_information+0x5c>
if ( !obj_info->local_table[i] )
465d2: 2268 0018 moveal %a0@(24),%a1 465d6: 4ab1 0c00 tstl %a1@(00000000,%d0:l:4) 465da: 6602 bnes 465de <rtems_object_get_class_information+0x5a>
unallocated++;
465dc: 5281 addql #1,%d1
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++ )
465de: 5280 addql #1,%d0 465e0: b480 cmpl %d0,%d2 465e2: 64ee bccs 465d2 <rtems_object_get_class_information+0x4e>
if ( !obj_info->local_table[i] )
unallocated++;
info->unallocated = unallocated;
465e4: 2541 000e movel %d1,%a2@(14) 465e8: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
}
465ea: 242e fff8 movel %fp@(-8),%d2 465ee: 246e fffc moveal %fp@(-4),%a2 465f2: 4e5e unlk %fp 465f4: 4e75 rts
...
00046604 <rtems_object_id_api_maximum>:
#undef rtems_object_id_api_maximum
int rtems_object_id_api_maximum(void)
{
return OBJECTS_ITRON_API;
}
46604: 7004 moveq #4,%d0
#include <rtems/score/object.h>
#include <rtems/rtems/types.h>
#undef rtems_object_id_api_maximum
int rtems_object_id_api_maximum(void)
{
46606: 4e56 0000 linkw %fp,#0
return OBJECTS_ITRON_API; }
4660a: 4e5e unlk %fp 4660c: 4e75 rts
...
00046610 <rtems_object_id_api_minimum>:
#undef rtems_object_id_api_minimum
int rtems_object_id_api_minimum(void)
{
return OBJECTS_INTERNAL_API;
}
46610: 7001 moveq #1,%d0
#include <rtems/score/object.h>
#include <rtems/rtems/types.h>
#undef rtems_object_id_api_minimum
int rtems_object_id_api_minimum(void)
{
46612: 4e56 0000 linkw %fp,#0
return OBJECTS_INTERNAL_API; }
46616: 4e5e unlk %fp 46618: 4e75 rts
...
0004661c <rtems_object_id_get_api>:
#undef rtems_object_id_get_api
int rtems_object_id_get_api(
rtems_id id
)
{
4661c: 4280 clrl %d0
return _Objects_Get_API( id ); }
4661e: 7207 moveq #7,%d1
#undef rtems_object_id_get_api
int rtems_object_id_get_api(
rtems_id id
)
{
46620: 4e56 0000 linkw %fp,#0 46624: 102e 0008 moveb %fp@(8),%d0
return _Objects_Get_API( id ); }
46628: 4e5e unlk %fp 4662a: c081 andl %d1,%d0 4662c: 4e75 rts
...
00046640 <rtems_object_id_get_index>:
int rtems_object_id_get_index(
rtems_id id
)
{
return _Objects_Get_index( id );
}
46640: 4280 clrl %d0
#undef rtems_object_id_get_index
int rtems_object_id_get_index(
rtems_id id
)
{
46642: 4e56 0000 linkw %fp,#0
return _Objects_Get_index( id ); }
46646: 302e 000a movew %fp@(10),%d0 4664a: 4e5e unlk %fp 4664c: 4e75 rts
...
00046650 <rtems_object_id_get_node>:
int rtems_object_id_get_node(
rtems_id id
)
{
return _Objects_Get_node( id );
}
46650: 4280 clrl %d0
#undef rtems_object_id_get_node
int rtems_object_id_get_node(
rtems_id id
)
{
46652: 4e56 0000 linkw %fp,#0
return _Objects_Get_node( id ); }
46656: 102e 0009 moveb %fp@(9),%d0 4665a: 4e5e unlk %fp 4665c: 4e75 rts
...
0004f28c <rtems_partition_delete>:
*/
rtems_status_code rtems_partition_delete(
rtems_id id
)
{
4f28c: 4e56 fffc linkw %fp,#-4 4f290: 2f0b movel %a3,%sp@- 4f292: 2f0a movel %a2,%sp@-
RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Partition_Control *)
4f294: 486e fffc pea %fp@(-4) 4f298: 2f2e 0008 movel %fp@(8),%sp@- 4f29c: 4879 0007 5272 pea 75272 <_Partition_Information> 4f2a2: 4eb9 0005 378c jsr 5378c <_Objects_Get>
register Partition_Control *the_partition;
Objects_Locations location;
the_partition = _Partition_Get( id, &location );
switch ( location ) {
4f2a8: 4fef 000c lea %sp@(12),%sp 4f2ac: 2440 moveal %d0,%a2 4f2ae: 4aae fffc tstl %fp@(-4) 4f2b2: 6704 beqs 4f2b8 <rtems_partition_delete+0x2c> 4f2b4: 7004 moveq #4,%d0 4f2b6: 6036 bras 4f2ee <rtems_partition_delete+0x62> 4f2b8: 47f9 0005 4012 lea 54012 <_Thread_Enable_dispatch>,%a3
case OBJECTS_LOCAL:
if ( the_partition->number_of_used_blocks == 0 ) {
4f2be: 4aaa 0020 tstl %a2@(32) 4f2c2: 6626 bnes 4f2ea <rtems_partition_delete+0x5e>
_Objects_Close( &_Partition_Information, &the_partition->Object );
4f2c4: 2f00 movel %d0,%sp@- 4f2c6: 4879 0007 5272 pea 75272 <_Partition_Information> 4f2cc: 4eb9 0005 3388 jsr 53388 <_Objects_Close>
*/
RTEMS_INLINE_ROUTINE void _Partition_Free (
Partition_Control *the_partition
)
{
_Objects_Free( &_Partition_Information, &the_partition->Object );
4f2d2: 2f0a movel %a2,%sp@- 4f2d4: 4879 0007 5272 pea 75272 <_Partition_Information> 4f2da: 4eb9 0005 35fc jsr 535fc <_Objects_Free>
0 /* Not used */
);
}
#endif
_Thread_Enable_dispatch();
4f2e0: 4e93 jsr %a3@
return RTEMS_SUCCESSFUL;
4f2e2: 4fef 0010 lea %sp@(16),%sp
0 /* Not used */
);
}
#endif
_Thread_Enable_dispatch();
4f2e6: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
4f2e8: 6004 bras 4f2ee <rtems_partition_delete+0x62>
}
_Thread_Enable_dispatch();
4f2ea: 4e93 jsr %a3@ 4f2ec: 700c moveq #12,%d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4f2ee: 246e fff4 moveal %fp@(-12),%a2 4f2f2: 266e fff8 moveal %fp@(-8),%a3 4f2f6: 4e5e unlk %fp 4f2f8: 4e75 rts
...
0004f364 <rtems_partition_ident>:
rtems_status_code rtems_partition_ident(
rtems_name name,
uint32_t node,
rtems_id *id
)
{
4f364: 4e56 0000 linkw %fp,#0
Objects_Name_or_id_lookup_errors status;
status = _Objects_Name_to_id_u32( &_Partition_Information, name, node, id );
4f368: 2f2e 0010 movel %fp@(16),%sp@- 4f36c: 2f2e 000c movel %fp@(12),%sp@- 4f370: 2f2e 0008 movel %fp@(8),%sp@- 4f374: 4879 0007 5272 pea 75272 <_Partition_Information> 4f37a: 4eb9 0005 39a0 jsr 539a0 <_Objects_Name_to_id_u32> 4f380: 41f9 0006 e700 lea 6e700 <_Status_Object_name_errors_to_status>,%a0
return _Status_Object_name_errors_to_status[ status ];
}
4f386: 4e5e unlk %fp 4f388: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4f38c: 4e75 rts
...
0004f390 <rtems_partition_return_buffer>:
rtems_status_code rtems_partition_return_buffer(
rtems_id id,
void *buffer
)
{
4f390: 4e56 fffc linkw %fp,#-4 4f394: 2f0a movel %a2,%sp@- 4f396: 2f02 movel %d2,%sp@-
RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Partition_Control *)
4f398: 486e fffc pea %fp@(-4) 4f39c: 2f2e 0008 movel %fp@(8),%sp@- 4f3a0: 4879 0007 5272 pea 75272 <_Partition_Information> 4f3a6: 242e 000c movel %fp@(12),%d2 4f3aa: 4eb9 0005 378c jsr 5378c <_Objects_Get>
register Partition_Control *the_partition;
Objects_Locations location;
the_partition = _Partition_Get( id, &location );
switch ( location ) {
4f3b0: 4fef 000c lea %sp@(12),%sp 4f3b4: 2440 moveal %d0,%a2 4f3b6: 4aae fffc tstl %fp@(-4) 4f3ba: 6704 beqs 4f3c0 <rtems_partition_return_buffer+0x30> 4f3bc: 7004 moveq #4,%d0 4f3be: 603c bras 4f3fc <rtems_partition_return_buffer+0x6c>
)
{
void *starting;
void *ending;
starting = the_partition->starting_address;
4f3c0: 202a 0010 movel %a2@(16),%d0
ending = _Addresses_Add_offset( starting, the_partition->length );
4f3c4: 222a 0014 movel %a2@(20),%d1
const void *address,
const void *base,
const void *limit
)
{
return (address >= base && address <= limit);
4f3c8: b082 cmpl %d2,%d0 4f3ca: 623c bhis 4f408 <rtems_partition_return_buffer+0x78> 4f3cc: d280 addl %d0,%d1 4f3ce: b282 cmpl %d2,%d1 4f3d0: 6536 bcss 4f408 <rtems_partition_return_buffer+0x78>
return (
4f3d2: 2202 movel %d2,%d1 4f3d4: 9280 subl %d0,%d1 4f3d6: 2001 movel %d1,%d0 4f3d8: 4c6a 0001 0018 remul %a2@(24),%d1,%d0 4f3de: 4a81 tstl %d1 4f3e0: 6626 bnes 4f408 <rtems_partition_return_buffer+0x78>
RTEMS_INLINE_ROUTINE void _Partition_Free_buffer (
Partition_Control *the_partition,
Chain_Node *the_buffer
)
{
_Chain_Append( &the_partition->Memory, the_buffer );
4f3e2: 2f02 movel %d2,%sp@- 4f3e4: 486a 0024 pea %a2@(36) 4f3e8: 4eb9 0005 1fdc jsr 51fdc <_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;
4f3ee: 53aa 0020 subql #1,%a2@(32)
_Thread_Enable_dispatch();
4f3f2: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
4f3f8: 508f addql #8,%sp
case OBJECTS_LOCAL:
if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) {
_Partition_Free_buffer( the_partition, buffer );
the_partition->number_of_used_blocks -= 1;
_Thread_Enable_dispatch();
4f3fa: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4f3fc: 242e fff4 movel %fp@(-12),%d2 4f400: 246e fff8 moveal %fp@(-8),%a2 4f404: 4e5e unlk %fp 4f406: 4e75 rts
_Partition_Free_buffer( the_partition, buffer );
the_partition->number_of_used_blocks -= 1;
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
}
_Thread_Enable_dispatch();
4f408: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4f40e: 7009 moveq #9,%d0
return RTEMS_INVALID_ADDRESS;
4f410: 60ea bras 4f3fc <rtems_partition_return_buffer+0x6c>
...
0004e8c4 <rtems_port_delete>:
*/
rtems_status_code rtems_port_delete(
rtems_id id
)
{
4e8c4: 4e56 fffc linkw %fp,#-4 4e8c8: 2f02 movel %d2,%sp@-
RTEMS_INLINE_ROUTINE Dual_ported_memory_Control *_Dual_ported_memory_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Dual_ported_memory_Control *)
4e8ca: 486e fffc pea %fp@(-4) 4e8ce: 2f2e 0008 movel %fp@(8),%sp@- 4e8d2: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e8d8: 4eb9 0005 378c jsr 5378c <_Objects_Get>
register Dual_ported_memory_Control *the_port;
Objects_Locations location;
the_port = _Dual_ported_memory_Get( id, &location );
switch ( location ) {
4e8de: 4fef 000c lea %sp@(12),%sp 4e8e2: 2400 movel %d0,%d2 4e8e4: 4aae fffc tstl %fp@(-4) 4e8e8: 6704 beqs 4e8ee <rtems_port_delete+0x2a> 4e8ea: 7004 moveq #4,%d0 4e8ec: 6028 bras 4e916 <rtems_port_delete+0x52>
case OBJECTS_LOCAL:
_Objects_Close( &_Dual_ported_memory_Information, &the_port->Object );
4e8ee: 2f00 movel %d0,%sp@- 4e8f0: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e8f6: 4eb9 0005 3388 jsr 53388 <_Objects_Close>
*/
RTEMS_INLINE_ROUTINE void _Dual_ported_memory_Free (
Dual_ported_memory_Control *the_port
)
{
_Objects_Free( &_Dual_ported_memory_Information, &the_port->Object );
4e8fc: 2f02 movel %d2,%sp@- 4e8fe: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e904: 4eb9 0005 35fc jsr 535fc <_Objects_Free>
_Dual_ported_memory_Free( the_port );
_Thread_Enable_dispatch();
4e90a: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
4e910: 4fef 0010 lea %sp@(16),%sp
switch ( location ) {
case OBJECTS_LOCAL:
_Objects_Close( &_Dual_ported_memory_Information, &the_port->Object );
_Dual_ported_memory_Free( the_port );
_Thread_Enable_dispatch();
4e914: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4e916: 242e fff8 movel %fp@(-8),%d2 4e91a: 4e5e unlk %fp 4e91c: 4e75 rts
...
0004e920 <rtems_port_external_to_internal>:
rtems_status_code rtems_port_external_to_internal(
rtems_id id,
void *external,
void **internal
)
{
4e920: 4e56 fffc linkw %fp,#-4 4e924: 2f0a movel %a2,%sp@- 4e926: 246e 0010 moveal %fp@(16),%a2 4e92a: 2f02 movel %d2,%sp@- 4e92c: 242e 000c movel %fp@(12),%d2
register Dual_ported_memory_Control *the_port;
Objects_Locations location;
uint32_t ending;
if ( !internal )
4e930: 4a8a tstl %a2 4e932: 6604 bnes 4e938 <rtems_port_external_to_internal+0x18> 4e934: 7009 moveq #9,%d0 4e936: 6042 bras 4e97a <rtems_port_external_to_internal+0x5a>
RTEMS_INLINE_ROUTINE Dual_ported_memory_Control *_Dual_ported_memory_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Dual_ported_memory_Control *)
4e938: 486e fffc pea %fp@(-4) 4e93c: 2f2e 0008 movel %fp@(8),%sp@- 4e940: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e946: 4eb9 0005 378c jsr 5378c <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_port = _Dual_ported_memory_Get( id, &location );
switch ( location ) {
4e94c: 4fef 000c lea %sp@(12),%sp 4e950: 2040 moveal %d0,%a0 4e952: 4aae fffc tstl %fp@(-4) 4e956: 6704 beqs 4e95c <rtems_port_external_to_internal+0x3c> 4e958: 7004 moveq #4,%d0 4e95a: 601e bras 4e97a <rtems_port_external_to_internal+0x5a>
case OBJECTS_LOCAL:
ending = _Addresses_Subtract( external, the_port->external_base );
4e95c: 2002 movel %d2,%d0 4e95e: 90a8 0014 subl %a0@(20),%d0
if ( ending > the_port->length )
4e962: b0a8 0018 cmpl %a0@(24),%d0 4e966: 6304 blss 4e96c <rtems_port_external_to_internal+0x4c>
*internal = external;
4e968: 2482 movel %d2,%a2@ 4e96a: 6006 bras 4e972 <rtems_port_external_to_internal+0x52>
else
*internal = _Addresses_Add_offset( the_port->internal_base,
4e96c: d0a8 0010 addl %a0@(16),%d0 4e970: 2480 movel %d0,%a2@
ending );
_Thread_Enable_dispatch();
4e972: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4e978: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4e97a: 242e fff4 movel %fp@(-12),%d2 4e97e: 246e fff8 moveal %fp@(-8),%a2 4e982: 4e5e unlk %fp 4e984: 4e75 rts
...
0004e9b0 <rtems_port_internal_to_external>:
rtems_status_code rtems_port_internal_to_external(
rtems_id id,
void *internal,
void **external
)
{
4e9b0: 4e56 fffc linkw %fp,#-4 4e9b4: 2f0a movel %a2,%sp@- 4e9b6: 246e 0010 moveal %fp@(16),%a2 4e9ba: 2f02 movel %d2,%sp@- 4e9bc: 242e 000c movel %fp@(12),%d2
register Dual_ported_memory_Control *the_port;
Objects_Locations location;
uint32_t ending;
if ( !external )
4e9c0: 4a8a tstl %a2 4e9c2: 6604 bnes 4e9c8 <rtems_port_internal_to_external+0x18> 4e9c4: 7009 moveq #9,%d0 4e9c6: 6042 bras 4ea0a <rtems_port_internal_to_external+0x5a> 4e9c8: 486e fffc pea %fp@(-4) 4e9cc: 2f2e 0008 movel %fp@(8),%sp@- 4e9d0: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e9d6: 4eb9 0005 378c jsr 5378c <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_port = _Dual_ported_memory_Get( id, &location );
switch ( location ) {
4e9dc: 4fef 000c lea %sp@(12),%sp 4e9e0: 2040 moveal %d0,%a0 4e9e2: 4aae fffc tstl %fp@(-4) 4e9e6: 6704 beqs 4e9ec <rtems_port_internal_to_external+0x3c> 4e9e8: 7004 moveq #4,%d0 4e9ea: 601e bras 4ea0a <rtems_port_internal_to_external+0x5a>
case OBJECTS_LOCAL:
ending = _Addresses_Subtract( internal, the_port->internal_base );
4e9ec: 2002 movel %d2,%d0 4e9ee: 90a8 0010 subl %a0@(16),%d0
if ( ending > the_port->length )
4e9f2: b0a8 0018 cmpl %a0@(24),%d0 4e9f6: 6304 blss 4e9fc <rtems_port_internal_to_external+0x4c>
*external = internal;
4e9f8: 2482 movel %d2,%a2@ 4e9fa: 6006 bras 4ea02 <rtems_port_internal_to_external+0x52>
else
*external = _Addresses_Add_offset( the_port->external_base,
4e9fc: d0a8 0014 addl %a0@(20),%d0 4ea00: 2480 movel %d0,%a2@
ending );
_Thread_Enable_dispatch();
4ea02: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4ea08: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4ea0a: 242e fff4 movel %fp@(-12),%d2 4ea0e: 246e fff8 moveal %fp@(-8),%a2 4ea12: 4e5e unlk %fp 4ea14: 4e75 rts
...
00045930 <rtems_rate_monotonic_create>:
rtems_status_code rtems_rate_monotonic_create(
rtems_name name,
rtems_id *id
)
{
45930: 4e56 fff0 linkw %fp,#-16 45934: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 45938: 242e 0008 movel %fp@(8),%d2 4593c: 286e 000c moveal %fp@(12),%a4
Rate_monotonic_Control *the_period;
if ( !rtems_is_name_valid( name ) )
45940: 6606 bnes 45948 <rtems_rate_monotonic_create+0x18> 45942: 7003 moveq #3,%d0 45944: 6000 009e braw 459e4 <rtems_rate_monotonic_create+0xb4>
return RTEMS_INVALID_NAME;
if ( !id )
45948: 4a8c tstl %a4 4594a: 6606 bnes 45952 <rtems_rate_monotonic_create+0x22> 4594c: 7009 moveq #9,%d0 4594e: 6000 0094 braw 459e4 <rtems_rate_monotonic_create+0xb4>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
45952: 2039 0005 e8d0 movel 5e8d0 <_Thread_Dispatch_disable_level>,%d0 45958: 5280 addql #1,%d0 4595a: 23c0 0005 e8d0 movel %d0,5e8d0 <_Thread_Dispatch_disable_level>
* This function allocates a period control block from
* the inactive chain of free period control blocks.
*/
RTEMS_INLINE_ROUTINE Rate_monotonic_Control *_Rate_monotonic_Allocate( void )
{
return (Rate_monotonic_Control *)
45960: 4879 0005 e7cc pea 5e7cc <_Rate_monotonic_Information> 45966: 47f9 0004 82be lea 482be <_Thread_Enable_dispatch>,%a3 4596c: 4eb9 0004 7594 jsr 47594 <_Objects_Allocate>
_Thread_Disable_dispatch(); /* to prevent deletion */
the_period = _Rate_monotonic_Allocate();
if ( !the_period ) {
45972: 588f addql #4,%sp 45974: 2440 moveal %d0,%a2 45976: 4a80 tstl %d0 45978: 6606 bnes 45980 <rtems_rate_monotonic_create+0x50>
_Thread_Enable_dispatch();
4597a: 4e93 jsr %a3@ 4597c: 7005 moveq #5,%d0
return RTEMS_TOO_MANY;
4597e: 6064 bras 459e4 <rtems_rate_monotonic_create+0xb4>
}
the_period->owner = _Thread_Executing;
45980: 41f9 0005 e98a lea 5e98a <_Thread_Executing>,%a0 45986: 2550 0040 movel %a0@,%a2@(64)
the_period->state = RATE_MONOTONIC_INACTIVE;
4598a: 42aa 0038 clrl %a2@(56)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
4598e: 42aa 0018 clrl %a2@(24)
the_watchdog->routine = routine;
45992: 42aa 002c clrl %a2@(44)
the_watchdog->id = id;
45996: 42aa 0030 clrl %a2@(48)
the_watchdog->user_data = user_data;
4599a: 42aa 0034 clrl %a2@(52)
_Watchdog_Initialize( &the_period->Timer, NULL, 0, NULL );
_Rate_monotonic_Reset_statistics( the_period );
4599e: 4878 0038 pea 38 <DBL_MANT_DIG+0x3> 459a2: 42a7 clrl %sp@- 459a4: 486a 0054 pea %a2@(84) 459a8: 4eb9 0004 e964 jsr 4e964 <memset>
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
459ae: 202a 0008 movel %a2@(8),%d0 459b2: 4281 clrl %d1 459b4: 2079 0005 e7e4 moveal 5e7e4 <_Rate_monotonic_Information+0x18>,%a0 459ba: 3200 movew %d0,%d1
information,
_Objects_Get_index( the_object->id ),
the_object
);
the_object->name = name;
459bc: 2542 000c movel %d2,%a2@(12)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
459c0: 218a 1c00 movel %a2,%a0@(00000000,%d1:l:4) 459c4: 223c 7fff ffff movel #2147483647,%d1 459ca: 2541 005c movel %d1,%a2@(92) 459ce: 2541 0060 movel %d1,%a2@(96) 459d2: 2541 0074 movel %d1,%a2@(116) 459d6: 2541 0078 movel %d1,%a2@(120)
&_Rate_monotonic_Information,
&the_period->Object,
(Objects_Name) name
);
*id = the_period->Object.id;
459da: 2880 movel %d0,%a4@
_Thread_Enable_dispatch();
459dc: 4e93 jsr %a3@
return RTEMS_SUCCESSFUL;
459de: 4fef 000c lea %sp@(12),%sp
&the_period->Object,
(Objects_Name) name
);
*id = the_period->Object.id;
_Thread_Enable_dispatch();
459e2: 4280 clrl %d0
return RTEMS_SUCCESSFUL; }
459e4: 4cee 1c04 fff0 moveml %fp@(-16),%d2/%a2-%a4 459ea: 4e5e unlk %fp 459ec: 4e75 rts
...
000713e4 <rtems_rate_monotonic_get_statistics>:
rtems_status_code rtems_rate_monotonic_get_statistics(
rtems_id id,
rtems_rate_monotonic_period_statistics *statistics
)
{
713e4: 4e56 fffc linkw %fp,#-4 713e8: 2f0a movel %a2,%sp@- 713ea: 246e 000c moveal %fp@(12),%a2
Objects_Locations location;
Rate_monotonic_Control *the_period;
rtems_rate_monotonic_period_statistics *dst;
Rate_monotonic_Statistics *src;
if ( !statistics )
713ee: 4a8a tstl %a2 713f0: 6606 bnes 713f8 <rtems_rate_monotonic_get_statistics+0x14> 713f2: 7009 moveq #9,%d0 713f4: 6000 0098 braw 7148e <rtems_rate_monotonic_get_statistics+0xaa> 713f8: 486e fffc pea %fp@(-4) 713fc: 2f2e 0008 movel %fp@(8),%sp@- 71400: 4879 0009 c72c pea 9c72c <_Rate_monotonic_Information> 71406: 4eb9 0004 a898 jsr 4a898 <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
7140c: 4fef 000c lea %sp@(12),%sp 71410: 2040 moveal %d0,%a0 71412: 4aae fffc tstl %fp@(-4) 71416: 6704 beqs 7141c <rtems_rate_monotonic_get_statistics+0x38> 71418: 7004 moveq #4,%d0 7141a: 6072 bras 7148e <rtems_rate_monotonic_get_statistics+0xaa>
case OBJECTS_LOCAL:
dst = statistics;
src = &the_period->Statistics;
dst->count = src->count;
7141c: 24a8 0054 movel %a0@(84),%a2@
dst->missed_count = src->missed_count;
71420: 2568 0058 0004 movel %a0@(88),%a2@(4)
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_Timestamp_To_timespec( &src->min_cpu_time, &dst->min_cpu_time );
71426: 2028 005c movel %a0@(92),%d0 7142a: 2228 0060 movel %a0@(96),%d1 7142e: 2540 0008 movel %d0,%a2@(8) 71432: 2541 000c movel %d1,%a2@(12)
_Timestamp_To_timespec( &src->max_cpu_time, &dst->max_cpu_time );
71436: 2028 0064 movel %a0@(100),%d0 7143a: 2228 0068 movel %a0@(104),%d1 7143e: 2540 0010 movel %d0,%a2@(16) 71442: 2541 0014 movel %d1,%a2@(20)
_Timestamp_To_timespec( &src->total_cpu_time, &dst->total_cpu_time );
71446: 2028 006c movel %a0@(108),%d0 7144a: 2228 0070 movel %a0@(112),%d1 7144e: 2540 0018 movel %d0,%a2@(24) 71452: 2541 001c movel %d1,%a2@(28)
_Timestamp_To_timespec( &src->min_wall_time, &dst->min_wall_time );
71456: 2028 0074 movel %a0@(116),%d0 7145a: 2228 0078 movel %a0@(120),%d1 7145e: 2540 0020 movel %d0,%a2@(32) 71462: 2541 0024 movel %d1,%a2@(36)
_Timestamp_To_timespec( &src->max_wall_time, &dst->max_wall_time );
71466: 2028 007c movel %a0@(124),%d0 7146a: 2228 0080 movel %a0@(128),%d1 7146e: 2540 0028 movel %d0,%a2@(40) 71472: 2541 002c movel %d1,%a2@(44)
_Timestamp_To_timespec( &src->total_wall_time, &dst->total_wall_time );
71476: 2028 0084 movel %a0@(132),%d0 7147a: 2228 0088 movel %a0@(136),%d1 7147e: 2540 0030 movel %d0,%a2@(48) 71482: 2541 0034 movel %d1,%a2@(52)
dst->min_wall_time = src->min_wall_time;
dst->max_wall_time = src->max_wall_time;
dst->total_wall_time = src->total_wall_time;
#endif
_Thread_Enable_dispatch();
71486: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 7148c: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
7148e: 246e fff8 moveal %fp@(-8),%a2 71492: 4e5e unlk %fp 71494: 4e75 rts
...
00071498 <rtems_rate_monotonic_get_status>:
rtems_status_code rtems_rate_monotonic_get_status(
rtems_id id,
rtems_rate_monotonic_period_status *status
)
{
71498: 4e56 ffec linkw %fp,#-20 7149c: 2f0a movel %a2,%sp@- 7149e: 246e 000c moveal %fp@(12),%a2
Objects_Locations location;
Rate_monotonic_Period_time_t since_last_period;
Rate_monotonic_Control *the_period;
bool valid_status;
if ( !status )
714a2: 4a8a tstl %a2 714a4: 6606 bnes 714ac <rtems_rate_monotonic_get_status+0x14> 714a6: 7009 moveq #9,%d0 714a8: 6000 0094 braw 7153e <rtems_rate_monotonic_get_status+0xa6> 714ac: 486e fffc pea %fp@(-4) 714b0: 2f2e 0008 movel %fp@(8),%sp@- 714b4: 4879 0009 c72c pea 9c72c <_Rate_monotonic_Information> 714ba: 4eb9 0004 a898 jsr 4a898 <_Objects_Get>
return RTEMS_INVALID_ADDRESS;
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
714c0: 4fef 000c lea %sp@(12),%sp 714c4: 2040 moveal %d0,%a0 714c6: 4aae fffc tstl %fp@(-4) 714ca: 6704 beqs 714d0 <rtems_rate_monotonic_get_status+0x38> 714cc: 7004 moveq #4,%d0 714ce: 606e bras 7153e <rtems_rate_monotonic_get_status+0xa6>
case OBJECTS_LOCAL:
status->owner = the_period->owner->Object.id;
714d0: 2268 0040 moveal %a0@(64),%a1
status->state = the_period->state;
714d4: 2028 0038 movel %a0@(56),%d0
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
case OBJECTS_LOCAL:
status->owner = the_period->owner->Object.id;
714d8: 24a9 0008 movel %a1@(8),%a2@
status->state = the_period->state;
714dc: 2540 0004 movel %d0,%a2@(4)
/*
* If the period is inactive, there is no information.
*/
if ( status->state == RATE_MONOTONIC_INACTIVE ) {
714e0: 6612 bnes 714f4 <rtems_rate_monotonic_get_status+0x5c>
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_Timespec_Set_to_zero( &status->since_last_period );
_Timespec_Set_to_zero( &status->executed_since_last_period );
714e2: 42aa 0014 clrl %a2@(20)
/*
* If the period is inactive, there is no information.
*/
if ( status->state == RATE_MONOTONIC_INACTIVE ) {
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_Timespec_Set_to_zero( &status->since_last_period );
714e6: 42aa 0008 clrl %a2@(8) 714ea: 42aa 000c clrl %a2@(12)
_Timespec_Set_to_zero( &status->executed_since_last_period );
714ee: 42aa 0010 clrl %a2@(16) 714f2: 6042 bras 71536 <rtems_rate_monotonic_get_status+0x9e>
/*
* Grab the current status.
*/
valid_status =
_Rate_monotonic_Get_status(
714f4: 486e fff4 pea %fp@(-12) 714f8: 486e ffec pea %fp@(-20) 714fc: 2f08 movel %a0,%sp@- 714fe: 4eb9 0007 15c0 jsr 715c0 <_Rate_monotonic_Get_status>
the_period, &since_last_period, &executed
);
if (!valid_status) {
71504: 4fef 000c lea %sp@(12),%sp 71508: 4a00 tstb %d0 7150a: 660a bnes 71516 <rtems_rate_monotonic_get_status+0x7e>
_Thread_Enable_dispatch();
7150c: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 71512: 700b moveq #11,%d0
return RTEMS_NOT_DEFINED;
71514: 6028 bras 7153e <rtems_rate_monotonic_get_status+0xa6>
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_Timestamp_To_timespec(
&since_last_period, &status->since_last_period
);
_Timestamp_To_timespec(
71516: 202e fff4 movel %fp@(-12),%d0 7151a: 222e fff8 movel %fp@(-8),%d1 7151e: 2540 0010 movel %d0,%a2@(16) 71522: 2541 0014 movel %d1,%a2@(20)
_Thread_Enable_dispatch();
return RTEMS_NOT_DEFINED;
}
#ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__
_Timestamp_To_timespec(
71526: 202e ffec movel %fp@(-20),%d0 7152a: 222e fff0 movel %fp@(-16),%d1 7152e: 2540 0008 movel %d0,%a2@(8) 71532: 2541 000c movel %d1,%a2@(12)
status->since_last_period = since_last_period;
status->executed_since_last_period = executed;
#endif
}
_Thread_Enable_dispatch();
71536: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 7153c: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
7153e: 246e ffe8 moveal %fp@(-24),%a2 71542: 4e5e unlk %fp 71544: 4e75 rts
...
0007175c <rtems_rate_monotonic_period>:
rtems_status_code rtems_rate_monotonic_period(
rtems_id id,
rtems_interval length
)
{
7175c: 4e56 ffec linkw %fp,#-20 71760: 48d7 041c moveml %d2-%d4/%a2,%sp@ 71764: 486e fffc pea %fp@(-4) 71768: 262e 0008 movel %fp@(8),%d3 7176c: 2f03 movel %d3,%sp@- 7176e: 4879 0009 c72c pea 9c72c <_Rate_monotonic_Information> 71774: 242e 000c movel %fp@(12),%d2 71778: 4eb9 0004 a898 jsr 4a898 <_Objects_Get>
rtems_rate_monotonic_period_states local_state;
ISR_Level level;
the_period = _Rate_monotonic_Get( id, &location );
switch ( location ) {
7177e: 4fef 000c lea %sp@(12),%sp 71782: 2440 moveal %d0,%a2 71784: 4aae fffc tstl %fp@(-4) 71788: 6600 0138 bnew 718c2 <rtems_rate_monotonic_period+0x166>
case OBJECTS_LOCAL:
if ( !_Thread_Is_executing( the_period->owner ) ) {
7178c: 2039 0009 bd42 movel 9bd42 <_Thread_Executing>,%d0 71792: b0aa 0040 cmpl %a2@(64),%d0 71796: 670c beqs 717a4 <rtems_rate_monotonic_period+0x48>
_Thread_Enable_dispatch();
71798: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 7179e: 7817 moveq #23,%d4
return RTEMS_NOT_OWNER_OF_RESOURCE;
717a0: 6000 0122 braw 718c4 <rtems_rate_monotonic_period+0x168>
}
if ( length == RTEMS_PERIOD_STATUS ) {
717a4: 4a82 tstl %d2 717a6: 6622 bnes 717ca <rtems_rate_monotonic_period+0x6e>
switch ( the_period->state ) {
717a8: 202a 0038 movel %a2@(56),%d0 717ac: 7204 moveq #4,%d1 717ae: b280 cmpl %d0,%d1 717b0: 6404 bccs 717b6 <rtems_rate_monotonic_period+0x5a>
717b2: 4284 clrl %d4 <== NOT EXECUTED 717b4: 600a bras 717c0 <rtems_rate_monotonic_period+0x64><== NOT EXECUTED
717b6: 41f9 0009 5cb8 lea 95cb8 <CSWTCH.43>,%a0 717bc: 2830 0c00 movel %a0@(00000000,%d0:l:4),%d4
case RATE_MONOTONIC_ACTIVE:
default: /* unreached -- only to remove warnings */
return_value = RTEMS_SUCCESSFUL;
break;
}
_Thread_Enable_dispatch();
717c0: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch>
return( return_value );
717c6: 6000 00fc braw 718c4 <rtems_rate_monotonic_period+0x168>
}
_ISR_Disable( level );
717ca: 203c 0000 0700 movel #1792,%d0 717d0: 40c4 movew %sr,%d4 717d2: 8084 orl %d4,%d0 717d4: 46c0 movew %d0,%sr
switch ( the_period->state ) {
717d6: 202a 0038 movel %a2@(56),%d0 717da: 7202 moveq #2,%d1 717dc: b280 cmpl %d0,%d1 717de: 6740 beqs 71820 <rtems_rate_monotonic_period+0xc4> 717e0: 123c 0004 moveb #4,%d1 717e4: b280 cmpl %d0,%d1 717e6: 6700 00a4 beqw 7188c <rtems_rate_monotonic_period+0x130> 717ea: 4a80 tstl %d0 717ec: 6600 00d4 bnew 718c2 <rtems_rate_monotonic_period+0x166>
case RATE_MONOTONIC_INACTIVE: {
_ISR_Enable( level );
717f0: 46c4 movew %d4,%sr
/*
* Baseline statistics information for the beginning of a period.
*/
_Rate_monotonic_Initiate_statistics( the_period );
717f2: 2f0a movel %a2,%sp@-
);
the_period->next_length = length;
_Watchdog_Insert_ticks( &the_period->Timer, length );
_Thread_Enable_dispatch();
717f4: 4284 clrl %d4
_ISR_Enable( level );
/*
* Baseline statistics information for the beginning of a period.
*/
_Rate_monotonic_Initiate_statistics( the_period );
717f6: 4eb9 0007 1548 jsr 71548 <_Rate_monotonic_Initiate_statistics>
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
717fc: 203c 0007 18d0 movel #465104,%d0
the_period->state = RATE_MONOTONIC_ACTIVE;
71802: 7202 moveq #2,%d1 71804: 2540 002c movel %d0,%a2@(44)
the_watchdog->id = id;
71808: 2543 0030 movel %d3,%a2@(48)
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
7180c: 2542 001c movel %d2,%a2@(28) 71810: 2541 0038 movel %d1,%a2@(56)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
71814: 42aa 0018 clrl %a2@(24)
the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data;
71818: 42aa 0034 clrl %a2@(52) 7181c: 6000 0084 braw 718a2 <rtems_rate_monotonic_period+0x146>
case RATE_MONOTONIC_ACTIVE:
/*
* Update statistics from the concluding period.
*/
_Rate_monotonic_Update_statistics( the_period );
71820: 2f0a movel %a2,%sp@- 71822: 4eb9 0007 1668 jsr 71668 <_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;
the_period->next_length = length;
71828: 2542 003c movel %d2,%a2@(60)
/*
* 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;
7182c: 7401 moveq #1,%d2 7182e: 2542 0038 movel %d2,%a2@(56)
the_period->next_length = length;
_ISR_Enable( level );
71832: 46c4 movew %d4,%sr
_Thread_Executing->Wait.id = the_period->Object.id;
71834: 2079 0009 bd42 moveal 9bd42 <_Thread_Executing>,%a0 7183a: 216a 0008 0020 movel %a2@(8),%a0@(32)
_Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD );
71840: 4878 4000 pea 4000 <D_MAX_EXP+0x3801> 71844: 2f08 movel %a0,%sp@- 71846: 4eb9 0004 b970 jsr 4b970 <_Thread_Set_state>
/*
* Did the watchdog timer expire while we were actually blocking
* on it?
*/
_ISR_Disable( level );
7184c: 203c 0000 0700 movel #1792,%d0 71852: 40c1 movew %sr,%d1 71854: 8081 orl %d1,%d0 71856: 46c0 movew %d0,%sr
local_state = the_period->state;
the_period->state = RATE_MONOTONIC_ACTIVE;
71858: 143c 0002 moveb #2,%d2
/*
* Did the watchdog timer expire while we were actually blocking
* on it?
*/
_ISR_Disable( level );
local_state = the_period->state;
7185c: 202a 0038 movel %a2@(56),%d0
the_period->state = RATE_MONOTONIC_ACTIVE;
71860: 2542 0038 movel %d2,%a2@(56)
_ISR_Enable( level );
71864: 46c1 movew %d1,%sr
/*
* 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 )
71866: 7203 moveq #3,%d1 71868: 4fef 000c lea %sp@(12),%sp 7186c: b280 cmpl %d0,%d1 7186e: 6612 bnes 71882 <rtems_rate_monotonic_period+0x126>
_Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD );
71870: 4878 4000 pea 4000 <D_MAX_EXP+0x3801> 71874: 2f39 0009 bd42 movel 9bd42 <_Thread_Executing>,%sp@- 7187a: 4eb9 0004 ad98 jsr 4ad98 <_Thread_Clear_state> 71880: 508f addql #8,%sp
_Thread_Enable_dispatch();
71882: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 71888: 4284 clrl %d4
return RTEMS_SUCCESSFUL;
7188a: 6038 bras 718c4 <rtems_rate_monotonic_period+0x168>
case RATE_MONOTONIC_EXPIRED:
/*
* Update statistics from the concluding period
*/
_Rate_monotonic_Update_statistics( the_period );
7188c: 2f0a movel %a2,%sp@- 7188e: 4eb9 0007 1668 jsr 71668 <_Rate_monotonic_Update_statistics>
_ISR_Enable( level );
71894: 46c4 movew %d4,%sr
the_period->state = RATE_MONOTONIC_ACTIVE;
71896: 7002 moveq #2,%d0
the_period->next_length = length;
_Watchdog_Insert_ticks( &the_period->Timer, length );
_Thread_Enable_dispatch();
71898: 7806 moveq #6,%d4
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
7189a: 2542 001c movel %d2,%a2@(28)
*/
_Rate_monotonic_Update_statistics( the_period );
_ISR_Enable( level );
the_period->state = RATE_MONOTONIC_ACTIVE;
7189e: 2540 0038 movel %d0,%a2@(56)
the_period->next_length = length;
718a2: 2542 003c movel %d2,%a2@(60)
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
718a6: 486a 0010 pea %a2@(16) 718aa: 4879 0009 bd60 pea 9bd60 <_Watchdog_Ticks_chain> 718b0: 4eb9 0004 c0b8 jsr 4c0b8 <_Watchdog_Insert>
_Watchdog_Insert_ticks( &the_period->Timer, length );
_Thread_Enable_dispatch();
718b6: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch>
return RTEMS_TIMEOUT;
718bc: 4fef 000c lea %sp@(12),%sp 718c0: 6002 bras 718c4 <rtems_rate_monotonic_period+0x168> 718c2: 7804 moveq #4,%d4
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
718c4: 2004 movel %d4,%d0 718c6: 4cee 041c ffec moveml %fp@(-20),%d2-%d4/%a2 718cc: 4e5e unlk %fp 718ce: 4e75 rts
00062dd6 <rtems_rate_monotonic_report_statistics>:
void rtems_rate_monotonic_report_statistics( void )
{
62dd6: 4e56 0000 linkw %fp,#0
rtems_rate_monotonic_report_statistics_with_plugin( NULL, printk_plugin );
62dda: 4879 0004 681c pea 4681c <printk_plugin> 62de0: 42a7 clrl %sp@- 62de2: 4eb9 0006 2c60 jsr 62c60 <rtems_rate_monotonic_report_statistics_with_plugin> 62de8: 508f addql #8,%sp
}
62dea: 4e5e unlk %fp 62dec: 4e75 rts
...
0004fc78 <rtems_region_delete>:
*/
rtems_status_code rtems_region_delete(
rtems_id id
)
{
4fc78: 4e56 fffc linkw %fp,#-4 4fc7c: 2f0a movel %a2,%sp@- 4fc7e: 2f02 movel %d2,%sp@-
Objects_Locations location;
rtems_status_code return_status;
Region_Control *the_region;
_RTEMS_Lock_allocator();
4fc80: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fc86: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock>
RTEMS_INLINE_ROUTINE Region_Control *_Region_Get (
Objects_Id id,
Objects_Locations *location
)
{
return (Region_Control *)
4fc8c: 486e fffc pea %fp@(-4) 4fc90: 2f2e 0008 movel %fp@(8),%sp@- 4fc94: 4879 0007 52e6 pea 752e6 <_Region_Information> 4fc9a: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection>
the_region = _Region_Get( id, &location );
switch ( location ) {
4fca0: 4fef 0010 lea %sp@(16),%sp 4fca4: 2440 moveal %d0,%a2 4fca6: 4aae fffc tstl %fp@(-4) 4fcaa: 6704 beqs 4fcb0 <rtems_region_delete+0x38> 4fcac: 7404 moveq #4,%d2 4fcae: 602c bras 4fcdc <rtems_region_delete+0x64>
case OBJECTS_LOCAL:
_Region_Debug_Walk( the_region, 5 );
if ( the_region->number_of_used_blocks != 0 )
4fcb0: 4aaa 0064 tstl %a2@(100) 4fcb4: 6704 beqs 4fcba <rtems_region_delete+0x42> 4fcb6: 740c moveq #12,%d2 4fcb8: 6022 bras 4fcdc <rtems_region_delete+0x64>
return_status = RTEMS_RESOURCE_IN_USE;
else {
_Objects_Close( &_Region_Information, &the_region->Object );
4fcba: 2f00 movel %d0,%sp@- 4fcbc: 4879 0007 52e6 pea 752e6 <_Region_Information>
*/
RTEMS_INLINE_ROUTINE void _Region_Free (
Region_Control *the_region
)
{
_Objects_Free( &_Region_Information, &the_region->Object );
4fcc2: 4282 clrl %d2 4fcc4: 4eb9 0005 3388 jsr 53388 <_Objects_Close> 4fcca: 2f0a movel %a2,%sp@- 4fccc: 4879 0007 52e6 pea 752e6 <_Region_Information> 4fcd2: 4eb9 0005 35fc jsr 535fc <_Objects_Free> 4fcd8: 4fef 0010 lea %sp@(16),%sp
default:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
4fcdc: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fce2: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock>
return return_status; }
4fce8: 246e fff8 moveal %fp@(-8),%a2 4fcec: 2002 movel %d2,%d0 4fcee: 242e fff4 movel %fp@(-12),%d2 4fcf2: 4e5e unlk %fp 4fcf4: 4e75 rts
...
0004fe0c <rtems_region_get_information>:
rtems_status_code rtems_region_get_information(
rtems_id id,
Heap_Information_block *the_info
)
{
4fe0c: 4e56 fffc linkw %fp,#-4 4fe10: 2f02 movel %d2,%sp@- 4fe12: 242e 000c movel %fp@(12),%d2
Objects_Locations location;
rtems_status_code return_status;
register Region_Control *the_region;
if ( !the_info )
4fe16: 6606 bnes 4fe1e <rtems_region_get_information+0x12> 4fe18: 143c 0009 moveb #9,%d2 4fe1c: 604e bras 4fe6c <rtems_region_get_information+0x60>
return RTEMS_INVALID_ADDRESS;
_RTEMS_Lock_allocator();
4fe1e: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fe24: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 4fe2a: 486e fffc pea %fp@(-4) 4fe2e: 2f2e 0008 movel %fp@(8),%sp@- 4fe32: 4879 0007 52e6 pea 752e6 <_Region_Information> 4fe38: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection>
the_region = _Region_Get( id, &location );
switch ( location ) {
4fe3e: 4fef 0010 lea %sp@(16),%sp 4fe42: 4aae fffc tstl %fp@(-4) 4fe46: 6704 beqs 4fe4c <rtems_region_get_information+0x40> 4fe48: 7404 moveq #4,%d2 4fe4a: 6012 bras 4fe5e <rtems_region_get_information+0x52>
case OBJECTS_LOCAL:
_Heap_Get_information( &the_region->Memory, the_info );
4fe4c: 2f02 movel %d2,%sp@- 4fe4e: 2040 moveal %d0,%a0 4fe50: 4868 0068 pea %a0@(104) 4fe54: 4282 clrl %d2 4fe56: 4eb9 0005 2db8 jsr 52db8 <_Heap_Get_information>
return_status = RTEMS_SUCCESSFUL;
break;
4fe5c: 508f addql #8,%sp
default:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
4fe5e: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fe64: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock>
return return_status;
4fe6a: 588f addql #4,%sp
}
4fe6c: 2002 movel %d2,%d0 4fe6e: 242e fff8 movel %fp@(-8),%d2 4fe72: 4e5e unlk %fp 4fe74: 4e75 rts
...
0004ff88 <rtems_region_get_segment_size>:
rtems_status_code rtems_region_get_segment_size(
rtems_id id,
void *segment,
uintptr_t *size
)
{
4ff88: 4e56 fffc linkw %fp,#-4 4ff8c: 2f03 movel %d3,%sp@- 4ff8e: 262e 0010 movel %fp@(16),%d3 4ff92: 2f02 movel %d2,%sp@- 4ff94: 242e 000c movel %fp@(12),%d2
Objects_Locations location;
rtems_status_code return_status = RTEMS_SUCCESSFUL;
register Region_Control *the_region;
if ( !segment )
4ff98: 6766 beqs 50000 <rtems_region_get_segment_size+0x78>
return RTEMS_INVALID_ADDRESS;
if ( !size )
4ff9a: 4a83 tstl %d3 4ff9c: 6762 beqs 50000 <rtems_region_get_segment_size+0x78>
return RTEMS_INVALID_ADDRESS;
_RTEMS_Lock_allocator();
4ff9e: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4ffa4: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 4ffaa: 486e fffc pea %fp@(-4) 4ffae: 2f2e 0008 movel %fp@(8),%sp@- 4ffb2: 4879 0007 52e6 pea 752e6 <_Region_Information> 4ffb8: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection>
the_region = _Region_Get( id, &location );
switch ( location ) {
4ffbe: 222e fffc movel %fp@(-4),%d1 4ffc2: 4fef 0010 lea %sp@(16),%sp 4ffc6: 670a beqs 4ffd2 <rtems_region_get_segment_size+0x4a> 4ffc8: 7001 moveq #1,%d0 4ffca: b081 cmpl %d1,%d0 4ffcc: 6620 bnes 4ffee <rtems_region_get_segment_size+0x66> 4ffce: 7404 moveq #4,%d2 4ffd0: 601e bras 4fff0 <rtems_region_get_segment_size+0x68>
case OBJECTS_LOCAL:
if ( !_Heap_Size_of_alloc_area( &the_region->Memory, segment, size ) )
4ffd2: 2f03 movel %d3,%sp@- 4ffd4: 2040 moveal %d0,%a0 4ffd6: 2f02 movel %d2,%sp@- 4ffd8: 4868 0068 pea %a0@(104) 4ffdc: 4eb9 0005 31d4 jsr 531d4 <_Heap_Size_of_alloc_area> 4ffe2: 4fef 000c lea %sp@(12),%sp 4ffe6: 4a00 tstb %d0 4ffe8: 6604 bnes 4ffee <rtems_region_get_segment_size+0x66>
4ffea: 7409 moveq #9,%d2 <== NOT EXECUTED 4ffec: 6002 bras 4fff0 <rtems_region_get_segment_size+0x68><== NOT EXECUTED
4ffee: 4282 clrl %d2
case OBJECTS_ERROR:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
4fff0: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fff6: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock>
return return_status;
4fffc: 588f addql #4,%sp 4fffe: 6002 bras 50002 <rtems_region_get_segment_size+0x7a> 50000: 7409 moveq #9,%d2
}
50002: 2002 movel %d2,%d0 50004: 242e fff4 movel %fp@(-12),%d2 50008: 262e fff8 movel %fp@(-8),%d3 5000c: 4e5e unlk %fp 5000e: 4e75 rts
0005003c <rtems_region_resize_segment>:
rtems_id id,
void *segment,
uintptr_t size,
uintptr_t *old_size
)
{
5003c: 4e56 ffe8 linkw %fp,#-24 50040: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 50044: 266e 0014 moveal %fp@(20),%a3
uintptr_t osize;
rtems_status_code return_status;
Heap_Resize_status status;
register Region_Control *the_region;
if ( !old_size )
50048: 4a8b tstl %a3 5004a: 6700 008e beqw 500da <rtems_region_resize_segment+0x9e>
return RTEMS_INVALID_ADDRESS;
_RTEMS_Lock_allocator();
5004e: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 50054: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 5005a: 486e fff8 pea %fp@(-8) 5005e: 2f2e 0008 movel %fp@(8),%sp@- 50062: 4879 0007 52e6 pea 752e6 <_Region_Information> 50068: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection>
the_region = _Region_Get( id, &location );
switch ( location ) {
5006e: 4fef 0010 lea %sp@(16),%sp 50072: 2440 moveal %d0,%a2 50074: 4aae fff8 tstl %fp@(-8) 50078: 664e bnes 500c8 <rtems_region_resize_segment+0x8c>
case OBJECTS_LOCAL:
_Region_Debug_Walk( the_region, 7 );
status = _Heap_Resize_block(
5007a: 486e fffc pea %fp@(-4) 5007e: 486e fff4 pea %fp@(-12) 50082: 2f2e 0010 movel %fp@(16),%sp@- 50086: 2f2e 000c movel %fp@(12),%sp@- 5008a: 486a 0068 pea %a2@(104) 5008e: 4eb9 0005 30fc jsr 530fc <_Heap_Resize_block>
segment,
(uint32_t) size,
&osize,
&avail_size
);
*old_size = (uint32_t) osize;
50094: 26ae fff4 movel %fp@(-12),%a3@
case OBJECTS_LOCAL:
_Region_Debug_Walk( the_region, 7 );
status = _Heap_Resize_block(
50098: 2400 movel %d0,%d2
);
*old_size = (uint32_t) osize;
_Region_Debug_Walk( the_region, 8 );
if ( status == HEAP_RESIZE_SUCCESSFUL )
5009a: 4fef 0014 lea %sp@(20),%sp 5009e: 660e bnes 500ae <rtems_region_resize_segment+0x72>
_Region_Process_queue( the_region ); /* unlocks allocator */
500a0: 2f0a movel %a2,%sp@- 500a2: 4eb9 0005 72f8 jsr 572f8 <_Region_Process_queue> 500a8: 588f addql #4,%sp 500aa: 4280 clrl %d0 500ac: 602e bras 500dc <rtems_region_resize_segment+0xa0>
else
_RTEMS_Unlock_allocator();
500ae: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 500b4: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock>
if (status == HEAP_RESIZE_SUCCESSFUL)
return RTEMS_SUCCESSFUL;
if (status == HEAP_RESIZE_UNSATISFIED)
500ba: 588f addql #4,%sp 500bc: 7001 moveq #1,%d0 500be: b082 cmpl %d2,%d0 500c0: 6618 bnes 500da <rtems_region_resize_segment+0x9e> 500c2: 103c 000d moveb #13,%d0 500c6: 6014 bras 500dc <rtems_region_resize_segment+0xa0>
default:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
500c8: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 500ce: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock>
return return_status;
500d4: 588f addql #4,%sp
default:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
500d6: 7004 moveq #4,%d0
return return_status;
500d8: 6002 bras 500dc <rtems_region_resize_segment+0xa0> 500da: 7009 moveq #9,%d0
}
500dc: 4cee 0c04 ffe8 moveml %fp@(-24),%d2/%a2-%a3 500e2: 4e5e unlk %fp 500e4: 4e75 rts
...
000500e8 <rtems_region_return_segment>:
rtems_status_code rtems_region_return_segment(
rtems_id id,
void *segment
)
{
500e8: 4e56 fffc linkw %fp,#-4 500ec: 2f0a movel %a2,%sp@- 500ee: 2f02 movel %d2,%sp@-
uint32_t size;
#endif
int status;
register Region_Control *the_region;
_RTEMS_Lock_allocator();
500f0: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 500f6: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 500fc: 486e fffc pea %fp@(-4) 50100: 2f2e 0008 movel %fp@(8),%sp@- 50104: 4879 0007 52e6 pea 752e6 <_Region_Information> 5010a: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection>
the_region = _Region_Get( id, &location );
switch ( location ) {
50110: 4fef 0010 lea %sp@(16),%sp 50114: 2440 moveal %d0,%a2 50116: 4aae fffc tstl %fp@(-4) 5011a: 6704 beqs 50120 <rtems_region_return_segment+0x38> 5011c: 7404 moveq #4,%d2 5011e: 6026 bras 50146 <rtems_region_return_segment+0x5e>
RTEMS_INLINE_ROUTINE bool _Region_Free_segment (
Region_Control *the_region,
void *the_segment
)
{
return _Heap_Free( &the_region->Memory, the_segment );
50120: 2f2e 000c movel %fp@(12),%sp@- 50124: 486a 0068 pea %a2@(104) 50128: 4eb9 0005 2c04 jsr 52c04 <_Heap_Free>
#endif
status = _Region_Free_segment( the_region, segment );
_Region_Debug_Walk( the_region, 4 );
if ( !status )
5012e: 508f addql #8,%sp 50130: 4a00 tstb %d0 50132: 6710 beqs 50144 <rtems_region_return_segment+0x5c>
return_status = RTEMS_INVALID_ADDRESS;
else {
the_region->number_of_used_blocks -= 1;
50134: 53aa 0064 subql #1,%a2@(100)
_Region_Process_queue(the_region); /* unlocks allocator */
50138: 4282 clrl %d2 5013a: 2f0a movel %a2,%sp@- 5013c: 4eb9 0005 72f8 jsr 572f8 <_Region_Process_queue> 50142: 600e bras 50152 <rtems_region_return_segment+0x6a>
return RTEMS_SUCCESSFUL;
50144: 7409 moveq #9,%d2
default:
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
50146: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 5014c: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock>
return return_status; }
50152: 2002 movel %d2,%d0
return_status = RTEMS_INVALID_ID;
break;
}
_RTEMS_Unlock_allocator();
return return_status;
50154: 588f addql #4,%sp
}
50156: 242e fff4 movel %fp@(-12),%d2 5015a: 246e fff8 moveal %fp@(-8),%a2 5015e: 4e5e unlk %fp 50160: 4e75 rts
...
00050440 <rtems_semaphore_ident>:
rtems_status_code rtems_semaphore_ident(
rtems_name name,
uint32_t node,
rtems_id *id
)
{
50440: 4e56 0000 linkw %fp,#0
Objects_Name_or_id_lookup_errors status;
status = _Objects_Name_to_id_u32( &_Semaphore_Information, name, node, id );
50444: 2f2e 0010 movel %fp@(16),%sp@- 50448: 2f2e 000c movel %fp@(12),%sp@- 5044c: 2f2e 0008 movel %fp@(8),%sp@- 50450: 4879 0007 5320 pea 75320 <_Semaphore_Information> 50456: 4eb9 0005 39a0 jsr 539a0 <_Objects_Name_to_id_u32> 5045c: 41f9 0006 e700 lea 6e700 <_Status_Object_name_errors_to_status>,%a0
return _Status_Object_name_errors_to_status[ status ];
}
50462: 4e5e unlk %fp 50464: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 50468: 4e75 rts
...
00045560 <rtems_shutdown_executive>:
void rtems_shutdown_executive(
uint32_t result
)
{
if ( !_System_state_Is_shutdown( _System_state_Get() ) ) {
45560: 7004 moveq #4,%d0
*/
void rtems_shutdown_executive(
uint32_t result
)
{
45562: 4e56 0000 linkw %fp,#0
if ( !_System_state_Is_shutdown( _System_state_Get() ) ) {
45566: b0b9 0005 ce1c cmpl 5ce1c <_System_state_Current>,%d0 4556c: 6718 beqs 45586 <rtems_shutdown_executive+0x26> 4556e: 23c0 0005 ce1c movel %d0,5ce1c <_System_state_Current>
* if we were running within the same context, it would work. * * And we will not return to this thread, so there is no point of * saving the context. */ _Context_Restart_self( &_Thread_BSP_context );
45574: 203c 0005 cc60 movel #380000,%d0 4557a: 2d40 0008 movel %d0,%fp@(8)
_System_state_Set( SYSTEM_STATE_SHUTDOWN );
_Thread_Stop_multitasking();
}
}
4557e: 4e5e unlk %fp 45580: 4ef9 0004 7f3e jmp 47f3e <_CPU_Context_Restart_self> 45586: 4e5e unlk %fp 45588: 4e75 rts
...
00045e34 <rtems_signal_catch>:
rtems_status_code rtems_signal_catch(
rtems_asr_entry asr_handler,
rtems_mode mode_set
)
{
45e34: 4e56 0000 linkw %fp,#0 45e38: 2239 0005 e05c movel 5e05c <_Thread_Dispatch_disable_level>,%d1 45e3e: 5281 addql #1,%d1
RTEMS_API_Control *api;
ASR_Information *asr;
/* XXX normalize mode */
executing = _Thread_Executing;
api = (RTEMS_API_Control*)executing->API_Extensions[ THREAD_API_RTEMS ];
45e40: 2079 0005 e116 moveal 5e116 <_Thread_Executing>,%a0
rtems_status_code rtems_signal_catch(
rtems_asr_entry asr_handler,
rtems_mode mode_set
)
{
45e46: 202e 0008 movel %fp@(8),%d0
RTEMS_API_Control *api;
ASR_Information *asr;
/* XXX normalize mode */
executing = _Thread_Executing;
api = (RTEMS_API_Control*)executing->API_Extensions[ THREAD_API_RTEMS ];
45e4a: 2068 010a moveal %a0@(266),%a0 45e4e: 23c1 0005 e05c movel %d1,5e05c <_Thread_Dispatch_disable_level>
asr = &api->Signal;
_Thread_Disable_dispatch(); /* cannot reschedule while */
/* the thread is inconsistent */
if ( !_ASR_Is_null_handler( asr_handler ) ) {
45e54: 4a80 tstl %d0 45e56: 670c beqs 45e64 <rtems_signal_catch+0x30>
asr->mode_set = mode_set;
asr->handler = asr_handler;
45e58: 2140 000a movel %d0,%a0@(10)
_Thread_Disable_dispatch(); /* cannot reschedule while */
/* the thread is inconsistent */
if ( !_ASR_Is_null_handler( asr_handler ) ) {
asr->mode_set = mode_set;
45e5c: 216e 000c 000e movel %fp@(12),%a0@(14) 45e62: 601a bras 45e7e <rtems_signal_catch+0x4a>
information->is_enabled = false; information->handler = NULL; information->mode_set = RTEMS_DEFAULT_MODES; information->signals_posted = 0; information->signals_pending = 0; information->nest_level = 0;
45e64: 42a8 001a clrl %a0@(26)
*/
RTEMS_INLINE_ROUTINE void _ASR_Initialize (
ASR_Information *information
)
{
information->is_enabled = false;
45e68: 4200 clrb %d0
information->handler = NULL;
45e6a: 42a8 000a clrl %a0@(10)
*/
RTEMS_INLINE_ROUTINE void _ASR_Initialize (
ASR_Information *information
)
{
information->is_enabled = false;
45e6e: 1140 0008 moveb %d0,%a0@(8)
information->handler = NULL; information->mode_set = RTEMS_DEFAULT_MODES;
45e72: 42a8 000e clrl %a0@(14)
information->signals_posted = 0;
45e76: 42a8 0012 clrl %a0@(18)
information->signals_pending = 0;
45e7a: 42a8 0016 clrl %a0@(22)
asr->handler = asr_handler;
}
else
_ASR_Initialize( asr );
_Thread_Enable_dispatch();
45e7e: 4eb9 0004 7cd2 jsr 47cd2 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL; }
45e84: 4280 clrl %d0 45e86: 4e5e unlk %fp 45e88: 4e75 rts
...
00050620 <rtems_signal_send>:
rtems_status_code rtems_signal_send(
rtems_id id,
rtems_signal_set signal_set
)
{
50620: 4e56 fffc linkw %fp,#-4 50624: 2f03 movel %d3,%sp@- 50626: 2f02 movel %d2,%sp@- 50628: 242e 000c movel %fp@(12),%d2
register Thread_Control *the_thread;
Objects_Locations location;
RTEMS_API_Control *api;
ASR_Information *asr;
if ( !signal_set )
5062c: 6606 bnes 50634 <rtems_signal_send+0x14> 5062e: 700a moveq #10,%d0 50630: 6000 0084 braw 506b6 <rtems_signal_send+0x96>
return RTEMS_INVALID_NUMBER;
the_thread = _Thread_Get( id, &location );
50634: 486e fffc pea %fp@(-4) 50638: 2f2e 0008 movel %fp@(8),%sp@- 5063c: 4eb9 0005 4068 jsr 54068 <_Thread_Get>
switch ( location ) {
50642: 508f addql #8,%sp 50644: 4aae fffc tstl %fp@(-4) 50648: 6704 beqs 5064e <rtems_signal_send+0x2e> 5064a: 7004 moveq #4,%d0 5064c: 6068 bras 506b6 <rtems_signal_send+0x96>
case OBJECTS_LOCAL:
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
5064e: 2240 moveal %d0,%a1 50650: 2069 010a moveal %a1@(266),%a0
asr = &api->Signal;
50654: 4aa8 000a tstl %a0@(10) 50658: 6754 beqs 506ae <rtems_signal_send+0x8e>
if ( ! _ASR_Is_null_handler( asr->handler ) ) {
if ( asr->is_enabled ) {
5065a: 4a28 0008 tstb %a0@(8) 5065e: 6732 beqs 50692 <rtems_signal_send+0x72>
rtems_signal_set *signal_set
)
{
ISR_Level _level;
_ISR_Disable( _level );
50660: 223c 0000 0700 movel #1792,%d1 50666: 40c3 movew %sr,%d3 50668: 8283 orl %d3,%d1 5066a: 46c1 movew %d1,%sr
*signal_set |= signals;
5066c: 85a8 0012 orl %d2,%a0@(18)
_ISR_Enable( _level );
50670: 46c3 movew %d3,%sr
_ASR_Post_signals( signal_set, &asr->signals_posted );
the_thread->do_post_task_switch_extension = true;
if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) )
50672: 2239 0007 5482 movel 75482 <_ISR_Nest_level>,%d1
if ( ! _ASR_Is_null_handler( asr->handler ) ) {
if ( asr->is_enabled ) {
_ASR_Post_signals( signal_set, &asr->signals_posted );
the_thread->do_post_task_switch_extension = true;
50678: 7401 moveq #1,%d2 5067a: 1342 0074 moveb %d2,%a1@(116)
if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) )
5067e: 4a81 tstl %d1 50680: 6722 beqs 506a4 <rtems_signal_send+0x84> 50682: b0b9 0007 54a2 cmpl 754a2 <_Thread_Executing>,%d0 50688: 661a bnes 506a4 <rtems_signal_send+0x84>
_ISR_Signals_to_thread_executing = true;
5068a: 13c2 0007 5530 moveb %d2,75530 <_ISR_Signals_to_thread_executing> 50690: 6012 bras 506a4 <rtems_signal_send+0x84>
rtems_signal_set *signal_set
)
{
ISR_Level _level;
_ISR_Disable( _level );
50692: 203c 0000 0700 movel #1792,%d0 50698: 40c1 movew %sr,%d1 5069a: 8081 orl %d1,%d0 5069c: 46c0 movew %d0,%sr
*signal_set |= signals;
5069e: 85a8 0016 orl %d2,%a0@(22)
_ISR_Enable( _level );
506a2: 46c1 movew %d1,%sr
} else {
_ASR_Post_signals( signal_set, &asr->signals_pending );
}
_Thread_Enable_dispatch();
506a4: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 506aa: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
506ac: 6008 bras 506b6 <rtems_signal_send+0x96>
}
_Thread_Enable_dispatch();
506ae: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 506b4: 700b moveq #11,%d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
506b6: 242e fff4 movel %fp@(-12),%d2 506ba: 262e fff8 movel %fp@(-8),%d3 506be: 4e5e unlk %fp 506c0: 4e75 rts
...
00045208 <rtems_task_delete>:
*/
rtems_status_code rtems_task_delete(
rtems_id id
)
{
45208: 4e56 fff0 linkw %fp,#-16 4520c: 48d7 1c00 moveml %a2-%a4,%sp@
register Thread_Control *the_thread;
Objects_Locations location;
Objects_Information *the_information;
_RTEMS_Lock_allocator();
45210: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 45216: 47f9 0004 589c lea 4589c <_API_Mutex_Unlock>,%a3 4521c: 4eb9 0004 583c jsr 4583c <_API_Mutex_Lock>
the_thread = _Thread_Get( id, &location );
45222: 486e fffc pea %fp@(-4) 45226: 2f2e 0008 movel %fp@(8),%sp@- 4522a: 4eb9 0004 6d08 jsr 46d08 <_Thread_Get>
switch ( location ) {
45230: 4fef 000c lea %sp@(12),%sp
Objects_Locations location;
Objects_Information *the_information;
_RTEMS_Lock_allocator();
the_thread = _Thread_Get( id, &location );
45234: 2440 moveal %d0,%a2
switch ( location ) {
45236: 4aae fffc tstl %fp@(-4) 4523a: 663c bnes 45278 <rtems_task_delete+0x70>
case OBJECTS_LOCAL:
the_information = _Objects_Get_information_id( the_thread->Object.id );
4523c: 2f2a 0008 movel %a2@(8),%sp@- 45240: 49f9 0004 6414 lea 46414 <_Objects_Get_information_id>,%a4 45246: 4e94 jsr %a4@
0 /* Not used */
);
}
#endif
_Thread_Close( the_information, the_thread );
45248: 2f0a movel %a2,%sp@- 4524a: 2f00 movel %d0,%sp@- 4524c: 4eb9 0004 69d4 jsr 469d4 <_Thread_Close> 45252: 2f2a 0008 movel %a2@(8),%sp@- 45256: 4e94 jsr %a4@ 45258: 2f0a movel %a2,%sp@- 4525a: 2f00 movel %d0,%sp@- 4525c: 4eb9 0004 6390 jsr 46390 <_Objects_Free>
_RTEMS_tasks_Free( the_thread );
_RTEMS_Unlock_allocator();
45262: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 45268: 4e93 jsr %a3@
_Thread_Enable_dispatch();
4526a: 4eb9 0004 6ce2 jsr 46ce2 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
45270: 4fef 001c lea %sp@(28),%sp
_Thread_Close( the_information, the_thread );
_RTEMS_tasks_Free( the_thread );
_RTEMS_Unlock_allocator();
_Thread_Enable_dispatch();
45274: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
45276: 600c bras 45284 <rtems_task_delete+0x7c>
case OBJECTS_ERROR:
break;
}
_RTEMS_Unlock_allocator();
45278: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4527e: 4e93 jsr %a3@
return RTEMS_INVALID_ID;
45280: 588f addql #4,%sp
case OBJECTS_ERROR:
break;
}
_RTEMS_Unlock_allocator();
45282: 7004 moveq #4,%d0
return RTEMS_INVALID_ID; }
45284: 4cee 1c00 fff0 moveml %fp@(-16),%a2-%a4 4528a: 4e5e unlk %fp 4528c: 4e75 rts
...
00046988 <rtems_task_get_note>:
rtems_status_code rtems_task_get_note(
rtems_id id,
uint32_t notepad,
uint32_t *note
)
{
46988: 4e56 fffc linkw %fp,#-4 4698c: 202e 0008 movel %fp@(8),%d0 46990: 2f0a movel %a2,%sp@- 46992: 246e 0010 moveal %fp@(16),%a2 46996: 2f02 movel %d2,%sp@- 46998: 242e 000c movel %fp@(12),%d2
register Thread_Control *the_thread;
Objects_Locations location;
RTEMS_API_Control *api;
if ( !rtems_configuration_get_notepads_enabled() )
4699c: 4a39 0005 db44 tstb 5db44 <Configuration_RTEMS_API+0x4> 469a2: 6604 bnes 469a8 <rtems_task_get_note+0x20> 469a4: 7016 moveq #22,%d0 469a6: 605e bras 46a06 <rtems_task_get_note+0x7e>
return RTEMS_NOT_CONFIGURED;
if ( !note )
469a8: 4a8a tstl %a2 469aa: 6604 bnes 469b0 <rtems_task_get_note+0x28> 469ac: 7009 moveq #9,%d0 469ae: 6056 bras 46a06 <rtems_task_get_note+0x7e>
/*
* NOTE: There is no check for < RTEMS_NOTEPAD_FIRST because that would
* be checking an unsigned number for being negative.
*/
if ( notepad > RTEMS_NOTEPAD_LAST )
469b0: 720f moveq #15,%d1 469b2: b282 cmpl %d2,%d1 469b4: 6404 bccs 469ba <rtems_task_get_note+0x32> 469b6: 700a moveq #10,%d0 469b8: 604c bras 46a06 <rtems_task_get_note+0x7e>
/*
* Optimize the most likely case to avoid the Thread_Dispatch.
*/
if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ||
469ba: 4a80 tstl %d0 469bc: 670c beqs 469ca <rtems_task_get_note+0x42>
_Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) {
469be: 2079 0005 f64e moveal 5f64e <_Thread_Executing>,%a0 469c4: b0a8 0008 cmpl %a0@(8),%d0 469c8: 6612 bnes 469dc <rtems_task_get_note+0x54>
api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ];
*note = api->Notepads[ notepad ];
469ca: 2079 0005 f64e moveal 5f64e <_Thread_Executing>,%a0 469d0: 4280 clrl %d0 469d2: 2068 010a moveal %a0@(266),%a0 469d6: 24b0 2c1e movel %a0@(0000001e,%d2:l:4),%a2@
return RTEMS_SUCCESSFUL;
469da: 602a bras 46a06 <rtems_task_get_note+0x7e>
}
the_thread = _Thread_Get( id, &location );
469dc: 486e fffc pea %fp@(-4) 469e0: 2f00 movel %d0,%sp@- 469e2: 4eb9 0004 86c8 jsr 486c8 <_Thread_Get>
switch ( location ) {
469e8: 508f addql #8,%sp 469ea: 4aae fffc tstl %fp@(-4) 469ee: 6704 beqs 469f4 <rtems_task_get_note+0x6c> 469f0: 7004 moveq #4,%d0 469f2: 6012 bras 46a06 <rtems_task_get_note+0x7e>
case OBJECTS_LOCAL:
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
*note = api->Notepads[ notepad ];
469f4: 2240 moveal %d0,%a1 469f6: 2069 010a moveal %a1@(266),%a0 469fa: 24b0 2c1e movel %a0@(0000001e,%d2:l:4),%a2@
_Thread_Enable_dispatch();
469fe: 4eb9 0004 86a2 jsr 486a2 <_Thread_Enable_dispatch> 46a04: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
46a06: 242e fff4 movel %fp@(-12),%d2 46a0a: 246e fff8 moveal %fp@(-8),%a2 46a0e: 4e5e unlk %fp 46a10: 4e75 rts
...
00045290 <rtems_task_ident>:
rtems_status_code rtems_task_ident(
rtems_name name,
uint32_t node,
rtems_id *id
)
{
45290: 4e56 0000 linkw %fp,#0 45294: 202e 0008 movel %fp@(8),%d0 45298: 206e 0010 moveal %fp@(16),%a0
Objects_Name_or_id_lookup_errors status;
if ( !id )
4529c: 4a88 tstl %a0 4529e: 6604 bnes 452a4 <rtems_task_ident+0x14> 452a0: 7009 moveq #9,%d0 452a2: 6032 bras 452d6 <rtems_task_ident+0x46>
return RTEMS_INVALID_ADDRESS;
if ( name == OBJECTS_ID_OF_SELF ) {
452a4: 4a80 tstl %d0 452a6: 660c bnes 452b4 <rtems_task_ident+0x24>
*id = _Thread_Executing->Object.id;
452a8: 2279 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a1 452ae: 20a9 0008 movel %a1@(8),%a0@
return RTEMS_SUCCESSFUL;
452b2: 6022 bras 452d6 <rtems_task_ident+0x46>
}
status = _Objects_Name_to_id_u32( &_RTEMS_tasks_Information, name, node, id );
452b4: 2f08 movel %a0,%sp@- 452b6: 2f2e 000c movel %fp@(12),%sp@- 452ba: 2f00 movel %d0,%sp@- 452bc: 4879 0005 cc06 pea 5cc06 <_RTEMS_tasks_Information> 452c2: 4eb9 0004 6670 jsr 46670 <_Objects_Name_to_id_u32>
return _Status_Object_name_errors_to_status[ status ];
452c8: 4fef 0010 lea %sp@(16),%sp 452cc: 41f9 0005 a40c lea 5a40c <_Status_Object_name_errors_to_status>,%a0 452d2: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0
}
452d6: 4e5e unlk %fp 452d8: 4e75 rts
...
0004bc30 <rtems_task_mode>:
rtems_status_code rtems_task_mode(
rtems_mode mode_set,
rtems_mode mask,
rtems_mode *previous_mode_set
)
{
4bc30: 4e56 ffe4 linkw %fp,#-28 4bc34: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@ 4bc38: 262e 0008 movel %fp@(8),%d3 4bc3c: 282e 000c movel %fp@(12),%d4 4bc40: 286e 0010 moveal %fp@(16),%a4
ASR_Information *asr;
bool is_asr_enabled = false;
bool needs_asr_dispatching = false;
rtems_mode old_mode;
if ( !previous_mode_set )
4bc44: 4a8c tstl %a4 4bc46: 6606 bnes 4bc4e <rtems_task_mode+0x1e> 4bc48: 7009 moveq #9,%d0 4bc4a: 6000 00fc braw 4bd48 <rtems_task_mode+0x118>
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
4bc4e: 2479 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a2
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT;
4bc54: 4a2a 0075 tstb %a2@(117) 4bc58: 57c0 seq %d0 4bc5a: 243c 0000 0100 movel #256,%d2 4bc60: 49c0 extbl %d0
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
4bc62: 266a 010a moveal %a2@(266),%a3
asr = &api->Signal;
old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT;
4bc66: c480 andl %d0,%d2
if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE )
4bc68: 4aaa 007a tstl %a2@(122) 4bc6c: 6704 beqs 4bc72 <rtems_task_mode+0x42>
old_mode |= RTEMS_NO_TIMESLICE;
else
old_mode |= RTEMS_TIMESLICE;
4bc6e: 08c2 0009 bset #9,%d2
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
4bc72: 4a2b 0008 tstb %a3@(8) 4bc76: 57c0 seq %d0 4bc78: 2a3c 0000 0400 movel #1024,%d5 4bc7e: 49c0 extbl %d0 4bc80: ca80 andl %d0,%d5
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();
4bc82: 4eb9 0004 7ff4 jsr 47ff4 <_CPU_ISR_Get_level>
if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE )
old_mode |= RTEMS_NO_TIMESLICE;
else
old_mode |= RTEMS_TIMESLICE;
old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR;
4bc88: 8085 orl %d5,%d0
old_mode |= _ISR_Get_level();
*previous_mode_set = old_mode;
4bc8a: 8082 orl %d2,%d0 4bc8c: 2880 movel %d0,%a4@
/*
* These are generic thread scheduling characteristics.
*/
if ( mask & RTEMS_PREEMPT_MASK )
4bc8e: 0804 0008 btst #8,%d4 4bc92: 670e beqs 4bca2 <rtems_task_mode+0x72>
executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false;
4bc94: 2003 movel %d3,%d0 4bc96: 7201 moveq #1,%d1 4bc98: e088 lsrl #8,%d0 4bc9a: b380 eorl %d1,%d0 4bc9c: c081 andl %d1,%d0 4bc9e: 1540 0075 moveb %d0,%a2@(117)
if ( mask & RTEMS_TIMESLICE_MASK ) {
4bca2: 0804 0009 btst #9,%d4 4bca6: 671c beqs 4bcc4 <rtems_task_mode+0x94>
if ( _Modes_Is_timeslice(mode_set) ) {
4bca8: 0803 0009 btst #9,%d3 4bcac: 6712 beqs 4bcc0 <rtems_task_mode+0x90>
executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE;
executing->cpu_time_budget = _Thread_Ticks_per_timeslice;
4bcae: 41f9 0005 cc44 lea 5cc44 <_Thread_Ticks_per_timeslice>,%a0
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;
4bcb4: 7001 moveq #1,%d0
executing->cpu_time_budget = _Thread_Ticks_per_timeslice;
4bcb6: 2550 0076 movel %a0@,%a2@(118)
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;
4bcba: 2540 007a movel %d0,%a2@(122) 4bcbe: 6004 bras 4bcc4 <rtems_task_mode+0x94>
executing->cpu_time_budget = _Thread_Ticks_per_timeslice;
} else
executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE;
4bcc0: 42aa 007a clrl %a2@(122)
/*
* Set the new interrupt level
*/
if ( mask & RTEMS_INTERRUPT_MASK )
4bcc4: 7007 moveq #7,%d0 4bcc6: c084 andl %d4,%d0 4bcc8: 6712 beqs 4bcdc <rtems_task_mode+0xac>
*/
RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level (
Modes_Control mode_set
)
{
_ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) );
4bcca: 40c0 movew %sr,%d0 4bccc: 7207 moveq #7,%d1 4bcce: c283 andl %d3,%d1 4bcd0: 0280 0000 f8ff andil #63743,%d0 4bcd6: e189 lsll #8,%d1 4bcd8: 8081 orl %d1,%d0 4bcda: 46c0 movew %d0,%sr
*/
is_asr_enabled = false;
needs_asr_dispatching = false;
if ( mask & RTEMS_ASR_MASK ) {
4bcdc: 0804 000a btst #10,%d4 4bce0: 6744 beqs 4bd26 <rtems_task_mode+0xf6>
* Output:
* *previous_mode_set - previous mode set
* always return RTEMS_SUCCESSFUL;
*/
rtems_status_code rtems_task_mode(
4bce2: 700a moveq #10,%d0 4bce4: e0ab lsrl %d0,%d3 4bce6: 7201 moveq #1,%d1
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
4bce8: 4280 clrl %d0 4bcea: 102b 0008 moveb %a3@(8),%d0
* Output:
* *previous_mode_set - previous mode set
* always return RTEMS_SUCCESSFUL;
*/
rtems_status_code rtems_task_mode(
4bcee: b383 eorl %d1,%d3 4bcf0: c681 andl %d1,%d3
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
4bcf2: b083 cmpl %d3,%d0 4bcf4: 6730 beqs 4bd26 <rtems_task_mode+0xf6>
)
{
rtems_signal_set _signals;
ISR_Level _level;
_ISR_Disable( _level );
4bcf6: 203c 0000 0700 movel #1792,%d0
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 ) {
asr->is_enabled = is_asr_enabled;
4bcfc: 1743 0008 moveb %d3,%a3@(8) 4bd00: 40c1 movew %sr,%d1 4bd02: 8081 orl %d1,%d0 4bd04: 46c0 movew %d0,%sr
_signals = information->signals_pending;
4bd06: 202b 0016 movel %a3@(22),%d0
information->signals_pending = information->signals_posted;
4bd0a: 276b 0012 0016 movel %a3@(18),%a3@(22)
information->signals_posted = _signals;
4bd10: 2740 0012 movel %d0,%a3@(18)
_ISR_Enable( _level );
4bd14: 46c1 movew %d1,%sr
if ( !previous_mode_set )
return RTEMS_INVALID_ADDRESS;
executing = _Thread_Executing;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
4bd16: 4aab 0012 tstl %a3@(18) 4bd1a: 670a beqs 4bd26 <rtems_task_mode+0xf6>
if ( is_asr_enabled != asr->is_enabled ) {
asr->is_enabled = is_asr_enabled;
_ASR_Swap_signals( asr );
if ( _ASR_Are_signals_pending( asr ) ) {
needs_asr_dispatching = true;
executing->do_post_task_switch_extension = true;
4bd1c: 7001 moveq #1,%d0 4bd1e: 7401 moveq #1,%d2 4bd20: 1540 0074 moveb %d0,%a2@(116) 4bd24: 6002 bras 4bd28 <rtems_task_mode+0xf8> 4bd26: 4202 clrb %d2
}
}
}
if ( _System_state_Is_up( _System_state_Get() ) )
4bd28: 7203 moveq #3,%d1 4bd2a: b2b9 0005 ce1c cmpl 5ce1c <_System_state_Current>,%d1 4bd30: 6614 bnes 4bd46 <rtems_task_mode+0x116>
if ( _Thread_Evaluate_mode() || needs_asr_dispatching )
4bd32: 4eb9 0004 c028 jsr 4c028 <_Thread_Evaluate_mode> 4bd38: 4a00 tstb %d0 4bd3a: 6604 bnes 4bd40 <rtems_task_mode+0x110> 4bd3c: 4a02 tstb %d2 4bd3e: 6706 beqs 4bd46 <rtems_task_mode+0x116>
_Thread_Dispatch();
4bd40: 4eb9 0004 6b90 jsr 46b90 <_Thread_Dispatch> 4bd46: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
}
4bd48: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 4bd4e: 4e5e unlk %fp 4bd50: 4e75 rts
...
0004e684 <rtems_task_self>:
#include <rtems/system.h>
#include <rtems/rtems/tasks.h>
rtems_id rtems_task_self(void)
{
4e684: 4e56 0000 linkw %fp,#0 4e688: 2079 0006 20c6 moveal 620c6 <_Thread_Executing>,%a0
return _Thread_Executing->Object.id; }
4e68e: 4e5e unlk %fp 4e690: 2028 0008 movel %a0@(8),%d0 4e694: 4e75 rts
...
00046af4 <rtems_task_set_note>:
rtems_status_code rtems_task_set_note(
rtems_id id,
uint32_t notepad,
uint32_t note
)
{
46af4: 4e56 fffc linkw %fp,#-4 46af8: 202e 0008 movel %fp@(8),%d0 46afc: 2f03 movel %d3,%sp@- 46afe: 262e 0010 movel %fp@(16),%d3 46b02: 2f02 movel %d2,%sp@- 46b04: 242e 000c movel %fp@(12),%d2
register Thread_Control *the_thread;
Objects_Locations location;
RTEMS_API_Control *api;
if ( !rtems_configuration_get_notepads_enabled() )
46b08: 4a39 0005 db44 tstb 5db44 <Configuration_RTEMS_API+0x4> 46b0e: 6604 bnes 46b14 <rtems_task_set_note+0x20> 46b10: 7016 moveq #22,%d0 46b12: 6056 bras 46b6a <rtems_task_set_note+0x76>
/*
* NOTE: There is no check for < RTEMS_NOTEPAD_FIRST because that would
* be checking an unsigned number for being negative.
*/
if ( notepad > RTEMS_NOTEPAD_LAST )
46b14: 720f moveq #15,%d1 46b16: b282 cmpl %d2,%d1 46b18: 6404 bccs 46b1e <rtems_task_set_note+0x2a> 46b1a: 700a moveq #10,%d0 46b1c: 604c bras 46b6a <rtems_task_set_note+0x76>
/*
* Optimize the most likely case to avoid the Thread_Dispatch.
*/
if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ||
46b1e: 4a80 tstl %d0 46b20: 670c beqs 46b2e <rtems_task_set_note+0x3a>
_Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) {
46b22: 2079 0005 f64e moveal 5f64e <_Thread_Executing>,%a0 46b28: b0a8 0008 cmpl %a0@(8),%d0 46b2c: 6612 bnes 46b40 <rtems_task_set_note+0x4c>
api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ];
api->Notepads[ notepad ] = note;
46b2e: 2079 0005 f64e moveal 5f64e <_Thread_Executing>,%a0 46b34: 4280 clrl %d0 46b36: 2068 010a moveal %a0@(266),%a0 46b3a: 2183 2c1e movel %d3,%a0@(0000001e,%d2:l:4)
return RTEMS_SUCCESSFUL;
46b3e: 602a bras 46b6a <rtems_task_set_note+0x76>
}
the_thread = _Thread_Get( id, &location );
46b40: 486e fffc pea %fp@(-4) 46b44: 2f00 movel %d0,%sp@- 46b46: 4eb9 0004 86c8 jsr 486c8 <_Thread_Get>
switch ( location ) {
46b4c: 508f addql #8,%sp 46b4e: 4aae fffc tstl %fp@(-4) 46b52: 6704 beqs 46b58 <rtems_task_set_note+0x64> 46b54: 7004 moveq #4,%d0 46b56: 6012 bras 46b6a <rtems_task_set_note+0x76>
case OBJECTS_LOCAL:
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
api->Notepads[ notepad ] = note;
46b58: 2240 moveal %d0,%a1 46b5a: 2069 010a moveal %a1@(266),%a0 46b5e: 2183 2c1e movel %d3,%a0@(0000001e,%d2:l:4)
_Thread_Enable_dispatch();
46b62: 4eb9 0004 86a2 jsr 486a2 <_Thread_Enable_dispatch> 46b68: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
46b6a: 242e fff4 movel %fp@(-12),%d2 46b6e: 262e fff8 movel %fp@(-8),%d3 46b72: 4e5e unlk %fp 46b74: 4e75 rts
...
000493f8 <rtems_task_set_priority>:
rtems_status_code rtems_task_set_priority(
rtems_id id,
rtems_task_priority new_priority,
rtems_task_priority *old_priority
)
{
493f8: 4e56 fffc linkw %fp,#-4 493fc: 2f0a movel %a2,%sp@- 493fe: 246e 0010 moveal %fp@(16),%a2 49402: 2f02 movel %d2,%sp@- 49404: 242e 000c movel %fp@(12),%d2
register Thread_Control *the_thread;
Objects_Locations location;
if ( new_priority != RTEMS_CURRENT_PRIORITY &&
49408: 6710 beqs 4941a <rtems_task_set_priority+0x22> 4940a: 4280 clrl %d0 4940c: 1039 0006 0b42 moveb 60b42 <rtems_maximum_priority>,%d0 49412: b082 cmpl %d2,%d0 49414: 6404 bccs 4941a <rtems_task_set_priority+0x22> 49416: 7013 moveq #19,%d0 49418: 6054 bras 4946e <rtems_task_set_priority+0x76>
!_RTEMS_tasks_Priority_is_valid( new_priority ) )
return RTEMS_INVALID_PRIORITY;
if ( !old_priority )
4941a: 4a8a tstl %a2 4941c: 6604 bnes 49422 <rtems_task_set_priority+0x2a> 4941e: 7009 moveq #9,%d0 49420: 604c bras 4946e <rtems_task_set_priority+0x76>
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get( id, &location );
49422: 486e fffc pea %fp@(-4) 49426: 2f2e 0008 movel %fp@(8),%sp@- 4942a: 4eb9 0004 b104 jsr 4b104 <_Thread_Get>
switch ( location ) {
49430: 508f addql #8,%sp
return RTEMS_INVALID_PRIORITY;
if ( !old_priority )
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get( id, &location );
49432: 2040 moveal %d0,%a0
switch ( location ) {
49434: 4aae fffc tstl %fp@(-4) 49438: 6704 beqs 4943e <rtems_task_set_priority+0x46> 4943a: 7004 moveq #4,%d0 4943c: 6030 bras 4946e <rtems_task_set_priority+0x76>
case OBJECTS_LOCAL:
/* XXX need helper to "convert" from core priority */
*old_priority = the_thread->current_priority;
4943e: 24a8 0014 movel %a0@(20),%a2@
if ( new_priority != RTEMS_CURRENT_PRIORITY ) {
49442: 4a82 tstl %d2 49444: 6720 beqs 49466 <rtems_task_set_priority+0x6e>
the_thread->real_priority = new_priority;
49446: 2142 0018 movel %d2,%a0@(24)
if ( the_thread->resource_count == 0 ||
4944a: 4aa8 001c tstl %a0@(28) 4944e: 6706 beqs 49456 <rtems_task_set_priority+0x5e>
the_thread->current_priority > new_priority )
49450: b4a8 0014 cmpl %a0@(20),%d2 49454: 6410 bccs 49466 <rtems_task_set_priority+0x6e>
_Thread_Change_priority( the_thread, new_priority, false );
49456: 42a7 clrl %sp@- 49458: 2f02 movel %d2,%sp@- 4945a: 2f08 movel %a0,%sp@- 4945c: 4eb9 0004 abb4 jsr 4abb4 <_Thread_Change_priority> 49462: 4fef 000c lea %sp@(12),%sp
}
_Thread_Enable_dispatch();
49466: 4eb9 0004 b0ae jsr 4b0ae <_Thread_Enable_dispatch> 4946c: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
4946e: 242e fff4 movel %fp@(-12),%d2 49472: 246e fff8 moveal %fp@(-8),%a2 49476: 4e5e unlk %fp 49478: 4e75 rts
...
00063308 <rtems_task_variable_add>:
rtems_status_code rtems_task_variable_add(
rtems_id tid,
void **ptr,
void (*dtor)(void *)
)
{
63308: 4e56 fff0 linkw %fp,#-16 6330c: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 63310: 246e 000c moveal %fp@(12),%a2 63314: 242e 0010 movel %fp@(16),%d2
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp, *new;
if ( !ptr )
63318: 4a8a tstl %a2 6331a: 6604 bnes 63320 <rtems_task_variable_add+0x18> 6331c: 7009 moveq #9,%d0 6331e: 6070 bras 63390 <rtems_task_variable_add+0x88>
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get (tid, &location);
63320: 486e fffc pea %fp@(-4) 63324: 2f2e 0008 movel %fp@(8),%sp@- 63328: 4eb9 0004 b178 jsr 4b178 <_Thread_Get>
switch (location) {
6332e: 508f addql #8,%sp
rtems_task_variable_t *tvp, *new;
if ( !ptr )
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get (tid, &location);
63330: 2640 moveal %d0,%a3
switch (location) {
63332: 4aae fffc tstl %fp@(-4) 63336: 6704 beqs 6333c <rtems_task_variable_add+0x34> 63338: 7004 moveq #4,%d0 6333a: 6054 bras 63390 <rtems_task_variable_add+0x88>
case OBJECTS_LOCAL:
/*
* Figure out if the variable is already in this task's list.
*/
tvp = the_thread->task_variables;
6333c: 206b 011a moveal %a3@(282),%a0
while (tvp) {
63340: 6014 bras 63356 <rtems_task_variable_add+0x4e>
if (tvp->ptr == ptr) {
63342: b5e8 0004 cmpal %a0@(4),%a2 63346: 660c bnes 63354 <rtems_task_variable_add+0x4c>
tvp->dtor = dtor;
63348: 2142 0010 movel %d2,%a0@(16)
_Thread_Enable_dispatch();
6334c: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 63352: 603a bras 6338e <rtems_task_variable_add+0x86>
return RTEMS_SUCCESSFUL;
}
tvp = (rtems_task_variable_t *)tvp->next;
63354: 2050 moveal %a0@,%a0
case OBJECTS_LOCAL:
/*
* Figure out if the variable is already in this task's list.
*/
tvp = the_thread->task_variables;
while (tvp) {
63356: 4a88 tstl %a0 63358: 66e8 bnes 63342 <rtems_task_variable_add+0x3a>
}
/*
* Now allocate memory for this task variable.
*/
new = (rtems_task_variable_t *)
6335a: 4878 0014 pea 14 <OPER2> 6335e: 4eb9 0004 c300 jsr 4c300 <_Workspace_Allocate>
_Workspace_Allocate(sizeof(rtems_task_variable_t));
if (new == NULL) {
63364: 588f addql #4,%sp 63366: 43f9 0004 b152 lea 4b152 <_Thread_Enable_dispatch>,%a1
}
/*
* Now allocate memory for this task variable.
*/
new = (rtems_task_variable_t *)
6336c: 2040 moveal %d0,%a0
_Workspace_Allocate(sizeof(rtems_task_variable_t));
if (new == NULL) {
6336e: 4a80 tstl %d0 63370: 6606 bnes 63378 <rtems_task_variable_add+0x70>
_Thread_Enable_dispatch();
63372: 4e91 jsr %a1@ 63374: 701a moveq #26,%d0
return RTEMS_NO_MEMORY;
63376: 6018 bras 63390 <rtems_task_variable_add+0x88>
}
new->gval = *ptr;
new->ptr = ptr;
new->dtor = dtor;
new->next = (struct rtems_task_variable_tt *)the_thread->task_variables;
63378: 20ab 011a movel %a3@(282),%a0@
_Workspace_Allocate(sizeof(rtems_task_variable_t));
if (new == NULL) {
_Thread_Enable_dispatch();
return RTEMS_NO_MEMORY;
}
new->gval = *ptr;
6337c: 2152 0008 movel %a2@,%a0@(8)
new->ptr = ptr;
new->dtor = dtor;
new->next = (struct rtems_task_variable_tt *)the_thread->task_variables;
the_thread->task_variables = new;
63380: 2740 011a movel %d0,%a3@(282)
if (new == NULL) {
_Thread_Enable_dispatch();
return RTEMS_NO_MEMORY;
}
new->gval = *ptr;
new->ptr = ptr;
63384: 214a 0004 movel %a2,%a0@(4)
new->dtor = dtor;
63388: 2142 0010 movel %d2,%a0@(16)
new->next = (struct rtems_task_variable_tt *)the_thread->task_variables;
the_thread->task_variables = new;
_Thread_Enable_dispatch();
6338c: 4e91 jsr %a1@ 6338e: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
63390: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 63396: 4e5e unlk %fp 63398: 4e75 rts
...
0006339c <rtems_task_variable_delete>:
rtems_status_code rtems_task_variable_delete(
rtems_id tid,
void **ptr
)
{
6339c: 4e56 fffc linkw %fp,#-4 633a0: 2f02 movel %d2,%sp@- 633a2: 242e 000c movel %fp@(12),%d2
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp, *prev;
if ( !ptr )
633a6: 675c beqs 63404 <rtems_task_variable_delete+0x68>
return RTEMS_INVALID_ADDRESS;
prev = NULL;
the_thread = _Thread_Get (tid, &location);
633a8: 486e fffc pea %fp@(-4) 633ac: 2f2e 0008 movel %fp@(8),%sp@- 633b0: 4eb9 0004 b178 jsr 4b178 <_Thread_Get>
switch (location) {
633b6: 508f addql #8,%sp 633b8: 4aae fffc tstl %fp@(-4) 633bc: 6704 beqs 633c2 <rtems_task_variable_delete+0x26> 633be: 7004 moveq #4,%d0 633c0: 6044 bras 63406 <rtems_task_variable_delete+0x6a>
case OBJECTS_LOCAL:
tvp = the_thread->task_variables;
633c2: 2240 moveal %d0,%a1 633c4: 2069 011a moveal %a1@(282),%a0 633c8: 93c9 subal %a1,%a1
while (tvp) {
633ca: 602e bras 633fa <rtems_task_variable_delete+0x5e>
if (tvp->ptr == ptr) {
633cc: b4a8 0004 cmpl %a0@(4),%d2 633d0: 6624 bnes 633f6 <rtems_task_variable_delete+0x5a>
if (prev)
633d2: 4a89 tstl %a1 633d4: 6704 beqs 633da <rtems_task_variable_delete+0x3e>
prev->next = tvp->next;
633d6: 2290 movel %a0@,%a1@ 633d8: 6006 bras 633e0 <rtems_task_variable_delete+0x44>
else
the_thread->task_variables = (rtems_task_variable_t *)tvp->next;
633da: 2240 moveal %d0,%a1 633dc: 2350 011a movel %a0@,%a1@(282)
_RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp );
633e0: 2f08 movel %a0,%sp@- 633e2: 2f00 movel %d0,%sp@- 633e4: 4eb9 0006 3478 jsr 63478 <_RTEMS_Tasks_Invoke_task_variable_dtor>
_Thread_Enable_dispatch();
633ea: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
633f0: 508f addql #8,%sp
prev->next = tvp->next;
else
the_thread->task_variables = (rtems_task_variable_t *)tvp->next;
_RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp );
_Thread_Enable_dispatch();
633f2: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
633f4: 6010 bras 63406 <rtems_task_variable_delete+0x6a>
}
prev = tvp;
tvp = (rtems_task_variable_t *)tvp->next;
633f6: 2248 moveal %a0,%a1 633f8: 2050 moveal %a0@,%a0
the_thread = _Thread_Get (tid, &location);
switch (location) {
case OBJECTS_LOCAL:
tvp = the_thread->task_variables;
while (tvp) {
633fa: 4a88 tstl %a0 633fc: 66ce bnes 633cc <rtems_task_variable_delete+0x30>
return RTEMS_SUCCESSFUL;
}
prev = tvp;
tvp = (rtems_task_variable_t *)tvp->next;
}
_Thread_Enable_dispatch();
633fe: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 63404: 7009 moveq #9,%d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
63406: 242e fff8 movel %fp@(-8),%d2 6340a: 4e5e unlk %fp 6340c: 4e75 rts
...
00063410 <rtems_task_variable_get>:
rtems_status_code rtems_task_variable_get(
rtems_id tid,
void **ptr,
void **result
)
{
63410: 4e56 fffc linkw %fp,#-4 63414: 2f0a movel %a2,%sp@- 63416: 246e 0010 moveal %fp@(16),%a2 6341a: 2f02 movel %d2,%sp@- 6341c: 242e 000c movel %fp@(12),%d2
Thread_Control *the_thread;
Objects_Locations location;
rtems_task_variable_t *tvp;
if ( !ptr )
63420: 6746 beqs 63468 <rtems_task_variable_get+0x58>
return RTEMS_INVALID_ADDRESS;
if ( !result )
63422: 4a8a tstl %a2 63424: 6742 beqs 63468 <rtems_task_variable_get+0x58>
return RTEMS_INVALID_ADDRESS;
the_thread = _Thread_Get (tid, &location);
63426: 486e fffc pea %fp@(-4) 6342a: 2f2e 0008 movel %fp@(8),%sp@- 6342e: 4eb9 0004 b178 jsr 4b178 <_Thread_Get>
switch (location) {
63434: 508f addql #8,%sp 63436: 4aae fffc tstl %fp@(-4) 6343a: 6704 beqs 63440 <rtems_task_variable_get+0x30> 6343c: 7004 moveq #4,%d0 6343e: 602a bras 6346a <rtems_task_variable_get+0x5a>
case OBJECTS_LOCAL:
/*
* Figure out if the variable is in this task's list.
*/
tvp = the_thread->task_variables;
63440: 2240 moveal %d0,%a1 63442: 2069 011a moveal %a1@(282),%a0
while (tvp) {
63446: 6016 bras 6345e <rtems_task_variable_get+0x4e>
if (tvp->ptr == ptr) {
63448: b4a8 0004 cmpl %a0@(4),%d2 6344c: 660e bnes 6345c <rtems_task_variable_get+0x4c>
/*
* Should this return the current (i.e not the
* saved) value if `tid' is the current task?
*/
*result = tvp->tval;
6344e: 24a8 000c movel %a0@(12),%a2@
_Thread_Enable_dispatch();
63452: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 63458: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
6345a: 600e bras 6346a <rtems_task_variable_get+0x5a>
}
tvp = (rtems_task_variable_t *)tvp->next;
6345c: 2050 moveal %a0@,%a0
case OBJECTS_LOCAL:
/*
* Figure out if the variable is in this task's list.
*/
tvp = the_thread->task_variables;
while (tvp) {
6345e: 4a88 tstl %a0 63460: 66e6 bnes 63448 <rtems_task_variable_get+0x38>
_Thread_Enable_dispatch();
return RTEMS_SUCCESSFUL;
}
tvp = (rtems_task_variable_t *)tvp->next;
}
_Thread_Enable_dispatch();
63462: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch>
return RTEMS_INVALID_ADDRESS;
63468: 7009 moveq #9,%d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
6346a: 242e fff4 movel %fp@(-12),%d2 6346e: 246e fff8 moveal %fp@(-8),%a2 63472: 4e5e unlk %fp 63474: 4e75 rts
...
00051270 <rtems_timer_server_fire_after>:
rtems_id id,
rtems_interval ticks,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
51270: 4e56 ffe4 linkw %fp,#-28 51274: 48d7 1c1c moveml %d2-%d4/%a2-%a4,%sp@ 51278: 262e 0008 movel %fp@(8),%d3 5127c: 242e 000c movel %fp@(12),%d2 51280: 282e 0010 movel %fp@(16),%d4
Timer_Control *the_timer; Objects_Locations location; ISR_Level level; Timer_server_Control *timer_server = _Timer_server;
51284: 2679 0007 5cb6 moveal 75cb6 <_Timer_server>,%a3
if ( !timer_server )
5128a: 4a8b tstl %a3 5128c: 6606 bnes 51294 <rtems_timer_server_fire_after+0x24> 5128e: 700e moveq #14,%d0 51290: 6000 008e braw 51320 <rtems_timer_server_fire_after+0xb0>
return RTEMS_INCORRECT_STATE;
if ( !routine )
51294: 4a84 tstl %d4 51296: 6606 bnes 5129e <rtems_timer_server_fire_after+0x2e> 51298: 7009 moveq #9,%d0 5129a: 6000 0084 braw 51320 <rtems_timer_server_fire_after+0xb0>
return RTEMS_INVALID_ADDRESS;
if ( ticks == 0 )
5129e: 4a82 tstl %d2 512a0: 6604 bnes 512a6 <rtems_timer_server_fire_after+0x36> 512a2: 700a moveq #10,%d0 512a4: 607a bras 51320 <rtems_timer_server_fire_after+0xb0> 512a6: 486e fffc pea %fp@(-4) 512aa: 2f03 movel %d3,%sp@- 512ac: 4879 0007 5c7c pea 75c7c <_Timer_Information> 512b2: 4eb9 0005 378c jsr 5378c <_Objects_Get>
return RTEMS_INVALID_NUMBER;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
512b8: 4fef 000c lea %sp@(12),%sp 512bc: 2440 moveal %d0,%a2 512be: 4aae fffc tstl %fp@(-4) 512c2: 6704 beqs 512c8 <rtems_timer_server_fire_after+0x58> 512c4: 7004 moveq #4,%d0 512c6: 6058 bras 51320 <rtems_timer_server_fire_after+0xb0>
case OBJECTS_LOCAL:
(void) _Watchdog_Remove( &the_timer->Ticker );
512c8: 486a 0010 pea %a2@(16) 512cc: 4eb9 0005 53a0 jsr 553a0 <_Watchdog_Remove>
_ISR_Disable( level );
512d2: 203c 0000 0700 movel #1792,%d0 512d8: 40c1 movew %sr,%d1 512da: 8081 orl %d1,%d0 512dc: 46c0 movew %d0,%sr 512de: 49f9 0005 4012 lea 54012 <_Thread_Enable_dispatch>,%a4
/*
* Check to see if the watchdog has just been inserted by a
* higher priority interrupt. If so, abandon this insert.
*/
if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) {
512e4: 588f addql #4,%sp 512e6: 4aaa 0018 tstl %a2@(24) 512ea: 6706 beqs 512f2 <rtems_timer_server_fire_after+0x82>
_ISR_Enable( level );
512ec: 46c1 movew %d1,%sr
_Thread_Enable_dispatch();
512ee: 4e94 jsr %a4@ 512f0: 602c bras 5131e <rtems_timer_server_fire_after+0xae>
/*
* OK. Now we now the timer was not rescheduled by an interrupt
* so we can atomically initialize it as in use.
*/
the_timer->the_class = TIMER_INTERVAL_ON_TASK;
512f2: 7001 moveq #1,%d0
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
the_watchdog->id = id;
the_watchdog->user_data = user_data;
512f4: 256e 0014 0034 movel %fp@(20),%a2@(52)
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
512fa: 2544 002c movel %d4,%a2@(44)
the_watchdog->id = id;
512fe: 2543 0030 movel %d3,%a2@(48)
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = ticks;
51302: 2542 001c movel %d2,%a2@(28)
/*
* OK. Now we now the timer was not rescheduled by an interrupt
* so we can atomically initialize it as in use.
*/
the_timer->the_class = TIMER_INTERVAL_ON_TASK;
51306: 2540 0038 movel %d0,%a2@(56)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
5130a: 42aa 0018 clrl %a2@(24)
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = ticks;
_ISR_Enable( level );
5130e: 46c1 movew %d1,%sr
(*timer_server->schedule_operation)( timer_server, the_timer );
51310: 2f0a movel %a2,%sp@- 51312: 2f0b movel %a3,%sp@- 51314: 206b 0004 moveal %a3@(4),%a0 51318: 4e90 jsr %a0@
_Thread_Enable_dispatch();
5131a: 4e94 jsr %a4@
return RTEMS_SUCCESSFUL;
5131c: 508f addql #8,%sp
the_timer->Ticker.initial = ticks;
_ISR_Enable( level );
(*timer_server->schedule_operation)( timer_server, the_timer );
_Thread_Enable_dispatch();
5131e: 4280 clrl %d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
51320: 4cee 1c1c ffe4 moveml %fp@(-28),%d2-%d4/%a2-%a4 51326: 4e5e unlk %fp 51328: 4e75 rts
...
0005132c <rtems_timer_server_fire_when>:
rtems_id id,
rtems_time_of_day *wall_time,
rtems_timer_service_routine_entry routine,
void *user_data
)
{
5132c: 4e56 ffe8 linkw %fp,#-24 51330: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 51334: 282e 0008 movel %fp@(8),%d4 51338: 262e 000c movel %fp@(12),%d3 5133c: 242e 0010 movel %fp@(16),%d2
Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server;
51340: 2679 0007 5cb6 moveal 75cb6 <_Timer_server>,%a3
if ( !timer_server )
51346: 4a8b tstl %a3 51348: 6606 bnes 51350 <rtems_timer_server_fire_when+0x24> 5134a: 700e moveq #14,%d0 5134c: 6000 00a4 braw 513f2 <rtems_timer_server_fire_when+0xc6>
return RTEMS_INCORRECT_STATE;
if ( !_TOD_Is_set )
51350: 4a39 0007 53fc tstb 753fc <_TOD_Is_set> 51356: 6606 bnes 5135e <rtems_timer_server_fire_when+0x32>
51358: 700b moveq #11,%d0 <== NOT EXECUTED 5135a: 6000 0096 braw 513f2 <rtems_timer_server_fire_when+0xc6><== NOT EXECUTED
return RTEMS_NOT_DEFINED;
if ( !routine )
5135e: 4a82 tstl %d2 51360: 6606 bnes 51368 <rtems_timer_server_fire_when+0x3c> 51362: 7009 moveq #9,%d0 51364: 6000 008c braw 513f2 <rtems_timer_server_fire_when+0xc6>
return RTEMS_INVALID_ADDRESS;
if ( !_TOD_Validate( wall_time ) )
51368: 2f03 movel %d3,%sp@- 5136a: 4eb9 0004 e7a8 jsr 4e7a8 <_TOD_Validate> 51370: 588f addql #4,%sp 51372: 4a00 tstb %d0 51374: 677a beqs 513f0 <rtems_timer_server_fire_when+0xc4>
return RTEMS_INVALID_CLOCK;
seconds = _TOD_To_seconds( wall_time );
51376: 2f03 movel %d3,%sp@- 51378: 4eb9 0004 e708 jsr 4e708 <_TOD_To_seconds>
if ( seconds <= _TOD_Seconds_since_epoch() )
5137e: 588f addql #4,%sp
return RTEMS_INVALID_ADDRESS;
if ( !_TOD_Validate( wall_time ) )
return RTEMS_INVALID_CLOCK;
seconds = _TOD_To_seconds( wall_time );
51380: 2600 movel %d0,%d3
if ( seconds <= _TOD_Seconds_since_epoch() )
51382: b0b9 0007 547a cmpl 7547a <_TOD_Now>,%d0 51388: 6366 blss 513f0 <rtems_timer_server_fire_when+0xc4> 5138a: 486e fffc pea %fp@(-4) 5138e: 2f04 movel %d4,%sp@- 51390: 4879 0007 5c7c pea 75c7c <_Timer_Information> 51396: 4eb9 0005 378c jsr 5378c <_Objects_Get>
return RTEMS_INVALID_CLOCK;
the_timer = _Timer_Get( id, &location );
switch ( location ) {
5139c: 4fef 000c lea %sp@(12),%sp 513a0: 2440 moveal %d0,%a2 513a2: 4aae fffc tstl %fp@(-4) 513a6: 6704 beqs 513ac <rtems_timer_server_fire_when+0x80> 513a8: 7004 moveq #4,%d0 513aa: 6046 bras 513f2 <rtems_timer_server_fire_when+0xc6>
case OBJECTS_LOCAL:
(void) _Watchdog_Remove( &the_timer->Ticker );
513ac: 486a 0010 pea %a2@(16) 513b0: 4eb9 0005 53a0 jsr 553a0 <_Watchdog_Remove>
the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data;
513b6: 256e 0014 0034 movel %fp@(20),%a2@(52)
the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK;
513bc: 7003 moveq #3,%d0
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
the_watchdog->id = id;
513be: 2544 0030 movel %d4,%a2@(48)
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch();
513c2: 96b9 0007 547a subl 7547a <_TOD_Now>,%d3
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;
513c8: 2540 0038 movel %d0,%a2@(56)
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch();
513cc: 2543 001c movel %d3,%a2@(28)
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
513d0: 2542 002c movel %d2,%a2@(44)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
513d4: 42aa 0018 clrl %a2@(24)
(*timer_server->schedule_operation)( timer_server, the_timer );
513d8: 2f0a movel %a2,%sp@- 513da: 2f0b movel %a3,%sp@- 513dc: 206b 0004 moveal %a3@(4),%a0 513e0: 4e90 jsr %a0@
_Thread_Enable_dispatch();
513e2: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch>
return RTEMS_SUCCESSFUL;
513e8: 4fef 000c lea %sp@(12),%sp
_Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data );
the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch();
(*timer_server->schedule_operation)( timer_server, the_timer );
_Thread_Enable_dispatch();
513ec: 4280 clrl %d0
return RTEMS_SUCCESSFUL;
513ee: 6002 bras 513f2 <rtems_timer_server_fire_when+0xc6> 513f0: 7014 moveq #20,%d0
case OBJECTS_ERROR:
break;
}
return RTEMS_INVALID_ID;
}
513f2: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 513f8: 4e5e unlk %fp 513fa: 4e75 rts
00045a3c <rtems_workspace_get_information>:
#include <string.h> /* for memset */
bool rtems_workspace_get_information(
Heap_Information_block *the_info
)
{
45a3c: 4e56 0000 linkw %fp,#0 45a40: 202e 0008 movel %fp@(8),%d0
if ( !the_info )
45a44: 6710 beqs 45a56 <rtems_workspace_get_information+0x1a>
return false;
return _Protected_heap_Get_information( &_Workspace_Area, the_info );
45a46: 2f00 movel %d0,%sp@- 45a48: 4879 0005 eac2 pea 5eac2 <_Workspace_Area> 45a4e: 4eb9 0004 6dd0 jsr 46dd0 <_Protected_heap_Get_information> 45a54: 508f addql #8,%sp
}
45a56: 4e5e unlk %fp 45a58: 4e75 rts
...
00045040 <sched_getparam>:
int sched_getparam(
pid_t pid __attribute__((unused)),
struct sched_param *param __attribute__((unused))
)
{
45040: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
45044: 4eb9 0004 d430 jsr 4d430 <__errno> 4504a: 7258 moveq #88,%d1 4504c: 2040 moveal %d0,%a0
}
4504e: 70ff moveq #-1,%d0 45050: 4e5e unlk %fp
int sched_getparam(
pid_t pid __attribute__((unused)),
struct sched_param *param __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
45052: 2081 movel %d1,%a0@
}
45054: 4e75 rts
...
00045058 <sched_getscheduler>:
#include <rtems/posix/time.h>
int sched_getscheduler(
pid_t pid __attribute__((unused))
)
{
45058: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
4505c: 4eb9 0004 d430 jsr 4d430 <__errno> 45062: 7258 moveq #88,%d1 45064: 2040 moveal %d0,%a0
}
45066: 70ff moveq #-1,%d0 45068: 4e5e unlk %fp
int sched_getscheduler(
pid_t pid __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
4506a: 2081 movel %d1,%a0@
}
4506c: 4e75 rts
...
00045714 <sched_rr_get_interval>:
int sched_rr_get_interval(
pid_t pid,
struct timespec *interval
)
{
45714: 4e56 0000 linkw %fp,#0 45718: 2f03 movel %d3,%sp@- 4571a: 262e 0008 movel %fp@(8),%d3 4571e: 2f02 movel %d2,%sp@- 45720: 242e 000c movel %fp@(12),%d2
/*
* Only supported for the "calling process" (i.e. this node).
*/
if ( pid && pid != getpid() )
45724: 4a83 tstl %d3 45726: 671a beqs 45742 <sched_rr_get_interval+0x2e> 45728: 4eb9 0004 2994 jsr 42994 <getpid> 4572e: b083 cmpl %d3,%d0 45730: 6710 beqs 45742 <sched_rr_get_interval+0x2e>
rtems_set_errno_and_return_minus_one( ESRCH );
45732: 4eb9 0004 d5a0 jsr 4d5a0 <__errno> 45738: 7403 moveq #3,%d2 4573a: 72ff moveq #-1,%d1 4573c: 2040 moveal %d0,%a0 4573e: 2082 movel %d2,%a0@ 45740: 6026 bras 45768 <sched_rr_get_interval+0x54>
if ( !interval )
45742: 4a82 tstl %d2 45744: 6610 bnes 45756 <sched_rr_get_interval+0x42>
rtems_set_errno_and_return_minus_one( EINVAL );
45746: 4eb9 0004 d5a0 jsr 4d5a0 <__errno> 4574c: 72ff moveq #-1,%d1 4574e: 2040 moveal %d0,%a0 45750: 7016 moveq #22,%d0 45752: 2080 movel %d0,%a0@ 45754: 6012 bras 45768 <sched_rr_get_interval+0x54>
_Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval );
45756: 2f02 movel %d2,%sp@- 45758: 2f39 0005 dc54 movel 5dc54 <_Thread_Ticks_per_timeslice>,%sp@- 4575e: 4eb9 0004 8850 jsr 48850 <_Timespec_From_ticks>
return 0;
45764: 508f addql #8,%sp
rtems_set_errno_and_return_minus_one( ESRCH );
if ( !interval )
rtems_set_errno_and_return_minus_one( EINVAL );
_Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval );
45766: 4281 clrl %d1
return 0; }
45768: 242e fff8 movel %fp@(-8),%d2 4576c: 2001 movel %d1,%d0 4576e: 262e fffc movel %fp@(-4),%d3 45772: 4e5e unlk %fp 45774: 4e75 rts
...
00045070 <sched_setparam>:
int sched_setparam(
pid_t pid __attribute__((unused)),
const struct sched_param *param __attribute__((unused))
)
{
45070: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
45074: 4eb9 0004 d430 jsr 4d430 <__errno> 4507a: 7258 moveq #88,%d1 4507c: 2040 moveal %d0,%a0
}
4507e: 70ff moveq #-1,%d0 45080: 4e5e unlk %fp
int sched_setparam(
pid_t pid __attribute__((unused)),
const struct sched_param *param __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
45082: 2081 movel %d1,%a0@
}
45084: 4e75 rts
...
00045088 <sched_setscheduler>:
int sched_setscheduler(
pid_t pid __attribute__((unused)),
int policy __attribute__((unused)),
const struct sched_param *param __attribute__((unused))
)
{
45088: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
4508c: 4eb9 0004 d430 jsr 4d430 <__errno> 45092: 7258 moveq #88,%d1 45094: 2040 moveal %d0,%a0
}
45096: 70ff moveq #-1,%d0 45098: 4e5e unlk %fp
pid_t pid __attribute__((unused)),
int policy __attribute__((unused)),
const struct sched_param *param __attribute__((unused))
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
4509a: 2081 movel %d1,%a0@
}
4509c: 4e75 rts
...
00047c50 <sem_getvalue>:
int sem_getvalue(
sem_t *sem,
int *sval
)
{
47c50: 4e56 fffc linkw %fp,#-4 47c54: 206e 0008 moveal %fp@(8),%a0 47c58: 486e fffc pea %fp@(-4) 47c5c: 2f10 movel %a0@,%sp@- 47c5e: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 47c64: 4eb9 0004 9aa0 jsr 49aa0 <_Objects_Get>
register POSIX_Semaphore_Control *the_semaphore;
Objects_Locations location;
the_semaphore = _POSIX_Semaphore_Get( sem, &location );
switch ( location ) {
47c6a: 4fef 000c lea %sp@(12),%sp 47c6e: 4aae fffc tstl %fp@(-4) 47c72: 6614 bnes 47c88 <sem_getvalue+0x38>
case OBJECTS_LOCAL:
*sval = _CORE_semaphore_Get_count( &the_semaphore->Semaphore );
47c74: 206e 000c moveal %fp@(12),%a0 47c78: 2240 moveal %d0,%a1 47c7a: 20a9 0062 movel %a1@(98),%a0@
_Thread_Enable_dispatch();
47c7e: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch> 47c84: 4280 clrl %d0
return 0;
47c86: 600e bras 47c96 <sem_getvalue+0x46>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EINVAL );
47c88: 4eb9 0005 07a0 jsr 507a0 <__errno> 47c8e: 7216 moveq #22,%d1 47c90: 2040 moveal %d0,%a0 47c92: 70ff moveq #-1,%d0 47c94: 2081 movel %d1,%a0@
}
47c96: 4e5e unlk %fp 47c98: 4e75 rts
...
00047dd0 <sem_post>:
*/
int sem_post(
sem_t *sem
)
{
47dd0: 4e56 fffc linkw %fp,#-4 47dd4: 206e 0008 moveal %fp@(8),%a0 47dd8: 486e fffc pea %fp@(-4) 47ddc: 2f10 movel %a0@,%sp@- 47dde: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 47de4: 4eb9 0004 9aa0 jsr 49aa0 <_Objects_Get>
register POSIX_Semaphore_Control *the_semaphore;
Objects_Locations location;
the_semaphore = _POSIX_Semaphore_Get( sem, &location );
switch ( location ) {
47dea: 4fef 000c lea %sp@(12),%sp 47dee: 4aae fffc tstl %fp@(-4) 47df2: 6620 bnes 47e14 <sem_post+0x44>
case OBJECTS_LOCAL:
_CORE_semaphore_Surrender(
47df4: 2040 moveal %d0,%a0 47df6: 42a7 clrl %sp@- 47df8: 2f28 0008 movel %a0@(8),%sp@- 47dfc: 4868 001a pea %a0@(26) 47e00: 4eb9 0004 91cc jsr 491cc <_CORE_semaphore_Surrender>
NULL /* XXX need to define a routine to handle this case */
#else
NULL
#endif
);
_Thread_Enable_dispatch();
47e06: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch>
return 0;
47e0c: 4fef 000c lea %sp@(12),%sp
NULL /* XXX need to define a routine to handle this case */
#else
NULL
#endif
);
_Thread_Enable_dispatch();
47e10: 4280 clrl %d0
return 0;
47e12: 600e bras 47e22 <sem_post+0x52>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EINVAL );
47e14: 4eb9 0005 07a0 jsr 507a0 <__errno> 47e1a: 7216 moveq #22,%d1 47e1c: 2040 moveal %d0,%a0 47e1e: 70ff moveq #-1,%d0 47e20: 2081 movel %d1,%a0@
}
47e22: 4e5e unlk %fp 47e24: 4e75 rts
...
00047e58 <sem_trywait>:
*/
int sem_trywait(
sem_t *sem
)
{
47e58: 4e56 0000 linkw %fp,#0
return _POSIX_Semaphore_Wait_support(sem, false, THREAD_QUEUE_WAIT_FOREVER);
47e5c: 42a7 clrl %sp@- 47e5e: 42a7 clrl %sp@- 47e60: 2f2e 0008 movel %fp@(8),%sp@- 47e64: 4eb9 0004 d604 jsr 4d604 <_POSIX_Semaphore_Wait_support>
}
47e6a: 4e5e unlk %fp 47e6c: 4e75 rts
...
00047e70 <sem_unlink>:
*/
int sem_unlink(
const char *name
)
{
47e70: 4e56 fff0 linkw %fp,#-16 47e74: 2039 0006 1a90 movel 61a90 <_Thread_Dispatch_disable_level>,%d0 47e7a: 5280 addql #1,%d0 47e7c: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 47e80: 23c0 0006 1a90 movel %d0,61a90 <_Thread_Dispatch_disable_level>
register POSIX_Semaphore_Control *the_semaphore;
sem_t the_semaphore_id;
_Thread_Disable_dispatch();
status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id );
47e86: 486e fffc pea %fp@(-4) 47e8a: 45f9 0004 a2f2 lea 4a2f2 <_Thread_Enable_dispatch>,%a2 47e90: 2f2e 0008 movel %fp@(8),%sp@- 47e94: 4eb9 0004 d590 jsr 4d590 <_POSIX_Semaphore_Name_to_id>
if ( status != 0 ) {
47e9a: 508f addql #8,%sp
register POSIX_Semaphore_Control *the_semaphore;
sem_t the_semaphore_id;
_Thread_Disable_dispatch();
status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id );
47e9c: 2400 movel %d0,%d2
if ( status != 0 ) {
47e9e: 6710 beqs 47eb0 <sem_unlink+0x40>
_Thread_Enable_dispatch();
47ea0: 4e92 jsr %a2@
rtems_set_errno_and_return_minus_one( status );
47ea2: 4eb9 0005 07a0 jsr 507a0 <__errno> 47ea8: 2040 moveal %d0,%a0 47eaa: 70ff moveq #-1,%d0 47eac: 2082 movel %d2,%a0@ 47eae: 6034 bras 47ee4 <sem_unlink+0x74>
}
the_semaphore = (POSIX_Semaphore_Control *) _Objects_Get_local_object(
47eb0: 4280 clrl %d0 47eb2: 2079 0006 1d02 moveal 61d02 <_POSIX_Semaphore_Information+0x18>,%a0 47eb8: 302e fffe movew %fp@(-2),%d0 47ebc: 2670 0c00 moveal %a0@(00000000,%d0:l:4),%a3
&_POSIX_Semaphore_Information,
_Objects_Get_index( the_semaphore_id )
);
the_semaphore->linked = false;
47ec0: 4200 clrb %d0 47ec2: 1740 0015 moveb %d0,%a3@(21)
RTEMS_INLINE_ROUTINE void _POSIX_Semaphore_Namespace_remove (
POSIX_Semaphore_Control *the_semaphore
)
{
_Objects_Namespace_remove(
47ec6: 2f0b movel %a3,%sp@- 47ec8: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 47ece: 4eb9 0004 9bf8 jsr 49bf8 <_Objects_Namespace_remove>
_POSIX_Semaphore_Namespace_remove( the_semaphore ); _POSIX_Semaphore_Delete( the_semaphore );
47ed4: 2f0b movel %a3,%sp@- 47ed6: 4eb9 0004 d540 jsr 4d540 <_POSIX_Semaphore_Delete>
_Thread_Enable_dispatch();
47edc: 4e92 jsr %a2@
return 0;
47ede: 4fef 000c lea %sp@(12),%sp
the_semaphore->linked = false;
_POSIX_Semaphore_Namespace_remove( the_semaphore );
_POSIX_Semaphore_Delete( the_semaphore );
_Thread_Enable_dispatch();
47ee2: 4280 clrl %d0
return 0; }
47ee4: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 47eea: 4e5e unlk %fp 47eec: 4e75 rts
...
000455e4 <sigaction>:
int sigaction(
int sig,
const struct sigaction *act,
struct sigaction *oact
)
{
455e4: 4e56 ffec linkw %fp,#-20 455e8: 222e 0010 movel %fp@(16),%d1 455ec: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 455f0: 242e 0008 movel %fp@(8),%d2 455f4: 246e 000c moveal %fp@(12),%a2
ISR_Level level;
if ( oact )
455f8: 4a81 tstl %d1 455fa: 6722 beqs 4561e <sigaction+0x3a>
*oact = _POSIX_signals_Vectors[ sig ];
455fc: 2602 movel %d2,%d3 455fe: 2002 movel %d2,%d0 45600: 4878 000c pea c <OPER1> 45604: e58b lsll #2,%d3 45606: e988 lsll #4,%d0 45608: 9083 subl %d3,%d0 4560a: 0680 0005 ed42 addil #388418,%d0 45610: 2f00 movel %d0,%sp@- 45612: 2f01 movel %d1,%sp@- 45614: 4eb9 0004 df4c jsr 4df4c <memcpy> 4561a: 4fef 000c lea %sp@(12),%sp
if ( !sig )
4561e: 4a82 tstl %d2 45620: 6710 beqs 45632 <sigaction+0x4e>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(sig) )
45622: 2002 movel %d2,%d0 45624: 5380 subql #1,%d0 45626: 721f moveq #31,%d1 45628: b280 cmpl %d0,%d1 4562a: 6506 bcss 45632 <sigaction+0x4e>
*
* NOTE: Solaris documentation claims to "silently enforce" this which
* contradicts the POSIX specification.
*/
if ( sig == SIGKILL )
4562c: 7009 moveq #9,%d0 4562e: b082 cmpl %d2,%d0 45630: 6610 bnes 45642 <sigaction+0x5e>
rtems_set_errno_and_return_minus_one( EINVAL );
45632: 4eb9 0004 d714 jsr 4d714 <__errno> 45638: 72ff moveq #-1,%d1 4563a: 2040 moveal %d0,%a0 4563c: 7016 moveq #22,%d0 4563e: 2080 movel %d0,%a0@ 45640: 6060 bras 456a2 <sigaction+0xbe>
/*
* Evaluate the new action structure and set the global signal vector
* appropriately.
*/
if ( act ) {
45642: 4a8a tstl %a2 45644: 675a beqs 456a0 <sigaction+0xbc>
/*
* Unless the user is installing the default signal actions, then
* we can just copy the provided sigaction structure into the vectors.
*/
_ISR_Disable( level );
45646: 203c 0000 0700 movel #1792,%d0 4564c: 40c3 movew %sr,%d3 4564e: 8083 orl %d3,%d0 45650: 46c0 movew %d0,%sr 45652: 780c moveq #12,%d4 45654: 47f9 0004 df4c lea 4df4c <memcpy>,%a3 4565a: 4c02 4800 mulsl %d2,%d4
if ( act->sa_handler == SIG_DFL ) {
4565e: 4aaa 0008 tstl %a2@(8) 45662: 661e bnes 45682 <sigaction+0x9e>
_POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ];
45664: 4878 000c pea c <OPER1> 45668: 2004 movel %d4,%d0 4566a: 0680 0005 c294 addil #377492,%d0 45670: 2f00 movel %d0,%sp@- 45672: 0684 0005 ed42 addil #388418,%d4 45678: 2f04 movel %d4,%sp@- 4567a: 4e93 jsr %a3@ 4567c: 4fef 000c lea %sp@(12),%sp 45680: 601c bras 4569e <sigaction+0xba>
} else {
_POSIX_signals_Clear_process_signals( sig );
45682: 2f02 movel %d2,%sp@-
_POSIX_signals_Vectors[ sig ] = *act;
45684: 0684 0005 ed42 addil #388418,%d4
_ISR_Disable( level );
if ( act->sa_handler == SIG_DFL ) {
_POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ];
} else {
_POSIX_signals_Clear_process_signals( sig );
4568a: 4eb9 0004 a6e0 jsr 4a6e0 <_POSIX_signals_Clear_process_signals>
_POSIX_signals_Vectors[ sig ] = *act;
45690: 4878 000c pea c <OPER1> 45694: 2f0a movel %a2,%sp@- 45696: 2f04 movel %d4,%sp@- 45698: 4e93 jsr %a3@ 4569a: 4fef 0010 lea %sp@(16),%sp
}
_ISR_Enable( level );
4569e: 46c3 movew %d3,%sr 456a0: 4281 clrl %d1
* + If we are now ignoring a signal that was previously pending,
* we clear the pending signal indicator.
*/
return 0;
}
456a2: 2001 movel %d1,%d0 456a4: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 456aa: 4e5e unlk %fp 456ac: 4e75 rts
...
00047234 <sigdelset>:
int sigdelset(
sigset_t *set,
int signo
)
{
47234: 4e56 0000 linkw %fp,#0 47238: 226e 0008 moveal %fp@(8),%a1 4723c: 202e 000c movel %fp@(12),%d0
if ( !set )
47240: 4a89 tstl %a1 47242: 6710 beqs 47254 <sigdelset+0x20>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !signo )
47244: 4a80 tstl %d0 47246: 6604 bnes 4724c <sigdelset+0x18> 47248: 91c8 subal %a0,%a0 4724a: 6024 bras 47270 <sigdelset+0x3c> 4724c: 5380 subql #1,%d0
return 0;
if ( !is_valid_signo(signo) )
4724e: 721f moveq #31,%d1 47250: b280 cmpl %d0,%d1 47252: 6412 bccs 47266 <sigdelset+0x32>
rtems_set_errno_and_return_minus_one( EINVAL );
47254: 4eb9 0004 f238 jsr 4f238 <__errno> 4725a: 307c ffff moveaw #-1,%a0 4725e: 2240 moveal %d0,%a1 47260: 7016 moveq #22,%d0 47262: 2280 movel %d0,%a1@ 47264: 600a bras 47270 <sigdelset+0x3c>
*set &= ~signo_to_mask(signo);
47266: 7201 moveq #1,%d1 47268: 91c8 subal %a0,%a0 4726a: e1a9 lsll %d0,%d1 4726c: 4681 notl %d1 4726e: c391 andl %d1,%a1@
return 0; }
47270: 2008 movel %a0,%d0 47272: 4e5e unlk %fp 47274: 4e75 rts
...
0004729c <sigfillset>:
#include <rtems/seterr.h>
int sigfillset(
sigset_t *set
)
{
4729c: 4e56 0000 linkw %fp,#0 472a0: 206e 0008 moveal %fp@(8),%a0
if ( !set )
472a4: 4a88 tstl %a0 472a6: 6610 bnes 472b8 <sigfillset+0x1c>
rtems_set_errno_and_return_minus_one( EINVAL );
472a8: 4eb9 0004 f238 jsr 4f238 <__errno> 472ae: 7216 moveq #22,%d1 472b0: 2040 moveal %d0,%a0 472b2: 70ff moveq #-1,%d0 472b4: 2081 movel %d1,%a0@ 472b6: 6006 bras 472be <sigfillset+0x22>
*set = SIGNAL_ALL_MASK;
472b8: 70ff moveq #-1,%d0 472ba: 2080 movel %d0,%a0@ 472bc: 4280 clrl %d0
return 0; }
472be: 4e5e unlk %fp 472c0: 4e75 rts
...
000472c4 <sigismember>:
int sigismember(
const sigset_t *set,
int signo
)
{
472c4: 4e56 0000 linkw %fp,#0 472c8: 206e 0008 moveal %fp@(8),%a0 472cc: 222e 000c movel %fp@(12),%d1
if ( !set )
472d0: 4a88 tstl %a0 472d2: 670c beqs 472e0 <sigismember+0x1c>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !signo )
472d4: 4a81 tstl %d1 472d6: 6724 beqs 472fc <sigismember+0x38> 472d8: 5381 subql #1,%d1
return 0;
if ( !is_valid_signo(signo) )
472da: 701f moveq #31,%d0 472dc: b081 cmpl %d1,%d0 472de: 6410 bccs 472f0 <sigismember+0x2c>
rtems_set_errno_and_return_minus_one( EINVAL );
472e0: 4eb9 0004 f238 jsr 4f238 <__errno> 472e6: 72ff moveq #-1,%d1 472e8: 2040 moveal %d0,%a0 472ea: 7016 moveq #22,%d0 472ec: 2080 movel %d0,%a0@ 472ee: 600c bras 472fc <sigismember+0x38> 472f0: 7001 moveq #1,%d0 472f2: e3a8 lsll %d1,%d0 472f4: c090 andl %a0@,%d0 472f6: 56c1 sne %d1 472f8: 49c1 extbl %d1 472fa: 4481 negl %d1
if ( *set & signo_to_mask(signo) )
return 1;
return 0;
}
472fc: 2001 movel %d1,%d0 472fe: 4e5e unlk %fp 47300: 4e75 rts
...
00045490 <signal>:
sighandler_t signal(
int signum,
sighandler_t handler
)
{
45490: 4e56 ffe8 linkw %fp,#-24
struct sigaction s;
struct sigaction old;
s.sa_handler = handler ;
45494: 2d6e 000c fffc movel %fp@(12),%fp@(-4)
sigemptyset(&s.sa_mask);
4549a: 486e fff8 pea %fp@(-8) 4549e: 4eb9 0004 546c jsr 4546c <sigemptyset>
s.sa_flags = SA_RESTART;
#else
s.sa_flags = 0;
#endif
sigaction( signum, &s, &old );
454a4: 486e ffe8 pea %fp@(-24) 454a8: 486e fff4 pea %fp@(-12) 454ac: 2f2e 0008 movel %fp@(8),%sp@-
s.sa_flags = SA_RESTART | SA_INTERRUPT | SA_NOMASK; s.sa_restorer= NULL ; #elif defined(signal_like_SVR4) s.sa_flags = SA_RESTART; #else s.sa_flags = 0;
454b0: 42ae fff4 clrl %fp@(-12)
#endif
sigaction( signum, &s, &old );
454b4: 4eb9 0004 5360 jsr 45360 <sigaction>
return (sighandler_t) old.sa_handler; }
454ba: 202e fff0 movel %fp@(-16),%d0 454be: 4e5e unlk %fp 454c0: 4e75 rts
...
00047348 <sigqueue>:
int sigqueue(
pid_t pid,
int signo,
const union sigval value
)
{
47348: 4e56 0000 linkw %fp,#0
return killinfo( pid, signo, &value );
4734c: 486e 0010 pea %fp@(16) 47350: 2f2e 000c movel %fp@(12),%sp@- 47354: 2f2e 0008 movel %fp@(8),%sp@- 47358: 4eb9 0004 c3c8 jsr 4c3c8 <killinfo>
}
4735e: 4e5e unlk %fp 47360: 4e75 rts
...
00047364 <sigsuspend>:
#include <rtems/seterr.h>
int sigsuspend(
const sigset_t *sigmask
)
{
47364: 4e56 ffec linkw %fp,#-20 47368: 48d7 040c moveml %d2-%d3/%a2,%sp@
int status;
POSIX_API_Control *api;
api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
status = sigprocmask( SIG_BLOCK, sigmask, &saved_signals_blocked );
4736c: 240e movel %fp,%d2 4736e: 5982 subql #4,%d2 47370: 45f9 0004 733c lea 4733c <sigprocmask>,%a2
(void) sigfillset( &all_signals );
47376: 260e movel %fp,%d3 47378: 5183 subql #8,%d3
int status;
POSIX_API_Control *api;
api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ];
status = sigprocmask( SIG_BLOCK, sigmask, &saved_signals_blocked );
4737a: 2f02 movel %d2,%sp@- 4737c: 2f2e 0008 movel %fp@(8),%sp@- 47380: 4878 0001 pea 1 <ADD> 47384: 4e92 jsr %a2@
(void) sigfillset( &all_signals );
47386: 2f03 movel %d3,%sp@- 47388: 4eb9 0004 729c jsr 4729c <sigfillset>
status = sigtimedwait( &all_signals, NULL, NULL );
4738e: 42a7 clrl %sp@- 47390: 42a7 clrl %sp@- 47392: 2f03 movel %d3,%sp@- 47394: 4eb9 0004 7414 jsr 47414 <sigtimedwait> 4739a: 2600 movel %d0,%d3
(void) sigprocmask( SIG_SETMASK, &saved_signals_blocked, NULL );
4739c: 42a7 clrl %sp@- 4739e: 2f02 movel %d2,%sp@- 473a0: 42a7 clrl %sp@- 473a2: 4e92 jsr %a2@
/*
* sigtimedwait() returns the signal number while sigsuspend()
* is supposed to return -1 and EINTR when a signal is caught.
*/
if ( status != -1 )
473a4: 4fef 0028 lea %sp@(40),%sp 473a8: 70ff moveq #-1,%d0 473aa: b083 cmpl %d3,%d0 473ac: 670c beqs 473ba <sigsuspend+0x56>
rtems_set_errno_and_return_minus_one( EINTR );
473ae: 4eb9 0004 f238 jsr 4f238 <__errno> 473b4: 2040 moveal %d0,%a0 473b6: 7004 moveq #4,%d0 473b8: 2080 movel %d0,%a0@
return status;
}
473ba: 70ff moveq #-1,%d0 473bc: 4cee 040c ffec moveml %fp@(-20),%d2-%d3/%a2 473c2: 4e5e unlk %fp 473c4: 4e75 rts
...
000475a0 <sigwait>:
int sigwait(
const sigset_t *set,
int *sig
)
{
475a0: 4e56 0000 linkw %fp,#0 475a4: 2f0a movel %a2,%sp@- 475a6: 246e 000c moveal %fp@(12),%a2
int status;
status = sigtimedwait( set, NULL, NULL );
475aa: 42a7 clrl %sp@- 475ac: 42a7 clrl %sp@- 475ae: 2f2e 0008 movel %fp@(8),%sp@- 475b2: 4eb9 0004 7414 jsr 47414 <sigtimedwait>
if ( status != -1 ) {
475b8: 4fef 000c lea %sp@(12),%sp 475bc: 72ff moveq #-1,%d1 475be: b280 cmpl %d0,%d1 475c0: 670a beqs 475cc <sigwait+0x2c>
if ( sig )
475c2: 4a8a tstl %a2 475c4: 6702 beqs 475c8 <sigwait+0x28>
*sig = status;
475c6: 2480 movel %d0,%a2@ 475c8: 4280 clrl %d0 475ca: 600a bras 475d6 <sigwait+0x36>
return 0;
}
return errno;
475cc: 4eb9 0004 f238 jsr 4f238 <__errno> 475d2: 2040 moveal %d0,%a0 475d4: 2010 movel %a0@,%d0
}
475d6: 246e fffc moveal %fp@(-4),%a2 475da: 4e5e unlk %fp 475dc: 4e75 rts
...
00044b28 <sysconf>:
long sysconf(
int name
)
{
if ( name == _SC_CLK_TCK )
44b28: 7002 moveq #2,%d0
*/
long sysconf(
int name
)
{
44b2a: 4e56 0000 linkw %fp,#0 44b2e: 222e 0008 movel %fp@(8),%d1 44b32: 2f02 movel %d2,%sp@-
if ( name == _SC_CLK_TCK )
44b34: b081 cmpl %d1,%d0 44b36: 6612 bnes 44b4a <sysconf+0x22>
return (TOD_MICROSECONDS_PER_SECOND /
44b38: 41f9 0005 ba44 lea 5ba44 <Configuration+0xc>,%a0 44b3e: 203c 000f 4240 movel #1000000,%d0 44b44: 4c50 0000 remul %a0@,%d0,%d0 44b48: 6034 bras 44b7e <sysconf+0x56>
rtems_configuration_get_microseconds_per_tick());
if ( name == _SC_OPEN_MAX )
44b4a: 7004 moveq #4,%d0 44b4c: b081 cmpl %d1,%d0 44b4e: 6608 bnes 44b58 <sysconf+0x30>
return rtems_libio_number_iops;
44b50: 2039 0005 b964 movel 5b964 <rtems_libio_number_iops>,%d0 44b56: 6026 bras 44b7e <sysconf+0x56>
if ( name == _SC_GETPW_R_SIZE_MAX )
44b58: 203c 0000 0400 movel #1024,%d0 44b5e: 7433 moveq #51,%d2 44b60: b481 cmpl %d1,%d2 44b62: 671a beqs 44b7e <sysconf+0x56>
return 1024;
if ( name == _SC_PAGESIZE )
44b64: 143c 0008 moveb #8,%d2 44b68: 303c 1000 movew #4096,%d0 44b6c: b481 cmpl %d1,%d2 44b6e: 670e beqs 44b7e <sysconf+0x56>
#if defined(__sparc__)
if ( name == 515 ) /* Solaris _SC_STACK_PROT */
return 0;
#endif
rtems_set_errno_and_return_minus_one( EINVAL );
44b70: 4eb9 0004 cedc jsr 4cedc <__errno> 44b76: 7216 moveq #22,%d1 44b78: 2040 moveal %d0,%a0 44b7a: 70ff moveq #-1,%d0 44b7c: 2081 movel %d1,%a0@
}
44b7e: 242e fffc movel %fp@(-4),%d2 44b82: 4e5e unlk %fp 44b84: 4e75 rts
...
00044bd0 <timer_create>:
timer_t *timerid
)
{
POSIX_Timer_Control *ptimer;
if ( clock_id != CLOCK_REALTIME )
44bd0: 7001 moveq #1,%d0
int timer_create(
clockid_t clock_id,
struct sigevent *evp,
timer_t *timerid
)
{
44bd2: 4e56 0000 linkw %fp,#0 44bd6: 2f0b movel %a3,%sp@- 44bd8: 266e 0010 moveal %fp@(16),%a3 44bdc: 2f0a movel %a2,%sp@- 44bde: 246e 000c moveal %fp@(12),%a2
POSIX_Timer_Control *ptimer;
if ( clock_id != CLOCK_REALTIME )
44be2: b0ae 0008 cmpl %fp@(8),%d0 44be6: 6620 bnes 44c08 <timer_create+0x38>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !timerid )
44be8: 4a8b tstl %a3 44bea: 671c beqs 44c08 <timer_create+0x38>
/*
* The data of the structure evp are checked in order to verify if they
* are coherent.
*/
if (evp != NULL) {
44bec: 4a8a tstl %a2 44bee: 672a beqs 44c1a <timer_create+0x4a>
/* The structure has data */
if ( ( evp->sigev_notify != SIGEV_NONE ) &&
44bf0: 2012 movel %a2@,%d0 44bf2: 7201 moveq #1,%d1 44bf4: 5380 subql #1,%d0 44bf6: b280 cmpl %d0,%d1 44bf8: 650e bcss 44c08 <timer_create+0x38>
( 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 )
44bfa: 202a 0004 movel %a2@(4),%d0 44bfe: 6708 beqs 44c08 <timer_create+0x38>
rtems_set_errno_and_return_minus_one( EINVAL );
if ( !is_valid_signo(evp->sigev_signo) )
44c00: 5380 subql #1,%d0 44c02: 721f moveq #31,%d1 44c04: b280 cmpl %d0,%d1 44c06: 6412 bccs 44c1a <timer_create+0x4a>
rtems_set_errno_and_return_minus_one( EINVAL );
44c08: 4eb9 0004 d134 jsr 4d134 <__errno> 44c0e: 72ff moveq #-1,%d1 44c10: 2040 moveal %d0,%a0 44c12: 7016 moveq #22,%d0 44c14: 2080 movel %d0,%a0@ 44c16: 6000 00a4 braw 44cbc <timer_create+0xec>
rtems_fatal_error_occurred( 99 );
}
}
#endif
_Thread_Dispatch_disable_level += 1;
44c1a: 2039 0005 d7f4 movel 5d7f4 <_Thread_Dispatch_disable_level>,%d0 44c20: 5280 addql #1,%d0 44c22: 23c0 0005 d7f4 movel %d0,5d7f4 <_Thread_Dispatch_disable_level>
* 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 );
44c28: 4879 0005 da88 pea 5da88 <_POSIX_Timer_Information> 44c2e: 4eb9 0004 67f4 jsr 467f4 <_Objects_Allocate>
/*
* Allocate a timer
*/
ptimer = _POSIX_Timer_Allocate();
if ( !ptimer ) {
44c34: 588f addql #4,%sp 44c36: 2040 moveal %d0,%a0 44c38: 4a80 tstl %d0 44c3a: 6616 bnes 44c52 <timer_create+0x82>
_Thread_Enable_dispatch();
44c3c: 4eb9 0004 73ca jsr 473ca <_Thread_Enable_dispatch>
rtems_set_errno_and_return_minus_one( EAGAIN );
44c42: 4eb9 0004 d134 jsr 4d134 <__errno> 44c48: 72ff moveq #-1,%d1 44c4a: 2040 moveal %d0,%a0 44c4c: 700b moveq #11,%d0 44c4e: 2080 movel %d0,%a0@ 44c50: 606a bras 44cbc <timer_create+0xec>
}
/* The data of the created timer are stored to use them later */
ptimer->state = POSIX_TIMER_STATE_CREATE_NEW;
44c52: 7002 moveq #2,%d0 44c54: 1140 003c moveb %d0,%a0@(60)
ptimer->thread_id = _Thread_Executing->Object.id;
44c58: 2279 0005 d8ae moveal 5d8ae <_Thread_Executing>,%a1 44c5e: 2169 0008 0038 movel %a1@(8),%a0@(56)
if ( evp != NULL ) {
44c64: 4a8a tstl %a2 44c66: 6710 beqs 44c78 <timer_create+0xa8>
ptimer->inf.sigev_notify = evp->sigev_notify;
44c68: 2152 003e movel %a2@,%a0@(62)
ptimer->inf.sigev_signo = evp->sigev_signo;
ptimer->inf.sigev_value = evp->sigev_value;
44c6c: 216a 0008 0046 movel %a2@(8),%a0@(70)
ptimer->state = POSIX_TIMER_STATE_CREATE_NEW;
ptimer->thread_id = _Thread_Executing->Object.id;
if ( evp != NULL ) {
ptimer->inf.sigev_notify = evp->sigev_notify;
ptimer->inf.sigev_signo = evp->sigev_signo;
44c72: 216a 0004 0042 movel %a2@(4),%a0@(66)
#if defined(RTEMS_DEBUG)
if ( index > information->maximum )
return;
#endif
information->local_table[ index ] = the_object;
44c78: 2028 0008 movel %a0@(8),%d0 44c7c: 4281 clrl %d1 44c7e: 2279 0005 daa0 moveal 5daa0 <_POSIX_Timer_Information+0x18>,%a1 44c84: 3200 movew %d0,%d1
ptimer->inf.sigev_value = evp->sigev_value;
}
ptimer->overrun = 0;
44c86: 42a8 0066 clrl %a0@(102) 44c8a: 2388 1c00 movel %a0,%a1@(00000000,%d1:l:4)
ptimer->timer_data.it_value.tv_sec = 0;
44c8e: 42a8 005a clrl %a0@(90)
_Objects_Get_index( the_object->id ),
the_object
);
/* ASSERT: information->is_string == false */
the_object->name.name_u32 = name;
44c92: 42a8 000c clrl %a0@(12)
ptimer->timer_data.it_value.tv_nsec = 0;
44c96: 42a8 005e clrl %a0@(94)
ptimer->timer_data.it_interval.tv_sec = 0;
44c9a: 42a8 0052 clrl %a0@(82)
ptimer->timer_data.it_interval.tv_nsec = 0;
44c9e: 42a8 0056 clrl %a0@(86)
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
the_watchdog->id = id;
44ca2: 42a8 0030 clrl %a0@(48)
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
44ca6: 42a8 0018 clrl %a0@(24)
_Watchdog_Initialize( &ptimer->Timer, NULL, 0, NULL );
_Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0);
*timerid = ptimer->Object.id;
44caa: 2680 movel %d0,%a3@
the_watchdog->routine = routine;
44cac: 42a8 002c clrl %a0@(44)
the_watchdog->id = id; the_watchdog->user_data = user_data;
44cb0: 42a8 0034 clrl %a0@(52)
_Thread_Enable_dispatch();
44cb4: 4eb9 0004 73ca jsr 473ca <_Thread_Enable_dispatch> 44cba: 4281 clrl %d1
return 0; }
44cbc: 246e fff8 moveal %fp@(-8),%a2 44cc0: 2001 movel %d1,%d0 44cc2: 266e fffc moveal %fp@(-4),%a3 44cc6: 4e5e unlk %fp 44cc8: 4e75 rts
...
000454b4 <timer_delete>:
int timer_delete(
timer_t timerid
)
{
454b4: 4e56 fffc linkw %fp,#-4 454b8: 2f0a movel %a2,%sp@-
RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get (
timer_t id,
Objects_Locations *location
)
{
return (POSIX_Timer_Control *)
454ba: 486e fffc pea %fp@(-4) 454be: 2f2e 0008 movel %fp@(8),%sp@- 454c2: 4879 0005 e420 pea 5e420 <_POSIX_Timer_Information> 454c8: 4eb9 0004 73d0 jsr 473d0 <_Objects_Get>
*/
POSIX_Timer_Control *ptimer;
Objects_Locations location;
ptimer = _POSIX_Timer_Get( timerid, &location );
switch ( location ) {
454ce: 4fef 000c lea %sp@(12),%sp 454d2: 2440 moveal %d0,%a2 454d4: 4aae fffc tstl %fp@(-4) 454d8: 663a bnes 45514 <timer_delete+0x60>
case OBJECTS_LOCAL:
_Objects_Close( &_POSIX_Timer_Information, &ptimer->Object );
454da: 2f00 movel %d0,%sp@- 454dc: 4879 0005 e420 pea 5e420 <_POSIX_Timer_Information> 454e2: 4eb9 0004 7004 jsr 47004 <_Objects_Close>
ptimer->state = POSIX_TIMER_STATE_FREE;
454e8: 7001 moveq #1,%d0 454ea: 1540 003c moveb %d0,%a2@(60)
(void) _Watchdog_Remove( &ptimer->Timer );
454ee: 486a 0010 pea %a2@(16) 454f2: 4eb9 0004 8c98 jsr 48c98 <_Watchdog_Remove>
RTEMS_INLINE_ROUTINE void _POSIX_Timer_Free (
POSIX_Timer_Control *the_timer
)
{
_Objects_Free( &_POSIX_Timer_Information, &the_timer->Object );
454f8: 2f0a movel %a2,%sp@- 454fa: 4879 0005 e420 pea 5e420 <_POSIX_Timer_Information> 45500: 4eb9 0004 7278 jsr 47278 <_Objects_Free>
_POSIX_Timer_Free( ptimer );
_Thread_Enable_dispatch();
45506: 4eb9 0004 7b5a jsr 47b5a <_Thread_Enable_dispatch>
return 0;
4550c: 4fef 0014 lea %sp@(20),%sp
case OBJECTS_LOCAL:
_Objects_Close( &_POSIX_Timer_Information, &ptimer->Object );
ptimer->state = POSIX_TIMER_STATE_FREE;
(void) _Watchdog_Remove( &ptimer->Timer );
_POSIX_Timer_Free( ptimer );
_Thread_Enable_dispatch();
45510: 4280 clrl %d0
return 0;
45512: 600e bras 45522 <timer_delete+0x6e>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EINVAL );
45514: 4eb9 0004 dc70 jsr 4dc70 <__errno> 4551a: 7216 moveq #22,%d1 4551c: 2040 moveal %d0,%a0 4551e: 70ff moveq #-1,%d0 45520: 2081 movel %d1,%a0@
}
45522: 246e fff8 moveal %fp@(-8),%a2 45526: 4e5e unlk %fp 45528: 4e75 rts
...
00045fc8 <timer_getoverrun>:
* its execution, _POSIX_Timer_TSR will have to set this counter to 0.
*/
int timer_getoverrun(
timer_t timerid
)
{
45fc8: 4e56 fffc linkw %fp,#-4 45fcc: 2f02 movel %d2,%sp@-
RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get (
timer_t id,
Objects_Locations *location
)
{
return (POSIX_Timer_Control *)
45fce: 486e fffc pea %fp@(-4) 45fd2: 2f2e 0008 movel %fp@(8),%sp@- 45fd6: 4879 0005 f888 pea 5f888 <_POSIX_Timer_Information> 45fdc: 4eb9 0004 7e6c jsr 47e6c <_Objects_Get>
int overrun;
POSIX_Timer_Control *ptimer;
Objects_Locations location;
ptimer = _POSIX_Timer_Get( timerid, &location );
switch ( location ) {
45fe2: 4fef 000c lea %sp@(12),%sp 45fe6: 4aae fffc tstl %fp@(-4) 45fea: 6612 bnes 45ffe <timer_getoverrun+0x36>
case OBJECTS_LOCAL:
overrun = ptimer->overrun;
45fec: 2040 moveal %d0,%a0 45fee: 2428 0066 movel %a0@(102),%d2
ptimer->overrun = 0;
45ff2: 42a8 0066 clrl %a0@(102)
_Thread_Enable_dispatch();
45ff6: 4eb9 0004 85f6 jsr 485f6 <_Thread_Enable_dispatch>
return overrun;
45ffc: 600e bras 4600c <timer_getoverrun+0x44>
#endif
case OBJECTS_ERROR:
break;
}
rtems_set_errno_and_return_minus_one( EINVAL );
45ffe: 4eb9 0004 e3e0 jsr 4e3e0 <__errno> 46004: 74ff moveq #-1,%d2 46006: 2040 moveal %d0,%a0 46008: 7016 moveq #22,%d0 4600a: 2080 movel %d0,%a0@
}
4600c: 2002 movel %d2,%d0 4600e: 242e fff8 movel %fp@(-8),%d2 46012: 4e5e unlk %fp 46014: 4e75 rts
...
00044d60 <ualarm>:
useconds_t ualarm(
useconds_t useconds,
useconds_t interval
)
{
44d60: 4e56 ffe8 linkw %fp,#-24 44d64: 48d7 041c moveml %d2-%d4/%a2,%sp@ 44d68: 262e 0008 movel %fp@(8),%d3
/*
* Initialize the timer used to implement alarm().
*/
if ( !the_timer->routine ) {
44d6c: 4ab9 0005 ec76 tstl 5ec76 <_POSIX_signals_Ualarm_timer+0x1c> 44d72: 6622 bnes 44d96 <ualarm+0x36>
Watchdog_Service_routine_entry routine,
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
44d74: 42b9 0005 ec62 clrl 5ec62 <_POSIX_signals_Ualarm_timer+0x8>
the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data;
44d7a: 4282 clrl %d2
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
44d7c: 203c 0004 4e4c movel #282188,%d0
the_watchdog->id = id;
44d82: 42b9 0005 ec7a clrl 5ec7a <_POSIX_signals_Ualarm_timer+0x20>
Objects_Id id,
void *user_data
)
{
the_watchdog->state = WATCHDOG_INACTIVE;
the_watchdog->routine = routine;
44d88: 23c0 0005 ec76 movel %d0,5ec76 <_POSIX_signals_Ualarm_timer+0x1c>
the_watchdog->id = id; the_watchdog->user_data = user_data;
44d8e: 42b9 0005 ec7e clrl 5ec7e <_POSIX_signals_Ualarm_timer+0x24> 44d94: 6058 bras 44dee <ualarm+0x8e>
_Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL );
} else {
Watchdog_States state;
state = _Watchdog_Remove( the_timer );
44d96: 4879 0005 ec5a pea 5ec5a <_POSIX_signals_Ualarm_timer> 44d9c: 4eb9 0004 8330 jsr 48330 <_Watchdog_Remove>
if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) {
44da2: 588f addql #4,%sp 44da4: 7201 moveq #1,%d1 44da6: 5580 subql #2,%d0 44da8: b280 cmpl %d0,%d1 44daa: 6404 bccs 44db0 <ualarm+0x50>
44dac: 4282 clrl %d2 <== NOT EXECUTED 44dae: 603e bras 44dee <ualarm+0x8e> <== NOT EXECUTED
* 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);
44db0: 2039 0005 ec6e movel 5ec6e <_POSIX_signals_Ualarm_timer+0x14>,%d0 44db6: d0b9 0005 ec66 addl 5ec66 <_POSIX_signals_Ualarm_timer+0xc>,%d0
/* remaining is now in ticks */
_Timespec_From_ticks( ticks, &tp );
44dbc: 486e fff8 pea %fp@(-8) 44dc0: 90b9 0005 ec72 subl 5ec72 <_POSIX_signals_Ualarm_timer+0x18>,%d0
remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND;
44dc6: 283c 000f 4240 movel #1000000,%d4
ticks = the_timer->initial;
ticks -= (the_timer->stop_time - the_timer->start_time);
/* remaining is now in ticks */
_Timespec_From_ticks( ticks, &tp );
44dcc: 2f00 movel %d0,%sp@- 44dce: 4eb9 0004 7e58 jsr 47e58 <_Timespec_From_ticks>
remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND;
44dd4: 202e fff8 movel %fp@(-8),%d0 44dd8: 4c04 0800 mulsl %d4,%d0
remaining += tp.tv_nsec / 1000;
44ddc: 283c 0000 03e8 movel #1000,%d4 44de2: 508f addql #8,%sp 44de4: 242e fffc movel %fp@(-4),%d2 44de8: 4c44 2802 remsl %d4,%d2,%d2 44dec: d480 addl %d0,%d2
/*
* 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 ) {
44dee: 4a83 tstl %d3 44df0: 674e beqs 44e40 <ualarm+0xe0>
Watchdog_Interval ticks;
tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND;
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
ticks = _Timespec_To_ticks( &tp );
44df2: 280e movel %fp,%d4
* 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;
44df4: 223c 000f 4240 movel #1000000,%d1
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
ticks = _Timespec_To_ticks( &tp );
44dfa: 5184 subql #8,%d4 44dfc: 45f9 0004 7edc lea 47edc <_Timespec_To_ticks>,%a2
* 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;
44e02: 4c41 3000 remul %d1,%d0,%d3 44e06: 4c41 3003 remul %d1,%d3,%d3
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
44e0a: 223c 0000 03e8 movel #1000,%d1 44e10: 4c00 1800 mulsl %d0,%d1
ticks = _Timespec_To_ticks( &tp );
44e14: 2f04 movel %d4,%sp@-
*/
if ( useconds ) {
Watchdog_Interval ticks;
tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND;
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
44e16: 2d41 fffc movel %d1,%fp@(-4)
* 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;
44e1a: 2d43 fff8 movel %d3,%fp@(-8)
tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000;
ticks = _Timespec_To_ticks( &tp );
44e1e: 4e92 jsr %a2@
if ( ticks == 0 )
ticks = 1;
_Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) );
44e20: 2f04 movel %d4,%sp@- 44e22: 4e92 jsr %a2@
)
{
the_watchdog->initial = units;
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
44e24: 4879 0005 ec5a pea 5ec5a <_POSIX_signals_Ualarm_timer> 44e2a: 4879 0005 e50c pea 5e50c <_Watchdog_Ticks_chain>
Watchdog_Control *the_watchdog,
Watchdog_Interval units
)
{
the_watchdog->initial = units;
44e30: 23c0 0005 ec66 movel %d0,5ec66 <_POSIX_signals_Ualarm_timer+0xc>
_Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog );
44e36: 4eb9 0004 8214 jsr 48214 <_Watchdog_Insert> 44e3c: 4fef 0010 lea %sp@(16),%sp
}
return remaining;
}
44e40: 2002 movel %d2,%d0 44e42: 4cee 041c ffe8 moveml %fp@(-24),%d2-%d4/%a2 44e48: 4e5e unlk %fp 44e4a: 4e75 rts
000450a0 <vfork>:
#include <unistd.h>
pid_t vfork(void)
{
return -1;
}
450a0: 70ff moveq #-1,%d0
#include <sys/types.h>
#include <unistd.h>
pid_t vfork(void)
{
450a2: 4e56 0000 linkw %fp,#0
return -1; }
450a6: 4e5e unlk %fp 450a8: 4e75 rts
...
000450ac <wait>:
#include <rtems/seterr.h>
int wait(
int *stat_loc
)
{
450ac: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
450b0: 4eb9 0004 d430 jsr 4d430 <__errno> 450b6: 7258 moveq #88,%d1 450b8: 2040 moveal %d0,%a0
}
450ba: 70ff moveq #-1,%d0 450bc: 4e5e unlk %fp
int wait(
int *stat_loc
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
450be: 2081 movel %d1,%a0@
}
450c0: 4e75 rts
...
000450c4 <waitpid>:
int waitpid(
pid_t pid,
int *stat_loc,
int options
)
{
450c4: 4e56 0000 linkw %fp,#0
rtems_set_errno_and_return_minus_one( ENOSYS );
450c8: 4eb9 0004 d430 jsr 4d430 <__errno> 450ce: 7258 moveq #88,%d1 450d0: 2040 moveal %d0,%a0
}
450d2: 70ff moveq #-1,%d0 450d4: 4e5e unlk %fp
pid_t pid,
int *stat_loc,
int options
)
{
rtems_set_errno_and_return_minus_one( ENOSYS );
450d6: 2081 movel %d1,%a0@
}
450d8: 4e75 rts
...