1. Add DebugAgentPei driver to initialize Debug Agent in PEI phase. Add DebugAgentDxe driver to initialize Debug Agent in DXE phase. DebugAgentDxe driver could be loaded and unloaded in shell. 2. Update the SourceLevelDebugPkg so that the debug agent can be initialized in any phase: SEC, PEI or DXE. 3. Add an enhanced retry algorithm that provides a robust connection when data loss happens in the debug channel. 4. Clear DR7 register in exception handler. 5. Set the default serial port parameter to 0 instead of PCDs. 6. Build pointer of Mailbox in HOB instead of Mailbox itself, since HOB may be moved at DXE entry point function. 7. Raise TPL to prevent recursion from EFI timer interrupts in SerialIo.c. 8. Add one spin lock for accessing Mailbox when MP debugging supported. 9. Use more non-NULL library instances in SourceLevelDebugPkg DSC file, thus DebugAgentDxe.efi built from SourceLevelDebugPkg could work in shell. 10.Separate all operations about IDT table entry from SecDebugAgentLib.c into DebugAgent\DebugAgentCommon's arch sub-directory. 11.Enhance Debug Agent to avoid breaking by hardware SMI during DXE debugging phase. 12.Add supporting on mode switch code debugging. 13.Remove reset Host Controller operation in DebugCommunicationLibUsb.c to avoid impacting EDKII usb stack. 14.Fix debug timer interrupt missing issue after back from legacy code. Signed-off-by: Jeff Fan <jeff.fan@intel.com> Signed-off-by: Ruiyu Ni <ruiyu.ni@intel.com> Signed-off-by: Feng Tian <feng.tian@intel.com> Reviewed-by: Jeff Fan <jeff.fan@intel.com> Reviewed-by: Ruiyu Ni <ruiyu.ni@intel.com> Reviewed-by: Feng Tian <feng.tian@intel.com> git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@14083 6f19259b-4bc3-4df7-8a09-765794883524
368 lines
8.1 KiB
ArmAsm
368 lines
8.1 KiB
ArmAsm
#------------------------------------------------------------------------------
|
|
#
|
|
# Copyright (c) 2010 - 2013, 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:
|
|
#
|
|
# AsmFuncs.S
|
|
#
|
|
# Abstract:
|
|
#
|
|
# Debug interrupt handle functions.
|
|
#
|
|
#------------------------------------------------------------------------------
|
|
|
|
#include "DebugException.h"
|
|
|
|
ASM_GLOBAL ASM_PFX(InterruptProcess)
|
|
ASM_GLOBAL ASM_PFX(Exception0Handle)
|
|
ASM_GLOBAL ASM_PFX(ExceptionStubHeaderSize)
|
|
ASM_GLOBAL ASM_PFX(TimerInterruptHandle)
|
|
ASM_GLOBAL ASM_PFX(CommonEntry)
|
|
|
|
.data
|
|
|
|
ASM_PFX(ExceptionStubHeaderSize): .word ASM_PFX(Exception1Handle) - ASM_PFX(Exception0Handle)
|
|
|
|
.text
|
|
|
|
.byte 0x41, 0x47, 0x54, 0x48 # AGENT_HANDLER_SIGNATURE SIGNATURE_32('A','G','T','H')
|
|
ASM_PFX(Exception0Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $0, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception1Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $1, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception2Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $2, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception3Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $3, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception4Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $4, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception5Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $5, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception6Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $6, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception7Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $7, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception8Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $8, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception9Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $9, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception10Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $10, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception11Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $11, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception12Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $12, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception13Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $13, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception14Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $14, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception15Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $15, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception16Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $16, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception17Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $17, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception18Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $18, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception19Handle):
|
|
cli
|
|
pushl %eax
|
|
mov $19, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
|
|
ASM_PFX(TimerInterruptHandle):
|
|
cli
|
|
pushl %eax
|
|
mov $32, %eax
|
|
jmp ASM_PFX(CommonEntry)
|
|
|
|
|
|
ASM_PFX(CommonEntry):
|
|
|
|
#---------------------------------------;
|
|
# _CommonEntry ;
|
|
#----------------------------------------------------------------------------;
|
|
# The follow algorithm is used for the common interrupt routine.
|
|
# Entry from each interrupt with a push eax and eax=interrupt number
|
|
#
|
|
# +---------------------+
|
|
# + EFlags +
|
|
# +---------------------+
|
|
# + CS +
|
|
# +---------------------+
|
|
# + EIP +
|
|
# +---------------------+
|
|
# + Error Code +
|
|
# +---------------------+
|
|
# + EAX / Vector Number +
|
|
# +---------------------+
|
|
# + EBP +
|
|
# +---------------------+ <-- EBP
|
|
#
|
|
|
|
# We need to determine if any extra data was pushed by the exception
|
|
cmpl $DEBUG_EXCEPT_DOUBLE_FAULT, %eax
|
|
je NoExtrPush
|
|
cmpl $DEBUG_EXCEPT_INVALID_TSS, %eax
|
|
je NoExtrPush
|
|
cmpl $DEBUG_EXCEPT_SEG_NOT_PRESENT, %eax
|
|
je NoExtrPush
|
|
cmpl $DEBUG_EXCEPT_STACK_FAULT, %eax
|
|
je NoExtrPush
|
|
cmpl $DEBUG_EXCEPT_GP_FAULT, %eax
|
|
je NoExtrPush
|
|
cmpl $DEBUG_EXCEPT_PAGE_FAULT, %eax
|
|
je NoExtrPush
|
|
cmpl $DEBUG_EXCEPT_ALIGNMENT_CHECK, %eax
|
|
je NoExtrPush
|
|
|
|
pushl (%esp)
|
|
movl $0, 4(%esp)
|
|
|
|
NoExtrPush:
|
|
|
|
pushl %ebp
|
|
movl %esp,%ebp
|
|
|
|
#
|
|
# Align stack to make sure that EFI_FX_SAVE_STATE_IA32 of EFI_SYSTEM_CONTEXT_IA32
|
|
# is 16-byte aligned
|
|
#
|
|
andl $0xfffffff0,%esp
|
|
subl $12,%esp
|
|
|
|
## UINT32 Edi, Esi, Ebp, Esp, Ebx, Edx, Ecx, Eax;
|
|
pushl 0x4(%ebp)
|
|
pushl %ebx
|
|
pushl %ecx
|
|
pushl %edx
|
|
mov %eax, %ebx # save vector in ebx
|
|
leal 24(%ebp),%ecx
|
|
pushl %ecx # save original ESP
|
|
pushl (%ebp)
|
|
pushl %esi
|
|
pushl %edi
|
|
|
|
## UINT32 Cr0, Cr1, Cr2, Cr3, Cr4;
|
|
movl %cr4, %eax
|
|
orl $0x208,%eax
|
|
movl %eax, %cr4
|
|
pushl %eax
|
|
movl %cr3, %eax
|
|
pushl %eax
|
|
movl %cr2, %eax
|
|
pushl %eax
|
|
xorl %eax,%eax
|
|
pushl %eax
|
|
movl %cr0, %eax
|
|
pushl %eax
|
|
|
|
## UINT32 Gs, Fs, Es, Ds, Cs, Ss;
|
|
movl %ss,%eax
|
|
pushl %eax
|
|
movzwl 16(%ebp), %eax
|
|
pushl %eax
|
|
movl %ds,%eax
|
|
pushl %eax
|
|
movl %es,%eax
|
|
pushl %eax
|
|
movl %fs,%eax
|
|
pushl %eax
|
|
movl %gs,%eax
|
|
pushl %eax
|
|
|
|
## UINT32 Eip;
|
|
pushl 12(%ebp)
|
|
|
|
## UINT32 Gdtr[2], Idtr[2];
|
|
subl $8,%esp
|
|
sidt (%esp)
|
|
subl $8,%esp
|
|
sgdt (%esp)
|
|
|
|
## UINT32 Ldtr, Tr;
|
|
xorl %eax,%eax
|
|
strl %eax
|
|
pushl %eax
|
|
sldtl %eax
|
|
pushl %eax
|
|
|
|
## UINT32 EFlags;
|
|
pushl 20(%ebp)
|
|
|
|
## UINT32 Dr0, Dr1, Dr2, Dr3, Dr6, Dr7;
|
|
movl %dr7, %eax
|
|
pushl %eax
|
|
## clear Dr7 while executing debugger itself
|
|
xorl %eax,%eax
|
|
movl %eax, %dr7
|
|
|
|
movl %dr6, %eax
|
|
pushl %eax
|
|
## insure all status bits in dr6 are clear...
|
|
xorl %eax,%eax
|
|
movl %eax, %dr6
|
|
|
|
movl %dr3, %eax
|
|
pushl %eax
|
|
movl %dr2, %eax
|
|
pushl %eax
|
|
movl %dr1, %eax
|
|
pushl %eax
|
|
movl %dr0, %eax
|
|
pushl %eax
|
|
|
|
## FX_SAVE_STATE_IA32 FxSaveState;
|
|
subl $512,%esp
|
|
movl %esp,%edi
|
|
.byte 0x0f, 0xae, 0x07 # fxsave [edi]
|
|
|
|
## save the exception data
|
|
pushl 8(%esp)
|
|
|
|
## Clear Direction Flag
|
|
cld
|
|
|
|
## Prepare parameter and call C function
|
|
pushl %esp
|
|
pushl %ebx
|
|
call ASM_PFX(InterruptProcess)
|
|
addl $8,%esp
|
|
|
|
## skip the exception data
|
|
addl $4,%esp
|
|
|
|
## FX_SAVE_STATE_IA32 FxSaveState;
|
|
movl %esp,%esi
|
|
.byte 0x0f, 0xae, 0x0e # fxrstor [esi]
|
|
addl $512,%esp
|
|
|
|
## UINT32 Dr0, Dr1, Dr2, Dr3, Dr6, Dr7;
|
|
popl %eax
|
|
movl %eax, %dr0
|
|
popl %eax
|
|
movl %eax, %dr1
|
|
popl %eax
|
|
movl %eax, %dr2
|
|
popl %eax
|
|
movl %eax, %dr3
|
|
## skip restore of dr6. We cleared dr6 during the context save.
|
|
addl $4,%esp
|
|
popl %eax
|
|
movl %eax, %dr7
|
|
|
|
## UINT32 EFlags;
|
|
popl 20(%ebp)
|
|
|
|
## UINT32 Ldtr, Tr;
|
|
## UINT32 Gdtr[2], Idtr[2];
|
|
## Best not let anyone mess with these particular registers...
|
|
addl $24,%esp
|
|
|
|
## UINT32 Eip;
|
|
pop 12(%ebp)
|
|
|
|
## 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.
|
|
##
|
|
popl %gs
|
|
popl %fs
|
|
popl %es
|
|
popl %ds
|
|
popl 16(%ebp)
|
|
popl %ss
|
|
|
|
## UINT32 Cr0, Cr1, Cr2, Cr3, Cr4;
|
|
popl %eax
|
|
movl %eax, %cr0
|
|
addl $4,%esp # not for Cr1
|
|
popl %eax
|
|
movl %eax, %cr2
|
|
popl %eax
|
|
movl %eax, %cr3
|
|
popl %eax
|
|
movl %eax, %cr4
|
|
|
|
## UINT32 Edi, Esi, Ebp, Esp, Ebx, Edx, Ecx, Eax;
|
|
popl %edi
|
|
popl %esi
|
|
addl $4,%esp # not for ebp
|
|
addl $4,%esp # not for esp
|
|
popl %edx
|
|
popl %ecx
|
|
popl %ebx
|
|
popl %eax
|
|
|
|
movl %ebp,%esp
|
|
popl %ebp
|
|
addl $8,%esp # skip eax
|
|
iretl
|
|
|