mirror of https://github.com/acidanthera/audk.git
207 lines
7.7 KiB
NASM
207 lines
7.7 KiB
NASM
|
;------------------------------------------------------------------------------ ;
|
||
|
|
; 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.asm
|
||
|
|
;
|
||
|
|
; Abstract:
|
||
|
|
;
|
||
|
|
; This is the assembly code for Multi-processor S3 support
|
||
|
|
;
|
||
|
|
;-------------------------------------------------------------------------------
|
||
|
|
|
||
|
|
EXTERN InitializeFloatingPointUnits:PROC
|
||
|
|
|
||
|
|
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
|
||
|
|
IdtrLocation equ LockLocation + 2Ah
|
||
|
|
BufferStartLocation equ LockLocation + 34h
|
||
|
|
Cr3OffsetLocation equ LockLocation + 38h
|
||
|
|
|
||
|
|
;-------------------------------------------------------------------------------------
|
||
|
|
;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 SEGMENT
|
||
|
|
.code
|
||
|
|
|
||
|
|
RendezvousFunnelProc PROC
|
||
|
|
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
|
||
|
|
|
||
|
|
flat32Start::
|
||
|
|
|
||
|
|
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 0BEh
|
||
|
|
dw IdtrLocation ; mov si, IdtrProfile
|
||
|
|
db 66h ; db 66h
|
||
|
|
db 2Eh, 0Fh, 01h, 1Ch ; lidt 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
|
||
|
|
|
||
|
|
PMODE_ENTRY:: ; protected mode entry point
|
||
|
|
|
||
|
|
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 assembly function to initialize FPU.
|
||
|
|
;
|
||
|
|
mov rax, InitializeFloatingPointUnits
|
||
|
|
sub rsp, 20h
|
||
|
|
call rax
|
||
|
|
add rsp, 20h
|
||
|
|
|
||
|
|
;
|
||
|
|
; 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
|
||
|
|
|
||
|
|
RendezvousFunnelProcEnd::
|
||
|
|
RendezvousFunnelProc ENDP
|
||
|
|
|
||
|
|
|
||
|
|
;-------------------------------------------------------------------------------------
|
||
|
|
; AsmGetAddressMap (&AddressMap);
|
||
|
|
;-------------------------------------------------------------------------------------
|
||
|
|
; comments here for definition of address map
|
||
|
|
AsmGetAddressMap PROC
|
||
|
|
mov rax, offset RendezvousFunnelProcStart
|
||
|
|
mov qword ptr [rcx], rax
|
||
|
|
mov qword ptr [rcx+8h], PMODE_ENTRY - RendezvousFunnelProcStart
|
||
|
|
mov qword ptr [rcx+10h], FLAT32_JUMP - RendezvousFunnelProcStart
|
||
|
|
mov qword ptr [rcx+18h], RendezvousFunnelProcEnd - RendezvousFunnelProcStart
|
||
|
|
mov qword ptr [rcx+20h], LongModeStart - RendezvousFunnelProcStart
|
||
|
|
mov qword ptr [rcx+28h], LONG_JUMP - RendezvousFunnelProcStart
|
||
|
|
ret
|
||
|
|
|
||
|
|
AsmGetAddressMap ENDP
|
||
|
|
|
||
|
|
END
|