#------------------------------------------------------------------------------ 
#
# SemMem() worker for ARM
#
# This file started out as C code that did 64 bit moves if the buffer was
# 32-bit aligned, else it does a byte copy. It also does a byte copy for
# any trailing bytes. Update to use VSTM/VLDM to do 128 byte writes.
#
# Copyright (c) 2008 - 2010, Apple Inc. All rights reserved.<BR>
# This program and the accompanying materials
# are licensed and made available under the terms and conditions of the BSD License
# which accompanies this distribution.  The full text of the license may be found at
# http://opensource.org/licenses/bsd-license.php
#
# THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
# WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
#
#------------------------------------------------------------------------------

/**
  Set Buffer to Value for Size bytes.

  @param  Buffer   Memory to set.
  @param  Length   Number of bytes to set
  @param  Value    Value of the set operation.

  @return Buffer

VOID *
EFIAPI
InternalMemSetMem (
  OUT     VOID                      *Buffer,
  IN      UINTN                     Length,
  IN      UINT8                     Value
  )
**/
	
.text
.align 2
.globl ASM_PFX(InternalMemSetMem)
INTERWORK_FUNC(InternalMemSetMem)

ASM_PFX(InternalMemSetMem):
	stmfd	sp!, {r4-r7, lr}
	tst	  r0, #3
	movne	r3, #0
	moveq	r3, #1
	cmp	  r1, #127
	movls lr, #0
	andhi	lr, r3, #1
	cmp	  lr, #0
	mov	  r12, r0
	bne	  L31
L32:
	mov	  r3, #0
	b	    L43
L31:
  vdup.8  q0,r2
  vmov    q1,q0
  vmov    q2,q0
  vmov    q3,q0
  vmov    q4,q0
  vmov    q5,q0
  vmov    q6,q0
  vmov    q7,q0
	b	      L32
L34:
	cmp	    lr, #0
	streqb	r2, [r12], #1
	subeq	  r1, r1, #1
	beq	    L43
	sub	    r1, r1, #128
	cmp	    r1, #127
	cmp	    r1, #31
	movls	  lr, r3
	vstm    r12!, {d0-d15}
L43:
	cmp	    r1, #0
	bne	    L34
	ldmfd	  sp!, {pc}