- IoWrite8 (TIMER0_COUNT_PORT, (UINT8) (Count & 0xFF));\r
- IoWrite8 (TIMER0_COUNT_PORT, (UINT8) ((Count>>8) & 0xFF));\r
+ IoWrite8 (TIMER0_COUNT_PORT, (UINT8)(Count & 0xFF));\r
+ IoWrite8 (TIMER0_COUNT_PORT, (UINT8)((Count>>8) & 0xFF));\r
- IN EFI_LEGACY_BIOS_PROTOCOL *This,\r
- IN UINT8 BiosInt,\r
- IN EFI_IA32_REGISTER_SET *Regs\r
+ IN EFI_LEGACY_BIOS_PROTOCOL *This,\r
+ IN UINT8 BiosInt,\r
+ IN EFI_IA32_REGISTER_SET *Regs\r
- IN EFI_LEGACY_BIOS_PROTOCOL *This,\r
- IN UINT16 Segment,\r
- IN UINT16 Offset,\r
- IN EFI_IA32_REGISTER_SET *Regs,\r
- IN VOID *Stack,\r
- IN UINTN StackSize\r
+ IN EFI_LEGACY_BIOS_PROTOCOL *This,\r
+ IN UINT16 Segment,\r
+ IN UINT16 Offset,\r
+ IN EFI_IA32_REGISTER_SET *Regs,\r
+ IN VOID *Stack,\r
+ IN UINTN StackSize\r
- IN EFI_EXCEPTION_TYPE InterruptType,\r
- IN EFI_SYSTEM_CONTEXT SystemContext\r
+ IN EFI_EXCEPTION_TYPE InterruptType,\r
+ IN EFI_SYSTEM_CONTEXT SystemContext\r
- IN EFI_LEGACY_BIOS_PROTOCOL *This,\r
- IN UINT16 Segment,\r
- IN UINT16 Offset,\r
- IN EFI_IA32_REGISTER_SET *Regs,\r
- IN VOID *Stack,\r
- IN UINTN StackSize\r
+ IN EFI_LEGACY_BIOS_PROTOCOL *This,\r
+ IN UINT16 Segment,\r
+ IN UINT16 Offset,\r
+ IN EFI_IA32_REGISTER_SET *Regs,\r
+ IN VOID *Stack,\r
+ IN UINTN StackSize\r
Private = LEGACY_BIOS_INSTANCE_FROM_THIS (This);\r
\r
ZeroMem (&ThunkRegSet, sizeof (ThunkRegSet));\r
Private = LEGACY_BIOS_INSTANCE_FROM_THIS (This);\r
\r
ZeroMem (&ThunkRegSet, sizeof (ThunkRegSet));\r
- ThunkRegSet.X.DI = Regs->X.DI;\r
- ThunkRegSet.X.SI = Regs->X.SI;\r
- ThunkRegSet.X.BP = Regs->X.BP;\r
- ThunkRegSet.X.BX = Regs->X.BX;\r
- ThunkRegSet.X.DX = Regs->X.DX;\r
+ ThunkRegSet.X.DI = Regs->X.DI;\r
+ ThunkRegSet.X.SI = Regs->X.SI;\r
+ ThunkRegSet.X.BP = Regs->X.BP;\r
+ ThunkRegSet.X.BX = Regs->X.BX;\r
+ ThunkRegSet.X.DX = Regs->X.DX;\r
//\r
// Sometimes, ECX is used to pass in 32 bit data. For example, INT 1Ah, AX = B10Dh is\r
// "PCI BIOS v2.0c + Write Configuration DWORD" and ECX has the dword to write.\r
//\r
//\r
// Sometimes, ECX is used to pass in 32 bit data. For example, INT 1Ah, AX = B10Dh is\r
// "PCI BIOS v2.0c + Write Configuration DWORD" and ECX has the dword to write.\r
//\r
- ThunkRegSet.E.ECX = Regs->E.ECX;\r
- ThunkRegSet.X.AX = Regs->X.AX;\r
- ThunkRegSet.E.DS = Regs->X.DS;\r
- ThunkRegSet.E.ES = Regs->X.ES;\r
+ ThunkRegSet.E.ECX = Regs->E.ECX;\r
+ ThunkRegSet.X.AX = Regs->X.AX;\r
+ ThunkRegSet.E.DS = Regs->X.DS;\r
+ ThunkRegSet.E.ES = Regs->X.ES;\r
// Clear the error flag; thunk code may set it. Stack16 should be the high address\r
// Make Statk16 address the low 16 bit must be not zero.\r
//\r
// Clear the error flag; thunk code may set it. Stack16 should be the high address\r
// Make Statk16 address the low 16 bit must be not zero.\r
//\r
- UINTN Vector;\r
- UINTN Count;\r
-\r
- for (Vector = 0x20, Count = 0; Vector < 0x100; Vector++) {\r
- Status = Private->Cpu->RegisterInterruptHandler (Private->Cpu, Vector, LegacyBiosNullInterruptHandler);\r
- if (Status == EFI_ALREADY_STARTED) {\r
- Count++;\r
- }\r
- if (Status == EFI_SUCCESS) {\r
- Private->Cpu->RegisterInterruptHandler (Private->Cpu, Vector, NULL);\r
- }\r
+ UINTN Vector;\r
+ UINTN Count;\r
+\r
+ for (Vector = 0x20, Count = 0; Vector < 0x100; Vector++) {\r
+ Status = Private->Cpu->RegisterInterruptHandler (Private->Cpu, Vector, LegacyBiosNullInterruptHandler);\r
+ if (Status == EFI_ALREADY_STARTED) {\r
+ Count++;\r
- if (Count >= 2) {\r
- DEBUG ((DEBUG_ERROR, "ERROR: More than one HW interrupt active with CSM enabled\n"));\r
+\r
+ if (Status == EFI_SUCCESS) {\r
+ Private->Cpu->RegisterInterruptHandler (Private->Cpu, Vector, NULL);\r
// period is less than the CSM required rate of 54.9254, then force the 8254\r
// PIT counter to 0, which is the CSM required rate of 54.9254 ms\r
//\r
// period is less than the CSM required rate of 54.9254, then force the 8254\r
// PIT counter to 0, which is the CSM required rate of 54.9254 ms\r
//\r
- ThunkRegSet.E.SS = (UINT16) (((UINTN) Stack16 >> 16) << 12);\r
- ThunkRegSet.E.ESP = (UINT16) (UINTN) Stack16;\r
- ThunkRegSet.E.CS = Segment;\r
- ThunkRegSet.E.Eip = Offset;\r
+ ThunkRegSet.E.SS = (UINT16)(((UINTN)Stack16 >> 16) << 12);\r
+ ThunkRegSet.E.ESP = (UINT16)(UINTN)Stack16;\r
+ ThunkRegSet.E.CS = Segment;\r
+ ThunkRegSet.E.Eip = Offset;\r
- {\r
- UINTN EbdaBaseAddress;\r
- UINTN ReservedEbdaBaseAddress;\r
-\r
- ACCESS_PAGE0_CODE (\r
- EbdaBaseAddress = (*(UINT16 *) (UINTN) 0x40E) << 4;\r
- ReservedEbdaBaseAddress = CONVENTIONAL_MEMORY_TOP\r
- - PcdGet32 (PcdEbdaReservedMemorySize);\r
- ASSERT (ReservedEbdaBaseAddress <= EbdaBaseAddress);\r
+ {\r
+ UINTN EbdaBaseAddress;\r
+ UINTN ReservedEbdaBaseAddress;\r
+\r
+ ACCESS_PAGE0_CODE (\r
+ EbdaBaseAddress = (*(UINT16 *)(UINTN)0x40E) << 4;\r
+ ReservedEbdaBaseAddress = CONVENTIONAL_MEMORY_TOP\r
+ - PcdGet32 (PcdEbdaReservedMemorySize);\r
+ ASSERT (ReservedEbdaBaseAddress <= EbdaBaseAddress);\r
- Regs->E.EDI = ThunkRegSet.E.EDI;\r
- Regs->E.ESI = ThunkRegSet.E.ESI;\r
- Regs->E.EBP = ThunkRegSet.E.EBP;\r
- Regs->E.EBX = ThunkRegSet.E.EBX;\r
- Regs->E.EDX = ThunkRegSet.E.EDX;\r
- Regs->E.ECX = ThunkRegSet.E.ECX;\r
- Regs->E.EAX = ThunkRegSet.E.EAX;\r
- Regs->X.SS = ThunkRegSet.E.SS;\r
- Regs->X.CS = ThunkRegSet.E.CS;\r
- Regs->X.DS = ThunkRegSet.E.DS;\r
- Regs->X.ES = ThunkRegSet.E.ES;\r
+ Regs->E.EDI = ThunkRegSet.E.EDI;\r
+ Regs->E.ESI = ThunkRegSet.E.ESI;\r
+ Regs->E.EBP = ThunkRegSet.E.EBP;\r
+ Regs->E.EBX = ThunkRegSet.E.EBX;\r
+ Regs->E.EDX = ThunkRegSet.E.EDX;\r
+ Regs->E.ECX = ThunkRegSet.E.ECX;\r
+ Regs->E.EAX = ThunkRegSet.E.EAX;\r
+ Regs->X.SS = ThunkRegSet.E.SS;\r
+ Regs->X.CS = ThunkRegSet.E.CS;\r
+ Regs->X.DS = ThunkRegSet.E.DS;\r
+ Regs->X.ES = ThunkRegSet.E.ES;\r
mThunkContext.RealModeBufferSize = EFI_PAGE_SIZE;\r
mThunkContext.ThunkAttributes = THUNK_ATTRIBUTE_BIG_REAL_MODE | THUNK_ATTRIBUTE_DISABLE_A20_MASK_INT_15;\r
\r
mThunkContext.RealModeBufferSize = EFI_PAGE_SIZE;\r
mThunkContext.ThunkAttributes = THUNK_ATTRIBUTE_BIG_REAL_MODE | THUNK_ATTRIBUTE_DISABLE_A20_MASK_INT_15;\r
\r