//\r
// Array of exception types that need to be hooked by the debugger\r
//\r
-EFI_EXCEPTION_TYPE_ENTRY gExceptionType[] = {\r
+EFI_EXCEPTION_TYPE_ENTRY gExceptionType[] = {\r
{ EXCEPT_X64_DIVIDE_ERROR, GDB_SIGFPE },\r
{ EXCEPT_X64_DEBUG, GDB_SIGTRAP },\r
{ EXCEPT_X64_NMI, GDB_SIGEMT },\r
{ EXCEPT_X64_MACHINE_CHECK, GDB_SIGEMT }\r
};\r
\r
-\r
// The offsets of registers SystemContextX64.\r
// The fields in the array are in the gdb ordering.\r
// HAVE TO DOUBLE-CHECK THE ORDER of the 24 regs\r
//\r
-UINTN gRegisterOffsets[] = {\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rax),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rcx),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rdx),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rbx),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rsp),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rbp),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rsi),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rdi),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rip),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Rflags),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Cs),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Ss),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Ds),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Es),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Fs),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, Gs),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, R8),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, R9),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, R10),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, R11),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, R12),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, R13),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, R14),\r
- OFFSET_OF(EFI_SYSTEM_CONTEXT_X64, R15)\r
+UINTN gRegisterOffsets[] = {\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rax),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rcx),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rdx),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rbx),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rsp),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rbp),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rsi),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rdi),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rip),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Rflags),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Cs),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Ss),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Ds),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Es),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Fs),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, Gs),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, R8),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, R9),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, R10),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, R11),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, R12),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, R13),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, R14),\r
+ OFFSET_OF (EFI_SYSTEM_CONTEXT_X64, R15)\r
};\r
\r
-\r
/**\r
Return the number of entries in the gExceptionType[]\r
\r
return sizeof (gExceptionType)/sizeof (EFI_EXCEPTION_TYPE_ENTRY);\r
}\r
\r
-\r
/**\r
Return the number of entries in the gRegisters[]\r
\r
return sizeof (gRegisterOffsets)/sizeof (UINTN);\r
}\r
\r
-\r
/**\r
Check to see if the ISA is supported.\r
ISA = Instruction Set Architecture\r
return (BOOLEAN)(Isa == IsaX64);\r
}\r
\r
-\r
/**\r
This takes in the register number and the System Context, and returns a pointer to the RegNumber-th register in gdb ordering\r
It is, by default, set to find the register pointer of the X64 member\r
@retval the pointer to the RegNumber-th pointer\r
**/\r
UINTN *\r
-FindPointerToRegister(\r
+FindPointerToRegister (\r
IN EFI_SYSTEM_CONTEXT SystemContext,\r
IN UINTN RegNumber\r
)\r
{\r
- UINT8 *TempPtr;\r
+ UINT8 *TempPtr;\r
+\r
TempPtr = ((UINT8 *)SystemContext.SystemContextX64) + gRegisterOffsets[RegNumber];\r
return (UINTN *)TempPtr;\r
}\r
\r
-\r
/**\r
Adds the RegNumber-th register's value to the output buffer, starting at the given OutBufPtr\r
@param SystemContext Register content at time of the exception\r
**/\r
CHAR8 *\r
BasicReadRegister (\r
- IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN UINTN RegNumber,\r
- IN CHAR8 *OutBufPtr\r
+ IN EFI_SYSTEM_CONTEXT SystemContext,\r
+ IN UINTN RegNumber,\r
+ IN CHAR8 *OutBufPtr\r
)\r
{\r
- UINTN RegSize;\r
+ UINTN RegSize;\r
\r
RegSize = 0;\r
while (RegSize < 64) {\r
- *OutBufPtr++ = mHexToStr[((*FindPointerToRegister(SystemContext, RegNumber) >> (RegSize+4)) & 0xf)];\r
- *OutBufPtr++ = mHexToStr[((*FindPointerToRegister(SystemContext, RegNumber) >> RegSize) & 0xf)];\r
- RegSize = RegSize + 8;\r
+ *OutBufPtr++ = mHexToStr[((*FindPointerToRegister (SystemContext, RegNumber) >> (RegSize+4)) & 0xf)];\r
+ *OutBufPtr++ = mHexToStr[((*FindPointerToRegister (SystemContext, RegNumber) >> RegSize) & 0xf)];\r
+ RegSize = RegSize + 8;\r
}\r
+\r
return OutBufPtr;\r
}\r
\r
-\r
/** ‘p n’\r
Reads the n-th register's value into an output buffer and sends it as a packet\r
@param SystemContext Register content at time of the exception\r
**/\r
VOID\r
ReadNthRegister (\r
- IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN CHAR8 *InBuffer\r
+ IN EFI_SYSTEM_CONTEXT SystemContext,\r
+ IN CHAR8 *InBuffer\r
)\r
{\r
- UINTN RegNumber;\r
- CHAR8 OutBuffer[17]; // 1 reg=16 hex chars, and the end '\0' (escape seq)\r
- CHAR8 *OutBufPtr; // pointer to the output buffer\r
+ UINTN RegNumber;\r
+ CHAR8 OutBuffer[17]; // 1 reg=16 hex chars, and the end '\0' (escape seq)\r
+ CHAR8 *OutBufPtr; // pointer to the output buffer\r
\r
RegNumber = AsciiStrHexToUintn (&InBuffer[1]);\r
\r
- if ((RegNumber < 0) || (RegNumber >= MaxRegisterCount())) {\r
+ if ((RegNumber < 0) || (RegNumber >= MaxRegisterCount ())) {\r
SendError (GDB_EINVALIDREGNUM);\r
return;\r
}\r
\r
OutBufPtr = OutBuffer;\r
- OutBufPtr = BasicReadRegister(SystemContext, RegNumber, OutBufPtr);\r
+ OutBufPtr = BasicReadRegister (SystemContext, RegNumber, OutBufPtr);\r
\r
*OutBufPtr = '\0'; // the end of the buffer\r
SendPacket (OutBuffer);\r
}\r
\r
-\r
/** ‘g’\r
Reads the general registers into an output buffer and sends it as a packet\r
\r
VOID\r
EFIAPI\r
ReadGeneralRegisters (\r
- IN EFI_SYSTEM_CONTEXT SystemContext\r
+ IN EFI_SYSTEM_CONTEXT SystemContext\r
)\r
{\r
- UINTN i;\r
- CHAR8 OutBuffer[385]; // 24 regs, 16 hex chars each, and the end '\0' (escape seq)\r
- CHAR8 *OutBufPtr; // pointer to the output buffer\r
+ UINTN i;\r
+ CHAR8 OutBuffer[385]; // 24 regs, 16 hex chars each, and the end '\0' (escape seq)\r
+ CHAR8 *OutBufPtr; // pointer to the output buffer\r
\r
OutBufPtr = OutBuffer;\r
- for(i = 0 ; i < MaxRegisterCount() ; i++) { // there are only 24 registers to read\r
- OutBufPtr = BasicReadRegister(SystemContext, i, OutBufPtr);\r
+ for (i = 0; i < MaxRegisterCount (); i++) {\r
+ // there are only 24 registers to read\r
+ OutBufPtr = BasicReadRegister (SystemContext, i, OutBufPtr);\r
}\r
\r
*OutBufPtr = '\0'; // the end of the buffer\r
SendPacket (OutBuffer);\r
}\r
\r
-\r
/**\r
Adds the RegNumber-th register's value to the output buffer, starting at the given OutBufPtr\r
\r
IN CHAR8 *InBufPtr\r
)\r
{\r
- UINTN RegSize;\r
- UINTN TempValue; // the value transferred from a hex char\r
- UINT64 NewValue; // the new value of the RegNumber-th Register\r
+ UINTN RegSize;\r
+ UINTN TempValue; // the value transferred from a hex char\r
+ UINT64 NewValue; // the new value of the RegNumber-th Register\r
\r
NewValue = 0;\r
- RegSize = 0;\r
+ RegSize = 0;\r
while (RegSize < 64) {\r
- TempValue = HexCharToInt(*InBufPtr++);\r
+ TempValue = HexCharToInt (*InBufPtr++);\r
\r
if (TempValue < 0) {\r
SendError (GDB_EBADMEMDATA);\r
}\r
\r
NewValue += (TempValue << (RegSize+4));\r
- TempValue = HexCharToInt(*InBufPtr++);\r
+ TempValue = HexCharToInt (*InBufPtr++);\r
\r
if (TempValue < 0) {\r
SendError (GDB_EBADMEMDATA);\r
return NULL;\r
- }\r
+ }\r
\r
NewValue += (TempValue << RegSize);\r
- RegSize = RegSize + 8;\r
+ RegSize = RegSize + 8;\r
}\r
- *(FindPointerToRegister(SystemContext, RegNumber)) = NewValue;\r
+\r
+ *(FindPointerToRegister (SystemContext, RegNumber)) = NewValue;\r
return InBufPtr;\r
}\r
\r
-\r
/** ‘P n...=r...’\r
Writes the new value of n-th register received into the input buffer to the n-th register\r
\r
VOID\r
EFIAPI\r
WriteNthRegister (\r
- IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN CHAR8 *InBuffer\r
+ IN EFI_SYSTEM_CONTEXT SystemContext,\r
+ IN CHAR8 *InBuffer\r
)\r
{\r
- UINTN RegNumber;\r
- CHAR8 RegNumBuffer[MAX_REG_NUM_BUF_SIZE]; // put the 'n..' part of the message into this array\r
- CHAR8 *RegNumBufPtr;\r
- CHAR8 *InBufPtr; // pointer to the input buffer\r
+ UINTN RegNumber;\r
+ CHAR8 RegNumBuffer[MAX_REG_NUM_BUF_SIZE]; // put the 'n..' part of the message into this array\r
+ CHAR8 *RegNumBufPtr;\r
+ CHAR8 *InBufPtr; // pointer to the input buffer\r
\r
// find the register number to write\r
- InBufPtr = &InBuffer[1];\r
+ InBufPtr = &InBuffer[1];\r
RegNumBufPtr = RegNumBuffer;\r
while (*InBufPtr != '=') {\r
*RegNumBufPtr++ = *InBufPtr++;\r
}\r
+\r
*RegNumBufPtr = '\0';\r
- RegNumber = AsciiStrHexToUintn (RegNumBuffer);\r
+ RegNumber = AsciiStrHexToUintn (RegNumBuffer);\r
\r
// check if this is a valid Register Number\r
- if ((RegNumber < 0) || (RegNumber >= MaxRegisterCount())) {\r
+ if ((RegNumber < 0) || (RegNumber >= MaxRegisterCount ())) {\r
SendError (GDB_EINVALIDREGNUM);\r
return;\r
}\r
+\r
InBufPtr++; // skips the '=' character\r
BasicWriteRegister (SystemContext, RegNumber, InBufPtr);\r
- SendSuccess();\r
+ SendSuccess ();\r
}\r
\r
-\r
/** ‘G XX...’\r
Writes the new values received into the input buffer to the general registers\r
\r
VOID\r
EFIAPI\r
WriteGeneralRegisters (\r
- IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN CHAR8 *InBuffer\r
+ IN EFI_SYSTEM_CONTEXT SystemContext,\r
+ IN CHAR8 *InBuffer\r
)\r
{\r
UINTN i;\r
- CHAR8 *InBufPtr; /// pointer to the input buffer\r
+ CHAR8 *InBufPtr; /// pointer to the input buffer\r
\r
// check to see if the buffer is the right size which is\r
// 1 (for 'G') + 16 (for 16 registers) * 8 ( for 8 hex chars each) = 385\r
- if (AsciiStrLen(InBuffer) != 385) { // 24 regs, 16 hex chars each, and the end '\0' (escape seq)\r
- //Bad message. Message is not the right length\r
+ if (AsciiStrLen (InBuffer) != 385) {\r
+ // 24 regs, 16 hex chars each, and the end '\0' (escape seq)\r
+ // Bad message. Message is not the right length\r
SendError (GDB_EBADBUFSIZE);\r
return;\r
}\r
\r
// Read the new values for the registers from the input buffer to an array, NewValueArray.\r
// The values in the array are in the gdb ordering\r
- for(i=0; i < MaxRegisterCount(); i++) { // there are only 16 registers to write\r
- InBufPtr = BasicWriteRegister(SystemContext, i, InBufPtr);\r
+ for (i = 0; i < MaxRegisterCount (); i++) {\r
+ // there are only 16 registers to write\r
+ InBufPtr = BasicWriteRegister (SystemContext, i, InBufPtr);\r
}\r
\r
- SendSuccess();\r
+ SendSuccess ();\r
}\r
\r
+/**\r
+Insert Single Step in the SystemContext\r
\r
- /**\r
- Insert Single Step in the SystemContext\r
-\r
- @param SystemContext Register content at time of the exception\r
- **/\r
+@param SystemContext Register content at time of the exception\r
+**/\r
VOID\r
AddSingleStep (\r
IN EFI_SYSTEM_CONTEXT SystemContext\r
)\r
{\r
- SystemContext.SystemContextX64->Rflags |= TF_BIT; //Setting the TF bit.\r
+ SystemContext.SystemContextX64->Rflags |= TF_BIT; // Setting the TF bit.\r
}\r
\r
-\r
-\r
/**\r
Remove Single Step in the SystemContext\r
\r
SystemContext.SystemContextX64->Rflags &= ~TF_BIT; // clearing the TF bit.\r
}\r
\r
-\r
-\r
/** ‘c [addr ]’\r
Continue. addr is Address to resume. If addr is omitted, resume at current\r
Address.\r
VOID\r
EFIAPI\r
ContinueAtAddress (\r
- IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN CHAR8 *PacketData\r
+ IN EFI_SYSTEM_CONTEXT SystemContext,\r
+ IN CHAR8 *PacketData\r
)\r
{\r
if (PacketData[1] != '\0') {\r
- SystemContext.SystemContextX64->Rip = AsciiStrHexToUintn(&PacketData[1]);\r
+ SystemContext.SystemContextX64->Rip = AsciiStrHexToUintn (&PacketData[1]);\r
}\r
}\r
\r
-\r
/** ‘s [addr ]’\r
Single step. addr is the Address at which to resume. If addr is omitted, resume\r
at same Address.\r
VOID\r
EFIAPI\r
SingleStep (\r
- IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN CHAR8 *PacketData\r
+ IN EFI_SYSTEM_CONTEXT SystemContext,\r
+ IN CHAR8 *PacketData\r
)\r
{\r
if (PacketData[1] != '\0') {\r
AddSingleStep (SystemContext);\r
}\r
\r
-\r
/**\r
Returns breakpoint data address from DR0-DR3 based on the input breakpoint\r
number\r
IN UINTN BreakpointNumber\r
)\r
{\r
- UINTN Address;\r
+ UINTN Address;\r
\r
if (BreakpointNumber == 1) {\r
Address = SystemContext.SystemContextIa32->Dr0;\r
IN EFI_SYSTEM_CONTEXT SystemContext\r
)\r
{\r
- IA32_DR6 Dr6;\r
- UINTN BreakpointNumber;\r
+ IA32_DR6 Dr6;\r
+ UINTN BreakpointNumber;\r
\r
Dr6.UintN = SystemContext.SystemContextIa32->Dr6;\r
\r
} else if (Dr6.Bits.B3 == 1) {\r
BreakpointNumber = 4;\r
} else {\r
- BreakpointNumber = 0; //No breakpoint detected\r
+ BreakpointNumber = 0; // No breakpoint detected\r
}\r
\r
return BreakpointNumber;\r
IN UINTN BreakpointNumber\r
)\r
{\r
- IA32_DR7 Dr7;\r
- BREAK_TYPE Type = NotSupported; //Default is NotSupported type\r
+ IA32_DR7 Dr7;\r
+ BREAK_TYPE Type = NotSupported; // Default is NotSupported type\r
\r
Dr7.UintN = SystemContext.SystemContextIa32->Dr7;\r
\r
if (BreakpointNumber == 1) {\r
- Type = (BREAK_TYPE) Dr7.Bits.RW0;\r
+ Type = (BREAK_TYPE)Dr7.Bits.RW0;\r
} else if (BreakpointNumber == 2) {\r
- Type = (BREAK_TYPE) Dr7.Bits.RW1;\r
+ Type = (BREAK_TYPE)Dr7.Bits.RW1;\r
} else if (BreakpointNumber == 3) {\r
- Type = (BREAK_TYPE) Dr7.Bits.RW2;\r
+ Type = (BREAK_TYPE)Dr7.Bits.RW2;\r
} else if (BreakpointNumber == 4) {\r
- Type = (BREAK_TYPE) Dr7.Bits.RW3;\r
+ Type = (BREAK_TYPE)Dr7.Bits.RW3;\r
}\r
\r
return Type;\r
}\r
\r
-\r
/**\r
Parses Length and returns the length which DR7 LENn field accepts.\r
For example: If we receive 1-Byte length then we should return 0.\r
**/\r
UINTN\r
ConvertLengthData (\r
- IN UINTN Length\r
+ IN UINTN Length\r
)\r
{\r
- if (Length == 1) { //1-Byte length\r
+ if (Length == 1) {\r
+ // 1-Byte length\r
return 0;\r
- } else if (Length == 2) { //2-Byte length\r
+ } else if (Length == 2) {\r
+ // 2-Byte length\r
return 1;\r
- } else if (Length == 4) { //4-Byte length\r
+ } else if (Length == 4) {\r
+ // 4-Byte length\r
return 3;\r
- } else { //Undefined or 8-byte length\r
+ } else {\r
+ // Undefined or 8-byte length\r
return 2;\r
}\r
}\r
\r
-\r
/**\r
Finds the next free debug register. If all the registers are occupied then\r
EFI_OUT_OF_RESOURCES is returned.\r
OUT UINTN *Register\r
)\r
{\r
- IA32_DR7 Dr7;\r
+ IA32_DR7 Dr7;\r
\r
Dr7.UintN = SystemContext.SystemContextIa32->Dr7;\r
\r
return EFI_SUCCESS;\r
}\r
\r
-\r
/**\r
Enables the debug register. Writes Address value to appropriate DR0-3 register.\r
Sets LENn, Gn, RWn bits in DR7 register.\r
{\r
IA32_DR7 Dr7;\r
\r
- //Convert length data\r
+ // Convert length data\r
Length = ConvertLengthData (Length);\r
\r
- //For Instruction execution, length should be 0\r
- //(Ref. Intel reference manual 18.2.4)\r
+ // For Instruction execution, length should be 0\r
+ // (Ref. Intel reference manual 18.2.4)\r
if ((Type == 0) && (Length != 0)) {\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
- //Hardware doesn't support ReadWatch (z3 packet) type. GDB can handle\r
- //software breakpoint. We should send empty packet in both these cases.\r
+ // Hardware doesn't support ReadWatch (z3 packet) type. GDB can handle\r
+ // software breakpoint. We should send empty packet in both these cases.\r
if ((Type == (BREAK_TYPE)DataRead) ||\r
- (Type == (BREAK_TYPE)SoftwareBreakpoint)) {\r
+ (Type == (BREAK_TYPE)SoftwareBreakpoint))\r
+ {\r
return EFI_UNSUPPORTED;\r
}\r
\r
- //Read DR7 so appropriate Gn, RWn and LENn bits can be modified.\r
+ // Read DR7 so appropriate Gn, RWn and LENn bits can be modified.\r
Dr7.UintN = SystemContext.SystemContextIa32->Dr7;\r
\r
if (Register == 0) {\r
SystemContext.SystemContextIa32->Dr0 = Address;\r
- Dr7.Bits.G0 = 1;\r
- Dr7.Bits.RW0 = Type;\r
- Dr7.Bits.LEN0 = Length;\r
+ Dr7.Bits.G0 = 1;\r
+ Dr7.Bits.RW0 = Type;\r
+ Dr7.Bits.LEN0 = Length;\r
} else if (Register == 1) {\r
SystemContext.SystemContextIa32->Dr1 = Address;\r
- Dr7.Bits.G1 = 1;\r
- Dr7.Bits.RW1 = Type;\r
- Dr7.Bits.LEN1 = Length;\r
+ Dr7.Bits.G1 = 1;\r
+ Dr7.Bits.RW1 = Type;\r
+ Dr7.Bits.LEN1 = Length;\r
} else if (Register == 2) {\r
SystemContext.SystemContextIa32->Dr2 = Address;\r
- Dr7.Bits.G2 = 1;\r
- Dr7.Bits.RW2 = Type;\r
- Dr7.Bits.LEN2 = Length;\r
+ Dr7.Bits.G2 = 1;\r
+ Dr7.Bits.RW2 = Type;\r
+ Dr7.Bits.LEN2 = Length;\r
} else if (Register == 3) {\r
SystemContext.SystemContextIa32->Dr3 = Address;\r
- Dr7.Bits.G3 = 1;\r
- Dr7.Bits.RW3 = Type;\r
- Dr7.Bits.LEN3 = Length;\r
+ Dr7.Bits.G3 = 1;\r
+ Dr7.Bits.RW3 = Type;\r
+ Dr7.Bits.LEN3 = Length;\r
} else {\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
- //Update Dr7 with appropriate Gn, RWn and LENn bits\r
+ // Update Dr7 with appropriate Gn, RWn and LENn bits\r
SystemContext.SystemContextIa32->Dr7 = Dr7.UintN;\r
\r
return EFI_SUCCESS;\r
}\r
\r
-\r
/**\r
Returns register number 0 - 3 for the matching debug register.\r
This function compares incoming Address, Type, Length and\r
**/\r
EFI_STATUS\r
FindMatchingDebugRegister (\r
- IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN UINTN Address,\r
- IN UINTN Length,\r
- IN UINTN Type,\r
- OUT UINTN *Register\r
- )\r
+ IN EFI_SYSTEM_CONTEXT SystemContext,\r
+ IN UINTN Address,\r
+ IN UINTN Length,\r
+ IN UINTN Type,\r
+ OUT UINTN *Register\r
+ )\r
{\r
- IA32_DR7 Dr7;\r
+ IA32_DR7 Dr7;\r
\r
- //Hardware doesn't support ReadWatch (z3 packet) type. GDB can handle\r
- //software breakpoint. We should send empty packet in both these cases.\r
+ // Hardware doesn't support ReadWatch (z3 packet) type. GDB can handle\r
+ // software breakpoint. We should send empty packet in both these cases.\r
if ((Type == (BREAK_TYPE)DataRead) ||\r
- (Type == (BREAK_TYPE)SoftwareBreakpoint)) {\r
+ (Type == (BREAK_TYPE)SoftwareBreakpoint))\r
+ {\r
return EFI_UNSUPPORTED;\r
}\r
\r
- //Convert length data\r
- Length = ConvertLengthData(Length);\r
+ // Convert length data\r
+ Length = ConvertLengthData (Length);\r
\r
Dr7.UintN = SystemContext.SystemContextIa32->Dr7;\r
\r
if ((Dr7.Bits.G0 == 1) &&\r
(Dr7.Bits.LEN0 == Length) &&\r
(Dr7.Bits.RW0 == Type) &&\r
- (Address == SystemContext.SystemContextIa32->Dr0)) {\r
+ (Address == SystemContext.SystemContextIa32->Dr0))\r
+ {\r
*Register = 0;\r
} else if ((Dr7.Bits.G1 == 1) &&\r
(Dr7.Bits.LEN1 == Length) &&\r
(Dr7.Bits.RW1 == Type) &&\r
- (Address == SystemContext.SystemContextIa32->Dr1)) {\r
+ (Address == SystemContext.SystemContextIa32->Dr1))\r
+ {\r
*Register = 1;\r
} else if ((Dr7.Bits.G2 == 1) &&\r
(Dr7.Bits.LEN2 == Length) &&\r
(Dr7.Bits.RW2 == Type) &&\r
- (Address == SystemContext.SystemContextIa32->Dr2)) {\r
+ (Address == SystemContext.SystemContextIa32->Dr2))\r
+ {\r
*Register = 2;\r
} else if ((Dr7.Bits.G3 == 1) &&\r
(Dr7.Bits.LEN3 == Length) &&\r
(Dr7.Bits.RW3 == Type) &&\r
- (Address == SystemContext.SystemContextIa32->Dr3)) {\r
+ (Address == SystemContext.SystemContextIa32->Dr3))\r
+ {\r
*Register = 3;\r
} else {\r
Print ((CHAR16 *)L"No match found..\n");\r
return EFI_SUCCESS;\r
}\r
\r
-\r
/**\r
Disables the particular debug register.\r
\r
**/\r
EFI_STATUS\r
DisableDebugRegister (\r
- IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN UINTN Register\r
- )\r
+ IN EFI_SYSTEM_CONTEXT SystemContext,\r
+ IN UINTN Register\r
+ )\r
{\r
IA32_DR7 Dr7;\r
- UINTN Address = 0;\r
+ UINTN Address = 0;\r
\r
- //Read DR7 register so appropriate Gn, RWn and LENn bits can be turned off.\r
+ // Read DR7 register so appropriate Gn, RWn and LENn bits can be turned off.\r
Dr7.UintN = SystemContext.SystemContextIa32->Dr7;\r
\r
if (Register == 0) {\r
SystemContext.SystemContextIa32->Dr0 = Address;\r
- Dr7.Bits.G0 = 0;\r
- Dr7.Bits.RW0 = 0;\r
- Dr7.Bits.LEN0 = 0;\r
+ Dr7.Bits.G0 = 0;\r
+ Dr7.Bits.RW0 = 0;\r
+ Dr7.Bits.LEN0 = 0;\r
} else if (Register == 1) {\r
SystemContext.SystemContextIa32->Dr1 = Address;\r
- Dr7.Bits.G1 = 0;\r
- Dr7.Bits.RW1 = 0;\r
- Dr7.Bits.LEN1 = 0;\r
+ Dr7.Bits.G1 = 0;\r
+ Dr7.Bits.RW1 = 0;\r
+ Dr7.Bits.LEN1 = 0;\r
} else if (Register == 2) {\r
SystemContext.SystemContextIa32->Dr2 = Address;\r
- Dr7.Bits.G2 = 0;\r
- Dr7.Bits.RW2 = 0;\r
- Dr7.Bits.LEN2 = 0;\r
+ Dr7.Bits.G2 = 0;\r
+ Dr7.Bits.RW2 = 0;\r
+ Dr7.Bits.LEN2 = 0;\r
} else if (Register == 3) {\r
SystemContext.SystemContextIa32->Dr3 = Address;\r
- Dr7.Bits.G3 = 0;\r
- Dr7.Bits.RW3 = 0;\r
- Dr7.Bits.LEN3 = 0;\r
+ Dr7.Bits.G3 = 0;\r
+ Dr7.Bits.RW3 = 0;\r
+ Dr7.Bits.LEN3 = 0;\r
} else {\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
- //Update DR7 register so appropriate Gn, RWn and LENn bits can be turned off.\r
+ // Update DR7 register so appropriate Gn, RWn and LENn bits can be turned off.\r
SystemContext.SystemContextIa32->Dr7 = Dr7.UintN;\r
\r
return EFI_SUCCESS;\r
EFIAPI\r
InsertBreakPoint (\r
IN EFI_SYSTEM_CONTEXT SystemContext,\r
- IN CHAR8 *PacketData\r
+ IN CHAR8 *PacketData\r
)\r
{\r
- UINTN Type;\r
- UINTN Address;\r
- UINTN Length;\r
- UINTN Register;\r
- EFI_STATUS Status;\r
- BREAK_TYPE BreakType = NotSupported;\r
- UINTN ErrorCode;\r
+ UINTN Type;\r
+ UINTN Address;\r
+ UINTN Length;\r
+ UINTN Register;\r
+ EFI_STATUS Status;\r
+ BREAK_TYPE BreakType = NotSupported;\r
+ UINTN ErrorCode;\r
\r
ErrorCode = ParseBreakpointPacket (PacketData, &Type, &Address, &Length);\r
if (ErrorCode > 0) {\r
}\r
\r
switch (Type) {\r
-\r
- case 0: //Software breakpoint\r
+ case 0: // Software breakpoint\r
BreakType = SoftwareBreakpoint;\r
break;\r
\r
- case 1: //Hardware breakpoint\r
+ case 1: // Hardware breakpoint\r
BreakType = InstructionExecution;\r
break;\r
\r
- case 2: //Write watchpoint\r
+ case 2: // Write watchpoint\r
BreakType = DataWrite;\r
break;\r
\r
- case 3: //Read watchpoint\r
+ case 3: // Read watchpoint\r
BreakType = DataRead;\r
break;\r
\r
- case 4: //Access watchpoint\r
+ case 4: // Access watchpoint\r
BreakType = DataReadWrite;\r
break;\r
\r
- default :\r
+ default:\r
Print ((CHAR16 *)L"Insert breakpoint default: %x\n", Type);\r
SendError (GDB_EINVALIDBRKPOINTTYPE);\r
return;\r
\r
// Find next free debug register\r
Status = FindNextFreeDebugRegister (SystemContext, &Register);\r
- if (EFI_ERROR(Status)) {\r
+ if (EFI_ERROR (Status)) {\r
Print ((CHAR16 *)L"No space left on device\n");\r
SendError (GDB_ENOSPACE);\r
return;\r
\r
// Write Address, length data at particular DR register\r
Status = EnableDebugRegister (SystemContext, Register, Address, Length, (UINTN)BreakType);\r
- if (EFI_ERROR(Status)) {\r
-\r
+ if (EFI_ERROR (Status)) {\r
if (Status == EFI_UNSUPPORTED) {\r
Print ((CHAR16 *)L"Not supported\n");\r
- SendNotSupported();\r
+ SendNotSupported ();\r
return;\r
}\r
\r
SendSuccess ();\r
}\r
\r
-\r
/**\r
‘z1, [addr], [length]’\r
‘z2, [addr], [length]’\r
IN CHAR8 *PacketData\r
)\r
{\r
- UINTN Type;\r
- UINTN Address;\r
- UINTN Length;\r
- UINTN Register;\r
- BREAK_TYPE BreakType = NotSupported;\r
- EFI_STATUS Status;\r
- UINTN ErrorCode;\r
-\r
- //Parse breakpoint packet data\r
+ UINTN Type;\r
+ UINTN Address;\r
+ UINTN Length;\r
+ UINTN Register;\r
+ BREAK_TYPE BreakType = NotSupported;\r
+ EFI_STATUS Status;\r
+ UINTN ErrorCode;\r
+\r
+ // Parse breakpoint packet data\r
ErrorCode = ParseBreakpointPacket (PacketData, &Type, &Address, &Length);\r
if (ErrorCode > 0) {\r
SendError ((UINT8)ErrorCode);\r
}\r
\r
switch (Type) {\r
-\r
- case 0: //Software breakpoint\r
+ case 0: // Software breakpoint\r
BreakType = SoftwareBreakpoint;\r
break;\r
\r
- case 1: //Hardware breakpoint\r
+ case 1: // Hardware breakpoint\r
BreakType = InstructionExecution;\r
break;\r
\r
- case 2: //Write watchpoint\r
+ case 2: // Write watchpoint\r
BreakType = DataWrite;\r
break;\r
\r
- case 3: //Read watchpoint\r
+ case 3: // Read watchpoint\r
BreakType = DataRead;\r
break;\r
\r
- case 4: //Access watchpoint\r
+ case 4: // Access watchpoint\r
BreakType = DataReadWrite;\r
break;\r
\r
- default :\r
+ default:\r
SendError (GDB_EINVALIDBRKPOINTTYPE);\r
return;\r
}\r
\r
- //Find matching debug register\r
+ // Find matching debug register\r
Status = FindMatchingDebugRegister (SystemContext, Address, Length, (UINTN)BreakType, &Register);\r
- if (EFI_ERROR(Status)) {\r
-\r
+ if (EFI_ERROR (Status)) {\r
if (Status == EFI_UNSUPPORTED) {\r
Print ((CHAR16 *)L"Not supported.\n");\r
- SendNotSupported();\r
+ SendNotSupported ();\r
return;\r
}\r
\r
return;\r
}\r
\r
- //Remove breakpoint\r
- Status = DisableDebugRegister(SystemContext, Register);\r
- if (EFI_ERROR(Status)) {\r
+ // Remove breakpoint\r
+ Status = DisableDebugRegister (SystemContext, Register);\r
+ if (EFI_ERROR (Status)) {\r
Print ((CHAR16 *)L"Invalid argument.\n");\r
SendError (GDB_EINVALIDARG);\r
return;\r
SendSuccess ();\r
}\r
\r
-\r
VOID\r
InitializeProcessor (\r
VOID\r
\r
BOOLEAN\r
ValidateException (\r
- IN EFI_EXCEPTION_TYPE ExceptionType,\r
- IN OUT EFI_SYSTEM_CONTEXT SystemContext\r
+ IN EFI_EXCEPTION_TYPE ExceptionType,\r
+ IN OUT EFI_SYSTEM_CONTEXT SystemContext\r
)\r
{\r
return TRUE;\r
}\r
-\r
projects / mirror_edk2.git / blobdiff