a0014624 <_CORE_message_queue_Broadcast>:
{
  Thread_Control          *the_thread;
  uint32_t                 number_broadcasted;
  Thread_Wait_information *waitp;

  if ( size > the_message_queue->maximum_message_size ) {
a0014624:	e590304c 	ldr	r3, [r0, #76]	; 0x4c
    Objects_Id                                 id __attribute__((unused)),
    CORE_message_queue_API_mp_support_callout  api_message_queue_mp_support __attribute__((unused)),
  #endif
  uint32_t                                  *count
)
{
a0014628:	e92d45f0 	push	{r4, r5, r6, r7, r8, sl, lr}
  Thread_Control          *the_thread;
  uint32_t                 number_broadcasted;
  Thread_Wait_information *waitp;

  if ( size > the_message_queue->maximum_message_size ) {
a001462c:	e1520003 	cmp	r2, r3
    Objects_Id                                 id __attribute__((unused)),
    CORE_message_queue_API_mp_support_callout  api_message_queue_mp_support __attribute__((unused)),
  #endif
  uint32_t                                  *count
)
{
a0014630:	e1a06000 	mov	r6, r0
a0014634:	e1a07002 	mov	r7, r2
a0014638:	e1a0a001 	mov	sl, r1
a001463c:	e59d8020 	ldr	r8, [sp, #32]
  Thread_Control          *the_thread;
  uint32_t                 number_broadcasted;
  Thread_Wait_information *waitp;

  if ( size > the_message_queue->maximum_message_size ) {
a0014640:	9a000001 	bls	a001464c <_CORE_message_queue_Broadcast+0x28>
a0014644:	e3a00001 	mov	r0, #1                                              	<== NOT EXECUTED
a0014648:	e8bd85f0 	pop	{r4, r5, r6, r7, r8, sl, pc}                        	<== 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 ) {
a001464c:	e5905048 	ldr	r5, [r0, #72]	; 0x48
a0014650:	e3550000 	cmp	r5, #0
a0014654:	0a000009 	beq	a0014680 <_CORE_message_queue_Broadcast+0x5c>
    *count = 0;
a0014658:	e3a00000 	mov	r0, #0
a001465c:	e5880000 	str	r0, [r8]
    return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
a0014660:	e8bd85f0 	pop	{r4, r5, r6, r7, r8, sl, pc}
  const void *source,
  void       *destination,
  size_t      size
)
{
  memcpy(destination, source, size);
a0014664:	e594002c 	ldr	r0, [r4, #44]	; 0x2c
a0014668:	e1a0100a 	mov	r1, sl
a001466c:	e1a02007 	mov	r2, r7
a0014670:	eb001fb8 	bl	a001c558 <memcpy>
      buffer,
      waitp->return_argument_second.mutable_object,
      size
    );

    *(size_t *) the_thread->Wait.return_argument = size;
a0014674:	e5943028 	ldr	r3, [r4, #40]	; 0x28
   */
  number_broadcasted = 0;
  while ((the_thread =
          _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) {
    waitp = &the_thread->Wait;
    number_broadcasted += 1;
a0014678:	e2855001 	add	r5, r5, #1
      buffer,
      waitp->return_argument_second.mutable_object,
      size
    );

    *(size_t *) the_thread->Wait.return_argument = size;
a001467c:	e5837000 	str	r7, [r3]
   *  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))) {
a0014680:	e1a00006 	mov	r0, r6
a0014684:	eb00096f 	bl	a0016c48 <_Thread_queue_Dequeue>
  /*
   *  There must be no pending messages if there is a thread waiting to
   *  receive a message.
   */
  number_broadcasted = 0;
  while ((the_thread =
a0014688:	e2504000 	subs	r4, r0, #0
a001468c:	1afffff4 	bne	a0014664 <_CORE_message_queue_Broadcast+0x40>
      if ( !_Objects_Is_local_id( the_thread->Object.id ) )
        (*api_message_queue_mp_support) ( the_thread, id );
    #endif

  }
  *count = number_broadcasted;
a0014690:	e5885000 	str	r5, [r8]
a0014694:	e1a00004 	mov	r0, r4
  return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL;
}
a0014698:	e8bd85f0 	pop	{r4, r5, r6, r7, r8, sl, pc}

a0009264 <_CORE_mutex_Seize_interrupt_trylock>:
{
  Thread_Control   *executing;

  /* disabled when you get here */

  executing = _Thread_Executing;
a0009264:	e59f2120 	ldr	r2, [pc, #288]	; a000938c <_CORE_mutex_Seize_interrupt_trylock+0x128>
  executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
a0009268:	e3a03000 	mov	r3, #0
#if defined(__RTEMS_DO_NOT_INLINE_CORE_MUTEX_SEIZE__)
int _CORE_mutex_Seize_interrupt_trylock(
  CORE_mutex_Control  *the_mutex,
  ISR_Level           *level_p
)
{
a000926c:	e52de004 	push	{lr}		; (str lr, [sp, #-4]!)
{
  Thread_Control   *executing;

  /* disabled when you get here */

  executing = _Thread_Executing;
a0009270:	e5922000 	ldr	r2, [r2]
  executing->Wait.return_code = CORE_MUTEX_STATUS_SUCCESSFUL;
a0009274:	e5823034 	str	r3, [r2, #52]	; 0x34
  if ( !_CORE_mutex_Is_locked( the_mutex ) ) {
a0009278:	e590c050 	ldr	ip, [r0, #80]	; 0x50
a000927c:	e15c0003 	cmp	ip, r3
a0009280:	0a00002c 	beq	a0009338 <_CORE_mutex_Seize_interrupt_trylock+0xd4>
    the_mutex->lock       = CORE_MUTEX_LOCKED;
a0009284:	e5803050 	str	r3, [r0, #80]	; 0x50
    the_mutex->holder     = executing;
    the_mutex->holder_id  = executing->Object.id;
a0009288:	e592c008 	ldr	ip, [r2, #8]
 */
RTEMS_INLINE_ROUTINE bool _CORE_mutex_Is_inherit_priority(
  CORE_mutex_Attributes *the_attribute
)
{
  return the_attribute->discipline == CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT;
a000928c:	e5903048 	ldr	r3, [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;
a0009290:	e580205c 	str	r2, [r0, #92]	; 0x5c
    the_mutex->holder_id  = executing->Object.id;
a0009294:	e580c060 	str	ip, [r0, #96]	; 0x60
    the_mutex->nest_count = 1;
    if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
a0009298:	e3530002 	cmp	r3, #2
  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;
    the_mutex->nest_count = 1;
a000929c:	e3a0c001 	mov	ip, #1
a00092a0:	e580c054 	str	ip, [r0, #84]	; 0x54
    if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) ||
a00092a4:	0a000001 	beq	a00092b0 <_CORE_mutex_Seize_interrupt_trylock+0x4c>
a00092a8:	e3530003 	cmp	r3, #3
a00092ac:	1a000004 	bne	a00092c4 <_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++;
a00092b0:	e592c01c 	ldr	ip, [r2, #28]
    }

    if ( !_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
a00092b4:	e3530003 	cmp	r3, #3
       _Chain_Prepend_unprotected( &executing->lock_mutex,
                                   &the_mutex->queue.lock_queue );
       the_mutex->queue.priority_before = executing->current_priority;
#endif

      executing->resource_count++;
a00092b8:	e28c3001 	add	r3, ip, #1
a00092bc:	e582301c 	str	r3, [r2, #28]
    }

    if ( !_CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) {
a00092c0:	0a000000 	beq	a00092c8 <_CORE_mutex_Seize_interrupt_trylock+0x64>
      _ISR_Enable( *level_p );
a00092c4:	ea00002a 	b	a0009374 <_CORE_mutex_Seize_interrupt_trylock+0x110>
       */
    {
      Priority_Control  ceiling;
      Priority_Control  current;

      ceiling = the_mutex->Attributes.priority_ceiling;
a00092c8:	e590304c 	ldr	r3, [r0, #76]	; 0x4c
      current = executing->current_priority;
a00092cc:	e592c014 	ldr	ip, [r2, #20]
      if ( current == ceiling ) {
a00092d0:	e15c0003 	cmp	ip, r3
a00092d4:	1a000000 	bne	a00092dc <_CORE_mutex_Seize_interrupt_trylock+0x78>
        _ISR_Enable( *level_p );
a00092d8:	ea000025 	b	a0009374 <_CORE_mutex_Seize_interrupt_trylock+0x110>
        return 0;
      }

      if ( current > ceiling ) {
a00092dc:	9a00000b 	bls	a0009310 <_CORE_mutex_Seize_interrupt_trylock+0xac>
	rtems_fatal_error_occurred( 99 );
      }
    }
  #endif

  _Thread_Dispatch_disable_level += 1;
a00092e0:	e59f30a8 	ldr	r3, [pc, #168]	; a0009390 <_CORE_mutex_Seize_interrupt_trylock+0x12c>
a00092e4:	e5932000 	ldr	r2, [r3]
a00092e8:	e2822001 	add	r2, r2, #1
a00092ec:	e5832000 	str	r2, [r3]
a00092f0:	e5913000 	ldr	r3, [r1]
a00092f4:	e129f003 	msr	CPSR_fc, r3
        _Thread_Disable_dispatch();
        _ISR_Enable( *level_p );
        _Thread_Change_priority(
a00092f8:	e3a02000 	mov	r2, #0
a00092fc:	e590104c 	ldr	r1, [r0, #76]	; 0x4c
a0009300:	e590005c 	ldr	r0, [r0, #92]	; 0x5c
a0009304:	ebfff1d2 	bl	a0005a54 <_Thread_Change_priority>
          the_mutex->holder,
          the_mutex->Attributes.priority_ceiling,
         false
        );
        _Thread_Enable_dispatch();
a0009308:	ebfff335 	bl	a0005fe4 <_Thread_Enable_dispatch>
a000930c:	ea00001a 	b	a000937c <_CORE_mutex_Seize_interrupt_trylock+0x118>
        return 0;
      }
      /* if ( current < ceiling ) */ {
        executing->Wait.return_code = CORE_MUTEX_STATUS_CEILING_VIOLATED;
a0009310:	e3a03006 	mov	r3, #6
a0009314:	e5823034 	str	r3, [r2, #52]	; 0x34
        the_mutex->lock       = CORE_MUTEX_UNLOCKED;
        the_mutex->nest_count = 0;     /* undo locking above */
a0009318:	e3a03000 	mov	r3, #0
a000931c:	e5803054 	str	r3, [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;
a0009320:	e2833001 	add	r3, r3, #1
a0009324:	e5803050 	str	r3, [r0, #80]	; 0x50
        the_mutex->nest_count = 0;     /* undo locking above */
        executing->resource_count--;   /* undo locking above */
a0009328:	e592301c 	ldr	r3, [r2, #28]
a000932c:	e2433001 	sub	r3, r3, #1
a0009330:	e582301c 	str	r3, [r2, #28]
        _ISR_Enable( *level_p );
a0009334:	ea00000e 	b	a0009374 <_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 ) ) {
a0009338:	e590305c 	ldr	r3, [r0, #92]	; 0x5c
a000933c:	e1530002 	cmp	r3, r2
a0009340:	1a00000f 	bne	a0009384 <_CORE_mutex_Seize_interrupt_trylock+0x120>
    switch ( the_mutex->Attributes.lock_nesting_behavior ) {
a0009344:	e5902040 	ldr	r2, [r0, #64]	; 0x40
a0009348:	e3520000 	cmp	r2, #0
a000934c:	0a000002 	beq	a000935c <_CORE_mutex_Seize_interrupt_trylock+0xf8>
a0009350:	e3520001 	cmp	r2, #1
a0009354:	1a00000a 	bne	a0009384 <_CORE_mutex_Seize_interrupt_trylock+0x120>
a0009358:	ea000003 	b	a000936c <_CORE_mutex_Seize_interrupt_trylock+0x108>  	<== NOT EXECUTED
      case CORE_MUTEX_NESTING_ACQUIRES:
        the_mutex->nest_count++;
a000935c:	e5903054 	ldr	r3, [r0, #84]	; 0x54
a0009360:	e2833001 	add	r3, r3, #1
a0009364:	e5803054 	str	r3, [r0, #84]	; 0x54
        _ISR_Enable( *level_p );
a0009368:	ea000001 	b	a0009374 <_CORE_mutex_Seize_interrupt_trylock+0x110>
        return 0;
      case CORE_MUTEX_NESTING_IS_ERROR:
        executing->Wait.return_code = CORE_MUTEX_STATUS_NESTING_NOT_ALLOWED;
a000936c:	e3a02002 	mov	r2, #2                                              	<== NOT EXECUTED
a0009370:	e5832034 	str	r2, [r3, #52]	; 0x34                                	<== NOT EXECUTED
a0009374:	e5913000 	ldr	r3, [r1]
a0009378:	e129f003 	msr	CPSR_fc, r3
a000937c:	e3a00000 	mov	r0, #0
a0009380:	e49df004 	pop	{pc}		; (ldr pc, [sp], #4)
a0009384:	e3a00001 	mov	r0, #1
  return _CORE_mutex_Seize_interrupt_trylock_body( the_mutex, level_p );
}
a0009388:	e49df004 	pop	{pc}		; (ldr pc, [sp], #4)
a000938c:	a0018760 	.word	0xa0018760
a0009390:	a00186ac 	.word	0xa00186ac

a000e4dc <_Heap_Extend>:
  Heap_Control *heap,
  void *area_begin_ptr,
  uintptr_t area_size,
  uintptr_t *amount_extended
)
{
a000e4dc:	e92d41f0 	push	{r4, r5, r6, r7, r8, lr}
a000e4e0:	e1a04000 	mov	r4, r0
  Heap_Statistics *const stats = &heap->stats;
  uintptr_t const area_begin = (uintptr_t) area_begin_ptr;
  uintptr_t const heap_area_begin = heap->area_begin;
a000e4e4:	e594c018 	ldr	ip, [r4, #24]
  uintptr_t const heap_area_end = heap->area_end;
a000e4e8:	e590001c 	ldr	r0, [r0, #28]
  Heap_Control *heap,
  void *area_begin_ptr,
  uintptr_t area_size,
  uintptr_t *amount_extended
)
{
a000e4ec:	e1a08003 	mov	r8, r3
  uintptr_t const area_begin = (uintptr_t) area_begin_ptr;
  uintptr_t const heap_area_begin = heap->area_begin;
  uintptr_t const heap_area_end = heap->area_end;
  uintptr_t const new_heap_area_end = heap_area_end + area_size;
  uintptr_t extend_size = 0;
  Heap_Block *const last_block = heap->last_block;
a000e4f0:	e5946024 	ldr	r6, [r4, #36]	; 0x24
  uintptr_t *amount_extended
)
{
  Heap_Statistics *const stats = &heap->stats;
  uintptr_t const area_begin = (uintptr_t) area_begin_ptr;
  uintptr_t const heap_area_begin = heap->area_begin;
a000e4f4:	e1510000 	cmp	r1, r0
a000e4f8:	23a05000 	movcs	r5, #0
a000e4fc:	33a05001 	movcc	r5, #1
a000e500:	e151000c 	cmp	r1, ip
a000e504:	33a05000 	movcc	r5, #0
a000e508:	e3550000 	cmp	r5, #0
a000e50c:	0a000001 	beq	a000e518 <_Heap_Extend+0x3c>
a000e510:	e3a00001 	mov	r0, #1
a000e514:	e8bd81f0 	pop	{r4, r5, r6, r7, r8, pc}
   *  As noted, this code only supports (4).
   */

  if ( area_begin >= heap_area_begin && area_begin < heap_area_end ) {
    return HEAP_EXTEND_ERROR; /* case 3 */
  } else if ( area_begin != heap_area_end ) {
a000e518:	e1510000 	cmp	r1, r0
a000e51c:	0a000001 	beq	a000e528 <_Heap_Extend+0x4c>
a000e520:	e3a00002 	mov	r0, #2
a000e524:	e8bd81f0 	pop	{r4, r5, r6, r7, r8, pc}
   *  block and free it.
   */

  heap->area_end = new_heap_area_end;

  extend_size = new_heap_area_end
a000e528:	e3e07007 	mvn	r7, #7
{
  Heap_Statistics *const stats = &heap->stats;
  uintptr_t const area_begin = (uintptr_t) area_begin_ptr;
  uintptr_t const heap_area_begin = heap->area_begin;
  uintptr_t const heap_area_end = heap->area_end;
  uintptr_t const new_heap_area_end = heap_area_end + area_size;
a000e52c:	e0821001 	add	r1, r2, r1
   *  block and free it.
   */

  heap->area_end = new_heap_area_end;

  extend_size = new_heap_area_end
a000e530:	e0667007 	rsb	r7, r6, r7
a000e534:	e0877001 	add	r7, r7, r1
   *  Currently only case 4 should make it to this point.
   *  The basic trick is to make the extend area look like a used
   *  block and free it.
   */

  heap->area_end = new_heap_area_end;
a000e538:	e584101c 	str	r1, [r4, #28]
RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down(
  uintptr_t value,
  uintptr_t alignment
)
{
  return value - (value % alignment);
a000e53c:	e1a00007 	mov	r0, r7
a000e540:	e5941010 	ldr	r1, [r4, #16]
a000e544:	ebffd297 	bl	a0002fa8 <__umodsi3>
a000e548:	e0600007 	rsb	r0, r0, r7

  extend_size = new_heap_area_end
    - (uintptr_t) last_block - HEAP_BLOCK_HEADER_SIZE;
  extend_size = _Heap_Align_down( extend_size, heap->page_size );

  *amount_extended = extend_size;
a000e54c:	e5880000 	str	r0, [r8]

  if( extend_size >= heap->min_block_size ) {
a000e550:	e5943014 	ldr	r3, [r4, #20]
a000e554:	e1500003 	cmp	r0, r3
a000e558:	2a000001 	bcs	a000e564 <_Heap_Extend+0x88>
a000e55c:	e1a00005 	mov	r0, r5                                              	<== NOT EXECUTED
a000e560:	e8bd81f0 	pop	{r4, r5, r6, r7, r8, pc}                            	<== NOT EXECUTED
  uintptr_t size
)
{
  uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;

  block->size_and_flag = size | flag;
a000e564:	e5961004 	ldr	r1, [r6, #4]
    Heap_Block *const new_last_block = _Heap_Block_at( last_block, extend_size );

    _Heap_Block_set_size( last_block, extend_size );

    new_last_block->size_and_flag =
a000e568:	e5942020 	ldr	r2, [r4, #32]
RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at(
  const Heap_Block *block,
  uintptr_t offset
)
{
  return (Heap_Block *) ((uintptr_t) block + offset);
a000e56c:	e0803006 	add	r3, r0, r6
  uintptr_t size
)
{
  uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED;

  block->size_and_flag = size | flag;
a000e570:	e2011001 	and	r1, r1, #1
a000e574:	e0632002 	rsb	r2, r3, r2
a000e578:	e1801001 	orr	r1, r0, r1
a000e57c:	e3822001 	orr	r2, r2, #1
a000e580:	e5861004 	str	r1, [r6, #4]
a000e584:	e5832004 	str	r2, [r3, #4]
        | HEAP_PREV_BLOCK_USED;

    heap->last_block = new_last_block;

    /* Statistics */
    stats->size += extend_size;
a000e588:	e594702c 	ldr	r7, [r4, #44]	; 0x2c
    ++stats->used_blocks;
a000e58c:	e5941040 	ldr	r1, [r4, #64]	; 0x40
    --stats->frees; /* Do not count subsequent call as actual free() */
a000e590:	e5942050 	ldr	r2, [r4, #80]	; 0x50
        | HEAP_PREV_BLOCK_USED;

    heap->last_block = new_last_block;

    /* Statistics */
    stats->size += extend_size;
a000e594:	e0870000 	add	r0, r7, r0
    ++stats->used_blocks;
a000e598:	e2811001 	add	r1, r1, #1
    --stats->frees; /* Do not count subsequent call as actual free() */
a000e59c:	e2422001 	sub	r2, r2, #1
        | HEAP_PREV_BLOCK_USED;

    heap->last_block = new_last_block;

    /* Statistics */
    stats->size += extend_size;
a000e5a0:	e584002c 	str	r0, [r4, #44]	; 0x2c
    ++stats->used_blocks;
a000e5a4:	e5841040 	str	r1, [r4, #64]	; 0x40

    new_last_block->size_and_flag =
      ((uintptr_t) heap->first_block - (uintptr_t) new_last_block)
        | HEAP_PREV_BLOCK_USED;

    heap->last_block = new_last_block;
a000e5a8:	e5843024 	str	r3, [r4, #36]	; 0x24

    /* Statistics */
    stats->size += extend_size;
    ++stats->used_blocks;
    --stats->frees; /* Do not count subsequent call as actual free() */
a000e5ac:	e5842050 	str	r2, [r4, #80]	; 0x50

    _Heap_Free( heap, (void *) _Heap_Alloc_area_of_block( last_block ));
a000e5b0:	e1a00004 	mov	r0, r4
a000e5b4:	e2861008 	add	r1, r6, #8
a000e5b8:	ebffec1c 	bl	a0009630 <_Heap_Free>
a000e5bc:	e1a00005 	mov	r0, r5
  }

  return HEAP_EXTEND_SUCCESSFUL;
}
a000e5c0:	e8bd81f0 	pop	{r4, r5, r6, r7, r8, pc}

a0006554 <_Thread_queue_Enqueue_priority>:
  Priority_Control     priority;
  States_Control       block_state;

  _Chain_Initialize_empty( &the_thread->Wait.Block2n );

  priority     = the_thread->current_priority;
a0006554:	e5913014 	ldr	r3, [r1, #20]
Thread_blocking_operation_States _Thread_queue_Enqueue_priority (
  Thread_queue_Control *the_thread_queue,
  Thread_Control       *the_thread,
  ISR_Level            *level_p
)
{
a0006558:	e92d45f0 	push	{r4, r5, r6, r7, r8, sl, lr}
 */
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
a000655c:	e281503c 	add	r5, r1, #60	; 0x3c
a0006560:	e5815038 	str	r5, [r1, #56]	; 0x38
  the_chain->permanent_null = NULL;
a0006564:	e3a05000 	mov	r5, #0
  the_chain->last           = _Chain_Head(the_chain);
a0006568:	e281c038 	add	ip, r1, #56	; 0x38
  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 ) )
a000656c:	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 ];
a0006570:	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;
a0006574:	e581503c 	str	r5, [r1, #60]	; 0x3c
a0006578:	e285500c 	add	r5, r5, #12
  the_chain->last           = _Chain_Head(the_chain);
a000657c:	e581c040 	str	ip, [r1, #64]	; 0x40
  block_state  = the_thread_queue->state;
a0006580:	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 ];
a0006584:	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;
a0006588:	159f8158 	ldrne	r8, [pc, #344]	; a00066e8 <_Thread_queue_Enqueue_priority+0x194>
  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 ) )
a000658c:	1a000023 	bne	a0006620 <_Thread_queue_Enqueue_priority+0xcc>
 */
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
  Chain_Control *the_chain
)
{
   return (Chain_Node *) &the_chain->permanent_null;
a0006590:	e28c8004 	add	r8, ip, #4
static inline uint32_t arm_interrupt_disable( void )
{
  uint32_t arm_switch_reg;
  uint32_t level;

  asm volatile (
a0006594:	e10f5000 	mrs	r5, CPSR
a0006598:	e3854080 	orr	r4, r5, #128	; 0x80
a000659c:	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;
a00065a0:	e3e06000 	mvn	r6, #0
a00065a4:	e59c4000 	ldr	r4, [ip]
  while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) {
a00065a8:	ea00000b 	b	a00065dc <_Thread_queue_Enqueue_priority+0x88>
    search_priority = search_thread->current_priority;
a00065ac:	e5946014 	ldr	r6, [r4, #20]
    if ( priority <= search_priority )
a00065b0:	e1530006 	cmp	r3, r6
a00065b4:	9a00000a 	bls	a00065e4 <_Thread_queue_Enqueue_priority+0x90>

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

  asm volatile (
a00065b8:	e10fa000 	mrs	sl, CPSR
a00065bc:	e129f005 	msr	CPSR_fc, r5
a00065c0:	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) ) {
a00065c4:	e594a010 	ldr	sl, [r4, #16]
a00065c8:	e117000a 	tst	r7, sl
a00065cc:	1a000001 	bne	a00065d8 <_Thread_queue_Enqueue_priority+0x84>

static inline void arm_interrupt_enable( uint32_t level )
{
  ARM_SWITCH_REGISTERS;

  asm volatile (
a00065d0:	e129f005 	msr	CPSR_fc, r5                                         	<== NOT EXECUTED
a00065d4:	eaffffee 	b	a0006594 <_Thread_queue_Enqueue_priority+0x40>        	<== NOT EXECUTED
      _ISR_Enable( level );
      goto restart_forward_search;
    }
    search_thread =
       (Thread_Control *)search_thread->Object.Node.next;
a00065d8:	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 ) ) {
a00065dc:	e1540008 	cmp	r4, r8
a00065e0:	1afffff1 	bne	a00065ac <_Thread_queue_Enqueue_priority+0x58>
    }
    search_thread =
       (Thread_Control *)search_thread->Object.Node.next;
  }

  if ( the_thread_queue->sync_state !=
a00065e4:	e5907030 	ldr	r7, [r0, #48]	; 0x30

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

  if ( the_thread_queue->sync_state !=
a00065ec:	e3570001 	cmp	r7, #1
a00065f0:	1a000039 	bne	a00066dc <_Thread_queue_Enqueue_priority+0x188>
       THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
    goto synchronize;

  the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;

  if ( priority == search_priority )
a00065f4:	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;
a00065f8:	e3a03000 	mov	r3, #0
a00065fc:	e5803030 	str	r3, [r0, #48]	; 0x30

  if ( priority == search_priority )
a0006600:	0a00002b 	beq	a00066b4 <_Thread_queue_Enqueue_priority+0x160>
    goto equal_priority;

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

  the_node->next         = search_node;
a0006608:	e5814000 	str	r4, [r1]
  the_node->previous     = previous_node;
  previous_node->next    = the_node;
  search_node->previous  = the_node;
  the_thread->Wait.queue = the_thread_queue;
a000660c:	e5810044 	str	r0, [r1, #68]	; 0x44
  search_node   = (Chain_Node *) search_thread;
  previous_node = search_node->previous;
  the_node      = (Chain_Node *) the_thread;

  the_node->next         = search_node;
  the_node->previous     = previous_node;
a0006610:	e5813004 	str	r3, [r1, #4]
  previous_node->next    = the_node;
a0006614:	e5831000 	str	r1, [r3]
  search_node->previous  = the_node;
a0006618:	e5841004 	str	r1, [r4, #4]
  the_thread->Wait.queue = the_thread_queue;
  _ISR_Enable( level );
a000661c:	ea000022 	b	a00066ac <_Thread_queue_Enqueue_priority+0x158>
  return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;

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

  asm volatile (
a0006628:	e10f5000 	mrs	r5, CPSR
a000662c:	e3854080 	orr	r4, r5, #128	; 0x80
a0006630:	e129f004 	msr	CPSR_fc, r4

  _ISR_Disable( level );
  search_thread = (Thread_Control *) header->last;
a0006634:	e59c4008 	ldr	r4, [ip, #8]
  while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) {
a0006638:	ea00000b 	b	a000666c <_Thread_queue_Enqueue_priority+0x118>
    search_priority = search_thread->current_priority;
a000663c:	e5946014 	ldr	r6, [r4, #20]
    if ( priority >= search_priority )
a0006640:	e1530006 	cmp	r3, r6
a0006644:	2a00000a 	bcs	a0006674 <_Thread_queue_Enqueue_priority+0x120>

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

  asm volatile (
a0006648:	e10fa000 	mrs	sl, CPSR
a000664c:	e129f005 	msr	CPSR_fc, r5
a0006650:	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) ) {
a0006654:	e594a010 	ldr	sl, [r4, #16]
a0006658:	e117000a 	tst	r7, sl
a000665c:	1a000001 	bne	a0006668 <_Thread_queue_Enqueue_priority+0x114>

static inline void arm_interrupt_enable( uint32_t level )
{
  ARM_SWITCH_REGISTERS;

  asm volatile (
a0006660:	e129f005 	msr	CPSR_fc, r5                                         	<== NOT EXECUTED
a0006664:	eaffffed 	b	a0006620 <_Thread_queue_Enqueue_priority+0xcc>        	<== NOT EXECUTED
      _ISR_Enable( level );
      goto restart_reverse_search;
    }
    search_thread = (Thread_Control *)
a0006668:	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 ) ) {
a000666c:	e154000c 	cmp	r4, ip
a0006670:	1afffff1 	bne	a000663c <_Thread_queue_Enqueue_priority+0xe8>
    }
    search_thread = (Thread_Control *)
                         search_thread->Object.Node.previous;
  }

  if ( the_thread_queue->sync_state !=
a0006674:	e5907030 	ldr	r7, [r0, #48]	; 0x30
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 ) ) {
a0006678:	e1a0c005 	mov	ip, r5
    }
    search_thread = (Thread_Control *)
                         search_thread->Object.Node.previous;
  }

  if ( the_thread_queue->sync_state !=
a000667c:	e3570001 	cmp	r7, #1
a0006680:	1a000015 	bne	a00066dc <_Thread_queue_Enqueue_priority+0x188>
       THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED )
    goto synchronize;

  the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED;

  if ( priority == search_priority )
a0006684:	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;
a0006688:	e3a03000 	mov	r3, #0
a000668c:	e5803030 	str	r3, [r0, #48]	; 0x30

  if ( priority == search_priority )
a0006690:	0a000007 	beq	a00066b4 <_Thread_queue_Enqueue_priority+0x160>
    goto equal_priority;

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

  the_node->next          = next_node;
  the_node->previous      = search_node;
a0006698:	e5814004 	str	r4, [r1, #4]
  search_node->next       = the_node;
  next_node->previous    = the_node;
  the_thread->Wait.queue = the_thread_queue;
a000669c:	e5810044 	str	r0, [r1, #68]	; 0x44

  search_node = (Chain_Node *) search_thread;
  next_node   = search_node->next;
  the_node    = (Chain_Node *) the_thread;

  the_node->next          = next_node;
a00066a0:	e5813000 	str	r3, [r1]
  the_node->previous      = search_node;
  search_node->next       = the_node;
  next_node->previous    = the_node;
a00066a4:	e5831004 	str	r1, [r3, #4]
  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;
a00066a8:	e5841000 	str	r1, [r4]
a00066ac:	e129f005 	msr	CPSR_fc, r5
a00066b0:	ea000007 	b	a00066d4 <_Thread_queue_Enqueue_priority+0x180>
a00066b4:	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;
a00066b8:	e5943004 	ldr	r3, [r4, #4]
  the_node      = (Chain_Node *) the_thread;

  the_node->next         = search_node;
a00066bc:	e5814000 	str	r4, [r1]
  the_node->previous     = previous_node;
  previous_node->next    = the_node;
  search_node->previous  = the_node;
  the_thread->Wait.queue = the_thread_queue;
a00066c0:	e5810044 	str	r0, [r1, #68]	; 0x44
  search_node   = _Chain_Tail( &search_thread->Wait.Block2n );
  previous_node = search_node->previous;
  the_node      = (Chain_Node *) the_thread;

  the_node->next         = search_node;
  the_node->previous     = previous_node;
a00066c4:	e5813004 	str	r3, [r1, #4]
  previous_node->next    = the_node;
a00066c8:	e5831000 	str	r1, [r3]
  search_node->previous  = the_node;
a00066cc:	e5841004 	str	r1, [r4, #4]
a00066d0:	e129f00c 	msr	CPSR_fc, ip
a00066d4:	e3a00001 	mov	r0, #1
  the_thread->Wait.queue = the_thread_queue;
  _ISR_Enable( level );
  return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED;
a00066d8:	e8bd85f0 	pop	{r4, r5, r6, r7, r8, sl, pc}
   *  the mutex by an ISR or timed out.
   *
   *  WARNING! Returning with interrupts disabled!
   */
  *level_p = level;
  return the_thread_queue->sync_state;
a00066dc:	e5900030 	ldr	r0, [r0, #48]	; 0x30
   *  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;
a00066e0:	e582c000 	str	ip, [r2]
  return the_thread_queue->sync_state;
}
a00066e4:	e8bd85f0 	pop	{r4, r5, r6, r7, r8, sl, pc}
a00066e8:	a0016f20 	.word	0xa0016f20

a0013c40 <_Timer_server_Body>:
 *  @a arg points to the corresponding timer server control block.
 */
static rtems_task _Timer_server_Body(
  rtems_task_argument arg
)
{
a0013c40:	e92d4ff0 	push	{r4, r5, r6, r7, r8, r9, sl, fp, lr}
a0013c44:	e24dd020 	sub	sp, sp, #32
a0013c48:	e28d3014 	add	r3, sp, #20
a0013c4c:	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;
a0013c50:	e3a09000 	mov	r9, #0
 */
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail(
  Chain_Control *the_chain
)
{
   return (Chain_Node *) &the_chain->permanent_null;
a0013c54:	e283a004 	add	sl, r3, #4
a0013c58:	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);
a0013c5c:	e58d301c 	str	r3, [sp, #28]

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

static void _Timer_server_Stop_tod_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
a0013c64:	e2803040 	add	r3, r0, #64	; 0x40
 *  @a arg points to the corresponding timer server control block.
 */
static rtems_task _Timer_server_Body(
  rtems_task_argument arg
)
{
a0013c68:	e1a04000 	mov	r4, r0
 */
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
a0013c6c:	e58da014 	str	sl, [sp, #20]
  the_chain->permanent_null = NULL;
a0013c70:	e58d9018 	str	r9, [sp, #24]
 */
RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty(
  Chain_Control *the_chain
)
{
  the_chain->first          = _Chain_Tail(the_chain);
a0013c74:	e58d8008 	str	r8, [sp, #8]
  the_chain->permanent_null = NULL;
a0013c78:	e58d900c 	str	r9, [sp, #12]
  the_chain->last           = _Chain_Head(the_chain);
a0013c7c:	e58d5010 	str	r5, [sp, #16]
   */
  Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;

  watchdogs->last_snapshot = snapshot;

  _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
a0013c80:	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 );
a0013c84:	e2807068 	add	r7, r0, #104	; 0x68

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

static void _Timer_server_Stop_tod_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
a0013c8c:	e58d3000 	str	r3, [sp]
{
  /*
   *  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;
a0013c90:	e28d2014 	add	r2, sp, #20
a0013c94:	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;
a0013c98:	e59f216c 	ldr	r2, [pc, #364]	; a0013e0c <_Timer_server_Body+0x1cc>
   */
  Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;

  watchdogs->last_snapshot = snapshot;

  _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
a0013c9c:	e1a0000b 	mov	r0, fp
static void _Timer_server_Process_interval_watchdogs(
  Timer_server_Watchdogs *watchdogs,
  Chain_Control *fire_chain
)
{
  Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot;
a0013ca0:	e5923000 	ldr	r3, [r2]

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

  watchdogs->last_snapshot = snapshot;

  _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
a0013ca8:	e1a02005 	mov	r2, r5
  /*
   *  We assume adequate unsigned arithmetic here.
   */
  Watchdog_Interval delta = snapshot - watchdogs->last_snapshot;

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

  _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain );
a0013cb0:	e0611003 	rsb	r1, r1, r3
a0013cb4:	eb001001 	bl	a0017cc0 <_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();
a0013cb8:	e59f3150 	ldr	r3, [pc, #336]	; a0013e10 <_Timer_server_Body+0x1d0>
  Watchdog_Interval last_snapshot = watchdogs->last_snapshot;
a0013cbc:	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();
a0013cc0:	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 ) {
a0013cc4:	e1560002 	cmp	r6, r2
a0013cc8:	9a000004 	bls	a0013ce0 <_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 );
a0013ccc:	e0621006 	rsb	r1, r2, r6
a0013cd0:	e1a00007 	mov	r0, r7
a0013cd4:	e1a02005 	mov	r2, r5
a0013cd8:	eb000ff8 	bl	a0017cc0 <_Watchdog_Adjust_to_chain>
a0013cdc:	ea000004 	b	a0013cf4 <_Timer_server_Body+0xb4>

  } else if ( snapshot < last_snapshot ) {
a0013ce0:	2a000003 	bcs	a0013cf4 <_Timer_server_Body+0xb4>
     /*
      *  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 );
a0013ce4:	e0662002 	rsb	r2, r6, r2
a0013ce8:	e1a00007 	mov	r0, r7
a0013cec:	e3a01001 	mov	r1, #1
a0013cf0:	eb000fca 	bl	a0017c20 <_Watchdog_Adjust>
  }

  watchdogs->last_snapshot = snapshot;
a0013cf4:	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 );
a0013cf8:	e5940078 	ldr	r0, [r4, #120]	; 0x78
a0013cfc:	eb00022c 	bl	a00145b4 <_Chain_Get>

    if ( timer == NULL ) {
a0013d00:	e2501000 	subs	r1, r0, #0
a0013d04:	0a00000a 	beq	a0013d34 <_Timer_server_Body+0xf4>
static void _Timer_server_Insert_timer(
  Timer_server_Control *ts,
  Timer_Control *timer
)
{
  if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) {
a0013d08:	e5913038 	ldr	r3, [r1, #56]	; 0x38
a0013d0c:	e3530001 	cmp	r3, #1
    _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
a0013d10:	02811010 	addeq	r1, r1, #16
a0013d14:	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 ) {
a0013d18:	0a000003 	beq	a0013d2c <_Timer_server_Body+0xec>
    _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker );
  } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) {
a0013d1c:	e3530003 	cmp	r3, #3
a0013d20:	1afffff4 	bne	a0013cf8 <_Timer_server_Body+0xb8>
    _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker );
a0013d24:	e2811010 	add	r1, r1, #16
a0013d28:	e1a00007 	mov	r0, r7
a0013d2c:	eb001010 	bl	a0017d74 <_Watchdog_Insert>
a0013d30:	eafffff0 	b	a0013cf8 <_Timer_server_Body+0xb8>
static inline uint32_t arm_interrupt_disable( void )
{
  uint32_t arm_switch_reg;
  uint32_t level;

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

    _ISR_Disable( level );
    if ( _Chain_Is_empty( insert_chain ) ) {
a0013d40:	e59d2014 	ldr	r2, [sp, #20]
a0013d44:	e152000a 	cmp	r2, sl
a0013d48:	1a000005 	bne	a0013d64 <_Timer_server_Body+0x124>
      ts->insert_chain = NULL;
a0013d4c:	e5841078 	str	r1, [r4, #120]	; 0x78

static inline void arm_interrupt_enable( uint32_t level )
{
  ARM_SWITCH_REGISTERS;

  asm volatile (
a0013d50:	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 ) ) {
a0013d54:	e59d3008 	ldr	r3, [sp, #8]
a0013d58:	e1530008 	cmp	r3, r8
a0013d5c:	1a000002 	bne	a0013d6c <_Timer_server_Body+0x12c>
a0013d60:	ea000015 	b	a0013dbc <_Timer_server_Body+0x17c>
a0013d64:	e129f003 	msr	CPSR_fc, r3                                         	<== NOT EXECUTED
a0013d68:	eaffffca 	b	a0013c98 <_Timer_server_Body+0x58>                    	<== NOT EXECUTED
static inline uint32_t arm_interrupt_disable( void )
{
  uint32_t arm_switch_reg;
  uint32_t level;

  asm volatile (
a0013d6c:	e10f2000 	mrs	r2, CPSR
a0013d70:	e3823080 	orr	r3, r2, #128	; 0x80
a0013d74:	e129f003 	msr	CPSR_fc, r3
 */
RTEMS_INLINE_ROUTINE bool _Chain_Is_empty(
  Chain_Control *the_chain
)
{
  return (the_chain->first == _Chain_Tail(the_chain));
a0013d78:	e59d3008 	ldr	r3, [sp, #8]
 */
RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected(
  Chain_Control *the_chain
)
{
  if ( !_Chain_Is_empty(the_chain))
a0013d7c:	e1530008 	cmp	r3, r8
a0013d80:	0a00000b 	beq	a0013db4 <_Timer_server_Body+0x174>
{
  Chain_Node  *return_node;
  Chain_Node  *new_first;

  return_node         = the_chain->first;
  new_first           = return_node->next;
a0013d84:	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 ) {
a0013d88:	e3530000 	cmp	r3, #0
  the_chain->first    = new_first;
a0013d8c:	e58d1008 	str	r1, [sp, #8]
  new_first->previous = _Chain_Head(the_chain);
a0013d90:	e5815004 	str	r5, [r1, #4]
a0013d94:	0a000006 	beq	a0013db4 <_Timer_server_Body+0x174>
          watchdog->state = WATCHDOG_INACTIVE;
a0013d98:	e5839008 	str	r9, [r3, #8]

static inline void arm_interrupt_enable( uint32_t level )
{
  ARM_SWITCH_REGISTERS;

  asm volatile (
a0013d9c:	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 );
a0013da0:	e5930020 	ldr	r0, [r3, #32]
a0013da4:	e5931024 	ldr	r1, [r3, #36]	; 0x24
a0013da8:	e1a0e00f 	mov	lr, pc
a0013dac:	e593f01c 	ldr	pc, [r3, #28]
      }
a0013db0:	eaffffed 	b	a0013d6c <_Timer_server_Body+0x12c>
a0013db4:	e129f002 	msr	CPSR_fc, r2
a0013db8:	eaffffb4 	b	a0013c90 <_Timer_server_Body+0x50>
a0013dbc:	e59f3050 	ldr	r3, [pc, #80]	; a0013e14 <_Timer_server_Body+0x1d4>
    } else {
      ts->active = false;
a0013dc0:	e5c4907c 	strb	r9, [r4, #124]	; 0x7c
a0013dc4:	e5932000 	ldr	r2, [r3]
a0013dc8:	e2822001 	add	r2, r2, #1
a0013dcc:	e5832000 	str	r2, [r3]

      /*
       *  Block until there is something to do.
       */
      _Thread_Disable_dispatch();
        _Thread_Set_state( ts->thread, STATES_DELAYING );
a0013dd0:	e3a01008 	mov	r1, #8
a0013dd4:	e5940000 	ldr	r0, [r4]
a0013dd8:	eb000d41 	bl	a00172e4 <_Thread_Set_state>
        _Timer_server_Reset_interval_system_watchdog( ts );
a0013ddc:	e1a00004 	mov	r0, r4
a0013de0:	ebffff6a 	bl	a0013b90 <_Timer_server_Reset_interval_system_watchdog>
        _Timer_server_Reset_tod_system_watchdog( ts );
a0013de4:	e1a00004 	mov	r0, r4
a0013de8:	ebffff7e 	bl	a0013be8 <_Timer_server_Reset_tod_system_watchdog>
      _Thread_Enable_dispatch();
a0013dec:	eb000aa4 	bl	a0016884 <_Thread_Enable_dispatch>

      ts->active = true;
a0013df0:	e3a03001 	mov	r3, #1
a0013df4:	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 );
a0013df8:	e59d0004 	ldr	r0, [sp, #4]
a0013dfc:	eb001035 	bl	a0017ed8 <_Watchdog_Remove>

static void _Timer_server_Stop_tod_system_watchdog(
  Timer_server_Control *ts
)
{
  _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog );
a0013e00:	e59d0000 	ldr	r0, [sp]
a0013e04:	eb001033 	bl	a0017ed8 <_Watchdog_Remove>
a0013e08:	eaffffa0 	b	a0013c90 <_Timer_server_Body+0x50>
a0013e0c:	a0037c04 	.word	0xa0037c04
a0013e10:	a0037b34 	.word	0xa0037b34
a0013e14:	a0037aac 	.word	0xa0037aac