UefiCpuPkg/CpuMpPei: Load GDT table on BSP
Load new GDT table and update segment accordingly. Contributed-under: TianoCore Contribution Agreement 1.0 Signed-off-by: Jeff Fan <jeff.fan@intel.com> Reviewed-by: Feng Tian <feng.tian@intel.com> Reviewed-by: Jiewen Yao <jiewen.yao@intel.com> git-svn-id: https://svn.code.sf.net/p/edk2/code/trunk/edk2@17988 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
Jeff Fan
vanjeff
@@ -14,6 +14,30 @@
|
|||||||
|
|
||||||
#include "CpuMpPei.h"
|
#include "CpuMpPei.h"
|
||||||
|
|
||||||
|
//
|
||||||
|
// Global Descriptor Table (GDT)
|
||||||
|
//
|
||||||
|
GLOBAL_REMOVE_IF_UNREFERENCED IA32_GDT mGdtEntries[] = {
|
||||||
|
/* selector { Global Segment Descriptor } */
|
||||||
|
/* 0x00 */ {{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}}, //null descriptor
|
||||||
|
/* 0x08 */ {{0xffff, 0, 0, 0x2, 1, 0, 1, 0xf, 0, 0, 1, 1, 0}}, //linear data segment descriptor
|
||||||
|
/* 0x10 */ {{0xffff, 0, 0, 0xf, 1, 0, 1, 0xf, 0, 0, 1, 1, 0}}, //linear code segment descriptor
|
||||||
|
/* 0x18 */ {{0xffff, 0, 0, 0x3, 1, 0, 1, 0xf, 0, 0, 1, 1, 0}}, //system data segment descriptor
|
||||||
|
/* 0x20 */ {{0xffff, 0, 0, 0xa, 1, 0, 1, 0xf, 0, 0, 1, 1, 0}}, //system code segment descriptor
|
||||||
|
/* 0x28 */ {{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}}, //spare segment descriptor
|
||||||
|
/* 0x30 */ {{0xffff, 0, 0, 0x2, 1, 0, 1, 0xf, 0, 0, 1, 1, 0}}, //system data segment descriptor
|
||||||
|
/* 0x38 */ {{0xffff, 0, 0, 0xa, 1, 0, 1, 0xf, 0, 1, 0, 1, 0}}, //system code segment descriptor
|
||||||
|
/* 0x40 */ {{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}}, //spare segment descriptor
|
||||||
|
};
|
||||||
|
|
||||||
|
//
|
||||||
|
// IA32 Gdt register
|
||||||
|
//
|
||||||
|
GLOBAL_REMOVE_IF_UNREFERENCED IA32_DESCRIPTOR mGdt = {
|
||||||
|
sizeof (mGdtEntries) - 1,
|
||||||
|
(UINTN) mGdtEntries
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
The Entry point of the MP CPU PEIM.
|
The Entry point of the MP CPU PEIM.
|
||||||
@@ -36,6 +60,10 @@ CpuMpPeimInit (
|
|||||||
{
|
{
|
||||||
|
|
||||||
|
|
||||||
|
//
|
||||||
|
// Load new GDT table on BSP
|
||||||
|
//
|
||||||
|
AsmInitializeGdt (&mGdt);
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
return EFI_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -21,6 +21,36 @@
|
|||||||
#include <Library/BaseLib.h>
|
#include <Library/BaseLib.h>
|
||||||
#include <Library/PeimEntryPoint.h>
|
#include <Library/PeimEntryPoint.h>
|
||||||
|
|
||||||
|
#pragma pack(1)
|
||||||
|
typedef union {
|
||||||
|
struct {
|
||||||
|
UINT32 LimitLow : 16;
|
||||||
|
UINT32 BaseLow : 16;
|
||||||
|
UINT32 BaseMid : 8;
|
||||||
|
UINT32 Type : 4;
|
||||||
|
UINT32 System : 1;
|
||||||
|
UINT32 Dpl : 2;
|
||||||
|
UINT32 Present : 1;
|
||||||
|
UINT32 LimitHigh : 4;
|
||||||
|
UINT32 Software : 1;
|
||||||
|
UINT32 Reserved : 1;
|
||||||
|
UINT32 DefaultSize : 1;
|
||||||
|
UINT32 Granularity : 1;
|
||||||
|
UINT32 BaseHigh : 8;
|
||||||
|
} Bits;
|
||||||
|
UINT64 Uint64;
|
||||||
|
} IA32_GDT;
|
||||||
|
#pragma pack()
|
||||||
|
/**
|
||||||
|
Assembly code to load GDT table and update segment accordingly.
|
||||||
|
|
||||||
|
@param Gdtr Pointer to GDT descriptor
|
||||||
|
**/
|
||||||
|
VOID
|
||||||
|
EFIAPI
|
||||||
|
AsmInitializeGdt (
|
||||||
|
IN IA32_DESCRIPTOR *Gdtr
|
||||||
|
);
|
||||||
|
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
@@ -31,6 +31,17 @@
|
|||||||
CpuMpPei.h
|
CpuMpPei.h
|
||||||
CpuMpPei.c
|
CpuMpPei.c
|
||||||
|
|
||||||
|
[Sources.IA32]
|
||||||
|
Ia32/MpEqu.inc
|
||||||
|
Ia32/MpFuncs.asm | MSFT
|
||||||
|
Ia32/MpFuncs.asm | INTEL
|
||||||
|
Ia32/MpFuncs.nasm | GCC
|
||||||
|
|
||||||
|
[Sources.X64]
|
||||||
|
X64/MpEqu.inc
|
||||||
|
X64/MpFuncs.asm | MSFT
|
||||||
|
X64/MpFuncs.asm | INTEL
|
||||||
|
X64/MpFuncs.nasm | GCC
|
||||||
|
|
||||||
[Packages]
|
[Packages]
|
||||||
MdePkg/MdePkg.dec
|
MdePkg/MdePkg.dec
|
||||||
|
|||||||
24
UefiCpuPkg/CpuMpPei/Ia32/MpEqu.inc
Normal file
24
UefiCpuPkg/CpuMpPei/Ia32/MpEqu.inc
Normal file
@@ -0,0 +1,24 @@
|
|||||||
|
;------------------------------------------------------------------------------ ;
|
||||||
|
; Copyright (c) 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:
|
||||||
|
;
|
||||||
|
; MpEqu.inc
|
||||||
|
;
|
||||||
|
; Abstract:
|
||||||
|
;
|
||||||
|
; This is the equates file for Multiple Processor support
|
||||||
|
;
|
||||||
|
;-------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
PROTECT_MODE_CS equ 10h
|
||||||
|
PROTECT_MODE_DS equ 18h
|
||||||
|
|
||||||
|
|
||||||
55
UefiCpuPkg/CpuMpPei/Ia32/MpFuncs.asm
Normal file
55
UefiCpuPkg/CpuMpPei/Ia32/MpFuncs.asm
Normal file
@@ -0,0 +1,55 @@
|
|||||||
|
;------------------------------------------------------------------------------ ;
|
||||||
|
; Copyright (c) 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:
|
||||||
|
;
|
||||||
|
; MpFuncs32.asm
|
||||||
|
;
|
||||||
|
; Abstract:
|
||||||
|
;
|
||||||
|
; This is the assembly code for MP support
|
||||||
|
;
|
||||||
|
;-------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
.686p
|
||||||
|
.model flat
|
||||||
|
|
||||||
|
include MpEqu.inc
|
||||||
|
.code
|
||||||
|
|
||||||
|
|
||||||
|
AsmInitializeGdt PROC near C PUBLIC
|
||||||
|
push ebp
|
||||||
|
mov ebp, esp
|
||||||
|
pushad
|
||||||
|
mov edi, [ebp + 8] ; Load GDT register
|
||||||
|
|
||||||
|
mov ax,cs ; Get the selector data from our code image
|
||||||
|
mov es,ax
|
||||||
|
lgdt FWORD PTR es:[edi] ; and update the GDTR
|
||||||
|
|
||||||
|
push PROTECT_MODE_CS
|
||||||
|
lea eax, SetCodeSelectorFarJump
|
||||||
|
push eax
|
||||||
|
retf
|
||||||
|
SetCodeSelectorFarJump:
|
||||||
|
mov ax, PROTECT_MODE_DS ; Update the Base for the new selectors, too
|
||||||
|
mov ds, ax
|
||||||
|
mov es, ax
|
||||||
|
mov fs, ax
|
||||||
|
mov gs, ax
|
||||||
|
mov ss, ax
|
||||||
|
|
||||||
|
popad
|
||||||
|
pop ebp
|
||||||
|
ret
|
||||||
|
AsmInitializeGdt ENDP
|
||||||
|
|
||||||
|
END
|
||||||
49
UefiCpuPkg/CpuMpPei/Ia32/MpFuncs.nasm
Normal file
49
UefiCpuPkg/CpuMpPei/Ia32/MpFuncs.nasm
Normal file
@@ -0,0 +1,49 @@
|
|||||||
|
;------------------------------------------------------------------------------ ;
|
||||||
|
; Copyright (c) 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.nasm
|
||||||
|
;
|
||||||
|
; Abstract:
|
||||||
|
;
|
||||||
|
; This is the assembly code for MP support
|
||||||
|
;
|
||||||
|
;-------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
%include "MpEqu.inc"
|
||||||
|
|
||||||
|
SECTION .text
|
||||||
|
|
||||||
|
|
||||||
|
global ASM_PFX(AsmInitializeGdt)
|
||||||
|
ASM_PFX(AsmInitializeGdt):
|
||||||
|
push ebp
|
||||||
|
mov ebp, esp
|
||||||
|
pushad
|
||||||
|
mov edi, [ebp + 8] ; Load GDT register
|
||||||
|
|
||||||
|
lgdt [edi] ; and update the GDTR
|
||||||
|
|
||||||
|
push PROTECT_MODE_CS
|
||||||
|
mov eax, ASM_PFX(SetCodeSelectorFarJump)
|
||||||
|
push eax
|
||||||
|
retf
|
||||||
|
ASM_PFX(SetCodeSelectorFarJump):
|
||||||
|
mov ax, PROTECT_MODE_DS ; Update the Base for the new selectors, too
|
||||||
|
mov ds, ax
|
||||||
|
mov es, ax
|
||||||
|
mov fs, ax
|
||||||
|
mov gs, ax
|
||||||
|
mov ss, ax
|
||||||
|
|
||||||
|
popad
|
||||||
|
pop ebp
|
||||||
|
ret
|
||||||
25
UefiCpuPkg/CpuMpPei/X64/MpEqu.inc
Normal file
25
UefiCpuPkg/CpuMpPei/X64/MpEqu.inc
Normal file
@@ -0,0 +1,25 @@
|
|||||||
|
;------------------------------------------------------------------------------ ;
|
||||||
|
; Copyright (c) 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:
|
||||||
|
;
|
||||||
|
; MpEqu.inc
|
||||||
|
;
|
||||||
|
; Abstract:
|
||||||
|
;
|
||||||
|
; This is the equates file for Multiple Processor support
|
||||||
|
;
|
||||||
|
;-------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
LONG_MODE_CS equ 38h
|
||||||
|
LONG_MODE_DS equ 30h
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
51
UefiCpuPkg/CpuMpPei/X64/MpFuncs.asm
Normal file
51
UefiCpuPkg/CpuMpPei/X64/MpFuncs.asm
Normal file
@@ -0,0 +1,51 @@
|
|||||||
|
;------------------------------------------------------------------------------ ;
|
||||||
|
; Copyright (c) 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:
|
||||||
|
;
|
||||||
|
; MpFuncs32.asm
|
||||||
|
;
|
||||||
|
; Abstract:
|
||||||
|
;
|
||||||
|
; This is the assembly code for MP support
|
||||||
|
;
|
||||||
|
;-------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
include MpEqu.inc
|
||||||
|
.code
|
||||||
|
|
||||||
|
|
||||||
|
AsmInitializeGdt PROC
|
||||||
|
push rbp
|
||||||
|
mov rbp, rsp
|
||||||
|
|
||||||
|
lgdt fword PTR [rcx] ; update the GDTR
|
||||||
|
|
||||||
|
sub rsp, 0x10
|
||||||
|
lea rax, SetCodeSelectorFarJump
|
||||||
|
mov [rsp], rax
|
||||||
|
mov rdx, LONG_MODE_CS
|
||||||
|
mov [rsp + 4], dx ; get new CS
|
||||||
|
jmp fword ptr [rsp]
|
||||||
|
SetCodeSelectorFarJump:
|
||||||
|
add rsp, 0x10
|
||||||
|
|
||||||
|
mov rax, LONG_MODE_DS ; get new DS
|
||||||
|
mov ds, ax
|
||||||
|
mov es, ax
|
||||||
|
mov fs, ax
|
||||||
|
mov gs, ax
|
||||||
|
mov ss, ax
|
||||||
|
|
||||||
|
pop rbp
|
||||||
|
ret
|
||||||
|
AsmInitializeGdt ENDP
|
||||||
|
|
||||||
|
END
|
||||||
50
UefiCpuPkg/CpuMpPei/X64/MpFuncs.nasm
Normal file
50
UefiCpuPkg/CpuMpPei/X64/MpFuncs.nasm
Normal file
@@ -0,0 +1,50 @@
|
|||||||
|
;------------------------------------------------------------------------------ ;
|
||||||
|
; Copyright (c) 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.nasm
|
||||||
|
;
|
||||||
|
; Abstract:
|
||||||
|
;
|
||||||
|
; This is the assembly code for MP support
|
||||||
|
;
|
||||||
|
;-------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
%include "MpEqu.inc"
|
||||||
|
DEFAULT REL
|
||||||
|
SECTION .text
|
||||||
|
|
||||||
|
global ASM_PFX(AsmInitializeGdt)
|
||||||
|
ASM_PFX(AsmInitializeGdt):
|
||||||
|
push rbp
|
||||||
|
mov rbp, rsp
|
||||||
|
|
||||||
|
lgdt [rcx] ; update the GDTR
|
||||||
|
|
||||||
|
sub rsp, 0x10
|
||||||
|
mov rax, ASM_PFX(SetCodeSelectorFarJump)
|
||||||
|
mov [rsp], rax
|
||||||
|
mov rdx, LONG_MODE_CS
|
||||||
|
mov [rsp + 4], dx ; get new CS
|
||||||
|
jmp far dword [rsp] ; far jump with new CS
|
||||||
|
ASM_PFX(SetCodeSelectorFarJump):
|
||||||
|
add rsp, 0x10
|
||||||
|
|
||||||
|
mov rax, LONG_MODE_DS ; get new DS
|
||||||
|
mov ds, ax
|
||||||
|
mov es, ax
|
||||||
|
mov fs, ax
|
||||||
|
mov gs, ax
|
||||||
|
mov ss, ax
|
||||||
|
|
||||||
|
pop rbp
|
||||||
|
|
||||||
|
ret
|
||||||
Reference in New Issue
Block a user