1 ;------------------------------------------------------------------------------ ;
2 ; Copyright (c) 2015 - 2016, Intel Corporation. All rights reserved.<BR>
3 ; This program and the accompanying materials
4 ; are licensed and made available under the terms and conditions of the BSD License
5 ; which accompanies this distribution. The full text of the license may be found at
6 ; http://opensource.org/licenses/bsd-license.php.
8 ; THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
9 ; WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
17 ; This is the assembly code for MP support
19 ;-------------------------------------------------------------------------------
22 extern ASM_PFX(InitializeFloatingPointUnits)
26 ;-------------------------------------------------------------------------------------
27 ;RendezvousFunnelProc procedure follows. All APs execute their procedure. This
28 ;procedure serializes all the AP processors through an Init sequence. It must be
29 ;noted that APs arrive here very raw...ie: real mode, no stack.
30 ;ALSO THIS PROCEDURE IS EXECUTED BY APs ONLY ON 16 BIT MODE. HENCE THIS PROC
32 ;-------------------------------------------------------------------------------------
33 global ASM_PFX(RendezvousFunnelProc)
34 ASM_PFX(RendezvousFunnelProc):
35 RendezvousFunnelProcStart:
36 ; At this point CS = 0x(vv00) and ip= 0x0.
38 mov ebp, eax ; save BIST information
48 mov si, BufferStartLocation
51 mov si, ModeOffsetLocation
53 mov si, CodeSegmentLocation
62 mov si, DataSegmentLocation
74 mov eax, cr0 ; Get control register 0
75 or eax, 000000003h ; Set PE bit (bit #0) & MP
78 jmp 0:strict dword 0 ; far jump to protected mode
80 Flat32Start: ; protected mode entry point
90 add edi, EnableExecuteDisableLocation
92 jz SkipEnableExecuteDisable
95 ; Enable IA32 PAE execute disable
116 SkipEnableExecuteDisable:
118 add edi, InitFlagLocation
119 cmp dword [edi], 1 ; 1 == ApInitConfig
124 add edi, LockLocation
125 mov eax, NotVacantFlag
129 cmp eax, NotVacantFlag
133 add ecx, NumApsExecutingLocation
142 add edi, StackSizeLocation
146 mul ecx ; EAX = StackSize * (CpuNumber + 1)
148 add edi, StackStartAddressLocation
158 ; Processor is not x2APIC capable, so get 8-bit APIC ID
163 jmp GetProcessorNumber
166 ; Processor is x2APIC capable, so get 32-bit x2APIC ID
174 ; Get processor number for this AP
175 ; Note that BSP may become an AP due to SwitchBsp()
178 lea eax, [esi + CpuInfoLocation]
182 cmp [edi], edx ; APIC ID match?
186 jmp GetNextProcNumber
192 push ebp ; push BIST data at top of AP stack
193 xor ebp, ebp ; clear ebp for call stack trace
197 mov eax, ASM_PFX(InitializeFloatingPointUnits)
198 call eax ; Call assembly function to initialize FPU per UEFI spec
200 push ebx ; Push NumApsExecuting
202 add eax, LockLocation
203 push eax ; push address of exchange info data buffer
206 add edi, ApProcedureLocation
209 call eax ; Invoke C function
211 jmp $ ; Never reach here
212 RendezvousFunnelProcEnd:
214 ;-------------------------------------------------------------------------------------
215 ; AsmRelocateApLoop (MwaitSupport, ApTargetCState, PmCodeSegment);
216 ;-------------------------------------------------------------------------------------
217 global ASM_PFX(AsmRelocateApLoop)
218 ASM_PFX(AsmRelocateApLoop):
219 AsmRelocateApLoopStart:
220 cmp byte [esp + 4], 1
227 mov eax, [esp + 8] ; Mwait Cx, Target C-State per eax[7:4]
236 AsmRelocateApLoopEnd:
238 ;-------------------------------------------------------------------------------------
239 ; AsmGetAddressMap (&AddressMap);
240 ;-------------------------------------------------------------------------------------
241 global ASM_PFX(AsmGetAddressMap)
242 ASM_PFX(AsmGetAddressMap):
247 mov dword [ebx], RendezvousFunnelProcStart
248 mov dword [ebx + 4h], Flat32Start - RendezvousFunnelProcStart
249 mov dword [ebx + 8h], RendezvousFunnelProcEnd - RendezvousFunnelProcStart
250 mov dword [ebx + 0Ch], AsmRelocateApLoopStart
251 mov dword [ebx + 10h], AsmRelocateApLoopEnd - AsmRelocateApLoopStart
256 ;-------------------------------------------------------------------------------------
257 ;AsmExchangeRole procedure follows. This procedure executed by current BSP, that is
258 ;about to become an AP. It switches it'stack with the current AP.
259 ;AsmExchangeRole (IN CPU_EXCHANGE_INFO *MyInfo, IN CPU_EXCHANGE_INFO *OthersInfo);
260 ;-------------------------------------------------------------------------------------
261 global ASM_PFX(AsmExchangeRole)
262 ASM_PFX(AsmExchangeRole):
263 ; DO NOT call other functions in this function, since 2 CPU may use 1 stack
264 ; at the same time. If 1 CPU try to call a function, stack will be corrupted.
268 ; esi contains MyInfo pointer
271 ; edi contains OthersInfo pointer
274 ;Store EFLAGS, GDTR and IDTR register to stack
277 push eax ; push cr4 firstly
284 ; Store the its StackPointer
287 ; update its switch state to STORED
288 mov byte [esi], CPU_SWITCH_STATE_STORED
291 ; wait until the other CPU finish storing its state
292 cmp byte [edi], CPU_SWITCH_STATE_STORED
295 jmp WaitForOtherStored
298 ; Since another CPU already stored its state, load them
305 ; load its future StackPointer
308 ; update the other CPU's switch state to LOADED
309 mov byte [edi], CPU_SWITCH_STATE_LOADED
312 ; wait until the other CPU finish loading new state,
313 ; otherwise the data in stack may corrupt
314 cmp byte [esi], CPU_SWITCH_STATE_LOADED
317 jmp WaitForOtherLoaded
320 ; since the other CPU already get the data it want, leave this procedure