mirror of https://github.com/acidanthera/audk.git
Check in thunk driver to produce PI MP Services Protocol based on Framework MP Services Protocol.
git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@9563 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
xli24
parent
c0b89afd91
commit
768e2a903b
|
|
@ -0,0 +1,25 @@
|
|||
;------------------------------------------------------------------------------
|
||||
; Include file for IA32 MpFuncs.asm
|
||||
;
|
||||
; Copyright (c) 2009, Intel Corporation
|
||||
; All rights reserved. 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.
|
||||
;
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
VacantFlag Equ 00h
|
||||
NotVacantFlag Equ 0ffh
|
||||
|
||||
LockLocation equ RendezvousFunnelProcEnd - RendezvousFunnelProcStart
|
||||
StackStart equ LockLocation + 4h
|
||||
StackSize equ LockLocation + 8h
|
||||
RendezvousProc equ LockLocation + 0Ch
|
||||
GdtrProfile equ LockLocation + 10h
|
||||
BufferStart equ LockLocation + 18h
|
||||
|
||||
;-------------------------------------------------------------------------------
|
||||
|
|
@ -0,0 +1,154 @@
|
|||
#------------------------------------------------------------------------------
|
||||
# IA32 assembly file for AP startup vector.
|
||||
#
|
||||
# Copyright (c) 2009, Intel Corporation
|
||||
# All rights reserved. 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.
|
||||
#
|
||||
#------------------------------------------------------------------------------
|
||||
|
||||
.equ VacantFlag, 0x0
|
||||
.equ NotVacantFlag, 0xff
|
||||
|
||||
.equ LockLocation, RendezvousFunnelProcEnd - RendezvousFunnelProcStart
|
||||
.equ StackStart, LockLocation + 0x04
|
||||
.equ StackSize, LockLocation + 0x08
|
||||
.equ RendezvousProc, LockLocation + 0x0C
|
||||
.equ GdtrProfile, LockLocation + 0x10
|
||||
.equ BufferStart, LockLocation + 0x18
|
||||
|
||||
#-------------------------------------------------------------------------------------
|
||||
#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
|
||||
|
||||
# Switch to flat mode.
|
||||
|
||||
.byte 0xBE
|
||||
.word BufferStart
|
||||
.byte 0x66,0x8B,0xC # mov ecx,dword ptr [si] ; ECX is keeping the start address of wakeup buffer
|
||||
|
||||
.byte 0xFA # cli
|
||||
.byte 0xBE
|
||||
.word GdtrProfile
|
||||
.byte 0x66 # db 66h
|
||||
.byte 0x2E,0xF,0x1,0x14 # lgdt 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
|
||||
|
||||
|
||||
#step-4:
|
||||
|
||||
FLAT32_JUMP:
|
||||
.byte 0x66
|
||||
.byte 0x67
|
||||
.byte 0xEA # far jump
|
||||
.long 0x0
|
||||
.word 0x10
|
||||
|
||||
ProtectedModeStart: # 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 %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 C Function
|
||||
#
|
||||
movl %esi,%edi
|
||||
addl $RendezvousProc, %edi
|
||||
movl (%edi), %ebx
|
||||
|
||||
testl %ebx,%ebx
|
||||
jz GoToSleep
|
||||
call *%ebx # Call C function
|
||||
|
||||
#Step-6: Sleep
|
||||
|
||||
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 $(ProtectedModeStart - RendezvousFunnelProcStart), 0x4(%ebx)
|
||||
movl $(FLAT32_JUMP - RendezvousFunnelProcStart), 0x8(%ebx)
|
||||
movl $0, 0x0c(%ebx)
|
||||
movl $0, 0x10(%ebx)
|
||||
movl $(RendezvousFunnelProcEnd - RendezvousFunnelProcStart), 0x14(%ebx)
|
||||
|
||||
popal
|
||||
ret
|
||||
|
|
@ -0,0 +1,148 @@
|
|||
;------------------------------------------------------------------------------
|
||||
; IA32 assembly file for AP startup vector.
|
||||
;
|
||||
; Copyright (c) 2009, Intel Corporation
|
||||
; All rights reserved. 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.
|
||||
;
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
.686p
|
||||
.model flat
|
||||
.code
|
||||
|
||||
include AsmInclude.inc
|
||||
;-------------------------------------------------------------------------------------
|
||||
FJMP32 MACRO Selector, Offset
|
||||
DB 066h
|
||||
DB 067h
|
||||
DB 0EAh ; far jump
|
||||
DD Offset ; 32-bit offset
|
||||
DW Selector ; 16-bit selector
|
||||
ENDM
|
||||
|
||||
;-------------------------------------------------------------------------------------
|
||||
;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);
|
||||
|
||||
RendezvousFunnelProc PROC near C PUBLIC
|
||||
RendezvousFunnelProcStart::
|
||||
|
||||
|
||||
; At this point CS = 0x(vv00) and ip= 0x0.
|
||||
|
||||
db 8ch, 0c8h ; mov ax, cs
|
||||
db 8eh, 0d8h ; mov ds, ax
|
||||
db 8eh, 0c0h ; mov es, ax
|
||||
db 8eh, 0d0h ; mov ss, ax
|
||||
db 33h, 0c0h ; xor ax, ax
|
||||
db 8eh, 0e0h ; mov fs, ax
|
||||
db 8eh, 0e8h ; mov gs, ax
|
||||
|
||||
; Switch to flat mode.
|
||||
|
||||
db 0BEh
|
||||
dw BufferStart ; mov si, BufferStart
|
||||
db 66h, 8Bh, 0Ch ; mov ecx,dword ptr [si] ; ECX is keeping the start address of wakeup buffer
|
||||
|
||||
db 0FAh ; cli
|
||||
db 0BEh
|
||||
dw GdtrProfile ; mov si, GdtrProfile
|
||||
db 66h ; db 66h
|
||||
db 2Eh,0Fh, 01h, 14h ; lgdt fword ptr cs:[si]
|
||||
|
||||
db 33h, 0C0h ; xor ax, ax
|
||||
db 8Eh, 0D8h ; mov ds, ax
|
||||
db 0Fh, 20h, 0C0h ; mov eax, cr0 ; Get control register 0
|
||||
db 66h, 83h, 0C8h, 01h ; or eax, 000000001h ; Set PE bit (bit #0)
|
||||
db 0Fh, 22h, 0C0h ; mov cr0, eax
|
||||
|
||||
|
||||
FLAT32_JUMP::
|
||||
FJMP32 010h,0h ; Far jmp using code segment descriptor
|
||||
|
||||
ProtectedModeStart:: ; protected mode entry point
|
||||
|
||||
mov ax, 8h
|
||||
mov ds, ax
|
||||
mov es, ax
|
||||
mov fs, ax
|
||||
mov gs, ax
|
||||
mov ss, ax ; Flat mode setup.
|
||||
|
||||
|
||||
mov edi, esi
|
||||
add edi, LockLocation
|
||||
mov al, NotVacantFlag
|
||||
TestLock::
|
||||
xchg byte ptr [edi], al
|
||||
cmp al, NotVacantFlag
|
||||
jz TestLock
|
||||
|
||||
ProgramStack::
|
||||
|
||||
mov edi, esi
|
||||
add edi, StackSize
|
||||
mov eax, dword ptr [edi]
|
||||
mov edi, esi
|
||||
add edi, StackStart
|
||||
add eax, dword ptr [edi]
|
||||
mov esp, eax
|
||||
mov dword ptr [edi], eax
|
||||
|
||||
Releaselock::
|
||||
mov al, VacantFlag
|
||||
mov edi, esi
|
||||
add edi, LockLocation
|
||||
xchg byte ptr [edi], al
|
||||
|
||||
;
|
||||
; Call C Function
|
||||
;
|
||||
mov edi, esi
|
||||
add edi, RendezvousProc
|
||||
mov ebx, dword ptr [edi]
|
||||
|
||||
test ebx, ebx
|
||||
jz GoToSleep
|
||||
call ebx ; Call C function
|
||||
|
||||
GoToSleep::
|
||||
|
||||
cli
|
||||
hlt
|
||||
jmp $-2
|
||||
|
||||
RendezvousFunnelProc ENDP
|
||||
RendezvousFunnelProcEnd::
|
||||
;-------------------------------------------------------------------------------------
|
||||
; AsmGetAddressMap (&AddressMap);
|
||||
;-------------------------------------------------------------------------------------
|
||||
AsmGetAddressMap PROC near C PUBLIC
|
||||
|
||||
pushad
|
||||
mov ebp,esp
|
||||
|
||||
mov ebx, dword ptr [ebp+24h]
|
||||
mov dword ptr [ebx], RendezvousFunnelProcStart
|
||||
mov dword ptr [ebx+4h], ProtectedModeStart - RendezvousFunnelProcStart
|
||||
mov dword ptr [ebx+8h], FLAT32_JUMP - RendezvousFunnelProcStart
|
||||
mov dword ptr [ebx+0ch], 0
|
||||
mov dword ptr [ebx+10h], 0
|
||||
mov dword ptr [ebx+14h], RendezvousFunnelProcEnd - RendezvousFunnelProcStart
|
||||
|
||||
popad
|
||||
ret
|
||||
AsmGetAddressMap ENDP
|
||||
|
||||
END
|
||||
File diff suppressed because it is too large
Load Diff
|
|
@ -0,0 +1,516 @@
|
|||
/** @file
|
||||
Include file for PI MP Services Protocol Thunk.
|
||||
|
||||
Copyright (c) 2009 Intel Corporation. <BR>
|
||||
All rights reserved. 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:
|
||||
|
||||
**/
|
||||
|
||||
#ifndef _MP_SERVICES_ON_FRAMEWORK_MP_SERVICES_THUNK_
|
||||
#define _MP_SERVICES_ON_FRAMEWORK_MP_SERVICES_THUNK_
|
||||
|
||||
#include <Protocol/MpService.h>
|
||||
#include <Protocol/FrameworkMpService.h>
|
||||
#include <Protocol/GenericMemoryTest.h>
|
||||
|
||||
#include <Library/BaseLib.h>
|
||||
#include <Library/SynchronizationLib.h>
|
||||
#include <Library/DebugLib.h>
|
||||
#include <Library/UefiLib.h>
|
||||
#include <Library/BaseMemoryLib.h>
|
||||
#include <Library/UefiDriverEntryPoint.h>
|
||||
#include <Library/MemoryAllocationLib.h>
|
||||
#include <Library/UefiBootServicesTableLib.h>
|
||||
#include <Library/DxeServicesTableLib.h>
|
||||
#include <Library/IoLib.h>
|
||||
#include <Library/TimerLib.h>
|
||||
|
||||
#define AP_STACK_SIZE 0x8000
|
||||
#define MAX_CPU_NUMBER 256
|
||||
|
||||
//
|
||||
// Bit definition for IPI
|
||||
//
|
||||
#define BROADCAST_MODE_ALL_EXCLUDING_SELF_BIT 0xC0000
|
||||
#define SPECIFY_CPU_MODE_BIT 0x00000
|
||||
#define TRIGGER_MODE_LEVEL_BIT 0x08000
|
||||
#define ASSERT_BIT 0x04000
|
||||
|
||||
//
|
||||
// Local APIC register definition for IPI.
|
||||
//
|
||||
#define APIC_REGISTER_ICR_LOW_OFFSET 0x300
|
||||
#define APIC_REGISTER_ICR_HIGH_OFFSET 0x310
|
||||
|
||||
typedef struct {
|
||||
UINTN Lock;
|
||||
VOID *StackStart;
|
||||
UINTN StackSize;
|
||||
VOID *ApFunction;
|
||||
IA32_DESCRIPTOR GdtrProfile;
|
||||
UINT32 BufferStart;
|
||||
UINT32 Cr3;
|
||||
} MP_CPU_EXCHANGE_INFO;
|
||||
|
||||
typedef struct {
|
||||
UINT8 *RendezvousFunnelAddress;
|
||||
UINTN PModeEntryOffset;
|
||||
UINTN FlatJumpOffset;
|
||||
UINTN LModeEntryOffset;
|
||||
UINTN LongJumpOffset;
|
||||
UINTN Size;
|
||||
} MP_ASSEMBLY_ADDRESS_MAP;
|
||||
|
||||
typedef enum {
|
||||
CpuStateIdle,
|
||||
CpuStateReady,
|
||||
CpuStateBusy,
|
||||
CpuStateFinished,
|
||||
CpuStateDisabled
|
||||
} CPU_STATE;
|
||||
|
||||
//
|
||||
// Define Individual Processor Data block.
|
||||
//
|
||||
typedef struct {
|
||||
EFI_AP_PROCEDURE volatile Procedure;
|
||||
VOID* volatile Parameter;
|
||||
|
||||
EFI_EVENT WaitEvent;
|
||||
BOOLEAN *Finished;
|
||||
UINT64 ExpectedTime;
|
||||
UINT64 CurrentTime;
|
||||
UINT64 TotalTime;
|
||||
|
||||
SPIN_LOCK CpuDataLock;
|
||||
CPU_STATE volatile State;
|
||||
|
||||
} CPU_DATA_BLOCK;
|
||||
|
||||
//
|
||||
// Define MP data block which consumes individual processor block.
|
||||
//
|
||||
typedef struct {
|
||||
SPIN_LOCK APSerializeLock;
|
||||
|
||||
EFI_EVENT CheckAPsEvent;
|
||||
|
||||
UINTN FinishCount;
|
||||
UINTN StartCount;
|
||||
|
||||
BOOLEAN CpuList[MAX_CPU_NUMBER];
|
||||
|
||||
EFI_AP_PROCEDURE Procedure;
|
||||
VOID *ProcArguments;
|
||||
BOOLEAN SingleThread;
|
||||
EFI_EVENT WaitEvent;
|
||||
UINTN **FailedCpuList;
|
||||
UINT64 ExpectedTime;
|
||||
UINT64 CurrentTime;
|
||||
UINT64 TotalTime;
|
||||
|
||||
CPU_DATA_BLOCK CpuData[MAX_CPU_NUMBER];
|
||||
} MP_SYSTEM_DATA;
|
||||
|
||||
/**
|
||||
Implementation of GetNumberOfProcessors() service of MP Services Protocol.
|
||||
|
||||
This service retrieves the number of logical processor in the platform
|
||||
and the number of those logical processors that are enabled on this boot.
|
||||
This service may only be called from the BSP.
|
||||
|
||||
@param This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.
|
||||
@param NumberOfProcessors Pointer to the total number of logical processors in the system,
|
||||
including the BSP and disabled APs.
|
||||
@param NumberOfEnabledProcessors Pointer to the number of enabled logical processors that exist
|
||||
in system, including the BSP.
|
||||
|
||||
@retval EFI_SUCCESS Number of logical processors and enabled logical processors retrieved..
|
||||
@retval EFI_DEVICE_ERROR Caller processor is AP.
|
||||
@retval EFI_INVALID_PARAMETER NumberOfProcessors is NULL
|
||||
@retval EFI_INVALID_PARAMETER NumberOfEnabledProcessors is NULL
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
GetNumberOfProcessors (
|
||||
IN EFI_MP_SERVICES_PROTOCOL *This,
|
||||
OUT UINTN *NumberOfProcessors,
|
||||
OUT UINTN *NumberOfEnabledProcessors
|
||||
);
|
||||
|
||||
/**
|
||||
Implementation of GetNumberOfProcessors() service of MP Services Protocol.
|
||||
|
||||
Gets detailed MP-related information on the requested processor at the
|
||||
instant this call is made. This service may only be called from the BSP.
|
||||
|
||||
@param This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.
|
||||
@param ProcessorNumber The handle number of processor.
|
||||
@param ProcessorInfoBuffer A pointer to the buffer where information for the requested processor is deposited.
|
||||
|
||||
@retval EFI_SUCCESS Processor information successfully returned.
|
||||
@retval EFI_DEVICE_ERROR Caller processor is AP.
|
||||
@retval EFI_INVALID_PARAMETER ProcessorInfoBuffer is NULL
|
||||
@retval EFI_NOT_FOUND Processor with the handle specified by ProcessorNumber does not exist.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
GetProcessorInfo (
|
||||
IN EFI_MP_SERVICES_PROTOCOL *This,
|
||||
IN UINTN ProcessorNumber,
|
||||
OUT EFI_PROCESSOR_INFORMATION *ProcessorInfoBuffer
|
||||
);
|
||||
|
||||
/**
|
||||
Implementation of StartupAllAPs() service of MP Services Protocol.
|
||||
|
||||
This service lets the caller get all enabled APs to execute a caller-provided function.
|
||||
This service may only be called from the BSP.
|
||||
|
||||
@param This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.
|
||||
@param Procedure A pointer to the function to be run on enabled APs of the system.
|
||||
@param SingleThread Indicates whether to execute the function simultaneously or one by one..
|
||||
@param WaitEvent The event created by the caller.
|
||||
If it is NULL, then execute in blocking mode.
|
||||
If it is not NULL, then execute in non-blocking mode.
|
||||
@param TimeoutInMicroSeconds The time limit in microseconds for this AP to finish the function.
|
||||
Zero means infinity.
|
||||
@param ProcedureArgument Pointer to the optional parameter of the assigned function.
|
||||
@param FailedCpuList The list of processor numbers that fail to finish the function before
|
||||
TimeoutInMicrosecsond expires.
|
||||
|
||||
@retval EFI_SUCCESS In blocking mode, all APs have finished before the timeout expired.
|
||||
@retval EFI_SUCCESS In non-blocking mode, function has been dispatched to all enabled APs.
|
||||
@retval EFI_DEVICE_ERROR Caller processor is AP.
|
||||
@retval EFI_NOT_STARTED No enabled AP exists in the system.
|
||||
@retval EFI_NOT_READY Any enabled AP is busy.
|
||||
@retval EFI_TIMEOUT In blocking mode, The timeout expired before all enabled APs have finished.
|
||||
@retval EFI_INVALID_PARAMETER Procedure is NULL.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
StartupAllAPs (
|
||||
IN EFI_MP_SERVICES_PROTOCOL *This,
|
||||
IN EFI_AP_PROCEDURE Procedure,
|
||||
IN BOOLEAN SingleThread,
|
||||
IN EFI_EVENT WaitEvent OPTIONAL,
|
||||
IN UINTN TimeoutInMicroSeconds,
|
||||
IN VOID *ProcedureArgument OPTIONAL,
|
||||
OUT UINTN **FailedCpuList OPTIONAL
|
||||
);
|
||||
|
||||
/**
|
||||
Implementation of StartupThisAP() service of MP Services Protocol.
|
||||
|
||||
This service lets the caller get one enabled AP to execute a caller-provided function.
|
||||
This service may only be called from the BSP.
|
||||
|
||||
@param This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.
|
||||
@param Procedure A pointer to the function to be run on the designated AP.
|
||||
@param ProcessorNumber The handle number of AP..
|
||||
@param WaitEvent The event created by the caller.
|
||||
If it is NULL, then execute in blocking mode.
|
||||
If it is not NULL, then execute in non-blocking mode.
|
||||
@param TimeoutInMicroseconds The time limit in microseconds for this AP to finish the function.
|
||||
Zero means infinity.
|
||||
@param ProcedureArgument Pointer to the optional parameter of the assigned function.
|
||||
@param Finished Indicates whether AP has finished assigned function.
|
||||
In blocking mode, it is ignored.
|
||||
|
||||
@retval EFI_SUCCESS In blocking mode, specified AP has finished before the timeout expires.
|
||||
@retval EFI_SUCCESS In non-blocking mode, function has been dispatched to specified AP.
|
||||
@retval EFI_DEVICE_ERROR Caller processor is AP.
|
||||
@retval EFI_TIMEOUT In blocking mode, the timeout expires before specified AP has finished.
|
||||
@retval EFI_NOT_READY Specified AP is busy.
|
||||
@retval EFI_NOT_FOUND Processor with the handle specified by ProcessorNumber does not exist.
|
||||
@retval EFI_INVALID_PARAMETER ProcessorNumber specifies the BSP or disabled AP.
|
||||
@retval EFI_INVALID_PARAMETER Procedure is NULL.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
StartupThisAP (
|
||||
IN EFI_MP_SERVICES_PROTOCOL *This,
|
||||
IN EFI_AP_PROCEDURE Procedure,
|
||||
IN UINTN ProcessorNumber,
|
||||
IN EFI_EVENT WaitEvent OPTIONAL,
|
||||
IN UINTN TimeoutInMicroseconds,
|
||||
IN VOID *ProcedureArgument OPTIONAL,
|
||||
OUT BOOLEAN *Finished OPTIONAL
|
||||
);
|
||||
|
||||
/**
|
||||
Implementation of SwitchBSP() service of MP Services Protocol.
|
||||
|
||||
This service switches the requested AP to be the BSP from that point onward.
|
||||
This service may only be called from the current BSP.
|
||||
|
||||
@param This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.
|
||||
@param ProcessorNumber The handle number of processor.
|
||||
@param EnableOldBSP Whether to enable or disable the original BSP.
|
||||
|
||||
@retval EFI_SUCCESS BSP successfully switched.
|
||||
@retval EFI_DEVICE_ERROR Caller processor is AP.
|
||||
@retval EFI_NOT_FOUND Processor with the handle specified by ProcessorNumber does not exist.
|
||||
@retval EFI_INVALID_PARAMETER ProcessorNumber specifies the BSP or disabled AP.
|
||||
@retval EFI_NOT_READY Specified AP is busy.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
SwitchBSP (
|
||||
IN EFI_MP_SERVICES_PROTOCOL *This,
|
||||
IN UINTN ProcessorNumber,
|
||||
IN BOOLEAN EnableOldBSP
|
||||
);
|
||||
|
||||
/**
|
||||
Implementation of EnableDisableAP() service of MP Services Protocol.
|
||||
|
||||
This service lets the caller enable or disable an AP.
|
||||
This service may only be called from the BSP.
|
||||
|
||||
@param This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.
|
||||
@param ProcessorNumber The handle number of processor.
|
||||
@param EnableAP Indicates whether the newstate of the AP is enabled or disabled.
|
||||
@param HealthFlag Indicates new health state of the AP..
|
||||
|
||||
@retval EFI_SUCCESS AP successfully enabled or disabled.
|
||||
@retval EFI_DEVICE_ERROR Caller processor is AP.
|
||||
@retval EFI_NOT_FOUND Processor with the handle specified by ProcessorNumber does not exist.
|
||||
@retval EFI_INVALID_PARAMETERS ProcessorNumber specifies the BSP.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
EnableDisableAP (
|
||||
IN EFI_MP_SERVICES_PROTOCOL *This,
|
||||
IN UINTN ProcessorNumber,
|
||||
IN BOOLEAN EnableAP,
|
||||
IN UINT32 *HealthFlag OPTIONAL
|
||||
);
|
||||
|
||||
/**
|
||||
Implementation of WhoAmI() service of MP Services Protocol.
|
||||
|
||||
This service lets the caller processor get its handle number.
|
||||
This service may be called from the BSP and APs.
|
||||
|
||||
@param This A pointer to the EFI_MP_SERVICES_PROTOCOL instance.
|
||||
@param ProcessorNumber Pointer to the handle number of AP.
|
||||
|
||||
@retval EFI_SUCCESS Processor number successfully returned.
|
||||
@retval EFI_INVALID_PARAMETER ProcessorNumber is NULL
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
WhoAmI (
|
||||
IN EFI_MP_SERVICES_PROTOCOL *This,
|
||||
OUT UINTN *ProcessorNumber
|
||||
);
|
||||
|
||||
/**
|
||||
Checks APs' status periodically.
|
||||
|
||||
This function is triggerred by timer perodically to check the
|
||||
state of APs for StartupAllAPs() and StartupThisAP() executed
|
||||
in non-blocking mode.
|
||||
|
||||
@param Event Event triggered.
|
||||
@param Context Parameter passed with the event.
|
||||
|
||||
**/
|
||||
VOID
|
||||
EFIAPI
|
||||
CheckAPsStatus (
|
||||
IN EFI_EVENT Event,
|
||||
IN VOID *Context
|
||||
);
|
||||
|
||||
/**
|
||||
Checks status of all APs.
|
||||
|
||||
This function checks whether all APs have finished task assigned by StartupAllAPs(),
|
||||
and whether timeout expires.
|
||||
|
||||
@retval EFI_SUCCESS All APs have finished task assigned by StartupAllAPs().
|
||||
@retval EFI_TIMEOUT The timeout expires.
|
||||
@retval EFI_NOT_READY APs have not finished task and timeout has not expired.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
CheckAllAPs (
|
||||
VOID
|
||||
);
|
||||
|
||||
/**
|
||||
Checks status of specified AP.
|
||||
|
||||
This function checks whether specified AP has finished task assigned by StartupThisAP(),
|
||||
and whether timeout expires.
|
||||
|
||||
@param ProcessorNumber The handle number of processor.
|
||||
|
||||
@retval EFI_SUCCESS Specified AP has finished task assigned by StartupThisAPs().
|
||||
@retval EFI_TIMEOUT The timeout expires.
|
||||
@retval EFI_NOT_READY Specified AP has not finished task and timeout has not expired.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
CheckThisAP (
|
||||
UINTN ProcessorNumber
|
||||
);
|
||||
|
||||
/**
|
||||
Calculate timeout value and return the current performance counter value.
|
||||
|
||||
Calculate the number of performance counter ticks required for a timeout.
|
||||
If TimeoutInMicroseconds is 0, return value is also 0, which is recognized
|
||||
as infinity.
|
||||
|
||||
@param TimeoutInMicroseconds Timeout value in microseconds.
|
||||
@param CurrentTime Returns the current value of the performance counter.
|
||||
|
||||
@return Expected timestamp counter for timeout.
|
||||
If TimeoutInMicroseconds is 0, return value is also 0, which is recognized
|
||||
as infinity.
|
||||
|
||||
**/
|
||||
UINT64
|
||||
CalculateTimeout (
|
||||
IN UINTN TimeoutInMicroseconds,
|
||||
OUT UINT64 *CurrentTime
|
||||
);
|
||||
|
||||
/**
|
||||
Checks whether timeout expires.
|
||||
|
||||
Check whether the number of ellapsed performance counter ticks required for a timeout condition
|
||||
has been reached. If Timeout is zero, which means infinity, return value is always FALSE.
|
||||
|
||||
@param PreviousTime On input, the value of the performance counter when it was last read.
|
||||
On output, the current value of the performance counter
|
||||
@param TotalTime The total amount of ellapsed time in performance counter ticks.
|
||||
@param Timeout The number of performance counter ticks required to reach a timeout condition.
|
||||
|
||||
@retval TRUE A timeout condition has been reached.
|
||||
@retval FALSE A timeout condition has not been reached.
|
||||
|
||||
**/
|
||||
BOOLEAN
|
||||
CheckTimeout (
|
||||
IN OUT UINT64 *PreviousTime,
|
||||
IN UINT64 *TotalTime,
|
||||
IN UINT64 Timeout
|
||||
);
|
||||
|
||||
/**
|
||||
Searches for the next waiting AP.
|
||||
|
||||
Search for the next AP that is put in waiting state by single-threaded StartupAllAPs().
|
||||
|
||||
@param NextProcessorNumber Pointer to the processor number of the next waiting AP.
|
||||
|
||||
@retval EFI_SUCCESS The next waiting AP has been found.
|
||||
@retval EFI_NOT_FOUND No waiting AP exists.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
GetNextWaitingProcessorNumber (
|
||||
OUT UINTN *NextProcessorNumber
|
||||
);
|
||||
|
||||
/**
|
||||
Wrapper function for all procedures assigned to AP.
|
||||
|
||||
Wrapper function for all procedures assigned to AP via MP service protocol.
|
||||
It controls states of AP and invokes assigned precedure.
|
||||
|
||||
**/
|
||||
VOID
|
||||
ApProcWrapper (
|
||||
VOID
|
||||
);
|
||||
|
||||
/**
|
||||
Function to wake up a specified AP and assign procedure to it.
|
||||
|
||||
@param ProcessorNumber Handle number of the specified processor.
|
||||
@param Procedure Procedure to assign.
|
||||
@param ProcArguments Argument for Procedure.
|
||||
|
||||
**/
|
||||
VOID
|
||||
WakeUpAp (
|
||||
IN UINTN ProcessorNumber,
|
||||
IN EFI_AP_PROCEDURE Procedure,
|
||||
IN VOID *ProcArguments
|
||||
);
|
||||
|
||||
/**
|
||||
Terminate AP's task and set it to idle state.
|
||||
|
||||
This function terminates AP's task due to timeout by sending INIT-SIPI,
|
||||
and sends it to idle state.
|
||||
|
||||
@param ProcessorNumber Handle number of the specified processor.
|
||||
|
||||
**/
|
||||
VOID
|
||||
ResetProcessorToIdleState (
|
||||
UINTN ProcessorNumber
|
||||
);
|
||||
|
||||
/**
|
||||
Worker function of EnableDisableAP ()
|
||||
|
||||
Worker function of EnableDisableAP (). Changes state of specified processor.
|
||||
|
||||
@param ProcessorNumber Processor number of specified AP.
|
||||
@param NewState Desired state of the specified AP.
|
||||
|
||||
@retval EFI_SUCCESS AP's state successfully changed.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
ChangeCpuState (
|
||||
IN UINTN ProcessorNumber,
|
||||
IN BOOLEAN NewState
|
||||
);
|
||||
|
||||
/**
|
||||
Gets the processor number of BSP.
|
||||
|
||||
@return The processor number of BSP.
|
||||
|
||||
**/
|
||||
UINTN
|
||||
GetBspNumber (
|
||||
VOID
|
||||
);
|
||||
|
||||
/**
|
||||
Get address map of RendezvousFunnelProc.
|
||||
|
||||
This function gets address map of RendezvousFunnelProc.
|
||||
|
||||
@param AddressMap Output buffer for address map information
|
||||
|
||||
**/
|
||||
VOID
|
||||
AsmGetAddressMap (
|
||||
OUT MP_ASSEMBLY_ADDRESS_MAP *AddressMap
|
||||
);
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,68 @@
|
|||
#/** @file
|
||||
# Produces PI MP Services Protocol on top of Framework MP Services Protocol.
|
||||
#
|
||||
# Intel's Framework MP Services Protocol is replaced by EFI_MP_SERVICES_PROTOCOL in PI 1.1.
|
||||
# This module produces PI MP Services Protocol on top of Framework MP Services Protocol.
|
||||
#
|
||||
# Copyright (c) 2009, Intel Corporation
|
||||
#
|
||||
# All rights reserved. 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.
|
||||
#
|
||||
#
|
||||
#**/
|
||||
|
||||
[Defines]
|
||||
INF_VERSION = 0x00010005
|
||||
BASE_NAME = MpServicesOnFrameworkMpServicesThunk
|
||||
FILE_GUID = 51739E2A-A022-4D73-ADB9-91F0C9BC7142
|
||||
MODULE_TYPE = DXE_DRIVER
|
||||
ENTRY_POINT = InitializeMpServicesProtocol
|
||||
|
||||
#
|
||||
# The following information is for reference only and not required by the build tools.
|
||||
#
|
||||
# VALID_ARCHITECTURES = IA32 X64
|
||||
#
|
||||
|
||||
[Sources.common]
|
||||
MpServicesOnFrameworkMpServicesThunk.c
|
||||
MpServicesOnFrameworkMpServicesThunk.h
|
||||
|
||||
[Sources.X64]
|
||||
X64/MpFuncs.asm
|
||||
X64/MpFuncs.S
|
||||
|
||||
[Sources.IA32]
|
||||
IA32/MpFuncs.asm
|
||||
IA32/MpFuncs.S
|
||||
|
||||
[Packages]
|
||||
MdePkg/MdePkg.dec
|
||||
MdeModulePkg/MdeModulePkg.dec
|
||||
IntelFrameworkPkg/IntelFrameworkPkg.dec
|
||||
|
||||
[LibraryClasses]
|
||||
TimerLib
|
||||
IoLib
|
||||
UefiBootServicesTableLib
|
||||
DxeServicesTableLib
|
||||
MemoryAllocationLib
|
||||
UefiDriverEntryPoint
|
||||
BaseMemoryLib
|
||||
UefiLib
|
||||
DebugLib
|
||||
BaseLib
|
||||
SynchronizationLib
|
||||
|
||||
[Protocols]
|
||||
gEfiMpServiceProtocolGuid ## PRODUCES
|
||||
gFrameworkEfiMpServiceProtocolGuid ## CONSUMES
|
||||
gEfiGenericMemTestProtocolGuid ## SOMETIMES_CONSUMES
|
||||
|
||||
[Depex]
|
||||
gFrameworkEfiMpServiceProtocolGuid
|
||||
|
|
@ -0,0 +1,26 @@
|
|||
;------------------------------------------------------------------------------
|
||||
; Include file for X64 MpFuncs.asm
|
||||
;
|
||||
; Copyright (c) 2009, Intel Corporation
|
||||
; All rights reserved. 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.
|
||||
;
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
VacantFlag Equ 00h
|
||||
NotVacantFlag Equ 0ffh
|
||||
|
||||
LockLocation equ RendezvousFunnelProcEnd - RendezvousFunnelProcStart
|
||||
StackStartAddressLocation equ LockLocation + 08h
|
||||
StackSizeLocation equ LockLocation + 10h
|
||||
CProcedureLocation equ LockLocation + 18h
|
||||
GdtrLocation equ LockLocation + 20h
|
||||
BufferStartLocation equ LockLocation + 2Ch
|
||||
Cr3OffsetLocation equ LockLocation + 30h
|
||||
|
||||
;-------------------------------------------------------------------------------
|
||||
|
|
@ -0,0 +1,189 @@
|
|||
#------------------------------------------------------------------------------
|
||||
# X64 assembly file for AP startup vector.
|
||||
#
|
||||
# Copyright (c) 2009, Intel Corporation
|
||||
# All rights reserved. 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.
|
||||
#
|
||||
#------------------------------------------------------------------------------
|
||||
|
||||
|
||||
.equ VacantFlag, 0x0
|
||||
.equ NotVacantFlag, 0xff
|
||||
|
||||
.equ LockLocation, RendezvousFunnelProcEnd - RendezvousFunnelProcStart
|
||||
.equ StackStartAddressLocation, RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x08
|
||||
.equ StackSizeLocation, RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x10
|
||||
.equ CProcedureLocation, RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x18
|
||||
.equ GdtrLocation, RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x20
|
||||
.equ BufferStartLocation, RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x2C
|
||||
.equ Cr3OffsetLocation, RendezvousFunnelProcEnd - RendezvousFunnelProcStart + 0x30
|
||||
|
||||
#-------------------------------------------------------------------------------------
|
||||
|
||||
#-------------------------------------------------------------------------------------
|
||||
#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);
|
||||
|
||||
.text
|
||||
|
||||
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
|
||||
|
||||
# Switch to flat mode.
|
||||
|
||||
.byte 0xBE
|
||||
.word BufferStartLocation
|
||||
.byte 0x66,0x8B,0x14 # mov edx,dword ptr [si] ; EDX is keeping the start address of wakeup buffer
|
||||
|
||||
.byte 0xBE
|
||||
.word Cr3OffsetLocation
|
||||
.byte 0x66,0x8B,0xC # mov ecx,dword ptr [si] ; ECX is keeping the value of CR3
|
||||
|
||||
.byte 0xBE
|
||||
.word GdtrLocation
|
||||
.byte 0x66 # db 66h
|
||||
.byte 0x2E,0xF,0x1,0x14 # lgdt 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
|
||||
|
||||
ProtectedModeStart:
|
||||
|
||||
.byte 0x66,0xB8,0x18,0x0 # mov ax, 18h
|
||||
.byte 0x66,0x8E,0xD8 # mov ds, ax
|
||||
.byte 0x66,0x8E,0xC0 # mov es, ax
|
||||
.byte 0x66,0x8E,0xE0 # mov fs, ax
|
||||
.byte 0x66,0x8E,0xE8 # mov gs, ax
|
||||
.byte 0x66,0x8E,0xD0 # mov ss, ax ; Flat mode setup.
|
||||
|
||||
.byte 0xF,0x20,0xE0 # mov eax, cr4
|
||||
.byte 0xF,0xBA,0xE8,0x5 # bts eax, 5
|
||||
.byte 0xF,0x22,0xE0 # mov cr4, eax
|
||||
|
||||
.byte 0xF,0x22,0xD9 # mov cr3, ecx
|
||||
|
||||
.byte 0x8B,0xF2 # mov esi, edx ; Save wakeup buffer address
|
||||
|
||||
.byte 0xB9
|
||||
.long 0xC0000080 # mov ecx, 0c0000080h ; EFER MSR number.
|
||||
.byte 0xF,0x32 # rdmsr ; Read EFER.
|
||||
.byte 0xF,0xBA,0xE8,0x8 # bts eax, 8 ; Set LME=1.
|
||||
.byte 0xF,0x30 # wrmsr ; Write EFER.
|
||||
|
||||
.byte 0xF,0x20,0xC0 # mov eax, cr0 ; Read CR0.
|
||||
.byte 0xF,0xBA,0xE8,0x1F # bts eax, 31 ; Set PG=1.
|
||||
.byte 0xF,0x22,0xC0 # mov cr0, eax ; Write CR0.
|
||||
|
||||
LONG_JUMP:
|
||||
|
||||
.byte 0x67,0xEA # far jump
|
||||
.long 0x0 # 32-bit offset
|
||||
.word 0x38 # 16-bit selector
|
||||
|
||||
LongModeStart:
|
||||
|
||||
movw $0x30,%ax
|
||||
.byte 0x66
|
||||
movw %ax,%ds
|
||||
.byte 0x66
|
||||
movw %ax,%es
|
||||
.byte 0x66
|
||||
movw %ax,%ss
|
||||
|
||||
movl %esi, %edi
|
||||
addl $LockLocation, %edi
|
||||
movb $NotVacantFlag, %al
|
||||
TestLock:
|
||||
xchgb (%edi), %al
|
||||
cmpb $NotVacantFlag, %al
|
||||
jz TestLock
|
||||
|
||||
ProgramStack:
|
||||
|
||||
movl %esi, %edi
|
||||
addl $StackSizeLocation, %edi
|
||||
movq (%edi), %rax
|
||||
movl %esi, %edi
|
||||
addl $StackStartAddressLocation, %edi
|
||||
addq (%edi), %rax
|
||||
movq %rax, %rsp
|
||||
movq %rax, (%edi)
|
||||
|
||||
Releaselock:
|
||||
|
||||
movb $VacantFlag, %al
|
||||
movl %esi, %edi
|
||||
addl $LockLocation, %edi
|
||||
xchgb (%edi), %al
|
||||
|
||||
#
|
||||
# Call C Function
|
||||
#
|
||||
movl %esi,%edi
|
||||
addl $CProcedureLocation, %edi
|
||||
movq (%edi), %rax
|
||||
|
||||
testq %rax, %rax
|
||||
jz GoToSleep
|
||||
|
||||
subq $0x20, %rsp
|
||||
call *%rax
|
||||
addq $0x20, %rsp
|
||||
|
||||
GoToSleep:
|
||||
|
||||
cli
|
||||
hlt
|
||||
jmp .-2
|
||||
|
||||
RendezvousFunnelProcEnd:
|
||||
|
||||
|
||||
#-------------------------------------------------------------------------------------
|
||||
# AsmGetAddressMap (&AddressMap);
|
||||
#-------------------------------------------------------------------------------------
|
||||
# comments here for definition of address map
|
||||
ASM_GLOBAL ASM_PFX(AsmGetAddressMap)
|
||||
ASM_PFX(AsmGetAddressMap):
|
||||
|
||||
movq $RendezvousFunnelProcStart, %rax
|
||||
movq %rax, (%rcx)
|
||||
movq $(ProtectedModeStart - RendezvousFunnelProcStart), 0x08(%rcx)
|
||||
movq $(FLAT32_JUMP - RendezvousFunnelProcStart), 0x10(%rcx)
|
||||
movq $(LongModeStart - RendezvousFunnelProcStart), 0x18(%rcx)
|
||||
movq $(LONG_JUMP - RendezvousFunnelProcStart), 0x20(%rcx)
|
||||
movq $(RendezvousFunnelProcEnd - RendezvousFunnelProcStart), 0x28(%rcx)
|
||||
|
||||
ret
|
||||
|
|
@ -0,0 +1,177 @@
|
|||
;------------------------------------------------------------------------------
|
||||
; X64 assembly file for AP startup vector.
|
||||
;
|
||||
; Copyright (c) 2009, Intel Corporation
|
||||
; All rights reserved. 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.
|
||||
;
|
||||
;------------------------------------------------------------------------------
|
||||
|
||||
.code
|
||||
|
||||
include AsmInclude.inc
|
||||
;-------------------------------------------------------------------------------------
|
||||
|
||||
;-------------------------------------------------------------------------------------
|
||||
;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);
|
||||
|
||||
RendezvousFunnelProc PROC PUBLIC
|
||||
RendezvousFunnelProcStart::
|
||||
|
||||
; At this point CS = 0x(vv00) and ip= 0x0.
|
||||
|
||||
db 8ch, 0c8h ; mov ax, cs
|
||||
db 8eh, 0d8h ; mov ds, ax
|
||||
db 8eh, 0c0h ; mov es, ax
|
||||
db 8eh, 0d0h ; mov ss, ax
|
||||
db 33h, 0c0h ; xor ax, ax
|
||||
db 8eh, 0e0h ; mov fs, ax
|
||||
db 8eh, 0e8h ; mov gs, ax
|
||||
|
||||
; Switch to flat mode.
|
||||
|
||||
db 0BEh
|
||||
dw BufferStartLocation ; mov si, BufferStartLocation
|
||||
db 66h, 8Bh, 14h ; mov edx,dword ptr [si] ; EDX is keeping the start address of wakeup buffer
|
||||
|
||||
db 0BEh
|
||||
dw Cr3OffsetLocation ; mov si, Cr3Location
|
||||
db 66h, 8Bh, 0Ch ; mov ecx,dword ptr [si] ; ECX is keeping the value of CR3
|
||||
|
||||
db 0BEh
|
||||
dw GdtrLocation ; mov si, GdtrProfile
|
||||
db 66h ; db 66h
|
||||
db 2Eh, 0Fh, 01h, 14h ; lgdt fword ptr cs:[si]
|
||||
|
||||
db 33h, 0C0h ; xor ax, ax
|
||||
db 8Eh, 0D8h ; mov ds, ax
|
||||
|
||||
db 0Fh, 20h, 0C0h ; mov eax, cr0 ; Get control register 0
|
||||
db 66h, 83h, 0C8h, 01h ; or eax, 000000001h ; Set PE bit (bit #0)
|
||||
db 0Fh, 22h, 0C0h ; mov cr0, eax
|
||||
|
||||
FLAT32_JUMP::
|
||||
|
||||
db 66h, 67h, 0EAh ; far jump
|
||||
dd 0h ; 32-bit offset
|
||||
dw 20h ; 16-bit selector
|
||||
|
||||
ProtectedModeStart::
|
||||
|
||||
db 66h, 0B8h, 18h, 00h ; mov ax, 18h
|
||||
db 66h, 8Eh, 0D8h ; mov ds, ax
|
||||
db 66h, 8Eh, 0C0h ; mov es, ax
|
||||
db 66h, 8Eh, 0E0h ; mov fs, ax
|
||||
db 66h, 8Eh, 0E8h ; mov gs, ax
|
||||
db 66h, 8Eh, 0D0h ; mov ss, ax ; Flat mode setup.
|
||||
|
||||
db 0Fh, 20h, 0E0h ; mov eax, cr4
|
||||
db 0Fh, 0BAh, 0E8h, 05h ; bts eax, 5
|
||||
db 0Fh, 22h, 0E0h ; mov cr4, eax
|
||||
|
||||
db 0Fh, 22h, 0D9h ; mov cr3, ecx
|
||||
|
||||
db 8Bh, 0F2h ; mov esi, edx ; Save wakeup buffer address
|
||||
|
||||
db 0B9h
|
||||
dd 0C0000080h ; mov ecx, 0c0000080h ; EFER MSR number.
|
||||
db 0Fh, 32h ; rdmsr ; Read EFER.
|
||||
db 0Fh, 0BAh, 0E8h, 08h ; bts eax, 8 ; Set LME=1.
|
||||
db 0Fh, 30h ; wrmsr ; Write EFER.
|
||||
|
||||
db 0Fh, 20h, 0C0h ; mov eax, cr0 ; Read CR0.
|
||||
db 0Fh, 0BAh, 0E8h, 1Fh ; bts eax, 31 ; Set PG=1.
|
||||
db 0Fh, 22h, 0C0h ; mov cr0, eax ; Write CR0.
|
||||
|
||||
LONG_JUMP::
|
||||
|
||||
db 67h, 0EAh ; far jump
|
||||
dd 0h ; 32-bit offset
|
||||
dw 38h ; 16-bit selector
|
||||
|
||||
LongModeStart::
|
||||
|
||||
mov ax, 30h
|
||||
mov ds, ax
|
||||
mov es, ax
|
||||
mov ss, ax
|
||||
|
||||
mov edi, esi
|
||||
add edi, LockLocation
|
||||
mov al, NotVacantFlag
|
||||
TestLock::
|
||||
xchg byte ptr [edi], al
|
||||
cmp al, NotVacantFlag
|
||||
jz TestLock
|
||||
|
||||
ProgramStack::
|
||||
|
||||
mov edi, esi
|
||||
add edi, StackSizeLocation
|
||||
mov rax, qword ptr [edi]
|
||||
mov edi, esi
|
||||
add edi, StackStartAddressLocation
|
||||
add rax, qword ptr [edi]
|
||||
mov rsp, rax
|
||||
mov qword ptr [edi], rax
|
||||
|
||||
Releaselock::
|
||||
|
||||
mov al, VacantFlag
|
||||
mov edi, esi
|
||||
add edi, LockLocation
|
||||
xchg byte ptr [edi], al
|
||||
|
||||
;
|
||||
; Call C Function
|
||||
;
|
||||
mov edi, esi
|
||||
add edi, CProcedureLocation
|
||||
mov rax, qword ptr [edi]
|
||||
|
||||
test rax, rax
|
||||
jz GoToSleep
|
||||
|
||||
sub rsp, 20h
|
||||
call rax
|
||||
add rsp, 20h
|
||||
|
||||
GoToSleep::
|
||||
|
||||
cli
|
||||
hlt
|
||||
jmp $-2
|
||||
|
||||
RendezvousFunnelProc ENDP
|
||||
RendezvousFunnelProcEnd::
|
||||
|
||||
|
||||
;-------------------------------------------------------------------------------------
|
||||
; AsmGetAddressMap (&AddressMap);
|
||||
;-------------------------------------------------------------------------------------
|
||||
AsmGetAddressMap PROC
|
||||
|
||||
mov rax, offset RendezvousFunnelProcStart
|
||||
mov qword ptr [rcx], rax
|
||||
mov qword ptr [rcx+8h], ProtectedModeStart - RendezvousFunnelProcStart
|
||||
mov qword ptr [rcx+10h], FLAT32_JUMP - RendezvousFunnelProcStart
|
||||
mov qword ptr [rcx+18h], LongModeStart - RendezvousFunnelProcStart
|
||||
mov qword ptr [rcx+20h], LONG_JUMP - RendezvousFunnelProcStart
|
||||
mov qword ptr [rcx+28h], RendezvousFunnelProcEnd - RendezvousFunnelProcStart
|
||||
|
||||
ret
|
||||
|
||||
AsmGetAddressMap ENDP
|
||||
|
||||
END
|
||||
|
|
@ -62,6 +62,7 @@ define GCC_MACRO = -DEFI_SPECIFICATION_VERSION=0x00020000 -DPI_S
|
|||
PeiServicesLib|MdePkg/Library/PeiServicesLib/PeiServicesLib.inf
|
||||
PeiServicesTablePointerLib|MdePkg/Library/PeiServicesTablePointerLib/PeiServicesTablePointerLib.inf
|
||||
LanguageLib|EdkCompatibilityPkg/Compatibility/Library/UefiLanguageLib/UefiLanguageLib.inf
|
||||
DxeServicesTableLib|MdePkg/Library/DxeServicesTableLib/DxeServicesTableLib.inf
|
||||
|
||||
[LibraryClasses.common.PEIM]
|
||||
HobLib|MdePkg/Library/PeiHobLib/PeiHobLib.inf
|
||||
|
|
@ -242,6 +243,7 @@ define GCC_MACRO = -DEFI_SPECIFICATION_VERSION=0x00020000 -DPI_S
|
|||
EdkCompatibilityPkg/Compatibility/UcOnUc2Thunk/UcOnUc2Thunk.inf
|
||||
EdkCompatibilityPkg/Compatibility/PrintThunk/PrintThunk.inf
|
||||
EdkCompatibilityPkg/Compatibility/LegacyRegion2OnLegacyRegionThunk/LegacyRegion2OnLegacyRegionThunk.inf
|
||||
EdkCompatibilityPkg/Compatibility/MpServicesOnFrameworkMpServicesThunk/MpServicesOnFrameworkMpServicesThunk.inf
|
||||
EdkCompatibilityPkg/Compatibility/CpuIo2OnCpuIoThunk/CpuIo2OnCpuIoThunk.inf
|
||||
|
||||
#
|
||||
|
|
|
|||
Loading…
Reference in New Issue