00009280 <_CORE_mutex_Seize_interrupt_trylock>:
{
  Thread_Control   *executing;

  /* disabled when you get here */

  executing = _Thread_Executing;
    9280:	e59f3120 	ldr	r3, [pc, #288]	; 93a8 <_CORE_mutex_Seize_interrupt_trylock+0x128>
    9284:	e5933000 	ldr	r3, [r3]
  executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
    9288:	e3a02000 	mov	r2, #0
    928c:	e5832034 	str	r2, [r3, #52]	; 0x34
  if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
    9290:	e590c050 	ldr	ip, [r0, #80]	; 0x50
    9294:	e15c0002 	cmp	ip, r2
#if defined(__RTEMS_DO_NOT_INLINE_CORE_MUTEX_SEIZE__)
int _CORE_mutex_Seize_interrupt_trylock(
  CORE_mutex_Control  *the_mutex,
  ISR_Level           *level_p
)
{
    9298:	e52de004 	push	{lr}		; (str lr, [sp, #-4]!)
    929c:	0a00002c 	beq	9354 <_CORE_mutex_Seize_interrupt_trylock+0xd4>
    the_mutex->lock       = CORE_MUTEX_LOCKED;
    92a0:	e5802050 	str	r2, [r0, #80]	; 0x50
 */
RTEMS_INLINE_ROUTINE bool _CORE_mutex_Is_inherit_priority(
  CORE_mutex_Attributes *the_attribute
)
{
  return the_attribute->discipline == CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT;
    92a4:	e5902048 	ldr	r2, [r0, #72]	; 0x48
  executing = _Thread_Executing;
  executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
  if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
    the_mutex->lock       = CORE_MUTEX_LOCKED;
    the_mutex->holder     = executing;
    the_mutex->holder_id  = executing->Object.id;
    92a8:	e593c008 	ldr	ip, [r3, #8]
    the_mutex->nest_count = 1;
    if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
    92ac:	e3520002 	cmp	r2, #2
  executing = _Thread_Executing;
  executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
  if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
    the_mutex->lock       = CORE_MUTEX_LOCKED;
    the_mutex->holder     = executing;
    the_mutex->holder_id  = executing->Object.id;
    92b0:	e580c060 	str	ip, [r0, #96]	; 0x60
    the_mutex->nest_count = 1;
    92b4:	e3a0c001 	mov	ip, #1
    92b8:	e580c054 	str	ip, [r0, #84]	; 0x54

  executing = _Thread_Executing;
  executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
  if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
    the_mutex->lock       = CORE_MUTEX_LOCKED;
    the_mutex->holder     = executing;
    92bc:	e580305c 	str	r3, [r0, #92]	; 0x5c
    the_mutex->holder_id  = executing->Object.id;
    the_mutex->nest_count = 1;
    if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
    92c0:	0a000001 	beq	92cc <_CORE_mutex_Seize_interrupt_trylock+0x4c>
    92c4:	e3520003 	cmp	r2, #3
    92c8:	1a000004 	bne	92e0 <_CORE_mutex_Seize_interrupt_trylock+0x60>
       _Chain_Prepend_unprotected( &executing->lock_mutex,
                                   &the_mutex->queue.lock_queue );
       the_mutex->queue.priority_before = executing->current_priority;
#endif

      executing->resource_count++;
    92cc:	e593c01c 	ldr	ip, [r3, #28]
    }

    if ( !_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
    92d0:	e3520003 	cmp	r2, #3
       _Chain_Prepend_unprotected( &executing->lock_mutex,
                                   &the_mutex->queue.lock_queue );
       the_mutex->queue.priority_before = executing->current_priority;
#endif

      executing->resource_count++;
    92d4:	e28c2001 	add	r2, ip, #1
    92d8:	e583201c 	str	r2, [r3, #28]
    }

    if ( !_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
    92dc:	0a000000 	beq	92e4 <_CORE_mutex_Seize_interrupt_trylock+0x64>
      _ISR_Enable( *level_p );
    92e0:	ea00002a 	b	9390 <_CORE_mutex_Seize_interrupt_trylock+0x110>
       */
    {
      Priority_Control  ceiling;
      Priority_Control  current;

      ceiling = the_mutex->Attributes.priority_ceiling;
    92e4:	e590204c 	ldr	r2, [r0, #76]	; 0x4c
      current = executing->current_priority;
    92e8:	e593c014 	ldr	ip, [r3, #20]
      if ( current == ceiling ) {
    92ec:	e15c0002 	cmp	ip, r2
    92f0:	1a000000 	bne	92f8 <_CORE_mutex_Seize_interrupt_trylock+0x78>
        _ISR_Enable( *level_p );
    92f4:	ea000025 	b	9390 <_CORE_mutex_Seize_interrupt_trylock+0x110>
        return 0;
      }

      if ( current > ceiling ) {
    92f8:	9a00000b 	bls	932c <_CORE_mutex_Seize_interrupt_trylock+0xac>
	rtems_fatal_error_occurred( 99 );
      }
    }
  #endif

  _Thread_Dispatch_disable_level += 1;
    92fc:	e59f30a8 	ldr	r3, [pc, #168]	; 93ac <_CORE_mutex_Seize_interrupt_trylock+0x12c>
    9300:	e5932000 	ldr	r2, [r3]
    9304:	e2822001 	add	r2, r2, #1
    9308:	e5832000 	str	r2, [r3]
    930c:	e5913000 	ldr	r3, [r1]
    9310:	e129f003 	msr	CPSR_fc, r3
        _Thread_Disable_dispatch();
        _ISR_Enable( *level_p );
        _Thread_Change_priority(
    9314:	e3a02000 	mov	r2, #0
    9318:	e590104c 	ldr	r1, [r0, #76]	; 0x4c
    931c:	e590005c 	ldr	r0, [r0, #92]	; 0x5c
    9320:	ebfff1ef 	bl	5ae4 <_Thread_Change_priority>
          the_mutex->holder,
          the_mutex->Attributes.priority_ceiling,
         false
        );
        _Thread_Enable_dispatch();
    9324:	ebfff34f 	bl	6068 <_Thread_Enable_dispatch>
    9328:	ea00001a 	b	9398 <_CORE_mutex_Seize_interrupt_trylock+0x118>
        return 0;
      }
      /* if ( current < ceiling ) */ {
        executing->Wait.return_code = CORE_MUTEX_STATUS_CEILING_VIOLATED;
    932c:	e3a02006 	mov	r2, #6
    9330:	e5832034 	str	r2, [r3, #52]	; 0x34
        the_mutex->lock       = CORE_MUTEX_UNLOCKED;
        the_mutex->nest_count = 0;     /* undo locking above */
    9334:	e3a02000 	mov	r2, #0
    9338:	e5802054 	str	r2, [r0, #84]	; 0x54
        _Thread_Enable_dispatch();
        return 0;
      }
      /* if ( current < ceiling ) */ {
        executing->Wait.return_code = CORE_MUTEX_STATUS_CEILING_VIOLATED;
        the_mutex->lock       = CORE_MUTEX_UNLOCKED;
    933c:	e2822001 	add	r2, r2, #1
    9340:	e5802050 	str	r2, [r0, #80]	; 0x50
        the_mutex->nest_count = 0;     /* undo locking above */
        executing->resource_count--;   /* undo locking above */
    9344:	e593201c 	ldr	r2, [r3, #28]
    9348:	e2422001 	sub	r2, r2, #1
    934c:	e583201c 	str	r2, [r3, #28]
        _ISR_Enable( *level_p );
    9350:	ea00000e 	b	9390 <_CORE_mutex_Seize_interrupt_trylock+0x110>
  /*
   *  At this point, we know the mutex was not available.  If this thread
   *  is the thread that has locked the mutex, let's see if we are allowed
   *  to nest access.
   */
  if ( _Thread_Is_executing( the_mutex->holder ) ) {
    9354:	e590205c 	ldr	r2, [r0, #92]	; 0x5c
    9358:	e1520003 	cmp	r2, r3
    935c:	1a00000f 	bne	93a0 <_CORE_mutex_Seize_interrupt_trylock+0x120>
    switch ( the_mutex->Attributes.lock_nesting_behavior ) {
    9360:	e5903040 	ldr	r3, [r0, #64]	; 0x40
    9364:	e3530000 	cmp	r3, #0
    9368:	0a000002 	beq	9378 <_CORE_mutex_Seize_interrupt_trylock+0xf8>
    936c:	e3530001 	cmp	r3, #1
    9370:	1a00000a 	bne	93a0 <_CORE_mutex_Seize_interrupt_trylock+0x120>
    9374:	ea000003 	b	9388 <_CORE_mutex_Seize_interrupt_trylock+0x108>      	<== NOT EXECUTED
      case CORE_MUTEX_NESTING_ACQUIRES:
        the_mutex->nest_count++;
    9378:	e5903054 	ldr	r3, [r0, #84]	; 0x54
    937c:	e2833001 	add	r3, r3, #1
    9380:	e5803054 	str	r3, [r0, #84]	; 0x54
        _ISR_Enable( *level_p );
    9384:	ea000001 	b	9390 <_CORE_mutex_Seize_interrupt_trylock+0x110>
        return 0;
      case CORE_MUTEX_NESTING_IS_ERROR:
        executing->Wait.return_code = CORE_MUTEX_STATUS_NESTING_NOT_ALLOWED;
    9388:	e3a03002 	mov	r3, #2                                              	<== NOT EXECUTED
    938c:	e5823034 	str	r3, [r2, #52]	; 0x34                                	<== NOT EXECUTED
    9390:	e5913000 	ldr	r3, [r1]
    9394:	e129f003 	msr	CPSR_fc, r3
    9398:	e3a00000 	mov	r0, #0
    939c:	e49df004 	pop	{pc}		; (ldr pc, [sp], #4)
    93a0:	e3a00001 	mov	r0, #1
  return _CORE_mutex_Seize_interrupt_trylock_body( the_mutex, level_p );
}
    93a4:	e49df004 	pop	{pc}		; (ldr pc, [sp], #4)
    93a8:	000187c0 	.word	0x000187c0
    93ac:	0001870c 	.word	0x0001870c

000065c4 <_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
)
{
    65c4:	e92d45f0 	push	{r4, r5, r6, r7, r8, sl, lr}
  Priority_Control     priority;
  States_Control       block_state;

  _Chain_Initialize_empty( &the_thread->Wait.Block2n );

  priority     = the_thread->current_priority;
    65c8:	e5913014 	ldr	r3, [r1, #20]
 */
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
    65cc:	e281503c 	add	r5, r1, #60	; 0x3c
    65d0:	e5815038 	str	r5, [r1, #56]	; 0x38
  the_chain->permanent_null = NULL;
    65d4:	e3a05000 	mov	r5, #0
  the_chain->last           = _Chain_Head(the_chain);
    65d8:	e281c038 	add	ip, r1, #56	; 0x38
  header_index = _Thread_queue_Header_number( priority );
  header       = &the_thread_queue->Queues.Priority[ header_index ];
  block_state  = the_thread_queue->state;

  if ( _Thread_queue_Is_reverse_search( priority ) )
    65dc:	e3130020 	tst	r3, #32

  _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 ];
    65e0:	e1a04323 	lsr	r4, r3, #6
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
  the_chain->permanent_null = NULL;
    65e4:	e581503c 	str	r5, [r1, #60]	; 0x3c
    65e8:	e285500c 	add	r5, r5, #12
  the_chain->last           = _Chain_Head(the_chain);
    65ec:	e581c040 	str	ip, [r1, #64]	; 0x40
  block_state  = the_thread_queue->state;
    65f0:	e5907038 	ldr	r7, [r0, #56]	; 0x38

  _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 ];
    65f4:	e02c0495 	mla	ip, r5, r4, r0
  the_thread->Wait.queue = the_thread_queue;
  _ISR_Enable( level );
  return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;

restart_reverse_search:
  search_priority     = PRIORITY_MAXIMUM + 1;
    65f8:	159f8154 	ldrne	r8, [pc, #340]	; 6754 <_Thread_queue_Enqueue_priority+0x190>
  priority     = the_thread->current_priority;
  header_index = _Thread_queue_Header_number( priority );
  header       = &the_thread_queue->Queues.Priority[ header_index ];
  block_state  = the_thread_queue->state;

  if ( _Thread_queue_Is_reverse_search( priority ) )
    65fc:	1a000023 	bne	6690 <_Thread_queue_Enqueue_priority+0xcc>
 */
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
  Chain_Control *the_chain
)
{
   return (Chain_Node *) &the_chain->permanent_null;
    6600:	e28c8004 	add	r8, ip, #4
static inline uint32_t arm_interrupt_disable( void )
{
  uint32_t arm_switch_reg;
  uint32_t level;

  asm volatile (
    6604:	e10f5000 	mrs	r5, CPSR
    6608:	e3854080 	orr	r4, r5, #128	; 0x80
    660c:	e129f004 	msr	CPSR_fc, r4
    goto restart_reverse_search;

restart_forward_search:
  search_priority = PRIORITY_MINIMUM - 1;
  _ISR_Disable( level );
  search_thread = (Thread_Control *) header->first;
    6610:	e3e06000 	mvn	r6, #0
    6614:	e59c4000 	ldr	r4, [ip]
  while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) {
    6618:	ea00000b 	b	664c <_Thread_queue_Enqueue_priority+0x88>
    search_priority = search_thread->current_priority;
    661c:	e5946014 	ldr	r6, [r4, #20]
    if ( priority <= search_priority )
    6620:	e1530006 	cmp	r3, r6
    6624:	9a00000a 	bls	6654 <_Thread_queue_Enqueue_priority+0x90>

static inline void arm_interrupt_flash( uint32_t level )
{
  uint32_t arm_switch_reg;

  asm volatile (
    6628:	e10fa000 	mrs	sl, CPSR
    662c:	e129f005 	msr	CPSR_fc, r5
    6630:	e129f00a 	msr	CPSR_fc, sl
    search_priority = search_thread->current_priority;
    if ( priority <= search_priority )
      break;
#endif
    _ISR_Flash( level );
    if ( !_States_Are_set( search_thread->current_state, block_state) ) {
    6634:	e594a010 	ldr	sl, [r4, #16]
    6638:	e117000a 	tst	r7, sl
    663c:	1a000001 	bne	6648 <_Thread_queue_Enqueue_priority+0x84>

static inline void arm_interrupt_enable( uint32_t level )
{
  ARM_SWITCH_REGISTERS;

  asm volatile (
    6640:	e129f005 	msr	CPSR_fc, r5                                         	<== NOT EXECUTED
    6644:	eaffffee 	b	6604 <_Thread_queue_Enqueue_priority+0x40>            	<== NOT EXECUTED
      _ISR_Enable( level );
      goto restart_forward_search;
    }
    search_thread =
       (Thread_Control *)search_thread->Object.Node.next;
    6648:	e5944000 	ldr	r4, [r4]

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 ) ) {
    664c:	e1540008 	cmp	r4, r8
    6650:	1afffff1 	bne	661c <_Thread_queue_Enqueue_priority+0x58>
    }
    search_thread =
       (Thread_Control *)search_thread->Object.Node.next;
  }

  if ( the_thread_queue->sync_state !=
    6654:	e590c030 	ldr	ip, [r0, #48]	; 0x30
    6658:	e35c0001 	cmp	ip, #1

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 ) ) {
    665c:	e1a0c005 	mov	ip, r5
    }
    search_thread =
       (Thread_Control *)search_thread->Object.Node.next;
  }

  if ( the_thread_queue->sync_state !=
    6660:	1a000038 	bne	6748 <_Thread_queue_Enqueue_priority+0x184>
       THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
    goto synchronize;

  the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;

  if ( priority == search_priority )
    6664:	e1530006 	cmp	r3, r6

  if ( the_thread_queue->sync_state !=
       THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
    goto synchronize;

  the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
    6668:	e3a03000 	mov	r3, #0
    666c:	e5803030 	str	r3, [r0, #48]	; 0x30

  if ( priority == search_priority )
    6670:	0a00002a 	beq	6720 <_Thread_queue_Enqueue_priority+0x15c>
    goto equal_priority;

  search_node   = (Chain_Node *) search_thread;
  previous_node = search_node->previous;
    6674:	e5943004 	ldr	r3, [r4, #4]
  the_node      = (Chain_Node *) the_thread;

  the_node->next         = search_node;
    6678:	e5814000 	str	r4, [r1]
  the_node->previous     = previous_node;
    667c:	e5813004 	str	r3, [r1, #4]
  previous_node->next    = the_node;
  search_node->previous  = the_node;
  the_thread->Wait.queue = the_thread_queue;
    6680:	e5810044 	str	r0, [r1, #68]	; 0x44
  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;
    6684:	e5831000 	str	r1, [r3]
  search_node->previous  = the_node;
    6688:	e5841004 	str	r1, [r4, #4]
  the_thread->Wait.queue = the_thread_queue;
  _ISR_Enable( level );
    668c:	ea000021 	b	6718 <_Thread_queue_Enqueue_priority+0x154>
  return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;

restart_reverse_search:
  search_priority     = PRIORITY_MAXIMUM + 1;
    6690:	e5d86000 	ldrb	r6, [r8]
    6694:	e2866001 	add	r6, r6, #1
static inline uint32_t arm_interrupt_disable( void )
{
  uint32_t arm_switch_reg;
  uint32_t level;

  asm volatile (
    6698:	e10f5000 	mrs	r5, CPSR
    669c:	e3854080 	orr	r4, r5, #128	; 0x80
    66a0:	e129f004 	msr	CPSR_fc, r4

  _ISR_Disable( level );
  search_thread = (Thread_Control *) header->last;
    66a4:	e59c4008 	ldr	r4, [ip, #8]
  while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) {
    66a8:	ea00000b 	b	66dc <_Thread_queue_Enqueue_priority+0x118>
    search_priority = search_thread->current_priority;
    66ac:	e5946014 	ldr	r6, [r4, #20]
    if ( priority >= search_priority )
    66b0:	e1530006 	cmp	r3, r6
    66b4:	2a00000a 	bcs	66e4 <_Thread_queue_Enqueue_priority+0x120>

static inline void arm_interrupt_flash( uint32_t level )
{
  uint32_t arm_switch_reg;

  asm volatile (
    66b8:	e10fa000 	mrs	sl, CPSR
    66bc:	e129f005 	msr	CPSR_fc, r5
    66c0:	e129f00a 	msr	CPSR_fc, sl
    search_priority = search_thread->current_priority;
    if ( priority >= search_priority )
      break;
#endif
    _ISR_Flash( level );
    if ( !_States_Are_set( search_thread->current_state, block_state) ) {
    66c4:	e594a010 	ldr	sl, [r4, #16]
    66c8:	e117000a 	tst	r7, sl
    66cc:	1a000001 	bne	66d8 <_Thread_queue_Enqueue_priority+0x114>

static inline void arm_interrupt_enable( uint32_t level )
{
  ARM_SWITCH_REGISTERS;

  asm volatile (
    66d0:	e129f005 	msr	CPSR_fc, r5
    66d4:	eaffffed 	b	6690 <_Thread_queue_Enqueue_priority+0xcc>
      _ISR_Enable( level );
      goto restart_reverse_search;
    }
    search_thread = (Thread_Control *)
    66d8:	e5944004 	ldr	r4, [r4, #4]
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 ) ) {
    66dc:	e154000c 	cmp	r4, ip
    66e0:	1afffff1 	bne	66ac <_Thread_queue_Enqueue_priority+0xe8>
    }
    search_thread = (Thread_Control *)
                         search_thread->Object.Node.previous;
  }

  if ( the_thread_queue->sync_state !=
    66e4:	e590c030 	ldr	ip, [r0, #48]	; 0x30
    66e8:	e35c0001 	cmp	ip, #1
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 ) ) {
    66ec:	e1a0c005 	mov	ip, r5
    }
    search_thread = (Thread_Control *)
                         search_thread->Object.Node.previous;
  }

  if ( the_thread_queue->sync_state !=
    66f0:	1a000014 	bne	6748 <_Thread_queue_Enqueue_priority+0x184>
       THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
    goto synchronize;

  the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;

  if ( priority == search_priority )
    66f4:	e1530006 	cmp	r3, r6

  if ( the_thread_queue->sync_state !=
       THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
    goto synchronize;

  the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;
    66f8:	e3a03000 	mov	r3, #0
    66fc:	e5803030 	str	r3, [r0, #48]	; 0x30

  if ( priority == search_priority )
    6700:	0a000006 	beq	6720 <_Thread_queue_Enqueue_priority+0x15c>
    goto equal_priority;

  search_node = (Chain_Node *) search_thread;
  next_node   = search_node->next;
    6704:	e5943000 	ldr	r3, [r4]
  the_node    = (Chain_Node *) the_thread;

  the_node->next          = next_node;
  the_node->previous      = search_node;
    6708:	e8810018 	stm	r1, {r3, r4}
  search_node->next       = the_node;
  next_node->previous    = the_node;
  the_thread->Wait.queue = the_thread_queue;
    670c:	e5810044 	str	r0, [r1, #68]	; 0x44
  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;
    6710:	e5841000 	str	r1, [r4]
  next_node->previous    = the_node;
    6714:	e5831004 	str	r1, [r3, #4]
    6718:	e129f005 	msr	CPSR_fc, r5
    671c:	ea000007 	b	6740 <_Thread_queue_Enqueue_priority+0x17c>
    6720:	e284403c 	add	r4, r4, #60	; 0x3c
  _ISR_Enable( level );
  return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;

equal_priority:               /* add at end of priority group */
  search_node   = _Chain_Tail( &search_thread->Wait.Block2n );
  previous_node = search_node->previous;
    6724:	e5943004 	ldr	r3, [r4, #4]
  the_node      = (Chain_Node *) the_thread;

  the_node->next         = search_node;
    6728:	e5814000 	str	r4, [r1]
  the_node->previous     = previous_node;
    672c:	e5813004 	str	r3, [r1, #4]
  previous_node->next    = the_node;
  search_node->previous  = the_node;
  the_thread->Wait.queue = the_thread_queue;
    6730:	e5810044 	str	r0, [r1, #68]	; 0x44
  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;
    6734:	e5831000 	str	r1, [r3]
  search_node->previous  = the_node;
    6738:	e5841004 	str	r1, [r4, #4]
    673c:	e129f00c 	msr	CPSR_fc, ip
    6740:	e3a00001 	mov	r0, #1
  the_thread->Wait.queue = the_thread_queue;
  _ISR_Enable( level );
  return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
    6744:	e8bd85f0 	pop	{r4, r5, r6, r7, r8, sl, pc}
   *  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;
    6748:	e582c000 	str	ip, [r2]
  return the_thread_queue->sync_state;
    674c:	e5900030 	ldr	r0, [r0, #48]	; 0x30
}
    6750:	e8bd85f0 	pop	{r4, r5, r6, r7, r8, sl, pc}
    6754:	000170a0 	.word	0x000170a0

00013cec <_Timer_server_Body>:
 *  @a arg points to the corresponding timer server control block.
 */
static rtems_task _Timer_server_Body(
  rtems_task_argument arg
)
{
   13cec:	e92d4ff0 	push	{r4, r5, r6, r7, r8, r9, sl, fp, lr}
   13cf0:	e24dd020 	sub	sp, sp, #32
   13cf4:	e28d3014 	add	r3, sp, #20
   13cf8:	e28d5008 	add	r5, sp, #8
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
  the_chain->permanent_null = NULL;
   13cfc:	e3a09000 	mov	r9, #0
 */
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
  Chain_Control *the_chain
)
{
   return (Chain_Node *) &the_chain->permanent_null;
   13d00:	e283a004 	add	sl, r3, #4
   13d04:	e2858004 	add	r8, r5, #4
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
  the_chain->permanent_null = NULL;
  the_chain->last           = _Chain_Head(the_chain);
   13d08:	e58d301c 	str	r3, [sp, #28]

static void _Timer_server_Stop_interval_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
   13d0c:	e2802008 	add	r2, r0, #8

static void _Timer_server_Stop_tod_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
   13d10:	e2803040 	add	r3, r0, #64	; 0x40
 */
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
   13d14:	e58da014 	str	sl, [sp, #20]
  the_chain->permanent_null = NULL;
   13d18:	e58d9018 	str	r9, [sp, #24]
 */
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
   13d1c:	e58d8008 	str	r8, [sp, #8]
  the_chain->permanent_null = NULL;
   13d20:	e58d900c 	str	r9, [sp, #12]
  the_chain->last           = _Chain_Head(the_chain);
   13d24:	e58d5010 	str	r5, [sp, #16]

static void _Timer_server_Stop_interval_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
   13d28:	e58d2004 	str	r2, [sp, #4]

static void _Timer_server_Stop_tod_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
   13d2c:	e58d3000 	str	r3, [sp]
 *  @a arg points to the corresponding timer server control block.
 */
static rtems_task _Timer_server_Body(
  rtems_task_argument arg
)
{
   13d30:	e1a04000 	mov	r4, r0
   */
  Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;

  watchdogs->last_snapshot = snapshot;

  _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
   13d34:	e280b030 	add	fp, r0, #48	; 0x30
    /*
     *  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 );
   13d38:	e2807068 	add	r7, r0, #104	; 0x68
{
  /*
   *  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;
   13d3c:	e28d2014 	add	r2, sp, #20
   13d40:	e5842078 	str	r2, [r4, #120]	; 0x78
static void _Timer_server_Process_interval_watchdogs(
  Timer_server_Watchdogs *watchdogs,
  Chain_Control *fire_chain
)
{
  Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
   13d44:	e59f2168 	ldr	r2, [pc, #360]	; 13eb4 <_Timer_server_Body+0x1c8>
   13d48:	e5923000 	ldr	r3, [r2]

  /*
   *  We assume adequate unsigned arithmetic here.
   */
  Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;
   13d4c:	e594103c 	ldr	r1, [r4, #60]	; 0x3c

  watchdogs->last_snapshot = snapshot;

  _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
   13d50:	e1a02005 	mov	r2, r5
   13d54:	e0611003 	rsb	r1, r1, r3
  /*
   *  We assume adequate unsigned arithmetic here.
   */
  Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;

  watchdogs->last_snapshot = snapshot;
   13d58:	e584303c 	str	r3, [r4, #60]	; 0x3c

  _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
   13d5c:	e1a0000b 	mov	r0, fp
   13d60:	eb000fdb 	bl	17cd4 <_Watchdog_Adjust_to_chain>
static void _Timer_server_Process_tod_watchdogs(
  Timer_server_Watchdogs *watchdogs,
  Chain_Control *fire_chain
)
{
  Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
   13d64:	e59f314c 	ldr	r3, [pc, #332]	; 13eb8 <_Timer_server_Body+0x1cc>
  Watchdog_Interval last_snapshot = watchdogs->last_snapshot;
   13d68:	e5942074 	ldr	r2, [r4, #116]	; 0x74
static void _Timer_server_Process_tod_watchdogs(
  Timer_server_Watchdogs *watchdogs,
  Chain_Control *fire_chain
)
{
  Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch();
   13d6c:	e5936000 	ldr	r6, [r3]
  /*
   *  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 ) {
   13d70:	e1560002 	cmp	r6, r2
   13d74:	9a000004 	bls	13d8c <_Timer_server_Body+0xa0>
    /*
     *  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 );
   13d78:	e0621006 	rsb	r1, r2, r6
   13d7c:	e1a00007 	mov	r0, r7
   13d80:	e1a02005 	mov	r2, r5
   13d84:	eb000fd2 	bl	17cd4 <_Watchdog_Adjust_to_chain>
   13d88:	ea000003 	b	13d9c <_Timer_server_Body+0xb0>
     /*
      *  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 );
   13d8c:	30662002 	rsbcc	r2, r6, r2
   13d90:	31a00007 	movcc	r0, r7
   13d94:	33a01001 	movcc	r1, #1
   13d98:	3b000fa5 	blcc	17c34 <_Watchdog_Adjust>
  }

  watchdogs->last_snapshot = snapshot;
   13d9c:	e5846074 	str	r6, [r4, #116]	; 0x74
}

static void _Timer_server_Process_insertions( Timer_server_Control *ts )
{
  while ( true ) {
    Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain );
   13da0:	e5940078 	ldr	r0, [r4, #120]	; 0x78
   13da4:	eb000228 	bl	1464c <_Chain_Get>

    if ( timer == NULL ) {
   13da8:	e2501000 	subs	r1, r0, #0
   13dac:	0a00000a 	beq	13ddc <_Timer_server_Body+0xf0>
static void _Timer_server_Insert_timer(
  Timer_server_Control *ts,
  Timer_Control *timer
)
{
  if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
   13db0:	e5913038 	ldr	r3, [r1, #56]	; 0x38
   13db4:	e3530001 	cmp	r3, #1
    _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
   13db8:	02811010 	addeq	r1, r1, #16
   13dbc:	01a0000b 	moveq	r0, fp
static void _Timer_server_Insert_timer(
  Timer_server_Control *ts,
  Timer_Control *timer
)
{
  if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
   13dc0:	0a000003 	beq	13dd4 <_Timer_server_Body+0xe8>
    _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
  } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
   13dc4:	e3530003 	cmp	r3, #3
   13dc8:	1afffff4 	bne	13da0 <_Timer_server_Body+0xb4>
    _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
   13dcc:	e2811010 	add	r1, r1, #16
   13dd0:	e1a00007 	mov	r0, r7
   13dd4:	eb000feb 	bl	17d88 <_Watchdog_Insert>
   13dd8:	eafffff0 	b	13da0 <_Timer_server_Body+0xb4>
static inline uint32_t arm_interrupt_disable( void )
{
  uint32_t arm_switch_reg;
  uint32_t level;

  asm volatile (
   13ddc:	e10f3000 	mrs	r3, CPSR
   13de0:	e3832080 	orr	r2, r3, #128	; 0x80
   13de4:	e129f002 	msr	CPSR_fc, r2
     *  body loop.
     */
    _Timer_server_Process_insertions( ts );

    _ISR_Disable( level );
    if ( _Chain_Is_empty( insert_chain ) ) {
   13de8:	e59d2014 	ldr	r2, [sp, #20]
   13dec:	e152000a 	cmp	r2, sl
   13df0:	1a000005 	bne	13e0c <_Timer_server_Body+0x120>
      ts->insert_chain = NULL;
   13df4:	e5841078 	str	r1, [r4, #120]	; 0x78

static inline void arm_interrupt_enable( uint32_t level )
{
  ARM_SWITCH_REGISTERS;

  asm volatile (
   13df8:	e129f003 	msr	CPSR_fc, r3
  _Chain_Initialize_empty( &fire_chain );

  while ( true ) {
    _Timer_server_Get_watchdogs_that_fire_now( ts, &insert_chain, &fire_chain );

    if ( !_Chain_Is_empty( &fire_chain ) ) {
   13dfc:	e59d3008 	ldr	r3, [sp, #8]
   13e00:	e1530008 	cmp	r3, r8
   13e04:	1a000002 	bne	13e14 <_Timer_server_Body+0x128>
   13e08:	ea000015 	b	13e64 <_Timer_server_Body+0x178>
   13e0c:	e129f003 	msr	CPSR_fc, r3                                         	<== NOT EXECUTED
   13e10:	eaffffcb 	b	13d44 <_Timer_server_Body+0x58>                       	<== NOT EXECUTED
static inline uint32_t arm_interrupt_disable( void )
{
  uint32_t arm_switch_reg;
  uint32_t level;

  asm volatile (
   13e14:	e10f2000 	mrs	r2, CPSR
   13e18:	e3823080 	orr	r3, r2, #128	; 0x80
   13e1c:	e129f003 	msr	CPSR_fc, r3
 */
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
  Chain_Control *the_chain
)
{
  return (the_chain->first == _Chain_Tail(the_chain));
   13e20:	e59d3008 	ldr	r3, [sp, #8]
 */
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected(
  Chain_Control *the_chain
)
{
  if ( !_Chain_Is_empty(the_chain))
   13e24:	e1530008 	cmp	r3, r8
   13e28:	0a00000b 	beq	13e5c <_Timer_server_Body+0x170>
{
  Chain_Node  *return_node;
  Chain_Node  *new_first;

  return_node         = the_chain->first;
  new_first           = return_node->next;
   13e2c:	e5931000 	ldr	r1, [r3]
         *  It is essential that interrupts are disable here since an interrupt
         *  service routine may remove a watchdog from the chain.
         */
        _ISR_Disable( level );
        watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain );
        if ( watchdog != NULL ) {
   13e30:	e3530000 	cmp	r3, #0
  the_chain->first    = new_first;
   13e34:	e58d1008 	str	r1, [sp, #8]
  new_first->previous = _Chain_Head(the_chain);
   13e38:	e5815004 	str	r5, [r1, #4]
   13e3c:	0a000006 	beq	13e5c <_Timer_server_Body+0x170>
          watchdog->state = WATCHDOG_INACTIVE;
   13e40:	e5839008 	str	r9, [r3, #8]

static inline void arm_interrupt_enable( uint32_t level )
{
  ARM_SWITCH_REGISTERS;

  asm volatile (
   13e44:	e129f002 	msr	CPSR_fc, r2
        /*
         *  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 );
   13e48:	e2830020 	add	r0, r3, #32
   13e4c:	e8900003 	ldm	r0, {r0, r1}
   13e50:	e1a0e00f 	mov	lr, pc
   13e54:	e593f01c 	ldr	pc, [r3, #28]
      }
   13e58:	eaffffed 	b	13e14 <_Timer_server_Body+0x128>
   13e5c:	e129f002 	msr	CPSR_fc, r2
   13e60:	eaffffb5 	b	13d3c <_Timer_server_Body+0x50>
    } else {
      ts->active = false;
   13e64:	e5c4907c 	strb	r9, [r4, #124]	; 0x7c
   13e68:	e59f304c 	ldr	r3, [pc, #76]	; 13ebc <_Timer_server_Body+0x1d0>
   13e6c:	e5932000 	ldr	r2, [r3]
   13e70:	e2822001 	add	r2, r2, #1
   13e74:	e5832000 	str	r2, [r3]

      /*
       *  Block until there is something to do.
       */
      _Thread_Disable_dispatch();
        _Thread_Set_state( ts->thread, STATES_DELAYING );
   13e78:	e3a01008 	mov	r1, #8
   13e7c:	e5940000 	ldr	r0, [r4]
   13e80:	eb000d20 	bl	17308 <_Thread_Set_state>
        _Timer_server_Reset_interval_system_watchdog( ts );
   13e84:	e1a00004 	mov	r0, r4
   13e88:	ebffff6b 	bl	13c3c <_Timer_server_Reset_interval_system_watchdog>
        _Timer_server_Reset_tod_system_watchdog( ts );
   13e8c:	e1a00004 	mov	r0, r4
   13e90:	ebffff7f 	bl	13c94 <_Timer_server_Reset_tod_system_watchdog>
      _Thread_Enable_dispatch();
   13e94:	eb000a8c 	bl	168cc <_Thread_Enable_dispatch>

      ts->active = true;
   13e98:	e3a03001 	mov	r3, #1
   13e9c:	e5c4307c 	strb	r3, [r4, #124]	; 0x7c

static void _Timer_server_Stop_interval_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog );
   13ea0:	e59d0004 	ldr	r0, [sp, #4]
   13ea4:	eb001010 	bl	17eec <_Watchdog_Remove>

static void _Timer_server_Stop_tod_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
   13ea8:	e59d0000 	ldr	r0, [sp]
   13eac:	eb00100e 	bl	17eec <_Watchdog_Remove>
   13eb0:	eaffffa1 	b	13d3c <_Timer_server_Body+0x50>
   13eb4:	00037c44 	.word	0x00037c44
   13eb8:	00037b74 	.word	0x00037b74
   13ebc:	00037aec 	.word	0x00037aec