1 files changed, 103 insertions, 0 deletions
diff --git a/IntelFspPkg/FspSecCore/Ia32/SaveRestoreSse.inc b/IntelFspPkg/FspSecCore/Ia32/SaveRestoreSse.inc
new file mode 100644
index 0000000000..a3d5c47ffa
--- /dev/null
+++ b/IntelFspPkg/FspSecCore/Ia32/SaveRestoreSse.inc
@@ -0,0 +1,103 @@
+;------------------------------------------------------------------------------
+;
+; Copyright (c) 2014, Intel Corporation. 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.
+;
+; Abstract:
+;
+;   Provide macro for register save/restore using SSE registers
+;
+;------------------------------------------------------------------------------
+
+;
+; Define SSE instruction set
+;
+IFDEF USE_SSE41_FLAG
+;
+; Define SSE macros using SSE 4.1 instructions
+;
+SXMMN        MACRO   XMM, IDX, REG
+             pinsrd  XMM, REG, (IDX AND 3)
+             ENDM
+
+LXMMN        MACRO   XMM, REG, IDX
+             pextrd  REG, XMM, (IDX AND 3)
+             ENDM
+ELSE
+;
+; Define SSE macros using SSE 2 instructions
+;
+SXMMN        MACRO   XMM, IDX, REG
+             pinsrw  XMM, REG, (IDX AND 3) * 2
+             ror     REG, 16
+             pinsrw  XMM, REG, (IDX AND 3) * 2 + 1
+             rol     REG, 16
+             ENDM
+
+LXMMN        MACRO   XMM, REG, IDX
+             pshufd  XMM, XMM,  (0E4E4E4h SHR (IDX * 2))  AND 0FFh
+             movd    REG, XMM
+             pshufd  XMM, XMM,  (0E4E4E4h SHR (IDX * 2 + (IDX AND 1) * 4)) AND 0FFh
+             ENDM
+ENDIF
+
+
+SAVE_REGS    MACRO
+  SXMMN      xmm7, 0, ebp
+  SXMMN      xmm7, 1, ebx
+  SXMMN      xmm7, 2, esi
+  SXMMN      xmm7, 3, edi
+  SAVE_ESP
+             ENDM
+
+LOAD_REGS    MACRO
+  LXMMN      xmm7, ebp, 0
+  LXMMN      xmm7, ebx, 1
+  LXMMN      xmm7, esi, 2
+  LXMMN      xmm7, edi, 3
+  LOAD_ESP
+             ENDM
+
+LOAD_EAX     MACRO
+  LXMMN      xmm6, eax, 1
+             ENDM
+
+SAVE_EAX     MACRO
+  SXMMN      xmm6, 1, eax
+             ENDM
+
+LOAD_EDX     MACRO
+  LXMMN      xmm6, edx, 2
+             ENDM
+
+SAVE_EDX     MACRO
+  SXMMN      xmm6, 2, edx
+             ENDM
+
+SAVE_ECX     MACRO
+  SXMMN      xmm6, 3, ecx
+             ENDM
+
+LOAD_ECX     MACRO
+  LXMMN      xmm6, ecx, 3
+             ENDM
+
+SAVE_ESP     MACRO
+  SXMMN      xmm6, 0, esp
+             ENDM
+
+LOAD_ESP     MACRO
+  movd       esp,  xmm6
+             ENDM
+
+ENABLE_SSE   MACRO
+  mov        eax, cr4
+  or         eax, 00000600h
+  mov        cr4, eax
+             ENDM