;------------------------------------------------------------------------------ ; ; Copyright (c) 2012, 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. ; ; Module Name: ; ; ExceptionHandlerAsm.Asm ; ; Abstract: ; ; IA32 CPU Exception Handler ; ; Notes: ; ;------------------------------------------------------------------------------ .686 .model flat,C ; ; CommonExceptionHandler() ; CommonExceptionHandler PROTO C .data CommonEntryAddr DD CommonInterruptEntry EXTRN mErrorCodeFlag:DWORD ; Error code flags for exceptions .code ; ; exception handler stub table ; Exception0Handle: push 0 jmp dword ptr [CommonEntryAddr] Exception1Handle: push 1 jmp dword ptr [CommonEntryAddr] Exception2Handle: push 2 jmp dword ptr [CommonEntryAddr] Exception3Handle: push 3 jmp dword ptr [CommonEntryAddr] Exception4Handle: push 4 jmp dword ptr [CommonEntryAddr] Exception5Handle: push 5 jmp dword ptr [CommonEntryAddr] Exception6Handle: push 6 jmp dword ptr [CommonEntryAddr] Exception7Handle: push 7 jmp dword ptr [CommonEntryAddr] Exception8Handle: push 8 jmp dword ptr [CommonEntryAddr] Exception9Handle: push 9 jmp dword ptr [CommonEntryAddr] Exception10Handle: push 10 jmp dword ptr [CommonEntryAddr] Exception11Handle: push 11 jmp dword ptr [CommonEntryAddr] Exception12Handle: push 12 jmp dword ptr [CommonEntryAddr] Exception13Handle: push 13 jmp dword ptr [CommonEntryAddr] Exception14Handle: push 14 jmp dword ptr [CommonEntryAddr] Exception15Handle: push 15 jmp dword ptr [CommonEntryAddr] Exception16Handle: push 16 jmp dword ptr [CommonEntryAddr] Exception17Handle: push 17 jmp dword ptr [CommonEntryAddr] Exception18Handle: push 18 jmp dword ptr [CommonEntryAddr] Exception19Handle: push 19 jmp dword ptr [CommonEntryAddr] Exception20Handle: push 20 jmp dword ptr [CommonEntryAddr] Exception21Handle: push 21 jmp dword ptr [CommonEntryAddr] Exception22Handle: push 22 jmp dword ptr [CommonEntryAddr] Exception23Handle: push 23 jmp dword ptr [CommonEntryAddr] Exception24Handle: push 24 jmp dword ptr [CommonEntryAddr] Exception25Handle: push 25 jmp dword ptr [CommonEntryAddr] Exception26Handle: push 26 jmp dword ptr [CommonEntryAddr] Exception27Handle: push 27 jmp dword ptr [CommonEntryAddr] Exception28Handle: push 28 jmp dword ptr [CommonEntryAddr] Exception29Handle: push 29 jmp dword ptr [CommonEntryAddr] Exception30Handle: push 30 jmp dword ptr [CommonEntryAddr] Exception31Handle: push 31 jmp dword ptr [CommonEntryAddr] ;----------------------------------------------------------------------------; ; CommonInterruptEntry ; ;----------------------------------------------------------------------------; ; The follow algorithm is used for the common interrupt routine. ; Entry from each interrupt with a push eax and eax=interrupt number CommonInterruptEntry PROC PUBLIC cli ; ; All interrupt handlers are invoked through interrupt gates, so ; IF flag automatically cleared at the entry point ; ; ; Calculate vector number ; ; Get the return address of call, actually, it is the ; address of vector number. ; xchg ecx, [esp] and ecx, 0FFFFh cmp ecx, 32 ; Intel reserved vector for exceptions? jae NoErrorCode bt mErrorCodeFlag, ecx jc HasErrorCode NoErrorCode: ; ; Stack: ; +---------------------+ ; + EFlags + ; +---------------------+ ; + CS + ; +---------------------+ ; + EIP + ; +---------------------+ ; + ECX + ; +---------------------+ <-- ESP ; ; Registers: ; ECX - Vector Number ; ; ; Put Vector Number on stack ; push ecx ; ; Put 0 (dummy) error code on stack, and restore ECX ; xor ecx, ecx ; ECX = 0 xchg ecx, [esp+4] jmp ErrorCodeAndVectorOnStack HasErrorCode: ; ; Stack: ; +---------------------+ ; + EFlags + ; +---------------------+ ; + CS + ; +---------------------+ ; + EIP + ; +---------------------+ ; + Error Code + ; +---------------------+ ; + ECX + ; +---------------------+ <-- ESP ; ; Registers: ; ECX - Vector Number ; ; ; Put Vector Number on stack and restore ECX ; xchg ecx, [esp] ; ; Fall through to join main routine code ; at ErrorCodeAndVectorOnStack ; @@: jmp @B ErrorCodeAndVectorOnStack: push ebp mov ebp, esp ; ; Stack: ; +---------------------+ ; + EFlags + ; +---------------------+ ; + CS + ; +---------------------+ ; + EIP + ; +---------------------+ ; + Error Code + ; +---------------------+ ; + Vector Number + ; +---------------------+ ; + EBP + ; +---------------------+ <-- EBP ; ; ; Align stack to make sure that EFI_FX_SAVE_STATE_IA32 of EFI_SYSTEM_CONTEXT_IA32 ; is 16-byte aligned ; and esp, 0fffffff0h sub esp, 12 ;; UINT32 Edi, Esi, Ebp, Esp, Ebx, Edx, Ecx, Eax; push eax push ecx push edx push ebx lea ecx, [ebp + 6 * 4] push ecx ; ESP push dword ptr [ebp] ; EBP push esi push edi ;; UINT32 Gs, Fs, Es, Ds, Cs, Ss; mov eax, ss push eax movzx eax, word ptr [ebp + 4 * 4] push eax mov eax, ds push eax mov eax, es push eax mov eax, fs push eax mov eax, gs push eax ;; UINT32 Eip; mov eax, [ebp + 3 * 4] push eax ;; UINT32 Gdtr[2], Idtr[2]; sub esp, 8 sidt [esp] mov eax, [esp + 2] xchg eax, [esp] and eax, 0FFFFh mov [esp+4], eax sub esp, 8 sgdt [esp] mov eax, [esp + 2] xchg eax, [esp] and eax, 0FFFFh mov [esp+4], eax ;; UINT32 Ldtr, Tr; xor eax, eax str ax push eax sldt ax push eax ;; UINT32 EFlags; mov eax, [ebp + 5 * 4] push eax ;; UINT32 Cr0, Cr1, Cr2, Cr3, Cr4; mov eax, cr4 or eax, 208h mov cr4, eax push eax mov eax, cr3 push eax mov eax, cr2 push eax xor eax, eax push eax mov eax, cr0 push eax ;; UINT32 Dr0, Dr1, Dr2, Dr3, Dr6, Dr7; mov eax, dr7 push eax mov eax, dr6 push eax mov eax, dr3 push eax mov eax, dr2 push eax mov eax, dr1 push eax mov eax, dr0 push eax ;; FX_SAVE_STATE_IA32 FxSaveState; sub esp, 512 mov edi, esp db 0fh, 0aeh, 07h ;fxsave [edi] ;; UEFI calling convention for IA32 requires that Direction flag in EFLAGs is clear cld ;; UINT32 ExceptionData; push dword ptr [ebp + 2 * 4] ;; Prepare parameter and call mov edx, esp push edx mov edx, dword ptr [ebp + 1 * 4] push edx ; ; Call External Exception Handler ; mov eax, CommonExceptionHandler call eax add esp, 8 cli ;; UINT32 ExceptionData; add esp, 4 ;; FX_SAVE_STATE_IA32 FxSaveState; mov esi, esp db 0fh, 0aeh, 0eh ; fxrstor [esi] add esp, 512 ;; UINT32 Dr0, Dr1, Dr2, Dr3, Dr6, Dr7; ;; Skip restoration of DRx registers to support in-circuit emualators ;; or debuggers set breakpoint in interrupt/exception context add esp, 4 * 6 ;; UINT32 Cr0, Cr1, Cr2, Cr3, Cr4; pop eax mov cr0, eax add esp, 4 ; not for Cr1 pop eax mov cr2, eax pop eax mov cr3, eax pop eax mov cr4, eax ;; UINT32 EFlags; pop dword ptr [ebp + 5 * 4] ;; UINT32 Ldtr, Tr; ;; UINT32 Gdtr[2], Idtr[2]; ;; Best not let anyone mess with these particular registers... add esp, 24 ;; UINT32 Eip; pop dword ptr [ebp + 3 * 4] ;; UINT32 Gs, Fs, Es, Ds, Cs, Ss; ;; NOTE - modified segment registers could hang the debugger... We ;; could attempt to insulate ourselves against this possibility, ;; but that poses risks as well. ;; pop gs pop fs pop es pop ds pop dword ptr [ebp + 4 * 4] pop ss ;; UINT32 Edi, Esi, Ebp, Esp, Ebx, Edx, Ecx, Eax; pop edi pop esi add esp, 4 ; not for ebp add esp, 4 ; not for esp pop ebx pop edx pop ecx pop eax mov esp, ebp pop ebp add esp, 8 iretd CommonInterruptEntry ENDP ;---------------------------------------; ; _GetTemplateAddressMap ; ;----------------------------------------------------------------------------; ; ; Protocol prototype ; GetTemplateAddressMap ( ; EXCEPTION_HANDLER_TEMPLATE_MAP *AddressMap ; ); ; ; Routine Description: ; ; Return address map of interrupt handler template so that C code can generate ; interrupt table. ; ; Arguments: ; ; ; Returns: ; ; Nothing ; ; ; Input: [ebp][0] = Original ebp ; [ebp][4] = Return address ; ; Output: Nothing ; ; Destroys: Nothing ;-----------------------------------------------------------------------------; GetTemplateAddressMap proc near public push ebp ; C prolog mov ebp, esp pushad mov ebx, dword ptr [ebp+08h] mov dword ptr [ebx], Exception0Handle mov dword ptr [ebx+4h], Exception1Handle - Exception0Handle popad pop ebp ret GetTemplateAddressMap ENDP END