mirror of https://github.com/acidanthera/audk.git
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:
parent
65e79f931f
commit
f9d30595ae
|
@ -14,6 +14,30 @@
|
|||
|
||||
#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.
|
||||
|
@ -36,6 +60,10 @@ CpuMpPeimInit (
|
|||
{
|
||||
|
||||
|
||||
//
|
||||
// Load new GDT table on BSP
|
||||
//
|
||||
AsmInitializeGdt (&mGdt);
|
||||
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
|
|
@ -21,6 +21,36 @@
|
|||
#include <Library/BaseLib.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
|
||||
|
|
|
@ -31,6 +31,17 @@
|
|||
CpuMpPei.h
|
||||
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]
|
||||
MdePkg/MdePkg.dec
|
||||
|
|
|
@ -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
|
||||
|
||||
|
|
@ -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
|
|
@ -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
|
|
@ -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
|
||||
|
||||
|
||||
|
|
@ -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
|
|
@ -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
|
Loading…
Reference in New Issue