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
409 lines
9.0 KiB
ArmAsm
409 lines
9.0 KiB
ArmAsm
#------------------------------------------------------------------------------
|
|
#
|
|
# Copyright (c) 2006 - 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
|
|
pushq %rcx
|
|
mov $0, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception1Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $1, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception2Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $2, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception3Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $3, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception4Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $4, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception5Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $5, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception6Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $6, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception7Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $7, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception8Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $8, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception9Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $9, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception10Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $10, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception11Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $11, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception12Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $12, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception13Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $13, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception14Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $14, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception15Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $15, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception16Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $16, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception17Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $17, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception18Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $18, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
ASM_PFX(Exception19Handle):
|
|
cli
|
|
pushq %rcx
|
|
mov $19, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
|
|
ASM_PFX(TimerInterruptHandle):
|
|
cli
|
|
pushq %rcx
|
|
mov $32, %rcx
|
|
jmp ASM_PFX(CommonEntry)
|
|
|
|
|
|
ASM_PFX(CommonEntry):
|
|
|
|
#---------------------------------------;
|
|
# CommonInterruptEntry ;
|
|
#---------------------------------------;
|
|
# The follow algorithm is used for the common interrupt routine.
|
|
|
|
#
|
|
# +---------------------+ <-- 16-byte aligned ensured by processor
|
|
# + Old SS +
|
|
# +---------------------+
|
|
# + Old RSP +
|
|
# +---------------------+
|
|
# + RFlags +
|
|
# +---------------------+
|
|
# + CS +
|
|
# +---------------------+
|
|
# + RIP +
|
|
# +---------------------+
|
|
# + Error Code +
|
|
# +---------------------+
|
|
# + RCX / Vector Number +
|
|
# +---------------------+
|
|
# + RBP +
|
|
# +---------------------+ <-- RBP, 16-byte aligned
|
|
#
|
|
|
|
# We need to determine if any extra data was pushed by the exception
|
|
cmpq $DEBUG_EXCEPT_DOUBLE_FAULT, %rcx
|
|
je NoExtrPush
|
|
cmpq $DEBUG_EXCEPT_INVALID_TSS, %rcx
|
|
je NoExtrPush
|
|
cmpq $DEBUG_EXCEPT_SEG_NOT_PRESENT, %rcx
|
|
je NoExtrPush
|
|
cmpq $DEBUG_EXCEPT_STACK_FAULT, %rcx
|
|
je NoExtrPush
|
|
cmpq $DEBUG_EXCEPT_GP_FAULT, %rcx
|
|
je NoExtrPush
|
|
cmpq $DEBUG_EXCEPT_PAGE_FAULT, %rcx
|
|
je NoExtrPush
|
|
cmpq $DEBUG_EXCEPT_ALIGNMENT_CHECK, %rcx
|
|
je NoExtrPush
|
|
|
|
pushq (%rsp)
|
|
movq $0, 8(%rsp)
|
|
|
|
NoExtrPush:
|
|
#
|
|
# All interrupt handlers are invoked through interrupt gates, so
|
|
# IF flag automatically cleared at the entry point
|
|
pushq %rbp
|
|
movq %rsp, %rbp
|
|
|
|
#
|
|
# Since here the stack pointer is 16-byte aligned, so
|
|
# EFI_FX_SAVE_STATE_X64 of EFI_SYSTEM_CONTEXT_x64
|
|
# is 16-byte aligned
|
|
#
|
|
|
|
## UINT64 R8, R9, R10, R11, R12, R13, R14, R15;
|
|
pushq %r15
|
|
pushq %r14
|
|
pushq %r13
|
|
pushq %r12
|
|
pushq %r11
|
|
pushq %r10
|
|
pushq %r9
|
|
pushq %r8
|
|
|
|
movq %cr8, %r8
|
|
pushq %r8
|
|
|
|
## UINT64 Rdi, Rsi, Rbp, Rsp, Rbx, Rdx, Rcx, Rax;
|
|
pushq %rax
|
|
pushq %rbx
|
|
pushq 8(%rbp) # original rcx
|
|
pushq %rdx
|
|
pushq 48(%rbp) # original rsp
|
|
pushq (%rbp) # original rbp
|
|
pushq %rsi
|
|
pushq %rdi
|
|
|
|
## UINT64 Cr0, Cr1, Cr2, Cr3, Cr4;
|
|
movq %cr4, %rax
|
|
orq $0x208, %rax
|
|
movq %rax, %cr4
|
|
pushq %rax
|
|
movq %cr3, %rax
|
|
pushq %rax
|
|
movq %cr2, %rax
|
|
pushq %rax
|
|
xorq %rax, %rax
|
|
pushq %rax
|
|
movq %cr0, %rax
|
|
pushq %rax
|
|
|
|
## UINT64 Gs, Fs, Es, Ds, Cs, Ss; insure high 16 bits of each is zero
|
|
xorq %rax, %rax # set rax to 0
|
|
movzwq 56(%rbp), %rax
|
|
# movq %ss, %rax
|
|
pushq %rax
|
|
movzwq 32(%rbp), %rax
|
|
# movq %cs, %rax
|
|
pushq %rax
|
|
movq %ds, %rax
|
|
pushq %rax
|
|
movq %es, %rax
|
|
pushq %rax
|
|
movq %fs, %rax
|
|
pushq %rax
|
|
movq %gs, %rax
|
|
pushq %rax
|
|
|
|
## UINT64 Rip;
|
|
pushq 24(%rbp)
|
|
|
|
## UINT64 Gdtr[2], Idtr[2];
|
|
subq $16, %rsp
|
|
sidt (%rsp)
|
|
subq $16, %rsp
|
|
sgdt (%rsp)
|
|
|
|
## UINT64 Ldtr, Tr;
|
|
xorq %rax, %rax
|
|
strw %ax
|
|
pushq %rax
|
|
sldtw %ax
|
|
pushq %rax
|
|
|
|
## UINT64 RFlags;
|
|
pushq 40(%rbp)
|
|
|
|
## UINT64 Dr0, Dr1, Dr2, Dr3, Dr6, Dr7;
|
|
movq %dr7, %rax
|
|
pushq %rax
|
|
## clear Dr7 while executing debugger itself
|
|
xorq %rax, %rax
|
|
movq %rax, %dr7
|
|
|
|
movq %dr6, %rax
|
|
pushq %rax
|
|
## insure all status bits in dr6 are clear...
|
|
xorq %rax, %rax
|
|
movq %rax, %dr6
|
|
|
|
movq %dr3, %rax
|
|
pushq %rax
|
|
movq %dr2, %rax
|
|
pushq %rax
|
|
movq %dr1, %rax
|
|
pushq %rax
|
|
movq %dr0, %rax
|
|
pushq %rax
|
|
|
|
## FX_SAVE_STATE_X64 FxSaveState;
|
|
subq $512, %rsp
|
|
movq %rsp, %rdi
|
|
.byte 0x0f, 0xae, 0b00000111
|
|
|
|
## save the exception data;
|
|
pushq 16(%rbp)
|
|
|
|
## Clear Direction Flag
|
|
cld
|
|
|
|
## Prepare parameter and call
|
|
# movq 8(%rbp), %rcx
|
|
movq %rsp, %rdx
|
|
movq %rcx, %r15 # save vector in r15
|
|
#
|
|
# Per X64 calling convention, allocate maximum parameter stack space
|
|
# and make sure RSP is 16-byte aligned
|
|
#
|
|
subq $(32 + 8), %rsp
|
|
call ASM_PFX(InterruptProcess)
|
|
addq $(32 + 8), %rsp
|
|
|
|
## skip the exception data;
|
|
addq $8, %rsp
|
|
|
|
## FX_SAVE_STATE_X64 FxSaveState;
|
|
|
|
movq %rsp, %rsi
|
|
.byte 0x0f, 0xae, 0b00001110
|
|
addq $512, %rsp
|
|
|
|
## UINT64 Dr0, Dr1, Dr2, Dr3, Dr6, Dr7;
|
|
popq %rax
|
|
movq %rax, %dr0
|
|
popq %rax
|
|
movq %rax, %dr1
|
|
popq %rax
|
|
movq %rax, %dr2
|
|
popq %rax
|
|
movq %rax, %dr3
|
|
## skip restore of dr6. We cleared dr6 during the context save.
|
|
addq $8, %rsp
|
|
popq %rax
|
|
movq %rax, %dr7
|
|
|
|
## UINT64 RFlags;
|
|
popq 40(%rbp)
|
|
|
|
## UINT64 Ldtr, Tr;
|
|
## UINT64 Gdtr[2], Idtr[2];
|
|
## Best not let anyone mess with these particular registers...
|
|
addq $48, %rsp
|
|
|
|
## UINT64 Rip;
|
|
popq 24(%rbp)
|
|
|
|
## UINT64 Gs, Fs, Es, Ds, Cs, Ss;
|
|
popq %rax
|
|
# mov gs, rax ; not for gs
|
|
popq %rax
|
|
# mov fs, rax ; not for fs
|
|
# (X64 will not use fs and gs, so we do not restore it)
|
|
popq %rax
|
|
movw %rax, %es
|
|
popq %rax
|
|
movw %rax, %ds
|
|
popq 32(%rbp)
|
|
popq 56(%rbp)
|
|
|
|
## UINT64 Cr0, Cr1, Cr2, Cr3, Cr4, Cr8;
|
|
popq %rax
|
|
movq %rax, %cr0
|
|
addq $8, %rsp
|
|
popq %rax
|
|
movq %rax, %cr2
|
|
popq %rax
|
|
movq %rax, %cr3
|
|
popq %rax
|
|
movq %rax, %cr4
|
|
|
|
## UINT64 Rdi, Rsi, Rbp, Rsp, Rbx, Rdx, Rcx, Rax;
|
|
## UINT64 R8, R9, R10, R11, R12, R13, R14, R15;
|
|
popq %rdi
|
|
popq %rsi
|
|
addq $8, %rsp
|
|
addq $8, %rsp
|
|
popq %rdx
|
|
popq %rcx
|
|
popq %rbx
|
|
popq %rax
|
|
|
|
popq %r8
|
|
movq %r8, %cr8
|
|
|
|
popq %r8
|
|
popq %r9
|
|
popq %r10
|
|
popq %r11
|
|
popq %r12
|
|
popq %r13
|
|
popq %r14
|
|
popq %r15
|
|
|
|
movq %rbp, %rsp
|
|
popq %rbp
|
|
addq $16, %rsp
|
|
iretq
|