- CalculateSum8 ((UINT8 *)&Value, sizeof(UINT8));\r
Mailbox->HostSequenceNo = (UINT8) Value;\r
break;\r
+ case DEBUG_MAILBOX_DEBUG_TIMER_FREQUENCY:\r
+ Mailbox->ToBeCheckSum = Mailbox->CheckSum + CalculateSum8 ((UINT8 *)&Mailbox->HostSequenceNo, sizeof(UINT32))\r
+ - CalculateSum8 ((UINT8 *)&Value, sizeof(UINT32));\r
+ Mailbox->DebugTimerFrequency = (UINT32) Value;\r
+ break;\r
}\r
UpdateMailboxChecksum (Mailbox);\r
ReleaseMpSpinLock (&mDebugMpContext.MailboxSpinLock);\r
}\r
+\r
+/**\r
+ Read data from debug device and save the data in buffer.\r
+\r
+ Reads NumberOfBytes data bytes from a debug device into the buffer\r
+ specified by Buffer. The number of bytes actually read is returned.\r
+ If the return value is less than NumberOfBytes, then the rest operation failed.\r
+ If NumberOfBytes is zero, then return 0.\r
+\r
+ @param Handle Debug port handle.\r
+ @param Buffer Pointer to the data buffer to store the data read from the debug device.\r
+ @param NumberOfBytes Number of bytes which will be read.\r
+ @param Timeout Timeout value for reading from debug device. It unit is Microsecond.\r
+\r
+ @retval 0 Read data failed, no data is to be read.\r
+ @retval >0 Actual number of bytes read from debug device.\r
+\r
+**/\r
+UINTN\r
+DebugAgentReadBuffer (\r
+ IN DEBUG_PORT_HANDLE Handle,\r
+ IN UINT8 *Buffer,\r
+ IN UINTN NumberOfBytes,\r
+ IN UINTN Timeout\r
+ )\r
+{\r
+ UINTN Index;\r
+ UINT32 Begin;\r
+ UINT32 TimeoutTicker;\r
+ UINT32 TimerRound;\r
+ UINT32 TimerFrequency;\r
+ UINT32 TimerCycle;\r
+ \r
+ Begin = 0;\r
+ TimeoutTicker = 0; \r
+ TimerRound = 0;\r
+ TimerFrequency = GetMailboxPointer()->DebugTimerFrequency;\r
+ TimerCycle = GetApicTimerInitCount ();\r
+\r
+ if (Timeout != 0) {\r
+ Begin = GetApicTimerCurrentCount ();\r
+ TimeoutTicker = (UINT32) DivU64x32 (\r
+ MultU64x64 (\r
+ TimerFrequency,\r
+ Timeout\r
+ ),\r
+ 1000000u\r
+ );\r
+ TimerRound = (UINT32) DivU64x32Remainder (TimeoutTicker, TimerCycle / 2, &TimeoutTicker);\r
+ }\r
+ Index = 0;\r
+ while (Index < NumberOfBytes) {\r
+ if (DebugPortPollBuffer (Handle)) {\r
+ DebugPortReadBuffer (Handle, Buffer + Index, 1, 0);\r
+ Index ++; \r
+ continue;\r
+ }\r
+ if (Timeout != 0) {\r
+ if (TimerRound == 0) {\r
+ if (IsDebugTimerTimeout (TimerCycle, Begin, TimeoutTicker)) {\r
+ //\r
+ // If time out occurs.\r
+ //\r
+ return 0;\r
+ }\r
+ } else {\r
+ if (IsDebugTimerTimeout (TimerCycle, Begin, TimerCycle / 2)) {\r
+ TimerRound --;\r
+ Begin = GetApicTimerCurrentCount ();\r
+ }\r
+ }\r
+ }\r
+ }\r
+\r
+ return Index;\r
+}\r
+\r
/**\r
Set debug flag in mailbox.\r
\r
//\r
// Has received start symbol, try to read the rest part\r
//\r
- if (DebugPortReadBuffer (Handle, (UINT8 *)DebugHeader + OFFSET_OF (DEBUG_PACKET_HEADER, Command), sizeof (DEBUG_PACKET_HEADER) - OFFSET_OF (DEBUG_PACKET_HEADER, Command), READ_PACKET_TIMEOUT) == 0) {\r
+ if (DebugAgentReadBuffer (Handle, (UINT8 *)DebugHeader + OFFSET_OF (DEBUG_PACKET_HEADER, Command), sizeof (DEBUG_PACKET_HEADER) - OFFSET_OF (DEBUG_PACKET_HEADER, Command), READ_PACKET_TIMEOUT) == 0) {\r
//\r
// Timeout occur, exit\r
//\r
//\r
// Find the valid start symbol\r
//\r
- Received = DebugPortReadBuffer (Handle, &DebugHeader->StartSymbol, sizeof (DebugHeader->StartSymbol), TimeoutForStartSymbol);\r
+ Received = DebugAgentReadBuffer (Handle, &DebugHeader->StartSymbol, sizeof (DebugHeader->StartSymbol), TimeoutForStartSymbol);\r
if (Received < sizeof (DebugHeader->StartSymbol)) {\r
- DebugAgentMsgPrint (DEBUG_AGENT_WARNING, "DebugPortReadBuffer(StartSymbol) timeout\n");\r
+ DebugAgentMsgPrint (DEBUG_AGENT_WARNING, "DebugAgentReadBuffer(StartSymbol) timeout\n");\r
return RETURN_TIMEOUT;\r
}\r
\r
//\r
// Read Package header till field Length\r
//\r
- Received = DebugPortReadBuffer (\r
+ Received = DebugAgentReadBuffer (\r
Handle,\r
(UINT8 *) DebugHeader + OFFSET_OF (DEBUG_PACKET_HEADER, Command),\r
OFFSET_OF (DEBUG_PACKET_HEADER, Length) + sizeof (DebugHeader->Length) - sizeof (DebugHeader->StartSymbol),\r
Timeout\r
);\r
if (Received == 0) {\r
- DebugAgentMsgPrint (DEBUG_AGENT_ERROR, "DebugPortReadBuffer(Command) timeout\n");\r
+ DebugAgentMsgPrint (DEBUG_AGENT_ERROR, "DebugAgentReadBuffer(Command) timeout\n");\r
return RETURN_TIMEOUT;\r
}\r
if (DebugHeader->Length < sizeof (DEBUG_PACKET_HEADER)) {\r
//\r
// Read the payload data include the CRC field\r
//\r
- Received = DebugPortReadBuffer (Handle, &DebugHeader->SequenceNo, (UINT8) (DebugHeader->Length - OFFSET_OF (DEBUG_PACKET_HEADER, SequenceNo)), Timeout);\r
+ Received = DebugAgentReadBuffer (Handle, &DebugHeader->SequenceNo, (UINT8) (DebugHeader->Length - OFFSET_OF (DEBUG_PACKET_HEADER, SequenceNo)), Timeout);\r
if (Received == 0) {\r
- DebugAgentMsgPrint (DEBUG_AGENT_ERROR, "DebugPortReadBuffer(SequenceNo) timeout\n");\r
+ DebugAgentMsgPrint (DEBUG_AGENT_ERROR, "DebugAgentReadBuffer(SequenceNo) timeout\n");\r
return RETURN_TIMEOUT;\r
}\r
//\r
// Poll Attach symbols from HOST and ack OK\r
//\r
do {\r
- DebugPortReadBuffer (Handle, &InputCharacter, 1, 0);\r
+ DebugAgentReadBuffer (Handle, &InputCharacter, 1, 0);\r
} while (InputCharacter != DEBUG_STARTING_SYMBOL_ATTACH);\r
SendAckPacket (DEBUG_COMMAND_OK);\r
\r
//\r
CurrentDebugTimerInitCount = GetApicTimerInitCount ();\r
if (mDebugMpContext.DebugTimerInitCount != CurrentDebugTimerInitCount) {\r
- InitializeDebugTimer ();\r
+ InitializeDebugTimer (NULL);\r
}\r
}\r
\r
// Timeout value for reading packet (unit is microsecond)\r
//\r
#define READ_PACKET_TIMEOUT (500 * 1000)\r
+#define DEBUG_TIMER_INTERVAL (100 * 1000)\r
\r
#define SOFT_INTERRUPT_SIGNATURE SIGNATURE_32('S','O','F','T')\r
#define SYSTEM_RESET_SIGNATURE SIGNATURE_32('S','Y','S','R')\r
#define DEBUG_MAILBOX_LAST_ACK 4\r
#define DEBUG_MAILBOX_SEQUENCE_NO_INDEX 5\r
#define DEBUG_MAILBOX_HOST_SEQUENCE_NO_INDEX 6\r
+#define DEBUG_MAILBOX_DEBUG_TIMER_FREQUENCY 7\r
\r
#pragma pack(1)\r
typedef union {\r
UINT8 LastAck; // The last ack packet type\r
UINT8 SequenceNo;\r
UINT8 HostSequenceNo;\r
+ UINT32 DebugTimerFrequency;\r
UINT8 CheckSum; // Mailbox checksum\r
UINT8 ToBeCheckSum; // To be Mailbox checksum at the next\r
} DEBUG_AGENT_MAILBOX;\r
IN OUT DEBUG_PACKET_HEADER *DebugHeader\r
);\r
\r
+/**\r
+ Read data from debug channel and save the data in buffer.\r
+\r
+ Reads NumberOfBytes data bytes from a debug device into the buffer\r
+ specified by Buffer. The number of bytes actually read is returned.\r
+ If the return value is less than NumberOfBytes, then the rest operation failed.\r
+ If NumberOfBytes is zero, then return 0.\r
+\r
+ @param Handle Debug port handle.\r
+ @param Buffer Pointer to the data buffer to store the data read from the debug device.\r
+ @param NumberOfBytes Number of bytes which will be read.\r
+ @param Timeout Timeout value for reading from debug device. It unit is Microsecond.\r
+\r
+ @retval 0 Read data failed, no data is to be read.\r
+ @retval >0 Actual number of bytes read from debug device.\r
+\r
+**/\r
+UINTN\r
+DebugAgentReadBuffer (\r
+ IN DEBUG_PORT_HANDLE Handle,\r
+ IN OUT UINT8 *Buffer,\r
+ IN UINTN NumberOfBytes,\r
+ IN UINTN Timeout\r
+ );\r
+\r
#endif\r
\r
/** @file\r
Code for debug timer to support debug agent library implementation.\r
\r
- Copyright (c) 2010 - 2014, Intel Corporation. All rights reserved.<BR>\r
+ Copyright (c) 2010 - 2015, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution. The full text of the license may be found at\r
/**\r
Initialize CPU local APIC timer.\r
\r
+ @param[out] Local APIC timer frequency returned.\r
+ \r
@return 32-bit Local APIC timer init count.\r
**/\r
UINT32\r
InitializeDebugTimer (\r
- VOID\r
+ OUT UINT32 *TimerFrequency\r
)\r
{\r
UINTN ApicTimerDivisor;\r
UINT32 InitialCount;\r
+ UINT32 ApicTimerFrequency;\r
\r
GetApicTimerState (&ApicTimerDivisor, NULL, NULL);\r
-\r
+ ApicTimerFrequency = PcdGet32(PcdFSBClock) / (UINT32)ApicTimerDivisor;\r
//\r
// Cpu Local Apic timer interrupt frequency, it is set to 0.1s\r
//\r
InitialCount = (UINT32)DivU64x32 (\r
MultU64x64 (\r
- PcdGet32(PcdFSBClock) / (UINT32)ApicTimerDivisor,\r
- 100\r
+ ApicTimerFrequency,\r
+ DEBUG_TIMER_INTERVAL\r
),\r
- 1000\r
+ 1000000u\r
);\r
\r
InitializeApicTimer (ApicTimerDivisor, InitialCount, TRUE, DEBUG_TIMER_VECTOR);\r
\r
+ DEBUG ((EFI_D_INFO, "Debug Timer: FSB Clock = %d\n", PcdGet32(PcdFSBClock))); \r
+ DEBUG ((EFI_D_INFO, "Debug Timer: Divisor = %d\n", ApicTimerDivisor)); \r
+ DEBUG ((EFI_D_INFO, "Debug Timer: Frequency = %d\n", ApicTimerFrequency)); \r
+ DEBUG ((EFI_D_INFO, "Debug Timer: InitialCount = %d\n", InitialCount)); \r
+\r
+ if (TimerFrequency != NULL) {\r
+ *TimerFrequency = ApicTimerFrequency;\r
+ }\r
return InitialCount;\r
}\r
\r
return OldDebugTimerInterruptState;\r
}\r
\r
+/**\r
+ Check if the timer is time out.\r
+ \r
+ @param[in] TimerCycle Timer total count.\r
+ @param[in] Timer The start timer from the begin.\r
+ @param[in] TimeoutTicker Ticker number need time out.\r
+\r
+ @return TRUE Timer time out occurs.\r
+ @retval FALSE Timer does not time out.\r
+\r
+**/\r
+BOOLEAN\r
+IsDebugTimerTimeout (\r
+ IN UINT32 TimerCycle,\r
+ IN UINT32 Timer,\r
+ IN UINT32 TimeoutTicker\r
+ )\r
+{\r
+ UINT64 CurrentTimer;\r
+ UINT64 Delta;\r
+\r
+ CurrentTimer = GetApicTimerCurrentCount ();\r
+\r
+ //\r
+ // This timer counter counts down. Check for roll over condition.\r
+ //\r
+ if (CurrentTimer < Timer) {\r
+ Delta = Timer - CurrentTimer;\r
+ } else {\r
+ //\r
+ // Handle one roll-over. \r
+ //\r
+ Delta = TimerCycle - (CurrentTimer - Timer);\r
+ }\r
+ \r
+ return (BOOLEAN) (Delta >= TimeoutTicker);\r
+}\r
+\r
/** @file\r
Header file for debug timer to support debug agent library implementation.\r
\r
- Copyright (c) 2010 - 2014, Intel Corporation. All rights reserved.<BR>\r
+ Copyright (c) 2010 - 2015, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution. The full text of the license may be found at\r
/**\r
Initialize CPU local APIC timer.\r
\r
+ @param[out] Local APIC timer frequency returned.\r
+ \r
@return 32-bit Local APIC timer init count.\r
**/\r
UINT32\r
InitializeDebugTimer (\r
- VOID\r
+ OUT UINT32 *TimerFrequency\r
+ );\r
+\r
+/**\r
+ Check if the timer is time out.\r
+ \r
+ @param[in] TimerCycle Timer total count.\r
+ @param[in] Timer The start timer from the begin.\r
+ @param[in] TimeoutTicker Ticker number need time out.\r
+\r
+ @return TRUE Timer time out occurs.\r
+ @retval FALSE Timer does not time out.\r
+\r
+**/\r
+BOOLEAN\r
+IsDebugTimerTimeout (\r
+ IN UINT32 TimerCycle,\r
+ IN UINT32 Timer,\r
+ IN UINT32 TimeoutTicker\r
);\r
\r
#endif\r
/** @file\r
Debug Agent library implementition for Dxe Core and Dxr modules.\r
\r
- Copyright (c) 2010 - 2014, Intel Corporation. All rights reserved.<BR>\r
+ Copyright (c) 2010 - 2015, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution. The full text of the license may be found at\r
IA32_DESCRIPTOR IdtDescriptor;\r
IA32_DESCRIPTOR *Ia32Idtr;\r
IA32_IDT_ENTRY *Ia32IdtEntry;\r
+ UINT32 DebugTimerFrequency;\r
\r
if (InitFlag == DEBUG_AGENT_INIT_DXE_AP) {\r
//\r
mSaveIdtTableSize = IdtDescriptor.Limit + 1;\r
mSavedIdtTable = AllocateCopyPool (mSaveIdtTableSize, (VOID *) IdtDescriptor.Base);\r
//\r
- // Initialize Debug Timer hardware and save its initial count\r
- //\r
- mDebugMpContext.DebugTimerInitCount = InitializeDebugTimer ();\r
- //\r
// Check if Debug Agent initialized in DXE phase\r
//\r
Mailbox = GetMailboxFromConfigurationTable ();\r
//\r
SetupDebugAgentEnviroment (Mailbox);\r
//\r
+ // Initialize Debug Timer hardware and save its initial count and frequency\r
+ //\r
+ mDebugMpContext.DebugTimerInitCount = InitializeDebugTimer (&DebugTimerFrequency);\r
+ UpdateMailboxContent (mMailboxPointer, DEBUG_MAILBOX_DEBUG_TIMER_FREQUENCY, DebugTimerFrequency);\r
+ //\r
// For DEBUG_AGENT_INIT_S3, needn't to install configuration table and EFI Serial IO protocol\r
// For DEBUG_AGENT_INIT_DXE_CORE, InternalConstructorWorker() will invoked in Constructor()\r
//\r
mDxeCoreFlag = TRUE;\r
mMultiProcessorDebugSupport = TRUE;\r
//\r
- // Initialize Debug Timer hardware and its initial count\r
- //\r
- mDebugMpContext.DebugTimerInitCount = InitializeDebugTimer ();\r
- //\r
// Try to get mailbox from GUIDed HOB build in PEI\r
//\r
HobList = Context;\r
//\r
SetupDebugAgentEnviroment (Mailbox);\r
//\r
+ // Initialize Debug Timer hardware and save its initial count and frequency\r
+ //\r
+ mDebugMpContext.DebugTimerInitCount = InitializeDebugTimer (&DebugTimerFrequency);\r
+ UpdateMailboxContent (mMailboxPointer, DEBUG_MAILBOX_DEBUG_TIMER_FREQUENCY, DebugTimerFrequency);\r
+ //\r
// Enable interrupt to receive Debug Timer interrupt\r
//\r
EnableInterrupts ();\r
/** @file\r
Install Serial IO Protocol that layers on top of a Debug Communication Library instance.\r
\r
- Copyright (c) 2012 - 2013, Intel Corporation. All rights reserved.<BR>\r
+ Copyright (c) 2012 - 2015, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution. The full text of the license may be found at\r
if (!DebugPortPollBuffer (Handle)) {\r
break;\r
}\r
- DebugPortReadBuffer (Handle, Data8, 1, 0);\r
+ DebugAgentReadBuffer (Handle, Data8, 1, 0);\r
\r
if (*Data8 == DEBUG_STARTING_SYMBOL_ATTACH) {\r
//\r
//\r
// Try to read the start symbol\r
//\r
- DebugPortReadBuffer (Handle, Data8, 1, 0);\r
+ DebugAgentReadBuffer (Handle, Data8, 1, 0);\r
if (*Data8 == DEBUG_STARTING_SYMBOL_ATTACH) {\r
DebugAgentMsgPrint (DEBUG_AGENT_INFO, "Debug Timer attach symbol received %x", *Data8);\r
*BreakSymbol = *Data8;\r
/** @file\r
SEC Core Debug Agent Library instance implementition.\r
\r
- Copyright (c) 2010 - 2014, Intel Corporation. All rights reserved.<BR>\r
+ Copyright (c) 2010 - 2015, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution. The full text of the license may be found at\r
//\r
// Try to read the start symbol\r
//\r
- DebugPortReadBuffer (Handle, Data8, 1, 0);\r
+ DebugAgentReadBuffer (Handle, Data8, 1, 0);\r
if (*Data8 == DEBUG_STARTING_SYMBOL_ATTACH) {\r
*BreakSymbol = *Data8;\r
DebugAgentMsgPrint (DEBUG_AGENT_INFO, "Debug Timer attach symbol received %x", *BreakSymbol);\r
UINT64 MailboxLocation;\r
UINT64 *MailboxLocationPointer;\r
EFI_PHYSICAL_ADDRESS Address;\r
+ UINT32 DebugTimerFrequency;\r
\r
DisableInterrupts ();\r
\r
// Save init arch type when debug agent initialized\r
//\r
SetDebugFlag (DEBUG_AGENT_FLAG_INIT_ARCH, DEBUG_ARCH_SYMBOL);\r
-\r
- InitializeDebugTimer ();\r
+ //\r
+ // Initialize Debug Timer hardware and save its frequency\r
+ //\r
+ InitializeDebugTimer (&DebugTimerFrequency);\r
+ UpdateMailboxContent (Mailbox, DEBUG_MAILBOX_DEBUG_TIMER_FREQUENCY, DebugTimerFrequency);\r
\r
Phase2Context.InitFlag = InitFlag;\r
Phase2Context.Context = Context;\r
&MailboxLocation,\r
sizeof (UINT64)\r
);\r
-\r
- InitializeDebugTimer ();\r
+ //\r
+ // Initialize Debug Timer hardware and save its frequency\r
+ //\r
+ InitializeDebugTimer (&DebugTimerFrequency);\r
+ UpdateMailboxContent (Mailbox, DEBUG_MAILBOX_DEBUG_TIMER_FREQUENCY, DebugTimerFrequency);\r
//\r
// Update IDT entry to save the location pointer saved mailbox pointer\r
//\r
/** @file\r
Debug Agent library implementition.\r
\r
- Copyright (c) 2010 - 2013, Intel Corporation. All rights reserved.<BR>\r
+ Copyright (c) 2010 - 2015, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution. The full text of the license may be found at\r
UINT16 IdtEntryCount;\r
DEBUG_AGENT_MAILBOX *Mailbox;\r
UINT64 *MailboxLocation;\r
+ UINT32 DebugTimerFrequency;\r
\r
switch (InitFlag) {\r
case DEBUG_AGENT_INIT_SMM:\r
// Initialized Debug Agent\r
//\r
InitializeDebugIdt ();\r
+ //\r
+ // Initialize Debug Timer hardware and save its frequency\r
+ //\r
+ InitializeDebugTimer (&DebugTimerFrequency);\r
+ UpdateMailboxContent (mMailboxPointer, DEBUG_MAILBOX_DEBUG_TIMER_FREQUENCY, DebugTimerFrequency);\r
+\r
DebugPortHandle = (UINT64) (UINTN)DebugPortInitialize ((DEBUG_PORT_HANDLE) (UINTN)Mailbox->DebugPortHandle, NULL);\r
UpdateMailboxContent (Mailbox, DEBUG_MAILBOX_DEBUG_PORT_HANDLE_INDEX, DebugPortHandle);\r
mMailboxPointer = Mailbox;\r
\r
InitializeDebugIdt ();\r
//\r
- // Initialize Debug Timer hardware and enable interrupt.\r
+ // Initialize Debug Timer hardware and save its frequency\r
//\r
- InitializeDebugTimer ();\r
+ InitializeDebugTimer (&DebugTimerFrequency);\r
+ UpdateMailboxContent (mMailboxPointer, DEBUG_MAILBOX_DEBUG_TIMER_FREQUENCY, DebugTimerFrequency);\r
EnableInterrupts ();\r
\r
FindAndReportModuleImageInfo (SIZE_4KB);\r
/** @file\r
Debug Port Library implementation based on serial port.\r
\r
- Copyright (c) 2010 - 2014, Intel Corporation. All rights reserved.<BR>\r
+ Copyright (c) 2010 - 2015, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution. The full text of the license may be found at\r
\r
#include <Library/DebugCommunicationLib.h>\r
#include <Library/SerialPortLib.h>\r
-#include <Library/TimerLib.h>\r
#include <Library/DebugLib.h>\r
-#include <Library/BaseLib.h>\r
-#include <Library/BaseMemoryLib.h>\r
-\r
-#pragma pack(1)\r
-//\r
-// The internal data structure of DEBUG_PORT_HANDLE, which stores some\r
-// important datum which are used across various phases.\r
-//\r
-typedef struct _SERIAL_DEBUG_PORT_HANDLE{\r
- //\r
- // Timter settings\r
- //\r
- UINT64 TimerFrequency;\r
- UINT64 TimerCycle;\r
- BOOLEAN TimerCountDown;\r
-} SERIAL_DEBUG_PORT_HANDLE;\r
-#pragma pack()\r
-\r
-//\r
-// The global variable which can be used after memory is ready.\r
-//\r
-SERIAL_DEBUG_PORT_HANDLE mSerialDebugPortHandle;\r
-\r
-/**\r
- Check if the timer is timeout.\r
- \r
- @param[in] SerialDebugPortHandle Pointer to Serial Debug port handle\r
- @param[in] Timer The start timer from the begin.\r
- @param[in] TimeoutTicker Ticker number need time out.\r
-\r
- @return TRUE Timer time out occurs.\r
- @retval FALSE Timer does not time out.\r
-\r
-**/\r
-BOOLEAN\r
-IsTimerTimeout (\r
- IN SERIAL_DEBUG_PORT_HANDLE *SerialDebugPortHandle,\r
- IN UINT64 Timer,\r
- IN UINT64 TimeoutTicker\r
- )\r
-{\r
- UINT64 CurrentTimer;\r
- UINT64 Delta;\r
-\r
- CurrentTimer = GetPerformanceCounter ();\r
-\r
- if (SerialDebugPortHandle->TimerCountDown) {\r
- //\r
- // The timer counter counts down. Check for roll over condition.\r
- //\r
- if (CurrentTimer < Timer) {\r
- Delta = Timer - CurrentTimer;\r
- } else {\r
- //\r
- // Handle one roll-over. \r
- //\r
- Delta = SerialDebugPortHandle->TimerCycle - (CurrentTimer - Timer);\r
- }\r
- } else {\r
- //\r
- // The timer counter counts up. Check for roll over condition.\r
- //\r
- if (CurrentTimer > Timer) {\r
- Delta = CurrentTimer - Timer;\r
- } else {\r
- //\r
- // Handle one roll-over. \r
- //\r
- Delta = SerialDebugPortHandle->TimerCycle - (Timer - CurrentTimer);\r
- }\r
- }\r
- \r
- return (BOOLEAN) (Delta >= TimeoutTicker);\r
-}\r
\r
/**\r
Initialize the debug port.\r
IN DEBUG_PORT_CONTINUE Function\r
)\r
{\r
- RETURN_STATUS Status;\r
- SERIAL_DEBUG_PORT_HANDLE Handle;\r
- SERIAL_DEBUG_PORT_HANDLE *SerialDebugPortHandle;\r
- UINT64 TimerStartValue;\r
- UINT64 TimerEndValue;\r
-\r
- //\r
- // Validate the PCD PcdDebugPortHandleBufferSize value \r
- //\r
- ASSERT (PcdGet16 (PcdDebugPortHandleBufferSize) == sizeof (SERIAL_DEBUG_PORT_HANDLE));\r
-\r
- if (Context != NULL && Function == NULL) {\r
- SerialDebugPortHandle = (SERIAL_DEBUG_PORT_HANDLE *)Context;\r
- } else {\r
- ZeroMem (&Handle, sizeof (SERIAL_DEBUG_PORT_HANDLE));\r
- SerialDebugPortHandle = &Handle;\r
- }\r
- SerialDebugPortHandle->TimerFrequency = GetPerformanceCounterProperties (\r
- &TimerStartValue,\r
- &TimerEndValue\r
- );\r
- DEBUG ((EFI_D_INFO, "Serial Debug Port: TimerFrequency = 0x%lx\n", SerialDebugPortHandle->TimerFrequency)); \r
- DEBUG ((EFI_D_INFO, "Serial Debug Port: TimerStartValue = 0x%lx\n", TimerStartValue)); \r
- DEBUG ((EFI_D_INFO, "Serial Debug Port: TimerEndValue = 0x%lx\n", TimerEndValue)); \r
-\r
- if (TimerEndValue < TimerStartValue) {\r
- SerialDebugPortHandle->TimerCountDown = TRUE;\r
- SerialDebugPortHandle->TimerCycle = TimerStartValue - TimerEndValue;\r
- } else {\r
- SerialDebugPortHandle->TimerCountDown = FALSE;\r
- SerialDebugPortHandle->TimerCycle = TimerEndValue - TimerStartValue;\r
- } \r
-\r
- if (Function == NULL && Context != NULL) {\r
- return (DEBUG_PORT_HANDLE *) Context;\r
- }\r
+ RETURN_STATUS Status;\r
\r
Status = SerialPortInitialize ();\r
if (RETURN_ERROR(Status)) {\r
}\r
\r
if (Function != NULL) {\r
- Function (Context, SerialDebugPortHandle);\r
- } else {\r
- CopyMem(&mSerialDebugPortHandle, SerialDebugPortHandle, sizeof (SERIAL_DEBUG_PORT_HANDLE));\r
+ Function (Context, NULL);\r
}\r
\r
- return (DEBUG_PORT_HANDLE)(UINTN)&mSerialDebugPortHandle;\r
+ return NULL;\r
}\r
\r
/**\r
IN UINTN Timeout\r
)\r
{\r
- SERIAL_DEBUG_PORT_HANDLE *SerialDebugPortHandle;\r
- UINTN Index;\r
- UINT64 Begin;\r
- UINT64 TimeoutTicker;\r
- UINT64 TimerRound;\r
- \r
- //\r
- // If Handle is NULL, it means memory is ready for use.\r
- // Use global variable to store handle value.\r
- //\r
- if (Handle == NULL) {\r
- SerialDebugPortHandle = &mSerialDebugPortHandle;\r
- } else {\r
- SerialDebugPortHandle = (SERIAL_DEBUG_PORT_HANDLE *)Handle;\r
- }\r
-\r
- Begin = 0;\r
- TimeoutTicker = 0; \r
- TimerRound = 0;\r
- if (Timeout != 0) {\r
- Begin = GetPerformanceCounter ();\r
- TimeoutTicker = DivU64x32 (\r
- MultU64x64 (\r
- SerialDebugPortHandle->TimerFrequency,\r
- Timeout\r
- ),\r
- 1000000u\r
- );\r
- TimerRound = DivU64x64Remainder (\r
- TimeoutTicker,\r
- DivU64x32 (SerialDebugPortHandle->TimerCycle, 2),\r
- &TimeoutTicker\r
- );\r
- }\r
- Index = 0;\r
- while (Index < NumberOfBytes) {\r
- if (SerialPortPoll () || Timeout == 0) {\r
- SerialPortRead (Buffer + Index, 1);\r
- Index ++; \r
- continue;\r
- }\r
- if (TimerRound == 0) {\r
- if (IsTimerTimeout (SerialDebugPortHandle, Begin, TimeoutTicker)) {\r
- //\r
- // If time out occurs.\r
- //\r
- return 0;\r
- }\r
- } else {\r
- if (IsTimerTimeout (SerialDebugPortHandle, Begin, DivU64x32 (SerialDebugPortHandle->TimerCycle, 2))) {\r
- TimerRound --;\r
- }\r
- }\r
+ if (NumberOfBytes != 1 || Buffer == NULL || Timeout != 0) {\r
+ return 0;\r
}\r
\r
- return Index;\r
+ return SerialPortRead (Buffer, 1);\r
}\r
\r
/**\r
\r
[LibraryClasses]\r
SerialPortLib\r
- TimerLib\r
DebugLib\r
- BaseMemoryLib\r
- BaseLib\r
-\r
-[PCD]\r
- # The value of data buffer size used for Serial debug port handle.\r
- # It should be equal to sizeof (SERIAL_DEBUG_PORT_HANDLE).\r
- gEfiSourceLevelDebugPkgTokenSpaceGuid.PcdDebugPortHandleBufferSize|17 ## SOMETIMES_CONSUMES\r
-\r
/** @file\r
Debug Port Library implementation based on usb debug port.\r
\r
- Copyright (c) 2010 - 2014, Intel Corporation. All rights reserved.<BR>\r
+ Copyright (c) 2010 - 2015, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution. The full text of the license may be found at\r
// The data buffer. Maximum length is 8 bytes.\r
//\r
UINT8 Data[8];\r
- //\r
- // Timter settings\r
- //\r
- UINT64 TimerFrequency;\r
- UINT64 TimerCycle;\r
- BOOLEAN TimerCountDown;\r
} USB_DEBUG_PORT_HANDLE;\r
#pragma pack()\r
\r
//\r
USB_DEBUG_PORT_HANDLE mDebugCommunicationLibUsbDebugPortHandle;\r
\r
-/**\r
- Check if the timer is timeout.\r
- \r
- @param[in] UsbDebugPortHandle Pointer to USB Debug port handle\r
- @param[in] Timer The start timer from the begin.\r
- @param[in] TimeoutTicker Ticker number need time out.\r
-\r
- @return TRUE Timer time out occurs.\r
- @retval FALSE Timer does not time out.\r
-\r
-**/\r
-BOOLEAN\r
-IsTimerTimeout (\r
- IN USB_DEBUG_PORT_HANDLE *UsbDebugPortHandle,\r
- IN UINT64 Timer,\r
- IN UINT64 TimeoutTicker\r
- )\r
-{\r
- UINT64 CurrentTimer;\r
- UINT64 Delta;\r
-\r
- CurrentTimer = GetPerformanceCounter ();\r
-\r
- if (UsbDebugPortHandle->TimerCountDown) {\r
- //\r
- // The timer counter counts down. Check for roll over condition.\r
- //\r
- if (CurrentTimer < Timer) {\r
- Delta = Timer - CurrentTimer;\r
- } else {\r
- //\r
- // Handle one roll-over. \r
- //\r
- Delta = UsbDebugPortHandle->TimerCycle - (CurrentTimer - Timer);\r
- }\r
- } else {\r
- //\r
- // The timer counter counts up. Check for roll over condition.\r
- //\r
- if (CurrentTimer > Timer) {\r
- Delta = CurrentTimer - Timer;\r
- } else {\r
- //\r
- // Handle one roll-over. \r
- //\r
- Delta = UsbDebugPortHandle->TimerCycle - (Timer - CurrentTimer);\r
- }\r
- }\r
- \r
- return (BOOLEAN) (Delta >= TimeoutTicker);\r
-}\r
-\r
/**\r
Calculate the usb debug port bar address.\r
\r
USB_DEBUG_PORT_HANDLE *UsbDebugPortHandle;\r
USB_DEBUG_PORT_REGISTER *UsbDebugPortRegister;\r
RETURN_STATUS Status;\r
- UINT8 Received;\r
- UINTN Total;\r
- UINTN Remaining;\r
UINT8 Index;\r
- UINT8 Length;\r
- UINT64 Begin;\r
- UINT64 TimeoutTicker;\r
- UINT64 TimerRound;\r
\r
- if (NumberOfBytes == 0 || Buffer == NULL) {\r
+ if (NumberOfBytes != 1 || Buffer == NULL || Timeout != 0) {\r
return 0;\r
}\r
\r
- Received = 0;\r
- Total = 0;\r
- Remaining = 0;\r
-\r
//\r
// If Handle is NULL, it means memory is ready for use.\r
// Use global variable to store handle value.\r
UsbDebugPortRegister = (USB_DEBUG_PORT_REGISTER *)(UINTN)(UsbDebugPortHandle->UsbDebugPortMemoryBase + UsbDebugPortHandle->DebugPortOffset);\r
\r
//\r
- // First read data from buffer, then read debug port hw to get received data.\r
+ // Read data from buffer\r
//\r
- if (UsbDebugPortHandle->DataCount > 0) {\r
- if (NumberOfBytes <= UsbDebugPortHandle->DataCount) {\r
- Total = NumberOfBytes;\r
- } else {\r
- Total = UsbDebugPortHandle->DataCount;\r
- }\r
-\r
- for (Index = 0; Index < Total; Index++) {\r
- Buffer[Index] = UsbDebugPortHandle->Data[Index];\r
- }\r
-\r
- for (Index = 0; Index < UsbDebugPortHandle->DataCount - Total; Index++) {\r
- if (Total + Index >= 8) {\r
+ if (UsbDebugPortHandle->DataCount < 1) {\r
+ return 0;\r
+ } else {\r
+ *Buffer = UsbDebugPortHandle->Data[0];\r
+ for (Index = 0; Index < UsbDebugPortHandle->DataCount - 1; Index++) {\r
+ if ((Index + 1) >= USB_DEBUG_PORT_MAX_PACKET_SIZE) {\r
return 0;\r
}\r
- UsbDebugPortHandle->Data[Index] = UsbDebugPortHandle->Data[Total + Index];\r
- }\r
- UsbDebugPortHandle->DataCount = (UINT8)(UsbDebugPortHandle->DataCount - (UINT8)Total);\r
- }\r
-\r
- //\r
- // If Timeout is equal to 0, then it means it should always wait until all datum required are received.\r
- //\r
- Begin = 0;\r
- TimeoutTicker = 0; \r
- TimerRound = 0;\r
- if (Timeout != 0) {\r
- Begin = GetPerformanceCounter ();\r
- TimeoutTicker = DivU64x32 (\r
- MultU64x64 (\r
- UsbDebugPortHandle->TimerFrequency,\r
- Timeout\r
- ),\r
- 1000000u\r
- );\r
- TimerRound = DivU64x64Remainder (\r
- TimeoutTicker,\r
- DivU64x32 (UsbDebugPortHandle->TimerCycle, 2),\r
- &TimeoutTicker\r
- );\r
- }\r
-\r
- //\r
- // Read remaining data by executing one or more usb debug transfer transactions at usb debug port hw.\r
- //\r
- while (Total < NumberOfBytes) {\r
- if (Timeout != 0) {\r
- if (TimerRound == 0) {\r
- if (IsTimerTimeout (UsbDebugPortHandle, Begin, TimeoutTicker)) {\r
- //\r
- // If time out occurs.\r
- //\r
- return 0;\r
- }\r
- } else {\r
- if (IsTimerTimeout (UsbDebugPortHandle, Begin, DivU64x32 (UsbDebugPortHandle->TimerCycle, 2))) {\r
- TimerRound --;\r
- }\r
- }\r
- }\r
- Remaining = NumberOfBytes - Total;\r
- if (Remaining >= USB_DEBUG_PORT_MAX_PACKET_SIZE) {\r
- Status = UsbDebugPortIn(UsbDebugPortRegister, Buffer + Total, &Received, INPUT_PID, 0x7f, 0x82, UsbDebugPortHandle->BulkInToggle);\r
-\r
- if (RETURN_ERROR(Status)) {\r
- return Total;\r
- }\r
- } else {\r
- Status = UsbDebugPortIn(UsbDebugPortRegister, &UsbDebugPortHandle->Data[0], &Received, INPUT_PID, 0x7f, 0x82, UsbDebugPortHandle->BulkInToggle);\r
-\r
- if (RETURN_ERROR(Status)) {\r
- return Total;\r
- }\r
-\r
- UsbDebugPortHandle->DataCount = Received;\r
-\r
- if (Remaining <= Received) {\r
- Length = (UINT8)Remaining;\r
- } else {\r
- Length = (UINT8)Received;\r
- }\r
-\r
- //\r
- // Copy required data from the data buffer to user buffer.\r
- //\r
- for (Index = 0; Index < Length; Index++) {\r
- (Buffer + Total)[Index] = UsbDebugPortHandle->Data[Index];\r
- UsbDebugPortHandle->DataCount--;\r
- }\r
-\r
- //\r
- // reorder the data buffer to make available data arranged from the beginning of the data buffer.\r
- //\r
- for (Index = 0; Index < Received - Length; Index++) {\r
- if (Length + Index >= 8) {\r
- return 0;\r
- }\r
- UsbDebugPortHandle->Data[Index] = UsbDebugPortHandle->Data[Length + Index];\r
- }\r
- //\r
- // fixup the real received length in Buffer.\r
- //\r
- Received = Length;\r
+ UsbDebugPortHandle->Data[Index] = UsbDebugPortHandle->Data[Index + 1];\r
}\r
- UsbDebugPortHandle->BulkInToggle ^= 1;\r
- Total += Received;\r
+ UsbDebugPortHandle->DataCount = (UINT8)(UsbDebugPortHandle->DataCount - 1);\r
+ return 1;\r
}\r
-\r
- return Total;\r
}\r
\r
/**\r
RETURN_STATUS Status;\r
USB_DEBUG_PORT_HANDLE Handle;\r
USB_DEBUG_PORT_HANDLE *UsbDebugPortHandle;\r
- UINT64 TimerStartValue;\r
- UINT64 TimerEndValue;\r
\r
//\r
// Validate the PCD PcdDebugPortHandleBufferSize value \r
UsbDebugPortHandle = &Handle;\r
}\r
\r
- UsbDebugPortHandle->TimerFrequency = GetPerformanceCounterProperties (\r
- &TimerStartValue,\r
- &TimerEndValue\r
- );\r
- DEBUG ((EFI_D_INFO, "USB Debug Port: TimerFrequency = 0x%lx\n", UsbDebugPortHandle->TimerFrequency)); \r
- DEBUG ((EFI_D_INFO, "USB Debug Port: TimerStartValue = 0x%lx\n", TimerStartValue)); \r
- DEBUG ((EFI_D_INFO, "USB Debug Port: TimerEndValue = 0x%lx\n", TimerEndValue)); \r
-\r
- if (TimerEndValue < TimerStartValue) {\r
- UsbDebugPortHandle->TimerCountDown = TRUE;\r
- UsbDebugPortHandle->TimerCycle = TimerStartValue - TimerEndValue;\r
- } else {\r
- UsbDebugPortHandle->TimerCountDown = FALSE;\r
- UsbDebugPortHandle->TimerCycle = TimerEndValue - TimerStartValue;\r
- } \r
-\r
if (Function == NULL && Context != NULL) {\r
return (DEBUG_PORT_HANDLE *) Context;\r
}\r
gEfiSourceLevelDebugPkgTokenSpaceGuid.PcdUsbEhciPciAddress ## CONSUMES\r
# The value of data buffer size used for USB debug port handle.\r
# It should be equal to sizeof (USB_DEBUG_PORT_HANDLE).\r
- gEfiSourceLevelDebugPkgTokenSpaceGuid.PcdDebugPortHandleBufferSize|40 ## SOMETIMES_CONSUMES\r
+ gEfiSourceLevelDebugPkgTokenSpaceGuid.PcdDebugPortHandleBufferSize|23 ## SOMETIMES_CONSUMES\r
\r
[LibraryClasses]\r
TimerLib\r
return XhciMmioBase;\r
}\r
\r
-/**\r
- Check if the timer is timeout.\r
- \r
- @param[in] UsbDebugPortHandle Pointer to USB Debug port handle\r
- @param[in] Timer The start timer from the begin.\r
- @param[in] TimeoutTicker Ticker number need time out.\r
-\r
- @return TRUE Timer time out occurs.\r
- @retval FALSE Timer does not time out.\r
-\r
-**/\r
-BOOLEAN\r
-IsTimerTimeout (\r
- IN USB3_DEBUG_PORT_HANDLE *UsbDebugPortHandle,\r
- IN UINT64 Timer,\r
- IN UINT64 TimeoutTicker\r
- )\r
-{\r
- UINT64 CurrentTimer;\r
- UINT64 Delta;\r
-\r
- CurrentTimer = GetPerformanceCounter ();\r
-\r
- if (UsbDebugPortHandle->TimerCountDown) {\r
- //\r
- // The timer counter counts down. Check for roll over condition.\r
- //\r
- if (CurrentTimer < Timer) {\r
- Delta = Timer - CurrentTimer;\r
- } else {\r
- //\r
- // Handle one roll-over. \r
- //\r
- Delta = UsbDebugPortHandle->TimerCycle - (CurrentTimer - Timer);\r
- }\r
- } else {\r
- //\r
- // The timer counter counts up. Check for roll over condition.\r
- //\r
- if (CurrentTimer > Timer) {\r
- Delta = CurrentTimer - Timer;\r
- } else {\r
- //\r
- // Handle one roll-over. \r
- //\r
- Delta = UsbDebugPortHandle->TimerCycle - (Timer - CurrentTimer);\r
- }\r
- }\r
- \r
- return (BOOLEAN) (Delta >= TimeoutTicker);\r
-}\r
-\r
/**\r
Update XHC MMIO base address when MMIO base address is changed.\r
\r
{\r
USB3_DEBUG_PORT_HANDLE *UsbDebugPortHandle;\r
RETURN_STATUS Status;\r
- UINTN Received;\r
- UINTN Total;\r
- UINTN Remaining;\r
UINT8 Index;\r
- UINTN Length;\r
- UINT64 Begin;\r
- UINT64 TimeoutTicker;\r
- UINT64 TimerRound;\r
- EFI_PHYSICAL_ADDRESS XhciMmioBase;\r
UINT8 *Data;\r
\r
- if (NumberOfBytes == 0 || Buffer == NULL) {\r
+ if (NumberOfBytes != 1 || Buffer == NULL || Timeout != 0) {\r
return 0;\r
}\r
\r
- Received = 0;\r
- Total = 0;\r
- Remaining = 0;\r
-\r
//\r
// If Handle is NULL, it means memory is ready for use.\r
// Use global variable to store handle value.\r
return 0;\r
}\r
\r
- XhciMmioBase = ProgramXhciBaseAddress ();\r
- UpdateXhcResource (UsbDebugPortHandle, XhciMmioBase);\r
- \r
if (NeedReinitializeHardware(UsbDebugPortHandle)) {\r
Status = InitializeUsbDebugHardware (UsbDebugPortHandle);\r
if (RETURN_ERROR(Status)) {\r
Data = (UINT8 *)(UINTN)UsbDebugPortHandle->Data;\r
\r
//\r
- // First read data from buffer, then read debug port hw to get received data.\r
+ // Read data from buffer\r
//\r
- if (UsbDebugPortHandle->DataCount > 0) {\r
- if (NumberOfBytes <= UsbDebugPortHandle->DataCount) {\r
- Total = NumberOfBytes;\r
- } else {\r
- Total = UsbDebugPortHandle->DataCount;\r
- }\r
-\r
- for (Index = 0; Index < Total; Index++) {\r
- Buffer[Index] = Data[Index];\r
- }\r
+ if (UsbDebugPortHandle->DataCount < 1) {\r
+ return 0;\r
+ } else {\r
+ *Buffer = Data[0];\r
\r
- for (Index = 0; Index < UsbDebugPortHandle->DataCount - Total; Index++) {\r
- if (Total + Index >= XHCI_DEBUG_DEVICE_MAX_PACKET_SIZE) {\r
+ for (Index = 0; Index < UsbDebugPortHandle->DataCount - 1; Index++) {\r
+ if ((Index + 1) >= XHCI_DEBUG_DEVICE_MAX_PACKET_SIZE) {\r
return 0;\r
}\r
- Data[Index] = Data[Total + Index];\r
+ Data[Index] = Data[Index + 1];\r
}\r
- UsbDebugPortHandle->DataCount = (UINT8)(UsbDebugPortHandle->DataCount - (UINT8)Total);\r
+ UsbDebugPortHandle->DataCount = (UINT8)(UsbDebugPortHandle->DataCount - 1);\r
+ return 1;\r
}\r
-\r
- //\r
- // If Timeout is equal to 0, then it means it should always wait until all data required are received.\r
- //\r
- Begin = 0;\r
- TimeoutTicker = 0; \r
- TimerRound = 0;\r
- if (Timeout != 0) {\r
- Begin = GetPerformanceCounter ();\r
- TimeoutTicker = DivU64x32 (\r
- MultU64x64 (\r
- UsbDebugPortHandle->TimerFrequency,\r
- Timeout\r
- ),\r
- 1000000u\r
- );\r
- TimerRound = DivU64x64Remainder (\r
- TimeoutTicker,\r
- DivU64x32 (UsbDebugPortHandle->TimerCycle, 2),\r
- &TimeoutTicker\r
- );\r
- }\r
-\r
- //\r
- // Read remaining data by executing one or more usb debug transfer transactions at usb debug port hw.\r
- //\r
- while (Total < NumberOfBytes) {\r
- if (Timeout != 0) {\r
- if (TimerRound == 0) {\r
- if (IsTimerTimeout (UsbDebugPortHandle, Begin, TimeoutTicker)) {\r
- //\r
- // If time out occurs.\r
- //\r
- return 0;\r
- }\r
- } else {\r
- if (IsTimerTimeout (UsbDebugPortHandle, Begin, DivU64x32 (UsbDebugPortHandle->TimerCycle, 2))) {\r
- TimerRound --;\r
- }\r
- }\r
- }\r
- Remaining = NumberOfBytes - Total;\r
- if (Remaining >= XHCI_DEBUG_DEVICE_MAX_PACKET_SIZE) {\r
- Received = XHCI_DEBUG_DEVICE_MAX_PACKET_SIZE;\r
- Status = XhcDataTransfer (UsbDebugPortHandle, EfiUsbDataIn, Buffer + Total, &Received, DATA_TRANSFER_READ_TIMEOUT);\r
- } else {\r
- Received = XHCI_DEBUG_DEVICE_MAX_PACKET_SIZE;\r
- Status = XhcDataTransfer (UsbDebugPortHandle, EfiUsbDataIn, (VOID *)Data, &Received, DATA_TRANSFER_READ_TIMEOUT);\r
- UsbDebugPortHandle->DataCount = (UINT8) Received;\r
-\r
- if (Remaining <= Received) {\r
- //\r
- // The data received are more than required\r
- //\r
- Length = (UINT8)Remaining;\r
- } else {\r
- //\r
- // The data received are less than the remaining bytes\r
- //\r
- Length = (UINT8)Received;\r
- }\r
-\r
- //\r
- // Copy required data from the data buffer to user buffer.\r
- //\r
- for (Index = 0; Index < Length; Index++) {\r
- (Buffer + Total)[Index] = Data[Index];\r
- UsbDebugPortHandle->DataCount--;\r
- }\r
-\r
- //\r
- // reorder the data buffer to make available data arranged from the beginning of the data buffer.\r
- //\r
- for (Index = 0; Index < Received - Length; Index++) {\r
- if (Length + Index >= XHCI_DEBUG_DEVICE_MAX_PACKET_SIZE) {\r
- return 0;\r
- }\r
- Data[Index] = Data[Length + Index];\r
- }\r
- //\r
- // fixup the real required length of data.\r
- //\r
- Received = Length;\r
- }\r
- Total += Received;\r
- }\r
- return Total;\r
}\r
\r
/**\r
RETURN_STATUS Status;\r
USB3_DEBUG_PORT_HANDLE Handle;\r
USB3_DEBUG_PORT_HANDLE *UsbDebugPortHandle;\r
- UINT64 TimerStartValue;\r
- UINT64 TimerEndValue;\r
\r
//\r
// Validate the PCD PcdDebugPortHandleBufferSize value \r
UsbDebugPortHandle = &Handle;\r
}\r
\r
- UsbDebugPortHandle->TimerFrequency = GetPerformanceCounterProperties (\r
- &TimerStartValue,\r
- &TimerEndValue\r
- );\r
-\r
- if (TimerEndValue < TimerStartValue) {\r
- UsbDebugPortHandle->TimerCountDown = TRUE;\r
- UsbDebugPortHandle->TimerCycle = TimerStartValue - TimerEndValue;\r
- } else {\r
- UsbDebugPortHandle->TimerCountDown = FALSE;\r
- UsbDebugPortHandle->TimerCycle = TimerEndValue - TimerStartValue;\r
- } \r
-\r
if (Function == NULL && Context != NULL) {\r
return (DEBUG_PORT_HANDLE *) Context;\r
}\r
\r
# The value of data buffer size used for USB debug port handle.\r
# It should be equal to sizeof (USB3_DEBUG_PORT_HANDLE).\r
- gEfiSourceLevelDebugPkgTokenSpaceGuid.PcdDebugPortHandleBufferSize|256 ## SOMETIMES_CONSUMES\r
+ gEfiSourceLevelDebugPkgTokenSpaceGuid.PcdDebugPortHandleBufferSize|239 ## SOMETIMES_CONSUMES\r
\r
[LibraryClasses]\r
BaseLib\r
#define DATA_TRANSFER_WRITE_TIMEOUT 0\r
#define DATA_TRANSFER_READ_TIMEOUT 50000\r
#define DATA_TRANSFER_POLL_TIMEOUT 1000\r
-\r
+#define XHC_DEBUG_PORT_1_MILLISECOND 1000\r
//\r
// XHCI port power off/on delay\r
//\r
// The data buffer address for data read and poll.\r
//\r
EFI_PHYSICAL_ADDRESS Data;\r
- //\r
- // Timter settings\r
- //\r
- UINT64 TimerFrequency;\r
- UINT64 TimerCycle;\r
- BOOLEAN TimerCountDown;\r
-\r
} USB3_DEBUG_PORT_HANDLE;\r
\r
#pragma pack()\r
IN UINTN Timeout\r
);\r
\r
-/**\r
- Check if the timer is timeout.\r
- \r
- @param[in] UsbDebugPortHandle Pointer to USB Debug port handle\r
- @param[in] Timer The start timer from the begin.\r
- @param[in] TimeoutTicker Ticker number need time out.\r
-\r
- @return TRUE Timer time out occurs.\r
- @retval FALSE Timer does not time out.\r
-\r
-**/\r
-BOOLEAN\r
-IsTimerTimeout (\r
- IN USB3_DEBUG_PORT_HANDLE *UsbDebugPortHandle,\r
- IN UINT64 Timer,\r
- IN UINT64 TimeoutTicker\r
- );\r
-\r
#endif //__SERIAL_PORT_LIB_USB__\r
\r
# The value of data buffer size used for USB debug port handle.\r
# It should be equal to sizeof (USB3_DEBUG_PORT_HANDLE).\r
- gEfiSourceLevelDebugPkgTokenSpaceGuid.PcdDebugPortHandleBufferSize|256 ## SOMETIMES_CONSUMES\r
+ gEfiSourceLevelDebugPkgTokenSpaceGuid.PcdDebugPortHandleBufferSize|239 ## SOMETIMES_CONSUMES\r
\r
[LibraryClasses]\r
BaseLib\r
)\r
{\r
TRANSFER_RING *Ring;\r
- UINT64 Begin;\r
- UINT64 TimeoutTicker;\r
- UINT64 TimerRound;\r
TRB_TEMPLATE *Trb;\r
+ UINTN Loop;\r
+ UINTN Index;\r
\r
- Begin = 0;\r
- TimeoutTicker = 0; \r
- TimerRound = 0;\r
-\r
- XhcRingDoorBell (Handle, Urb);\r
-\r
- if (Timeout != 0) {\r
- Begin = GetPerformanceCounter ();\r
- TimeoutTicker = DivU64x32 (\r
- MultU64x64 (\r
- Handle->TimerFrequency,\r
- Timeout\r
- ),\r
- 1000000u\r
- );\r
- TimerRound = DivU64x64Remainder (\r
- TimeoutTicker,\r
- DivU64x32 (Handle->TimerCycle, 2),\r
- &TimeoutTicker\r
- );\r
+ Loop = Timeout / XHC_DEBUG_PORT_1_MILLISECOND;\r
+ if (Timeout == 0) {\r
+ Loop = 0xFFFFFFFF;\r
}\r
-\r
+ XhcRingDoorBell (Handle, Urb);\r
//\r
// Event Ring Not Empty bit can only be set to 1 by XHC after ringing door bell with some delay.\r
//\r
- while (TRUE) {\r
- if (Timeout != 0) {\r
- if (TimerRound == 0) {\r
- if (IsTimerTimeout (Handle, Begin, TimeoutTicker)) {\r
- //\r
- // If time out occurs.\r
- //\r
- Urb->Result |= EFI_USB_ERR_TIMEOUT;\r
- break;\r
- }\r
- } else {\r
- if (IsTimerTimeout (Handle, Begin, DivU64x32 (Handle->TimerCycle, 2))) {\r
- TimerRound --;\r
- }\r
- }\r
- }\r
+ for (Index = 0; Index < Loop; Index++) {\r
XhcCheckUrbResult (Handle, Urb);\r
if (Urb->Finished) {\r
break;\r
}\r
+ MicroSecondDelay (XHC_DEBUG_PORT_1_MILLISECOND);\r
}\r
- \r
+ if (Index == Loop) {\r
+ //\r
+ // If time out occurs.\r
+ //\r
+ Urb->Result |= EFI_USB_ERR_TIMEOUT;\r
+ } \r
//\r
// If URB transfer is error, restore transfer ring to original value before URB transfer\r
// This will make the current transfer TRB is always at the latest unused one in transfer ring.\r
projects / mirror_edk2.git / commitdiff