X-Git-Url: https://git.proxmox.com/?p=mirror_edk2.git;a=blobdiff_plain;f=EmbeddedPkg%2FLibrary%2FGdbDebugAgent%2FArm%2FProcessor.c;h=8226c80ab4667d1dce953cbdf0440d297d59e4b1;hp=c5f59323dbb6bb1eaa3f3e22de400caff066de4f;hb=4f0624e87a89afce8408a87997482b383e7ba131;hpb=60274ccab831d7874129a6b6c271969418296960 diff --git a/EmbeddedPkg/Library/GdbDebugAgent/Arm/Processor.c b/EmbeddedPkg/Library/GdbDebugAgent/Arm/Processor.c old mode 100755 new mode 100644 index c5f59323db..8226c80ab4 --- a/EmbeddedPkg/Library/GdbDebugAgent/Arm/Processor.c +++ b/EmbeddedPkg/Library/GdbDebugAgent/Arm/Processor.c @@ -2,7 +2,7 @@ Processor specific parts of the GDB stub Copyright (c) 2008 - 2010, Apple Inc. 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 @@ -15,7 +15,6 @@ #include -#include #include #include @@ -49,8 +48,8 @@ AsmCommonExceptionEntry ( // EFI_EXCEPTION_TYPE_ENTRY gExceptionType[] = { { EXCEPT_ARM_SOFTWARE_INTERRUPT, GDB_SIGTRAP }, - { EXCEPT_ARM_UNDEFINED_INSTRUCTION, GDB_SIGTRAP }, - { EXCEPT_ARM_PREFETCH_ABORT, GDB_SIGTRAP }, + { EXCEPT_ARM_UNDEFINED_INSTRUCTION, GDB_SIGTRAP }, + { EXCEPT_ARM_PREFETCH_ABORT, GDB_SIGTRAP }, { EXCEPT_ARM_DATA_ABORT, GDB_SIGTRAP }, // GDB_SIGEMT { EXCEPT_ARM_RESERVED, GDB_SIGTRAP }, // GDB_SIGILL { EXCEPT_ARM_FIQ, GDB_SIGINT } // Used for ctrl-c @@ -114,8 +113,8 @@ UINTN gRegisterOffsets[] = { /** Return the number of entries in the gExceptionType[] - - @retval UINTN, the number of entries in the gExceptionType[] array. + + @retval UINTN, the number of entries in the gExceptionType[] array. **/ UINTN MaxEfiException ( @@ -129,10 +128,10 @@ MaxEfiException ( /** - Check to see if the ISA is supported. + Check to see if the ISA is supported. ISA = Instruction Set Architecture - @retval TRUE if Isa is supported + @retval TRUE if Isa is supported **/ BOOLEAN @@ -151,14 +150,14 @@ CheckIsa ( /** This takes in the register number and the System Context, and returns a pointer to the RegNumber-th register in gdb ordering It is, by default, set to find the register pointer of the ARM member - @param SystemContext Register content at time of the exception + @param SystemContext Register content at time of the exception @param RegNumber The register to which we want to find a pointer @retval the pointer to the RegNumber-th pointer - **/ + **/ UINTN * FindPointerToRegister( IN EFI_SYSTEM_CONTEXT SystemContext, - IN UINTN RegNumber + IN UINTN RegNumber ) { UINT8 *TempPtr; @@ -184,7 +183,7 @@ BasicReadRegister ( { UINTN RegSize; CHAR8 Char; - + if (gRegisterOffsets[RegNumber] > 0xF00) { AsciiSPrint(OutBufPtr, 9, "00000000"); OutBufPtr += 8; @@ -198,21 +197,21 @@ BasicReadRegister ( Char = Char - 'A' + 'a'; } *OutBufPtr++ = Char; - + Char = mHexToStr[(UINT8)((*FindPointerToRegister(SystemContext, RegNumber) >> RegSize) & 0xf)]; if ((Char >= 'A') && (Char <= 'F')) { Char = Char - 'A' + 'a'; } *OutBufPtr++ = Char; - + RegSize = RegSize + 8; } return OutBufPtr; } -/** ‘p n’ - Reads the n-th register's value into an output buffer and sends it as a packet +/** + Reads the n-th register's value into an output buffer and sends it as a packet @param SystemContext Register content at time of the exception @param InBuffer Pointer to the input buffer received from gdb server **/ @@ -225,29 +224,29 @@ ReadNthRegister ( UINTN RegNumber; CHAR8 OutBuffer[9]; // 1 reg=8 hex chars, and the end '\0' (escape seq) CHAR8 *OutBufPtr; // pointer to the output buffer - + RegNumber = AsciiStrHexToUintn (&InBuffer[1]); - + if (RegNumber >= (sizeof (gRegisterOffsets)/sizeof (UINTN))) { - SendError (GDB_EINVALIDREGNUM); + SendError (GDB_EINVALIDREGNUM); return; } - + OutBufPtr = OutBuffer; OutBufPtr = BasicReadRegister (SystemContext, RegNumber, OutBufPtr); - + *OutBufPtr = '\0'; // the end of the buffer SendPacket(OutBuffer); } -/** ‘g’ - Reads the general registers into an output buffer and sends it as a packet +/** + Reads the general registers into an output buffer and sends it as a packet @param SystemContext Register content at time of the exception **/ VOID EFIAPI -ReadGeneralRegisters ( +ReadGeneralRegisters ( IN EFI_SYSTEM_CONTEXT SystemContext ) { @@ -255,13 +254,13 @@ ReadGeneralRegisters ( // a UINT32 takes 8 ascii characters CHAR8 OutBuffer[(sizeof (gRegisterOffsets) * 2) + 1]; CHAR8 *OutBufPtr; - + // It is not safe to allocate pool here.... OutBufPtr = OutBuffer; for (Index = 0; Index < (sizeof (gRegisterOffsets)/sizeof (UINTN)); Index++) { OutBufPtr = BasicReadRegister (SystemContext, Index, OutBufPtr); } - + *OutBufPtr = '\0'; SendPacket(OutBuffer); } @@ -284,7 +283,7 @@ BasicWriteRegister ( UINTN RegSize; UINTN TempValue; // the value transferred from a hex char UINT32 NewValue; // the new value of the RegNumber-th Register - + if (gRegisterOffsets[RegNumber] > 0xF00) { return InBufPtr + 8; } @@ -293,21 +292,21 @@ BasicWriteRegister ( RegSize = 0; while (RegSize < 32) { TempValue = HexCharToInt(*InBufPtr++); - + if ((INTN)TempValue < 0) { - SendError (GDB_EBADMEMDATA); + SendError (GDB_EBADMEMDATA); return NULL; } - + NewValue += (TempValue << (RegSize+4)); TempValue = HexCharToInt(*InBufPtr++); - + if ((INTN)TempValue < 0) { - SendError (GDB_EBADMEMDATA); + SendError (GDB_EBADMEMDATA); return NULL; } - - NewValue += (TempValue << RegSize); + + NewValue += (TempValue << RegSize); RegSize = RegSize + 8; } *(FindPointerToRegister(SystemContext, RegNumber)) = NewValue; @@ -330,19 +329,19 @@ WriteNthRegister ( CHAR8 RegNumBuffer[MAX_REG_NUM_BUF_SIZE]; // put the 'n..' part of the message into this array CHAR8 *RegNumBufPtr; CHAR8 *InBufPtr; // pointer to the input buffer - + // find the register number to write InBufPtr = &InBuffer[1]; RegNumBufPtr = RegNumBuffer; while (*InBufPtr != '=') { *RegNumBufPtr++ = *InBufPtr++; - } + } *RegNumBufPtr = '\0'; - RegNumber = AsciiStrHexToUintn (RegNumBuffer); - + RegNumber = AsciiStrHexToUintn (RegNumBuffer); + // check if this is a valid Register Number if (RegNumber >= (sizeof (gRegisterOffsets)/sizeof (UINTN))) { - SendError (GDB_EINVALIDREGNUM); + SendError (GDB_EINVALIDREGNUM); return; } InBufPtr++; // skips the '=' character @@ -370,32 +369,32 @@ WriteGeneralRegisters ( UINTN RegisterCount = (sizeof (gRegisterOffsets)/sizeof (UINTN)); MinLength = (RegisterCount * 8) + 1; // 'G' plus the registers in ASCII format - + if (AsciiStrLen(InBuffer) < MinLength) { - //Bad message. Message is not the right length - SendError (GDB_EBADBUFSIZE); + //Bad message. Message is not the right length + SendError (GDB_EBADBUFSIZE); return; } - + InBufPtr = &InBuffer[1]; - + // Read the new values for the registers from the input buffer to an array, NewValueArray. // The values in the array are in the gdb ordering for(i = 0; i < RegisterCount; i++) { InBufPtr = BasicWriteRegister (SystemContext, i, InBufPtr); } - + SendSuccess (); } -/** ‘c [addr ]’ - Continue. addr is Address to resume. If addr is omitted, resume at current +/** + Continue. addr is Address to resume. If addr is omitted, resume at current Address. - - @param SystemContext Register content at time of the exception + + @param SystemContext Register content at time of the exception **/ VOID EFIAPI @@ -406,15 +405,15 @@ ContinueAtAddress ( { if (PacketData[1] != '\0') { SystemContext.SystemContextArm->PC = AsciiStrHexToUintn(&PacketData[1]); - } + } } /** ‘s [addr ]’ - Single step. addr is the Address at which to resume. If addr is omitted, resume + Single step. addr is the Address at which to resume. If addr is omitted, resume at same Address. - - @param SystemContext Register content at time of the exception + + @param SystemContext Register content at time of the exception **/ VOID EFIAPI @@ -448,69 +447,69 @@ RemoveBreakPoint ( } -/** - Send the T signal with the given exception type (in gdb order) and possibly - with n:r pairs related to the watchpoints - - @param SystemContext Register content at time of the exception - @param GdbExceptionType GDB exception type - **/ -VOID -ProcessorSendTSignal ( - IN EFI_SYSTEM_CONTEXT SystemContext, - IN UINT8 GdbExceptionType, - IN OUT CHAR8 *TSignalPtr, - IN UINTN SizeOfBuffer - ) -{ - *TSignalPtr = '\0'; -} +/** + Send the T signal with the given exception type (in gdb order) and possibly + with n:r pairs related to the watchpoints + + @param SystemContext Register content at time of the exception + @param GdbExceptionType GDB exception type + **/ +VOID +ProcessorSendTSignal ( + IN EFI_SYSTEM_CONTEXT SystemContext, + IN UINT8 GdbExceptionType, + IN OUT CHAR8 *TSignalPtr, + IN UINTN SizeOfBuffer + ) +{ + *TSignalPtr = '\0'; +} /** FIQ state is only changed by FIQ exception. We don't want to take FIQ - ticks in the GDB stub. The stub disables FIQ on entry, but this is the + ticks in the GDB stub. The stub disables FIQ on entry, but this is the third instruction that executes in the execption handler. Thus we have a crack we need to test for. @param PC PC of execption - @return TRUE We are in the GDB stub exception preamble + @return TRUE We are in the GDB stub exception preamble @return FALSE We are not in GDB stub code - **/ -BOOLEAN -InFiqCrack ( - IN UINT32 PC - ) -{ - UINT32 VectorBase = PcdGet32 (PcdCpuVectorBaseAddress); - UINT32 Length = (UINTN)ExceptionHandlersEnd - (UINTN)ExceptionHandlersStart; - - if ((PC >= VectorBase) && (PC <= (VectorBase + Length))) { - return TRUE; - } - - return FALSE; -} + **/ +BOOLEAN +InFiqCrack ( + IN UINT32 PC + ) +{ + UINT64 VectorBase = PcdGet64 (PcdCpuVectorBaseAddress); + UINT32 Length = (UINTN)ExceptionHandlersEnd - (UINTN)ExceptionHandlersStart; + + if ((PC >= VectorBase) && (PC <= (VectorBase + Length))) { + return TRUE; + } + + return FALSE; +} /** Check to see if this exception is related to ctrl-c handling. - In this scheme we dedicate FIQ to the ctrl-c handler so it is - independent of the rest of the system. - - SaveAndSetDebugTimerInterrupt () can be used to + In this scheme we dedicate FIQ to the ctrl-c handler so it is + independent of the rest of the system. + + SaveAndSetDebugTimerInterrupt () can be used to @param ExceptionType Exception that is being processed - @param SystemContext Register content at time of the exception + @param SystemContext Register content at time of the exception @return TRUE This was a ctrl-c check that did not find a ctrl-c @return FALSE This was not a ctrl-c check or some one hit ctrl-c **/ BOOLEAN -ProcessorControlC ( - IN EFI_EXCEPTION_TYPE ExceptionType, - IN OUT EFI_SYSTEM_CONTEXT SystemContext +ProcessorControlC ( + IN EFI_EXCEPTION_TYPE ExceptionType, + IN OUT EFI_SYSTEM_CONTEXT SystemContext ) { CHAR8 Char; @@ -527,24 +526,24 @@ ProcessorControlC ( return FALSE; } - while (TRUE) { - if (!GdbIsCharAvailable ()) { - // - // No characters are pending so exit the loop - // - Return = TRUE; - break; - } - - Char = GdbGetChar (); - if (Char == 0x03) { - // - // We have a ctrl-c so exit and process exception for ctrl-c - // - Return = FALSE; - break; - } - } + while (TRUE) { + if (!GdbIsCharAvailable ()) { + // + // No characters are pending so exit the loop + // + Return = TRUE; + break; + } + + Char = GdbGetChar (); + if (Char == 0x03) { + // + // We have a ctrl-c so exit and process exception for ctrl-c + // + Return = FALSE; + break; + } + } DebugAgentTimerEndOfInterrupt (); @@ -597,25 +596,39 @@ GdbFPutString ( /** Initialize debug agent. - This function is used to set up debug enviroment. It may enable interrupts. + This function is used to set up debug environment to support source level debugging. + If certain Debug Agent Library instance has to save some private data in the stack, + this function must work on the mode that doesn't return to the caller, then + the caller needs to wrap up all rest of logic after InitializeDebugAgent() into one + function and pass it into InitializeDebugAgent(). InitializeDebugAgent() is + responsible to invoke the passing-in function at the end of InitializeDebugAgent(). + + If the parameter Function is not NULL, Debug Agent Library instance will invoke it by + passing in the Context to be its parameter. - @param[in] InitFlag Init flag is used to decide initialize process. - @param[in] Context Context needed according to InitFlag, it was optional. + If Function() is NULL, Debug Agent Library instance will return after setup debug + environment. + + @param[in] InitFlag Init flag is used to decide the initialize process. + @param[in] Context Context needed according to InitFlag; it was optional. + @param[in] Function Continue function called by debug agent library; it was + optional. **/ VOID EFIAPI InitializeDebugAgent ( IN UINT32 InitFlag, - IN VOID *Context OPTIONAL + IN VOID *Context, OPTIONAL + IN DEBUG_AGENT_CONTINUE Function OPTIONAL ) -{ +{ UINTN Offset; UINTN Length; BOOLEAN IrqEnabled; - UINT32 *VectorBase; + UINT64 *VectorBase; + - // // Disable interrupts // @@ -631,10 +644,10 @@ InitializeDebugAgent ( // // Reserve space for the exception handlers // - VectorBase = (UINT32 *)(UINTN)PcdGet32 (PcdCpuVectorBaseAddress); + VectorBase = (UINT64 *)(UINTN)PcdGet64 (PcdCpuVectorBaseAddress); - // Copy our assembly code into the page that contains the exception vectors. + // Copy our assembly code into the page that contains the exception vectors. CopyMem ((VOID *)VectorBase, (VOID *)ExceptionHandlersStart, Length); // @@ -644,7 +657,7 @@ InitializeDebugAgent ( *(UINTN *) (((UINT8 *)VectorBase) + Offset) = (UINTN)AsmCommonExceptionEntry; // Flush Caches since we updated executable stuff - InvalidateInstructionCacheRange ((VOID *)PcdGet32(PcdCpuVectorBaseAddress), Length); + InvalidateInstructionCacheRange ((VOID *)PcdGet64(PcdCpuVectorBaseAddress), Length); // setup a timer so gdb can break in via ctrl-c DebugAgentTimerIntialize (); @@ -653,6 +666,10 @@ InitializeDebugAgent ( ArmEnableInterrupts (); } + if (Function != NULL) { + Function (Context); + } + return; }