X-Git-Url: https://git.proxmox.com/?p=mirror_edk2.git;a=blobdiff_plain;f=UefiCpuPkg%2FPiSmmCpuDxeSmm%2FIa32%2FMpFuncs.S;fp=UefiCpuPkg%2FPiSmmCpuDxeSmm%2FIa32%2FMpFuncs.S;h=75aa312a6e8aa2ea545e1db218bd4d2fb6ff3b33;hp=0000000000000000000000000000000000000000;hb=7947da3cccb5dfc973fe9ad9d814477ed978aea1;hpb=529a5a860996b5e83941bab50a7b8604139264a1

diff --git a/UefiCpuPkg/PiSmmCpuDxeSmm/Ia32/MpFuncs.S b/UefiCpuPkg/PiSmmCpuDxeSmm/Ia32/MpFuncs.S
new file mode 100644
index 0000000000..75aa312a6e
--- /dev/null
+++ b/UefiCpuPkg/PiSmmCpuDxeSmm/Ia32/MpFuncs.S
@@ -0,0 +1,165 @@
+#------------------------------------------------------------------------------
+#
+# Copyright (c) 2006 - 2015, 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.
+#
+# Module Name:
+#
+#   MpFuncs.S
+#
+# Abstract:
+#
+#   This is the assembly code for Multi-processor S3 support
+#
+#------------------------------------------------------------------------------
+
+.equ                   VacantFlag,       0x0
+.equ                   NotVacantFlag,    0xff
+
+.equ                   LockLocation,     RendezvousFunnelProcEnd - RendezvousFunnelProcStart
+.equ                   StackStart,       RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x04
+.equ                   StackSize,        RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x08
+.equ                   RendezvousProc,   RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x0C
+.equ                   GdtrProfile,      RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x10
+.equ                   IdtrProfile,      RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x16
+.equ                   BufferStart,      RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x1C
+
+#-------------------------------------------------------------------------------------
+#RendezvousFunnelProc  procedure follows. All APs execute their procedure. This
+#procedure serializes all the AP processors through an Init sequence. It must be
+#noted that APs arrive here very raw...ie: real mode, no stack.
+#ALSO THIS PROCEDURE IS EXECUTED BY APs ONLY ON 16 BIT MODE. HENCE THIS PROC
+#IS IN MACHINE CODE.
+#-------------------------------------------------------------------------------------
+#RendezvousFunnelProc (&WakeUpBuffer,MemAddress);
+
+ASM_GLOBAL ASM_PFX(RendezvousFunnelProc)
+ASM_PFX(RendezvousFunnelProc):
+RendezvousFunnelProcStart:
+
+# At this point CS = 0x(vv00) and ip= 0x0.
+
+        .byte 0x8c,0xc8               # mov        ax,  cs
+        .byte 0x8e,0xd8               # mov        ds,  ax
+        .byte 0x8e,0xc0               # mov        es,  ax
+        .byte 0x8e,0xd0               # mov        ss,  ax
+        .byte 0x33,0xc0               # xor        ax,  ax
+        .byte 0x8e,0xe0               # mov        fs,  ax
+        .byte 0x8e,0xe8               # mov        gs,  ax
+
+flat32Start:
+
+        .byte 0xBE
+        .word BufferStart
+        .byte 0x66,0x8B,0x14          # mov        edx,dword ptr [si]          ; EDX is keeping the start address of wakeup buffer
+
+        .byte 0xBE
+        .word GdtrProfile
+        .byte 0x66                    # db         66h
+        .byte 0x2E,0xF,0x1,0x14       # lgdt       fword ptr cs:[si]
+
+        .byte 0xBE
+        .word IdtrProfile
+        .byte 0x66                    # db         66h
+        .byte 0x2E,0xF,0x1,0x1C       # lidt       fword ptr cs:[si]
+
+        .byte 0x33,0xC0               # xor        ax,  ax
+        .byte 0x8E,0xD8               # mov        ds,  ax
+
+        .byte 0xF,0x20,0xC0           # mov        eax, cr0                    ; Get control register 0
+        .byte 0x66,0x83,0xC8,0x1      # or         eax, 000000001h             ; Set PE bit (bit #0)
+        .byte 0xF,0x22,0xC0           # mov        cr0, eax
+
+FLAT32_JUMP:
+
+        .byte 0x66,0x67,0xEA          # far jump
+        .long 0x0                     # 32-bit offset
+        .word 0x20                    # 16-bit selector
+
+PMODE_ENTRY:                          # protected mode entry point
+
+        movw        $0x8,%ax
+        .byte       0x66
+        movw        %ax,%ds
+        .byte       0x66
+        movw        %ax,%es
+        .byte       0x66
+        movw        %ax,%fs
+        .byte       0x66
+        movw        %ax,%gs
+        .byte       0x66
+        movw        %ax,%ss           # Flat mode setup.
+
+        movl        %edx,%esi
+
+        movl        %esi,%edi
+        addl        $LockLocation, %edi
+        movb        $NotVacantFlag, %al
+TestLock:
+        xchgb       (%edi), %al
+        cmpb        $NotVacantFlag, %al
+        jz          TestLock
+
+ProgramStack:
+
+        movl        %esi,%edi
+        addl        $StackSize, %edi
+        movl        (%edi),%eax
+        movl        %esi,%edi
+        addl        $StackStart, %edi
+        addl        (%edi),%eax
+        movl        %eax,%esp
+        movl        %eax,(%edi)
+
+Releaselock:
+
+        movb        $VacantFlag, %al
+        movl        %esi,%edi
+        addl        $LockLocation, %edi
+        xchgb       (%edi), %al
+
+        #
+        # Call assembly function to initialize FPU.
+        #
+        lea         ASM_PFX(InitializeFloatingPointUnits), %ebx
+        call        *%ebx
+        #
+        # Call C Function
+        #
+        movl        %esi,%edi
+        addl        $RendezvousProc, %edi
+        movl        (%edi),%eax
+
+        testl       %eax,%eax
+        jz          GoToSleep
+        call        *%eax                         # Call C function
+
+GoToSleep:
+        cli
+        hlt
+        jmp         GoToSleep
+
+RendezvousFunnelProcEnd:
+#-------------------------------------------------------------------------------------
+#  AsmGetAddressMap (&AddressMap);
+#-------------------------------------------------------------------------------------
+ASM_GLOBAL ASM_PFX(AsmGetAddressMap)
+ASM_PFX(AsmGetAddressMap):
+
+        pushal
+        movl        %esp,%ebp
+
+        movl        0x24(%ebp), %ebx
+        movl        $RendezvousFunnelProcStart, (%ebx)
+        movl        $(PMODE_ENTRY - RendezvousFunnelProcStart), 0x4(%ebx)
+        movl        $(FLAT32_JUMP - RendezvousFunnelProcStart), 0x8(%ebx)
+        movl        $(RendezvousFunnelProcEnd - RendezvousFunnelProcStart), 0x0c(%ebx)
+
+        popal
+        ret