X-Git-Url: https://git.proxmox.com/?p=mirror_edk2.git;a=blobdiff_plain;f=EmbeddedPkg%2FGdbStub%2FArm%2FProcessor.c;h=96b4f570c4ebb0733c086df2faa7c3ef69e7b623;hp=e620d344e6994ac5b170c176bd6498a0f07d12a0;hb=f33d5d68abc02727dc828c1079e72ab65e1d63af;hpb=2ef2b01e07c02db339f34004445734a2dbdd80e1 diff --git a/EmbeddedPkg/GdbStub/Arm/Processor.c b/EmbeddedPkg/GdbStub/Arm/Processor.c index e620d344e6..96b4f570c4 100644 --- a/EmbeddedPkg/GdbStub/Arm/Processor.c +++ b/EmbeddedPkg/GdbStub/Arm/Processor.c @@ -1,9 +1,9 @@ /** @file Processor specific parts of the GDB stub - Copyright (c) 2008-2009, Apple Inc. All rights reserved. - - All rights reserved. This program and the accompanying materials + Copyright (c) 2008 - 2009, 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 http://opensource.org/licenses/bsd-license.php @@ -11,18 +11,6 @@ THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. -**/ -/** @file - - Copyright (c) 2008, 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 - 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. - **/ #include @@ -35,10 +23,10 @@ // 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_DATA_ABORT, GDB_SIGEMT }, -// { EXCEPT_ARM_RESERVED, GDB_SIGILL } +// { EXCEPT_ARM_UNDEFINED_INSTRUCTION, GDB_SIGTRAP }, +// { EXCEPT_ARM_PREFETCH_ABORT, GDB_SIGTRAP }, +// { EXCEPT_ARM_DATA_ABORT, GDB_SIGEMT }, +// { EXCEPT_ARM_RESERVED, GDB_SIGILL } }; // Shut up some annoying RVCT warnings @@ -88,8 +76,6 @@ UINTN gRegisterOffsets[] = { 0x00000F72, 0x00000F73, 0x00000FFF, // fps - 0x00000FFF, - 0x00000FFF, OFFSET_OF(EFI_SYSTEM_CONTEXT_ARM, CPSR) }; @@ -100,37 +86,37 @@ 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 ( VOID ) { - return sizeof (gExceptionType)/sizeof (EFI_EXCEPTION_TYPE_ENTRY); + return sizeof (gExceptionType) / sizeof (EFI_EXCEPTION_TYPE_ENTRY); } /** Return the number of entries in the gRegisters[] - - @retval UINTN, the number of entries (registers) in the gRegisters[] array. + + @retval UINTN, the number of entries (registers) in the gRegisters[] array. **/ UINTN MaxRegisterCount ( VOID ) { - return sizeof (gRegisterOffsets)/sizeof (UINTN); + return sizeof (gRegisterOffsets) / sizeof (UINTN); } /** - 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 @@ -149,14 +135,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( +FindPointerToRegister ( IN EFI_SYSTEM_CONTEXT SystemContext, - IN UINTN RegNumber + IN UINTN RegNumber ) { UINT8 *TempPtr; @@ -182,35 +168,35 @@ BasicReadRegister ( { UINTN RegSize; CHAR8 Char; - + if (gRegisterOffsets[RegNumber] > 0xF00) { - AsciiSPrint(OutBufPtr, 9, "00000000"); + AsciiSPrint (OutBufPtr, 9, "00000000"); OutBufPtr += 8; return OutBufPtr; } RegSize = 0; while (RegSize < 32) { - Char = mHexToStr[(UINT8)((*FindPointerToRegister(SystemContext, RegNumber) >> (RegSize+4)) & 0xf)]; + Char = mHexToStr[(UINT8)((*FindPointerToRegister (SystemContext, RegNumber) >> (RegSize+4)) & 0xf)]; if ((Char >= 'A') && (Char <= 'F')) { Char = Char - 'A' + 'a'; } *OutBufPtr++ = Char; - - Char = mHexToStr[(UINT8)((*FindPointerToRegister(SystemContext, RegNumber) >> RegSize) & 0xf)]; + + 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 **/ @@ -223,47 +209,47 @@ 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 >= MaxRegisterCount()) { - SendError (GDB_EINVALIDREGNUM); + + if (RegNumber >= MaxRegisterCount ()) { + SendError (GDB_EINVALIDREGNUM); return; } - + OutBufPtr = OutBuffer; OutBufPtr = BasicReadRegister (SystemContext, RegNumber, OutBufPtr); - + *OutBufPtr = '\0'; // the end of the buffer - SendPacket(OutBuffer); + 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 ) { UINTN Index; CHAR8 *OutBuffer; CHAR8 *OutBufPtr; - UINTN RegisterCount = MaxRegisterCount(); - + UINTN RegisterCount = MaxRegisterCount (); + // It is not safe to allocate pool here.... - OutBuffer = AllocatePool((RegisterCount * 8) + 1); // 8 bytes per register in string format plus a null to terminate + OutBuffer = AllocatePool ((RegisterCount * 8) + 1); // 8 bytes per register in string format plus a null to terminate OutBufPtr = OutBuffer; for (Index = 0; Index < RegisterCount; Index++) { OutBufPtr = BasicReadRegister (SystemContext, Index, OutBufPtr); } - + *OutBufPtr = '\0'; - SendPacket(OutBuffer); - FreePool(OutBuffer); + SendPacket (OutBuffer); + FreePool (OutBuffer); } @@ -284,7 +270,7 @@ CHAR8 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; } @@ -292,25 +278,25 @@ CHAR8 NewValue = 0; RegSize = 0; while (RegSize < 32) { - TempValue = HexCharToInt(*InBufPtr++); - + TempValue = HexCharToInt (*InBufPtr++); + if ((INTN)TempValue < 0) { - SendError (GDB_EBADMEMDATA); + SendError (GDB_EBADMEMDATA); return NULL; } - + NewValue += (TempValue << (RegSize+4)); - TempValue = HexCharToInt(*InBufPtr++); - + 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; + *(FindPointerToRegister (SystemContext, RegNumber)) = NewValue; return InBufPtr; } @@ -330,19 +316,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 >= MaxRegisterCount()) { - SendError (GDB_EINVALIDREGNUM); + if (RegNumber >= MaxRegisterCount ()) { + SendError (GDB_EINVALIDREGNUM); return; } InBufPtr++; // skips the '=' character @@ -367,24 +353,24 @@ WriteGeneralRegisters ( UINTN i; CHAR8 *InBufPtr; /// pointer to the input buffer UINTN MinLength; - UINTN RegisterCount = MaxRegisterCount(); + UINTN RegisterCount = MaxRegisterCount (); 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); + + if (AsciiStrLen (InBuffer) < MinLength) { + //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++) { + for (i = 0; i < RegisterCount; i++) { InBufPtr = BasicWriteRegister (SystemContext, i, InBufPtr); } - + SendSuccess (); } @@ -409,10 +395,10 @@ typedef struct { LIST_ENTRY BreakpointList; -/** +/** Insert Single Step in the SystemContext - - @param SystemContext Register content at time of the exception + + @param SystemContext Register content at time of the exception **/ VOID AddSingleStep ( @@ -424,26 +410,26 @@ AddSingleStep ( return; } mSingleStepActive = TRUE; - + mSingleStepPC = SystemContext.SystemContextArm->PC; mSingleStepDataSize = sizeof (UINT32); - mSingleStepData = (*(UINT32 *)mSingleStepPC); + mSingleStepData = (*(UINT32 *)mSingleStepPC); *(UINT32 *)mSingleStepPC = GDB_ARM_BKPT; if (*(UINT32 *)mSingleStepPC != GDB_ARM_BKPT) { // For some reason our breakpoint did not take mSingleStepActive = FALSE; } - InvalidateInstructionCacheRange((VOID *)mSingleStepPC, mSingleStepDataSize); + InvalidateInstructionCacheRange ((VOID *)mSingleStepPC, mSingleStepDataSize); //DEBUG((EFI_D_ERROR, "AddSingleStep at 0x%08x (was: 0x%08x is:0x%08x)\n", SystemContext.SystemContextArm->PC, mSingleStepData, *(UINT32 *)mSingleStepPC)); } - -/** + +/** Remove Single Step in the SystemContext - - @param SystemContext Register content at time of the exception + + @param SystemContext Register content at time of the exception **/ VOID RemoveSingleStep ( @@ -453,24 +439,24 @@ RemoveSingleStep ( if (!mSingleStepActive) { return; } - + if (mSingleStepDataSize == sizeof (UINT16)) { *(UINT16 *)mSingleStepPC = (UINT16)mSingleStepData; } else { //DEBUG((EFI_D_ERROR, "RemoveSingleStep at 0x%08x (was: 0x%08x is:0x%08x)\n", SystemContext.SystemContextArm->PC, *(UINT32 *)mSingleStepPC, mSingleStepData)); *(UINT32 *)mSingleStepPC = mSingleStepData; } - InvalidateInstructionCacheRange((VOID *)mSingleStepPC, mSingleStepDataSize); + InvalidateInstructionCacheRange ((VOID *)mSingleStepPC, mSingleStepDataSize); mSingleStepActive = FALSE; } -/** ‘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 @@ -480,16 +466,16 @@ ContinueAtAddress ( ) { if (PacketData[1] != '\0') { - SystemContext.SystemContextArm->PC = AsciiStrHexToUintn(&PacketData[1]); - } + 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 @@ -498,7 +484,7 @@ SingleStep ( IN CHAR8 *PacketData ) { - SendNotSupported(); + SendNotSupported (); } UINTN @@ -535,15 +521,15 @@ SearchBreakpointList ( LIST_ENTRY *Current; ARM_SOFTWARE_BREAKPOINT *Breakpoint; - Current = GetFirstNode(&BreakpointList); - while (!IsNull(&BreakpointList, Current)) { + Current = GetFirstNode (&BreakpointList); + while (!IsNull (&BreakpointList, Current)) { Breakpoint = ARM_SOFTWARE_BREAKPOINT_FROM_LINK(Current); if (Address == Breakpoint->Address) { return Breakpoint; } - Current = GetNextNode(&BreakpointList, Current); + Current = GetNextNode (&BreakpointList, Current); } return NULL; @@ -556,25 +542,25 @@ SetBreakpoint ( { ARM_SOFTWARE_BREAKPOINT *Breakpoint; - Breakpoint = SearchBreakpointList(Address); + Breakpoint = SearchBreakpointList (Address); if (Breakpoint != NULL) { return; } // create and fill breakpoint structure - Breakpoint = AllocatePool(sizeof(ARM_SOFTWARE_BREAKPOINT)); + Breakpoint = AllocatePool (sizeof(ARM_SOFTWARE_BREAKPOINT)); Breakpoint->Signature = ARM_SOFTWARE_BREAKPOINT_SIGNATURE; Breakpoint->Address = Address; Breakpoint->Instruction = *(UINT32 *)Address; - + // Add it to the list - InsertTailList(&BreakpointList, &Breakpoint->Link); + InsertTailList (&BreakpointList, &Breakpoint->Link); // Insert the software breakpoint *(UINT32 *)Address = GDB_ARM_BKPT; - InvalidateInstructionCacheRange((VOID *)Address, 4); + InvalidateInstructionCacheRange ((VOID *)Address, 4); //DEBUG((EFI_D_ERROR, "SetBreakpoint at 0x%08x (was: 0x%08x is:0x%08x)\n", Address, Breakpoint->Instruction, *(UINT32 *)Address)); } @@ -586,22 +572,22 @@ ClearBreakpoint ( { ARM_SOFTWARE_BREAKPOINT *Breakpoint; - Breakpoint = SearchBreakpointList(Address); + Breakpoint = SearchBreakpointList (Address); if (Breakpoint == NULL) { return; } // Add it to the list - RemoveEntryList(&Breakpoint->Link); + RemoveEntryList (&Breakpoint->Link); // Restore the original instruction *(UINT32 *)Address = Breakpoint->Instruction; - InvalidateInstructionCacheRange((VOID *)Address, 4); + InvalidateInstructionCacheRange ((VOID *)Address, 4); //DEBUG((EFI_D_ERROR, "ClearBreakpoint at 0x%08x (was: 0x%08x is:0x%08x)\n", Address, GDB_ARM_BKPT, *(UINT32 *)Address)); - FreePool(Breakpoint); + FreePool (Breakpoint); } VOID @@ -616,7 +602,7 @@ InsertBreakPoint ( UINTN Length; UINTN ErrorCode; - ErrorCode = ParseBreakpointPacket(PacketData, &Type, &Address, &Length); + ErrorCode = ParseBreakpointPacket (PacketData, &Type, &Address, &Length); if (ErrorCode > 0) { SendError ((UINT8)ErrorCode); return; @@ -632,7 +618,7 @@ InsertBreakPoint ( return; } - SetBreakpoint(Address); + SetBreakpoint (Address); SendSuccess (); } @@ -659,13 +645,13 @@ RemoveBreakPoint ( switch (Type) { case 0: //Software breakpoint break; - + default: SendError (GDB_EINVALIDBRKPOINTTYPE); return; } - ClearBreakpoint(Address); + ClearBreakpoint (Address); SendSuccess (); } @@ -676,7 +662,7 @@ InitializeProcessor ( ) { // Initialize breakpoint list - InitializeListHead(&BreakpointList); + InitializeListHead (&BreakpointList); } BOOLEAN @@ -693,13 +679,13 @@ ValidateAddress ( BOOLEAN ValidateException ( - IN EFI_EXCEPTION_TYPE ExceptionType, - IN OUT EFI_SYSTEM_CONTEXT SystemContext + IN EFI_EXCEPTION_TYPE ExceptionType, + IN OUT EFI_SYSTEM_CONTEXT SystemContext ) { UINT32 ExceptionAddress; UINT32 Instruction; - + // Is it a debugger SWI? ExceptionAddress = SystemContext.SystemContextArm->PC -= 4; Instruction = *(UINT32 *)ExceptionAddress;