REF: https://bugzilla.tianocore.org/show_bug.cgi?id=2388
Token is new introduced by MM MP Protocol. Current logic allocate Token
every time when need to use it. The logic caused SMI latency raised to
very high. Update logic to allocate Token buffer at driver's entry point.
Later use the token from the allocated token buffer. Only when all the
buffer have been used, then need to allocate new buffer.
Former change (
9caaa79dd7e078ebb4012dde3b3d3a5d451df609) missed
PROCEDURE_TOKEN part, this change covers it.
Reviewed-by: Ray Ni <ray.ni@intel.com>
Cc: Laszlo Ersek <lersek@redhat.com>
Signed-off-by: Eric Dong <eric.dong@intel.com>
VOID\r
)\r
{\r
LIST_ENTRY *Link;\r
PROCEDURE_TOKEN *ProcToken;\r
VOID\r
)\r
{\r
LIST_ENTRY *Link;\r
PROCEDURE_TOKEN *ProcToken;\r
- TOKEN_BUFFER *TokenBuf;\r
- //\r
- // Only free the token buffer recorded in the OldTOkenBufList\r
- // upon exiting SMI. Current token buffer stays allocated so\r
- // next SMI doesn't need to re-allocate.\r
- //\r
- gSmmCpuPrivate->UsedTokenNum = 0;\r
-\r
- Link = GetFirstNode (&gSmmCpuPrivate->OldTokenBufList);\r
- while (!IsNull (&gSmmCpuPrivate->OldTokenBufList, Link)) {\r
- TokenBuf = TOKEN_BUFFER_FROM_LINK (Link);\r
-\r
- Link = RemoveEntryList (&TokenBuf->Link);\r
-\r
- FreePool (TokenBuf->Buffer);\r
- FreePool (TokenBuf);\r
- }\r
-\r
- while (!IsListEmpty (&gSmmCpuPrivate->TokenList)) {\r
- Link = GetFirstNode (&gSmmCpuPrivate->TokenList);\r
+ Link = GetFirstNode (&gSmmCpuPrivate->TokenList);\r
+ while (!IsNull (&gSmmCpuPrivate->TokenList, Link)) {\r
ProcToken = PROCEDURE_TOKEN_FROM_LINK (Link);\r
\r
ProcToken = PROCEDURE_TOKEN_FROM_LINK (Link);\r
\r
- RemoveEntryList (&ProcToken->Link);\r
+ ProcToken->RunningApCount = 0;\r
+ ProcToken->Used = FALSE;\r
+\r
+ //\r
+ // Check the spinlock status and release it if not released yet.\r
+ //\r
+ if (!AcquireSpinLockOrFail(ProcToken->SpinLock)) {\r
+ DEBUG((DEBUG_ERROR, "Risk::SpinLock still not released!"));\r
+ }\r
+ ReleaseSpinLock (ProcToken->SpinLock);\r
- FreePool (ProcToken);\r
+ Link = GetNextNode (&gSmmCpuPrivate->TokenList, Link);\r
WaitForAllAPs (ApCount);\r
\r
//\r
WaitForAllAPs (ApCount);\r
\r
//\r
- // Clean the tokens buffer.\r
+ // Reset the tokens buffer.\r
\r
//\r
// Reset BspIndex to -1, meaning BSP has not been elected.\r
\r
//\r
// Reset BspIndex to -1, meaning BSP has not been elected.\r
while (!IsNull (&gSmmCpuPrivate->TokenList, Link)) {\r
ProcToken = PROCEDURE_TOKEN_FROM_LINK (Link);\r
\r
while (!IsNull (&gSmmCpuPrivate->TokenList, Link)) {\r
ProcToken = PROCEDURE_TOKEN_FROM_LINK (Link);\r
\r
- if (ProcToken->SpinLock == Token) {\r
+ if (ProcToken->Used && ProcToken->SpinLock == Token) {\r
- create token and save it to the maintain list.\r
-\r
- @param RunningApCount Input running AP count.\r
-\r
- @retval return the spin lock used as token.\r
+ Allocate buffer for the SPIN_LOCK and PROCEDURE_TOKEN.\r
-PROCEDURE_TOKEN *\r
-CreateToken (\r
- IN UINT32 RunningApCount\r
+VOID\r
+AllocateTokenBuffer (\r
+ VOID\r
- PROCEDURE_TOKEN *ProcToken;\r
- SPIN_LOCK *SpinLock;\r
- TOKEN_BUFFER *TokenBuf;\r
UINT32 TokenCountPerChunk;\r
UINT32 TokenCountPerChunk;\r
+ UINTN ProcTokenSize;\r
+ UINTN Index;\r
+ PROCEDURE_TOKEN *ProcToken;\r
+ SPIN_LOCK *SpinLock;\r
+ UINT8 *SpinLockBuffer;\r
+ UINT8 *ProcTokenBuffer;\r
\r
SpinLockSize = GetSpinLockProperties ();\r
\r
SpinLockSize = GetSpinLockProperties ();\r
+ ProcTokenSize = sizeof (PROCEDURE_TOKEN);\r
+\r
TokenCountPerChunk = FixedPcdGet32 (PcdCpuSmmMpTokenCountPerChunk);\r
TokenCountPerChunk = FixedPcdGet32 (PcdCpuSmmMpTokenCountPerChunk);\r
+ ASSERT (TokenCountPerChunk != 0);\r
+ if (TokenCountPerChunk == 0) {\r
+ DEBUG ((DEBUG_ERROR, "PcdCpuSmmMpTokenCountPerChunk should not be Zero!\n"));\r
+ CpuDeadLoop ();\r
+ }\r
+ DEBUG ((DEBUG_INFO, "CpuSmm: SpinLock Size = 0x%x, PcdCpuSmmMpTokenCountPerChunk = 0x%x\n", SpinLockSize, TokenCountPerChunk));\r
- if (gSmmCpuPrivate->UsedTokenNum == TokenCountPerChunk) {\r
- DEBUG ((DEBUG_VERBOSE, "CpuSmm: No free token buffer, allocate new buffer!\n"));\r
+ //\r
+ // Separate the Spin_lock and Proc_token because the alignment requires by Spin_Lock.\r
+ //\r
+ SpinLockBuffer = AllocatePool (SpinLockSize * TokenCountPerChunk);\r
+ ASSERT (SpinLockBuffer != NULL);\r
- //\r
- // Record current token buffer for later free action usage.\r
- // Current used token buffer not in this list.\r
- //\r
- TokenBuf = AllocatePool (sizeof (TOKEN_BUFFER));\r
- ASSERT (TokenBuf != NULL);\r
- TokenBuf->Signature = TOKEN_BUFFER_SIGNATURE;\r
- TokenBuf->Buffer = gSmmCpuPrivate->CurrentTokenBuf;\r
+ ProcTokenBuffer = AllocatePool (ProcTokenSize * TokenCountPerChunk);\r
+ ASSERT (ProcTokenBuffer != NULL);\r
+\r
+ for (Index = 0; Index < TokenCountPerChunk; Index++) {\r
+ SpinLock = (SPIN_LOCK *)(SpinLockBuffer + SpinLockSize * Index);\r
+ InitializeSpinLock (SpinLock);\r
+\r
+ ProcToken = (PROCEDURE_TOKEN *)(ProcTokenBuffer + ProcTokenSize * Index);\r
+ ProcToken->Signature = PROCEDURE_TOKEN_SIGNATURE;\r
+ ProcToken->SpinLock = SpinLock;\r
+ ProcToken->Used = FALSE;\r
+ ProcToken->RunningApCount = 0;\r
+\r
+ InsertTailList (&gSmmCpuPrivate->TokenList, &ProcToken->Link);\r
+ }\r
+}\r
- InsertTailList (&gSmmCpuPrivate->OldTokenBufList, &TokenBuf->Link);\r
+/**\r
+ Find first free token in the allocated token list.\r
+\r
+ @retval return the first free PROCEDURE_TOKEN.\r
+\r
+**/\r
+PROCEDURE_TOKEN *\r
+FindFirstFreeToken (\r
+ VOID\r
+ )\r
+{\r
+ LIST_ENTRY *Link;\r
+ PROCEDURE_TOKEN *ProcToken;\r
- gSmmCpuPrivate->CurrentTokenBuf = AllocatePool (SpinLockSize * TokenCountPerChunk);\r
- ASSERT (gSmmCpuPrivate->CurrentTokenBuf != NULL);\r
- gSmmCpuPrivate->UsedTokenNum = 0;\r
+ Link = GetFirstNode (&gSmmCpuPrivate->TokenList);\r
+ while (!IsNull (&gSmmCpuPrivate->TokenList, Link)) {\r
+ ProcToken = PROCEDURE_TOKEN_FROM_LINK (Link);\r
+\r
+ if (!ProcToken->Used) {\r
+ return ProcToken;\r
+ }\r
+\r
+ Link = GetNextNode (&gSmmCpuPrivate->TokenList, Link);\r
- SpinLock = (SPIN_LOCK *)(gSmmCpuPrivate->CurrentTokenBuf + SpinLockSize * gSmmCpuPrivate->UsedTokenNum);\r
- gSmmCpuPrivate->UsedTokenNum++;\r
+ return NULL;\r
+}\r
+\r
+/**\r
+ Get the free token.\r
+\r
+ If no free token, allocate new tokens then return the free one.\r
+\r
+ @retval return the first free PROCEDURE_TOKEN.\r
- InitializeSpinLock (SpinLock);\r
- AcquireSpinLock (SpinLock);\r
+**/\r
+PROCEDURE_TOKEN *\r
+GetFreeToken (\r
+ IN UINT32 RunningApsCount\r
+ )\r
+{\r
+ PROCEDURE_TOKEN *NewToken;\r
- ProcToken = AllocatePool (sizeof (PROCEDURE_TOKEN));\r
- ASSERT (ProcToken != NULL);\r
- ProcToken->Signature = PROCEDURE_TOKEN_SIGNATURE;\r
- ProcToken->SpinLock = SpinLock;\r
- ProcToken->RunningApCount = RunningApCount;\r
+ NewToken = FindFirstFreeToken ();\r
+ if (NewToken == NULL) {\r
+ AllocateTokenBuffer ();\r
+ NewToken = FindFirstFreeToken ();\r
+ }\r
+ ASSERT (NewToken != NULL);\r
- InsertTailList (&gSmmCpuPrivate->TokenList, &ProcToken->Link);\r
+ NewToken->Used = TRUE;\r
+ NewToken->RunningApCount = RunningApsCount;\r
+ AcquireSpinLock (NewToken->SpinLock);\r
mSmmMpSyncData->CpuData[CpuIndex].Procedure = Procedure;\r
mSmmMpSyncData->CpuData[CpuIndex].Parameter = ProcArguments;\r
if (Token != NULL) {\r
mSmmMpSyncData->CpuData[CpuIndex].Procedure = Procedure;\r
mSmmMpSyncData->CpuData[CpuIndex].Parameter = ProcArguments;\r
if (Token != NULL) {\r
- ProcToken= CreateToken (1);\r
+ ProcToken= GetFreeToken (1);\r
mSmmMpSyncData->CpuData[CpuIndex].Token = ProcToken;\r
*Token = (MM_COMPLETION)ProcToken->SpinLock;\r
}\r
mSmmMpSyncData->CpuData[CpuIndex].Token = ProcToken;\r
*Token = (MM_COMPLETION)ProcToken->SpinLock;\r
}\r
}\r
\r
if (Token != NULL) {\r
}\r
\r
if (Token != NULL) {\r
- ProcToken = CreateToken ((UINT32)mMaxNumberOfCpus);\r
+ ProcToken = GetFreeToken ((UINT32)mMaxNumberOfCpus);\r
*Token = (MM_COMPLETION)ProcToken->SpinLock;\r
} else {\r
ProcToken = NULL;\r
*Token = (MM_COMPLETION)ProcToken->SpinLock;\r
} else {\r
ProcToken = NULL;\r
- UINTN SpinLockSize;\r
- UINT32 TokenCountPerChunk;\r
-\r
- SpinLockSize = GetSpinLockProperties ();\r
- TokenCountPerChunk = FixedPcdGet32 (PcdCpuSmmMpTokenCountPerChunk);\r
- ASSERT (TokenCountPerChunk != 0);\r
- if (TokenCountPerChunk == 0) {\r
- DEBUG ((DEBUG_ERROR, "PcdCpuSmmMpTokenCountPerChunk should not be Zero!\n"));\r
- CpuDeadLoop ();\r
- }\r
- DEBUG ((DEBUG_INFO, "CpuSmm: SpinLock Size = 0x%x, PcdCpuSmmMpTokenCountPerChunk = 0x%x\n", SpinLockSize, TokenCountPerChunk));\r
-\r
- gSmmCpuPrivate->CurrentTokenBuf = AllocatePool (SpinLockSize * TokenCountPerChunk);\r
- ASSERT (gSmmCpuPrivate->CurrentTokenBuf != NULL);\r
-\r
- gSmmCpuPrivate->UsedTokenNum = 0;\r
-\r
gSmmCpuPrivate->ApWrapperFunc = AllocatePool (sizeof (PROCEDURE_WRAPPER) * gSmmCpuPrivate->SmmCoreEntryContext.NumberOfCpus);\r
ASSERT (gSmmCpuPrivate->ApWrapperFunc != NULL);\r
\r
InitializeListHead (&gSmmCpuPrivate->TokenList);\r
gSmmCpuPrivate->ApWrapperFunc = AllocatePool (sizeof (PROCEDURE_WRAPPER) * gSmmCpuPrivate->SmmCoreEntryContext.NumberOfCpus);\r
ASSERT (gSmmCpuPrivate->ApWrapperFunc != NULL);\r
\r
InitializeListHead (&gSmmCpuPrivate->TokenList);\r
- InitializeListHead (&gSmmCpuPrivate->OldTokenBufList);\r
+\r
+ AllocateTokenBuffer ();\r
\r
SPIN_LOCK *SpinLock;\r
volatile UINT32 RunningApCount;\r
\r
SPIN_LOCK *SpinLock;\r
volatile UINT32 RunningApCount;\r
} PROCEDURE_TOKEN;\r
\r
#define PROCEDURE_TOKEN_FROM_LINK(a) CR (a, PROCEDURE_TOKEN, Link, PROCEDURE_TOKEN_SIGNATURE)\r
} PROCEDURE_TOKEN;\r
\r
#define PROCEDURE_TOKEN_FROM_LINK(a) CR (a, PROCEDURE_TOKEN, Link, PROCEDURE_TOKEN_SIGNATURE)\r
\r
PROCEDURE_WRAPPER *ApWrapperFunc;\r
LIST_ENTRY TokenList;\r
\r
PROCEDURE_WRAPPER *ApWrapperFunc;\r
LIST_ENTRY TokenList;\r
-\r
- LIST_ENTRY OldTokenBufList;\r
-\r
- UINT8 *CurrentTokenBuf;\r
- UINT32 UsedTokenNum; // Only record tokens used in CurrentTokenBuf.\r
} SMM_CPU_PRIVATE_DATA;\r
\r
extern SMM_CPU_PRIVATE_DATA *gSmmCpuPrivate;\r
} SMM_CPU_PRIVATE_DATA;\r
\r
extern SMM_CPU_PRIVATE_DATA *gSmmCpuPrivate;\r