--- /dev/null
+;------------------------------------------------------------------------------\r
+;\r
+; Copyright (c) 2006, Intel Corporation. All rights reserved.<BR>\r
+; This program and the accompanying materials\r
+; are licensed and made available under the terms and conditions of the BSD License\r
+; which accompanies this distribution. The full text of the license may be found at\r
+; http://opensource.org/licenses/bsd-license.php.\r
+;\r
+; THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
+; WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
+;\r
+; Module Name:\r
+;\r
+; SetMem16.nasm\r
+;\r
+; Abstract:\r
+;\r
+; SetMem16 function\r
+;\r
+; Notes:\r
+;\r
+;------------------------------------------------------------------------------\r
+\r
+ SECTION .text\r
+\r
+;------------------------------------------------------------------------------\r
+; VOID *\r
+; EFIAPI\r
+; InternalMemSetMem16 (\r
+; IN VOID *Buffer,\r
+; IN UINTN Count,\r
+; IN UINT16 Value\r
+; );\r
+;------------------------------------------------------------------------------\r
+global ASM_PFX(InternalMemSetMem16)\r
+ASM_PFX(InternalMemSetMem16):\r
+ push edi\r
+ mov edx, [esp + 12]\r
+ mov edi, [esp + 8]\r
+ xor ecx, ecx\r
+ sub ecx, edi\r
+ and ecx, 15 ; ecx + edi aligns on 16-byte boundary\r
+ mov eax, [esp + 16]\r
+ jz .0\r
+ shr ecx, 1\r
+ cmp ecx, edx\r
+ cmova ecx, edx\r
+ sub edx, ecx\r
+ rep stosw\r
+.0:\r
+ mov ecx, edx\r
+ and edx, 7\r
+ shr ecx, 3\r
+ jz @SetWords\r
+ movd xmm0, eax\r
+ pshuflw xmm0, xmm0, 0\r
+ movlhps xmm0, xmm0\r
+.1:\r
+ movntdq [edi], xmm0 ; edi should be 16-byte aligned\r
+ add edi, 16\r
+ loop .1\r
+ mfence\r
+@SetWords:\r
+ mov ecx, edx\r
+ rep stosw\r
+ mov eax, [esp + 8]\r
+ pop edi\r
+ ret\r
+\r