init. 1AQQW051HEADmaster

1 files changed, 1617 insertions, 0 deletions

diff --git a/Core/EM/CSM/CsmLib.c b/Core/EM/CSM/CsmLib.c
new file mode 100644
index 0000000..d0605ae
--- /dev/null
+++ b/Core/EM/CSM/CsmLib.c
@@ -0,0 +1,1617 @@
+//**********************************************************************
+//**********************************************************************
+//**                                                                  **
+//**        (C)Copyright 1985-2010, American Megatrends, Inc.         **
+//**                                                                  **
+//**                       All Rights Reserved.                       **
+//**                                                                  **
+//**           5555 Oakbrook Pkwy, Suite 200, Norcross, GA 30093      **
+//**                                                                  **
+//**                       Phone: (770)-246-8600                      **
+//**                                                                  **
+//**********************************************************************
+//**********************************************************************
+
+//****************************************************************************
+// $Header: /Alaska/SOURCE/Modules/CSM/Generic/Core/CsmLib.c 69    1/10/14 12:21p Olegi $
+//
+// $Revision: 69 $
+//
+// $Date: 1/10/14 12:21p $
+//
+//**********************************************************************
+// Revision History
+// ----------------
+// $Log: /Alaska/SOURCE/Modules/CSM/Generic/Core/CsmLib.c $
+// 
+// 69    1/10/14 12:21p Olegi
+// EIP149769: LegacyToEfi boot management
+// Changed default setting, added new token to extend the functionality
+// 
+// 68    10/31/13 9:45a Olegi
+// Typo in Csm16ResetFeature case.
+// 
+// 67    10/18/13 12:38p Olegi
+// EIP139866
+// Create interface to manage LegacyToEfi CSM feature
+// 
+// 66    10/07/13 10:21a Olegi
+// [TAG]  		EIP138427
+// [Category]  	New Feature
+// [Description]  	Create interface to let OEM customers change CSM16
+// variables
+// [Files] csm.c, csm.h, csmlib.c, legacybiosext.h
+// 
+// 65    5/17/13 10:28a Olegi
+// [TAG]  		EIP123915
+// [Category]  	Improvement
+// [Description]  	BBS table update in CSM should be atomic operation
+// (extra reentrance guards added)
+// 
+// 64    5/15/13 3:32p Olegi
+// [TAG]  		EIP123915
+// [Category]  	Improvement
+// [Description]  	BBS table update in CSM should be atomic operation
+// [Files]  		CsmOpROM.c
+// CsmLib.c
+// 
+// 63    4/09/13 9:25a Olegi
+// [TAG]  		EIP118727
+// [Category]  	New Feature
+// [Description]  	Onboard PCI Option ROM loading is moved outside CSM
+// [Files]  		CSM.mak
+// CSM.dxs
+// CSM.c
+// PciInterrupts.c
+// CsmBsp.c
+// CsmLib.c
+// 
+// 62    11/06/12 10:02a Olegi
+// [TAG]  		EIP105801
+// [Category]  	Bug Fix
+// [Severity]  	Important
+// [Symptom]  	CSM: FindEmbeddedRom improperly calls Check30ROM
+// [RootCause]  	Check30ROM updates Size parameter with the runtime size
+// of the ROM. FindEmbeddedRom passes the Init size, so after calling
+// Check30ROM init size value is lost
+// [Solution]  	Use dummy size variable to pass to Check30ROM
+// [Files]  		CsmLib.c
+// 
+// 61    12/23/11 3:09p Olegi
+// [TAG]  		EIP78921
+// [Category]  	Improvement
+// [Description]  	CsmBlockIo should create device handle in BBS table
+// [Files]  		CSM.h
+// CSM.c
+// CsmLib.c
+// 
+// 60    11/11/11 1:00p Olegi
+// [TAG]  		EIP71556
+// [Category]  	Improvement
+// [Description]  	Support for 6 IDE Controllers
+// [Files]  		CSM.h
+// CsmLib.c
+// 
+// 59    10/12/11 3:16p Olegi
+// 
+// 58    8/10/11 4:26p Olegi
+// [TAG]  		EIP65882
+// [Category]  	Improvement
+// [Description]  	Added checking for OPROM_MULTIPLE_MODULEID in
+// FindEmbeddedRom, PCI3.0 Option ROM section.
+// [Files]  		CsmLib.c
+// 
+// 57    8/03/11 4:27p Olegi
+// [TAG]  		EIP61035, EIP65224
+// [Category]  	Bug Fix
+// [Severity]  	Important
+// [Symptom]  	When AMIDebugger is using COM port, system halts in
+// DisconnectSerialIO().
+// [RootCause]  	DisconnectSerialIO() Function present in CsmLib.c
+// disconnects all SerialIO controllers including the AMI Debugger's
+// DebugPort driver.
+// [Solution]  	Before disconnecting SerialIo validate the controller by
+// checking if device path protocol is installed on it.
+// [Files]  		csmlib.c
+// 
+// 56    5/05/11 10:18a Olegi
+// [TAG]  		EIP59628
+// [Category]  	Bug Fix
+// [Severity]  	Important
+// [Symptom]  	BDA is not initialized correctly, reporting the maximum of
+// 2 comports in the system with 4 comports.
+// [RootCause]  	aPnP table did not have entries for COM3 and COM4
+// [Solution]  	added COM3/COM4 entries in the aPnP table.
+// [Files]  		csmlib.c
+// 
+// 55    1/31/11 4:31p Olegi
+// [TAG]  		EIP50327 
+// [Category]  	Improvement
+// 
+// 54    1/18/11 11:30a Olegi
+// [TAG]  		EIP52322
+// [Category]  	Improvement
+// [Description]  	Projects with two or more PCI 3.0 embedded ROMs: if
+// ROM's Device List all support one device, only one option ROM would be
+// invoked.
+// [Files]  		Changed the search method of FindEmbeddedRom()
+// 
+// 53    12/22/10 9:07a Olegi
+// Added code to clear BBS entry before setting the BBS_IGNORE priority in
+// RemoveBbsEntryAt function.
+// 
+// 52    12/03/10 12:43p Olegi
+// [TAG]  		EIP48471
+// [Category]  	Bug Fix
+// [Severity]  	Normal
+// [Symptom]  	COM Port addresses are not filled in correctly in BDA when
+// COM 0(First COM port) disabled in setup.
+// [RootCause]  	For the COM port resource details in BDA, we should not
+// depend on the UID of the Com port.
+// [Solution]  	1) Get the 1st COM port details and fill the details in
+// CSm16bootable , BDA 40:0 and increment Serial Port count in 40:0x10.
+// 2) Get the 2nd Com port details and fill the details in CSm16bootable ,
+// BDA 40:2 and increment Serial Port count in 40:0x10..Continue this for
+// 4 com ports.
+// [Files]  		CsmHwInfo.c
+// CsmLib.c
+// 
+// 51    10/07/10 9:07a Olegi
+// EIP44674: Reverted changes in GetComResource function.
+// 
+// 50    10/06/10 4:42p Olegi
+// Finalized changes related to EIP35156.
+// 
+// 49    10/01/10 4:43p Oleksiyy
+// Issue Number:  39752
+// 
+// Category:  Improvement
+// 
+// Description:  functuanality to hide Com1 from legacy OS if we are using
+// Trace in Runtime is added.
+// 
+// Files:  Uart1.asl, Tokens.c, Runtime.c, GenericSio.c, EfiLib.c,
+// CsmLib.c, AmiDxeLib.h and StatusCode eModule.
+// 
+// 48    10/01/10 4:30p Olegi
+// A call GetPlatformEmbeddedRom is replaced with the ELINK; this serves
+// the purpose of OEM function portability. EIP35156.
+// 
+// 47    9/20/10 1:04p Olegi
+// EIP42722: Corrected GetComResource function.
+// 
+// 46    9/01/10 10:37a Olegi
+// EIP42523: Added VendorId checking for PCI3.0 Option ROMs.
+// Background: CSM would check Device List to find the correct ROM image
+// if option ROM is PCI 3.0. But there was a lack of VendorID checking in
+// the search rule, this may cause FindEmbeddedRom return incorrect ROM
+// image.
+// 
+// 45    8/30/10 4:56p Olegi
+// Added EFI_NOT_FOUND output to RemoveBbsEntryAt function.
+// 
+// 44    7/16/10 12:08p Olegi
+// ConnectSerialIO/DisconnectSerialIO functions moved here from CSM.C.
+// 
+// 43    7/08/10 11:31a Olegi
+// Added SignalAmiLegacyBootEvent function. EIP39089
+// 
+// 42    5/21/10 2:29p Olegi
+// Modification in GetComPortResource: removed unneeded typecasting to
+// SIO_DEV.
+// 
+// 41    1/28/10 9:27a Olegi
+// Bugfix in GetComPortResource::EIP33931.
+// 
+// 40    1/12/10 11:46a Olegi
+// Copyright message updated.
+// 
+// 39    12/28/09 8:49a Olegi
+// Modification in LockShadow, remove decoding of the unused shadow area.
+// EIP#29087
+// 
+// 38    12/28/09 7:46a Olegi
+// Added GetLptResource function.
+// 
+// 37    8/05/09 5:56p Olegi
+// FindEmbeddedRom() is modified to implement the feature of PCI3.0 OpROM
+// that handles multiple devices. EIP#24327
+// 
+// 36    4/02/09 2:12p Olegi
+// Added GetComPortResource function.
+// 
+// 35    12/22/08 5:27p Olegi
+// Added GetPlatformEmbeddedRom function. This allows different packing of
+// the OpROM, can be used to pack it as FFS file.
+// 
+// 34    10/22/08 6:22p Robert
+// In UnlockShadow, moved the assignment of LockUnlockAddr and
+// LockUnlockSize outside the if (size) scope to cover the case where size
+// = 0
+// 
+// 33    10/10/08 11:56a Olegi
+// 
+// 32    10/10/08 11:54a Olegi
+// UnlockShadow: calculation of size adjustment is changed.
+// 
+// 31    9/23/08 2:18p Olegi
+// 
+// 30    6/30/08 3:53p Olegi
+// Added AddBbsEntryAt and RemoveBbsEntryAt functions.
+// 
+// 29    6/10/08 11:05a Olegi
+// Bugfix in RemoveDecodingForShadow, the size of the region was not
+// calculated correctly.
+// 
+// 28    5/19/08 12:37p Olegi
+// Removed EBDA size limitation.
+// 
+// 27    5/08/08 6:03p Olegi
+// Modified FindEmbeddedRom routine to support multiple DID for one OpROM
+// for PCI onboard devices
+// 
+// 26    4/14/08 2:46p Rameshraju
+// Removed the decoding for the remaining Shadow region
+// 
+// 25    1/31/08 11:53a Olegi
+// AllocateEbda definition changed.
+// 
+// 24    1/16/08 2:17p Olegi
+// Modified AllocateEbda function.
+// 
+// 23    12/04/07 11:07a Olegi
+// 
+// 22    10/08/07 5:24p Olegi
+// Bugfix in AllocateEbda() - after allocation all EBDA pointers
+// associated with already executed OpROMs must be updated.
+// 
+// 21    10/02/07 10:42a Olegi
+// Modified IsSioDevicePluggedIn() function.
+// 
+// 1     7/08/07 5:19p Fasihm
+// 
+// 19    4/27/07 5:13p Olegi
+// CSM.CHM file preparation.
+//
+// 18    4/20/07 4:41p Olegi
+// AllocateEbda function is modified so that it properly updates 40:13
+//
+// 17    12/13/06 11:09a Olegi
+// AllocateEbda function introduction (not tested).
+//
+// 16    8/29/06 5:48p Olegi
+//
+// 15    8/28/06 11:11a Olegi
+// IsConnected[] array data is corrected.
+//
+// 14    8/24/06 6:57p Felixp
+//
+// 13    8/24/06 6:49p Felixp
+// x64 support (warnings/errors fixed)
+//
+// 12    8/16/06 2:38p Olegi
+// Previous typecast changes undone.
+//
+// 11    8/11/06 4:54p Olegi
+//
+// 10    5/19/06 11:22p Felixp
+// Device Path code updated to use NEXT_NODE/NODE_LENGTH/SET_NODE_LENGTH
+// macros to remove direct access to the Length field
+//
+// 9     3/13/06 2:33p Felixp
+//
+// 8     11/23/05 11:22a Felixp
+// dev_status renamed to DEV_STATUS.
+// 
+// 7     11/23/05 9:40a Felixp
+// 
+//**********************************************************************
+//<AMI_FHDR_START>
+//
+// Name:	CsmLib.c
+//
+// Description:	Functions and variables used in different CSM modules
+//
+//<AMI_FHDR_END>
+//**********************************************************************
+#include "csm.h"
+#include "AmiDxeLib.h"
+#include "AcpiRes.h"
+#include <Protocol\AmiSio.h>
+#include <Protocol\SimplePointer.h>
+#include <Protocol\BlockIo.h>
+#include "token.h"
+#include "pci.h"
+#include <Protocol/SerialIo.h>
+#include <Protocol/AmiBoardInfo.h>
+
+extern BIOS_INFO *CoreBiosInfo;
+extern UINTN gMaxOpRomAddress;
+
+VOID        *EmbeddedRom;
+UINTN       EmbeddedRomSize;
+
+VOID        UpdateEbdaMap(UINT32);
+
+extern AMI_BOARD_INFO_PROTOCOL *gAmiBoardInfo;
+extern BOOLEAN gBbsUpdateInProgress;
+
+BOOLEAN
+Check30ROM(
+    IN VOID         *RomLocation,
+    IN OUT UINTN    *Size,
+    IN  EFI_HANDLE  PciHandle
+);
+
+static UINT16 aPnP[16] = {
+    0x0501, // 0 - UART1
+    0x0501, // 1 - UART2
+    0x0400, // 2 - LPT1
+    0x0604, // 3 - FDC
+    0, 0, 0, 0, 0, 0,
+    0x0303, // A - KBC
+    0,      // B - EC
+    0x0501, //C - UART3
+    0x0501, // D - UART4
+    0x0F03, // E - PS/2 Mouse
+    0       // F - Reserved
+};
+
+typedef EFI_STATUS (*IsConnectedFunc)(EFI_HANDLE);
+
+EFI_STATUS IsConnectedDummy(EFI_HANDLE);
+EFI_STATUS IsConnectedPS2MS(EFI_HANDLE);
+EFI_STATUS IsConnectedFloppy(EFI_HANDLE);
+
+static
+IsConnectedFunc IsConnected[] = {
+    IsConnectedDummy,   // 0 - UART1
+    IsConnectedDummy,   // 1 - UART2
+    IsConnectedDummy,   // 2 - LPT1
+    IsConnectedFloppy,  // 3 - FDC
+    IsConnectedDummy,   // 4 - SB16
+    IsConnectedDummy,   // 5 - MIDI
+    IsConnectedDummy,   // 6 - MSS AUDIO
+    IsConnectedDummy,   // 7 - FM Synthesizer
+    IsConnectedDummy,   // 8 - Game Port1
+    IsConnectedDummy,   // 9 - Game Port2
+    IsConnectedDummy,   // A - KBC
+    IsConnectedDummy,   // B - EC
+    IsConnectedDummy,   // C - reserved
+    IsConnectedDummy,   // D - reserved
+    IsConnectedPS2MS,   // E - PS/2 Mouse
+    IsConnectedDummy    // F - reserved
+};
+
+typedef struct _ACPI_PNPID {
+    UINT32  Signature   :16;
+    UINT32  PnpID       :16;
+} ACPI_PNPID;
+
+EFI_HANDLE  *gSerialIoHandleBuffer=NULL;
+UINTN       gSerialIoHandleCount=0;
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:  FindEmbeddedRom
+//
+// Description: This function searches for ROM within the data previously loaded
+//              from the main FV image and returns its pointer and size.
+//
+// Output:      EFI_SUCCESS or EFI_NOT_FOUND
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+typedef EFI_STATUS (*CSM_GET_EMBEDDED_PCI_ROM) (
+    UINT16 VendorId, UINT16 DeviceId, VOID **ImageStart, UINTN *ImageSize);
+
+EFI_STATUS FindEmbeddedRom(
+    UINT16 ModuleId, UINT16 VendorId, UINT16 DeviceId,
+    VOID **ImageStart, UINTN *ImageSize
+)
+{
+    OPROM_HEADER *Header;
+    EFI_STATUS Status;
+    PARTIAL_OPROM_HEADER *PartialHeader = NULL;
+    UINT8 NumAdditionalDevicesWithSameOpRom = 0;
+    UINT32 SizeOfPartialHeaders = 0;
+    UINT32 i = 0;
+    PCI_DATA_STRUCTURE *pcir;
+    UINT16 *DeviceIDList;
+    CSM_GET_EMBEDDED_PCI_ROM GetEmbeddedPciRom = (CSM_GET_EMBEDDED_PCI_ROM)gAmiBoardInfo->BoardOemInfo;
+
+    Status = GetPlatformEmbeddedRom(ModuleId, VendorId, DeviceId, ImageStart, ImageSize);
+    if (!EFI_ERROR(Status)) return Status;
+
+    if ((ModuleId == OPROM_MODULEID) && (gAmiBoardInfo->BoardOemInfo != NULL))
+    {
+        GetEmbeddedPciRom = (CSM_GET_EMBEDDED_PCI_ROM)gAmiBoardInfo->BoardOemInfo;
+        Status = GetEmbeddedPciRom(
+            VendorId, DeviceId, ImageStart, ImageSize);
+        return Status;
+    }
+
+
+    for(  Header = (OPROM_HEADER*)EmbeddedRom
+        ; (UINT8*)Header<(UINT8*)EmbeddedRom+EmbeddedRomSize
+        ; Header = (OPROM_HEADER*)((UINT8*)(Header+1)+
+                                    SizeOfPartialHeaders+
+                                    Header->Size)
+    )
+    {
+        if (   Header->ModuleId==ModuleId
+            && Header->VendorId==VendorId
+            && Header->DeviceId==DeviceId
+        )
+        {
+            *ImageStart = Header+1;
+            *ImageSize=Header->Size;
+            return EFI_SUCCESS;
+        }
+        else
+        {
+            // try LinkDid/LinkVid for OpROMs
+            //If there is more than 1 device using an option rom,
+            //the header of the first device has a module id with the follow format:
+            //  0xA0XX
+            //where the least significant byte is the additional number of devices using the option ROM.
+            // e.g. If there are 2 devices using the option rom, then the header of the
+            //first device has module id 0xA001.
+            //The first device device has a complete header, and the remaining devices have partial headers.
+            //A partial header is the complete header without the 'Size' field.
+            if ((Header->ModuleId & 0xFF00) == OPROM_MULTIPLE_MODULEID)
+            {
+                NumAdditionalDevicesWithSameOpRom = (UINT8) (Header->ModuleId & 0xFF);
+                SizeOfPartialHeaders = sizeof(PARTIAL_OPROM_HEADER) *
+                                        NumAdditionalDevicesWithSameOpRom;
+                //check the first header
+                //we do not check the module id
+                if ((Header->VendorId == VendorId) &&
+                    (Header->DeviceId==DeviceId)) {
+                    *ImageStart = (UINT8 *)(Header+1)+SizeOfPartialHeaders;
+                    *ImageSize=Header->Size;
+                    return EFI_SUCCESS;
+                }
+                //Check the partial headers of the remaining devices using this option rom.
+                //The first partial header directly follows the regular header.
+                PartialHeader = (PARTIAL_OPROM_HEADER *)(Header+1);
+                for (i = 0; i < NumAdditionalDevicesWithSameOpRom; i++) {
+                    if ((PartialHeader->ModuleId == ModuleId) &&
+                        (PartialHeader->VendorId == VendorId) &&
+                        (PartialHeader->DeviceId == DeviceId)) {
+                        *ImageStart = (UINT8 *)(Header+1)+SizeOfPartialHeaders;
+                        *ImageSize=Header->Size;
+                        return EFI_SUCCESS;
+                    }
+                    PartialHeader++;
+                }
+            } else {
+                SizeOfPartialHeaders = 0;
+            }
+        }
+        *ImageStart = 0;
+        *ImageSize = 0;
+    }
+
+    // Linked List failed. So check if it is a PCI 3.0 Option and has a valid Device List pointer
+    for(  Header = (OPROM_HEADER*)EmbeddedRom
+        ; (UINT8*)Header<(UINT8*)EmbeddedRom+EmbeddedRomSize
+        ; Header = (OPROM_HEADER*)((UINT8*)(Header+1)+
+                                    SizeOfPartialHeaders+
+                                    Header->Size)
+    )
+    {
+        UINTN DummyImageSize;
+
+        if ((Header->ModuleId & 0xFF00) == OPROM_MULTIPLE_MODULEID)
+        {
+            NumAdditionalDevicesWithSameOpRom = (UINT8) (Header->ModuleId & 0xFF);
+            SizeOfPartialHeaders = sizeof(PARTIAL_OPROM_HEADER) * NumAdditionalDevicesWithSameOpRom;
+            PartialHeader = (PARTIAL_OPROM_HEADER *)(Header+1);
+            for (i = 0; i < NumAdditionalDevicesWithSameOpRom; i++) {
+                PartialHeader++;
+            }
+        } else {
+            SizeOfPartialHeaders = 0;
+        }
+
+        *ImageStart = (UINT8 *)(Header+1)+SizeOfPartialHeaders;
+        *ImageSize = Header->Size;
+        if (Check30ROM(*ImageStart, &DummyImageSize, NULL)){
+            // Check for valid Device List Pointer
+            pcir = (PCI_DATA_STRUCTURE *)((UINT8*)*ImageStart + *(UINT16*)((UINT8*)*ImageStart + 0x18));
+            if ((pcir->VendorId == VendorId) && (pcir->Reserved0)) { //(EIP42523)
+                DeviceIDList = (UINT16 *)((UINT8 *)pcir +  pcir->Reserved0);
+                for (;*DeviceIDList; DeviceIDList++ ){
+                    if (*DeviceIDList == DeviceId) {
+                        return EFI_SUCCESS;
+                    }
+                }
+            }
+        }
+        *ImageStart = 0;
+        *ImageSize = 0;
+    }
+
+    return EFI_NOT_FOUND;
+}
+
+
+EFI_STATUS IsConnectedDummy(EFI_HANDLE handle)
+{
+    return EFI_UNSUPPORTED;
+}
+
+EFI_STATUS IsConnectedPS2MS(EFI_HANDLE handle)
+{
+    EFI_STATUS Status;
+    EFI_SIMPLE_POINTER_PROTOCOL *spp;
+    EFI_SIMPLE_POINTER_STATE state;
+
+    Status = pBS->HandleProtocol(handle,&gEfiSimplePointerProtocolGuid,&spp);
+    if (!EFI_ERROR(Status)) {
+        Status = spp->GetState(spp, &state);
+        // ask A. to fix this if - should return DEVICE_ERROR, not NO_READY
+        //if (Status != EFI_DEVICE_ERROR) {
+        if (Status != EFI_NOT_READY) {
+            Status = EFI_SUCCESS;
+        }
+    }
+    return Status;
+}
+
+
+EFI_STATUS IsConnectedFloppy(EFI_HANDLE handle)
+{
+    EFI_STATUS Status;
+    EFI_BLOCK_IO_PROTOCOL *blkiop;
+
+    Status = pBS->HandleProtocol(handle,&gEfiBlockIoProtocolGuid,&blkiop);
+
+    return Status;
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Function:    IsSioDevicePluggedIn
+//
+// Description: Returns connect status of certain SIO device.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+BOOLEAN IsSioDevicePluggedIn(
+    IN SIO_DEV_STATUS *dev_plugged_in,
+    OUT EFI_HANDLE    *hDevice
+)
+{
+    EFI_STATUS          Status;
+    UINT16              dev;
+    UINTN               i,j,cnt;
+    ACPI_HID_DEVICE_PATH    *siodp;
+    ACPI_PNPID          *pnpid;
+    EFI_HANDLE          *hbuff = NULL;
+    EFI_DEVICE_PATH_PROTOCOL        *dp;
+    BOOLEAN             bIsConnected = FALSE;
+
+    dev = dev_plugged_in->DEV_STATUS;
+    Status = pBS->LocateHandleBuffer(ByProtocol,&gEfiAmiSioProtocolGuid, NULL, &cnt, &hbuff);
+//  ASSERT_EFI_ERROR(Status);
+
+    if (EFI_ERROR(Status)) return FALSE;
+
+    //
+    // Find the device index. Note, that this function does not support multiple devices.
+    //
+    for (j=0; j<16; j++, dev>>=1) {
+        if (dev & 1) break;
+    }
+    if (j==16) {
+        pBS->FreePool(hbuff);
+        return FALSE;
+    }
+
+    for(i=0; i<cnt; i++){
+        Status=pBS->HandleProtocol(hbuff[i],&gEfiDevicePathProtocolGuid,&dp);
+        if(EFI_ERROR(Status)) continue;
+
+        siodp=DPGetLastNode(dp);
+        if(siodp->Header.Type!=ACPI_DEVICE_PATH
+            || siodp->Header.SubType!=ACPI_DP
+            || NODE_LENGTH(&siodp->Header) != ACPI_DEVICE_PATH_LENGTH) continue;
+
+        pnpid=(ACPI_PNPID*)&siodp->HID;
+        if (pnpid->PnpID == aPnP[j]) {
+            bIsConnected = (BOOLEAN) (IsConnected[j](hbuff[i]) == EFI_SUCCESS);
+            *hDevice = hbuff[i];
+            break;
+        }
+    }
+    pBS->FreePool(hbuff);
+    return bIsConnected;
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Function:    GetSioDeviceStatus
+//
+// Description: Returns present/absent status of SIO device.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+VOID
+GetSioDeviceStatus(
+    IN OUT SIO_DEV_STATUS *devsts
+)
+{
+    static EFI_GUID  SioDevStatusVarGuid = SIO_DEV_STATUS_VAR_GUID;
+    SIO_DEV_STATUS      siost;
+    UINTN               i, j, cnt;
+    EFI_STATUS          Status;
+    ACPI_HID_DEVICE_PATH    *siodp;
+    ACPI_PNPID          *pnpid;
+    EFI_HANDLE          *hbuff = NULL;
+    UINT16              shifty;
+    EFI_DEVICE_PATH_PROTOCOL        *dp;
+
+    siost.DEV_STATUS = 0;
+    i = sizeof(siost);
+    Status = pRS->GetVariable(
+                SIO_DEV_STATUS_VAR_NAME,
+                &SioDevStatusVarGuid,
+                NULL,
+                &i,
+                &siost.DEV_STATUS);
+    if (EFI_ERROR(Status)) {
+    //
+    // NVRAM variable is not found, let us try to get status directly.
+    //
+        Status = pBS->LocateHandleBuffer(ByProtocol,&gEfiAmiSioProtocolGuid, NULL, &cnt, &hbuff);
+//      ASSERT_EFI_ERROR(Status);
+        if(EFI_ERROR(Status)) return;
+
+        for (shifty=1,j=0; j<16; j++, shifty<<=1) { // 16 is the number of device types
+            if (!(devsts->DEV_STATUS | shifty)) continue;   // not this device
+            for(i=0; i<cnt; i++){
+                Status=pBS->HandleProtocol(hbuff[i],&gEfiDevicePathProtocolGuid,&dp);
+                if(EFI_ERROR(Status)) continue;
+
+                siodp=DPGetLastNode(dp);
+                if(siodp->Header.Type!=ACPI_DEVICE_PATH
+                || siodp->Header.SubType!=ACPI_DP
+                || NODE_LENGTH(&siodp->Header) != ACPI_DEVICE_PATH_LENGTH) continue;
+
+                pnpid=(ACPI_PNPID*)&siodp->HID;
+                if (pnpid->PnpID == aPnP[j]) {
+                    siost.DEV_STATUS |= shifty;
+                    break;
+                }
+            }
+        }
+        pBS->FreePool(hbuff);
+    }
+
+    *devsts = siost;
+
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Function:    GetComPortResource
+//
+// Description: Returns COM port base address and interrupt
+//
+// Input:       ComNo - COM port number, 0-based.
+//
+// Output:      EFI_NOT_FOUND - COM port is not found.
+//              EFI_SUCCESS - COM port found, the output variables are updated:
+//                  Address - IO base address
+//                  Irq     - IRQ number
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+GetComPortResource(
+    IN UINT8    ComNo,
+    OUT UINT16  *Address,
+    OUT UINT8   *Irq
+)
+{
+    EFI_HANDLE          *Handle = NULL;
+    UINTN               Count;
+    UINTN               i;
+    EFI_STATUS          Status;
+    UINT8               ComNumber = (UINT8)-1;
+    AMI_SIO_PROTOCOL    *AmiSio;
+    SPIO_DEV            *SpIoDev;
+
+    // Hide COM1 from legacy OS if we are using Trace in Runtime
+    if (ComNo == 0) {
+#if RUNTIME_TRACE_SUPPORT
+        return EFI_NOT_FOUND;
+#endif
+    }
+
+    Status = pBS->LocateHandleBuffer(
+        ByProtocol, &gEfiAmiSioProtocolGuid, NULL, &Count, &Handle);
+    if(EFI_ERROR(Status)) return Status;
+
+    for (i = 0; i < Count; i++)
+    {
+        Status = pBS->HandleProtocol(Handle[i],&gEfiAmiSioProtocolGuid, &AmiSio);
+        if (EFI_ERROR(Status)) continue;
+
+        Status = EFI_NOT_FOUND;
+
+        SpIoDev = (SPIO_DEV*)(UINTN)AmiSio;
+
+        if (SpIoDev->DeviceInfo->Type != dsUART) continue;  // not COM port
+        if (SpIoDev->VlData.DevImplemented == 0)
+        {
+            continue;
+        }
+        ComNumber++;
+        //
+        // Check if we have reached "ComNo" th instance of UART devices
+        // 
+        if(ComNumber!=ComNo)continue;
+
+
+        *Address = (UINT16)SpIoDev->VlData.DevBase1;
+        *Irq = (UINT8)SpIoDev->VlData.DevIrq1;
+
+        Status = EFI_SUCCESS;
+        break;
+    }
+
+    pBS->FreePool(Handle);
+
+    return Status;
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Function:    GetLptResource
+//
+// Description: Returns LPT base address and interrupt
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+GetLptResource(
+    OUT UINT16  *Address,
+    OUT UINT8   *Irq
+)
+{
+    EFI_HANDLE  *Handle = NULL;
+    UINTN       Count;
+    UINTN       i;
+    EFI_STATUS  Status;
+
+    AMI_SIO_PROTOCOL    *AmiSio;
+    SPIO_DEV            *SpIoDev;
+
+    Status = pBS->LocateHandleBuffer(
+        ByProtocol, &gEfiAmiSioProtocolGuid, NULL, &Count, &Handle);
+    if(EFI_ERROR(Status)) return Status;
+
+    for (i = 0; i < Count; i++) {
+        Status = pBS->HandleProtocol(Handle[i],&gEfiAmiSioProtocolGuid, &AmiSio);
+        if (EFI_ERROR(Status)) continue;
+
+        SpIoDev = (SPIO_DEV*)(UINTN)AmiSio;
+
+        if (SpIoDev->DeviceInfo->Type != dsLPT) continue;  // not LPT
+        if (SpIoDev->VlData.DevImplemented == 0) continue;
+
+        *Address = (UINT16)SpIoDev->VlData.DevBase1;
+        *Irq = (UINT8)SpIoDev->VlData.DevIrq1;
+
+        Status = EFI_SUCCESS;
+        break;
+    }
+
+    pBS->FreePool(Handle);
+
+    Status = (i == Count)? EFI_NOT_FOUND : EFI_SUCCESS;
+
+    return Status;
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// FUNCTION:    AllocateEbda
+//
+// DESCRIPTION: This function attempts to allocate EBDA.
+//
+// INPUT:       EBDA size in kilo Bytes
+//
+// RETURN:      32-bit pointer of the allocated memory block inside EBDA
+//              The allocated address offset off the beginning of EBDA
+//              EFI_OUT_OF_RESOURCES if EBDA can not be allocated
+//              EFI_SUCCESS if memory is successfully allocated
+//
+// NOTE:        - This routine can be called multiple times and every time EBDA
+//              data is copied to a different location. It is the caller
+//              responsibility to obtain the current EBDA segment and its size
+//              and adjust the offsets before accessing the data.
+//              - NewEbdaAddress could be used immediately after allocation. If
+//              the allocated block is not used immediately, - any successive
+//              call moves the existing data - then the caller should use
+//              EbdaStartOffset to calculate the correct address of the previously
+//              allocated data.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+AllocateEbda(
+    IN EFI_LEGACY_BIOS_EXT_PROTOCOL *This,
+    IN UINT8    RequestedSizeKB,
+    OUT UINT32  *NewEbdaAddress,
+    OUT UINT32  *EbdaStartOffset
+)
+{
+    UINT16 CurEbdaSeg = *(UINT16*)(UINTN)0x40E;
+    UINTN  CurEbdaLocation, NewEbdaLocation;
+    UINT8  CurEbdaSizeKB;
+    UINTN  CurEbdaSize, EbdaSize;
+    UINTN  MinEbdaAddress = 0xA0000-PMM_EBDA_LOMEM_SIZE;
+
+    //
+    // Check the current EBDA allocation and see if there is still room in it
+    //
+    CurEbdaLocation = (UINTN)CurEbdaSeg<<4;
+    ASSERT(CurEbdaLocation > MinEbdaAddress);   // either not allocated or already full
+
+    EbdaSize = (UINTN)RequestedSizeKB << 10;
+    NewEbdaLocation = CurEbdaLocation - EbdaSize;
+
+    if (NewEbdaLocation < MinEbdaAddress) {
+        return EFI_OUT_OF_RESOURCES;
+    }
+
+    //
+    // Do the allocation:
+    // - copy old EBDA
+    // - clear the allocated EBDA
+    // - update EBDA pointer and EBDA size
+    //
+    CurEbdaSizeKB = *(UINT8*)CurEbdaLocation;
+    CurEbdaSize = (UINTN)CurEbdaSizeKB<<10;
+
+    pBS->CopyMem((VOID*)NewEbdaLocation, (VOID*)CurEbdaLocation, CurEbdaSize);
+
+    pBS->SetMem((UINT8*)(NewEbdaLocation+CurEbdaSize), EbdaSize, 0);
+
+    *(UINT16*)(UINTN)0x40E = (UINT16)(NewEbdaLocation>>4);
+    *(UINT8*)NewEbdaLocation = CurEbdaSizeKB + RequestedSizeKB;
+
+    //
+    // Update 40:13 with the new size of available base memory
+    //
+    *(UINT16*)(UINTN)0x413 = (*(UINT16*)(UINTN)0x413) - RequestedSizeKB;
+
+    //
+    // Update the EBDA information for the saved OpROMs
+    //
+    UpdateEbdaMap((UINT32)EbdaSize);
+
+    *NewEbdaAddress = (UINT32)(NewEbdaLocation+CurEbdaSize);
+    *EbdaStartOffset = (UINT32)CurEbdaSizeKB << 10;
+
+    return EFI_SUCCESS;
+}
+
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Name:        UnlockShadow
+//
+// Description: Opens the shadow region(s) for writing.
+//
+// Input:   Address - starting address
+//          Size    - size of the region
+//
+// Output:  LockUnlockAddr - address of the first unlocked block
+//          LockUnlockSize - unlocked address space
+//          Function returns EFI_OUT_OF_RESOURCES if there is not enough room
+//          in the shadow.
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+UnlockShadow(
+    IN UINT8    *Address,
+    IN UINTN    Size,
+    OUT OPTIONAL UINT32  *LockUnlockAddr,
+    OUT OPTIONAL UINT32  *LockUnlockSize
+)
+{
+    UINT32 Granularity;
+    UINT32 addr, size;
+    UINT32 addr_adjustment;
+    UINT32 size_adjustment = 0;
+    EFI_STATUS Status;
+
+    addr = (UINT32)(UINTN)Address;
+    size = (UINT32)Size;
+    if (size) {
+        Status = CoreBiosInfo->iRegion->UnLock (CoreBiosInfo->iRegion,
+                    addr, size, &Granularity);
+        ASSERT_EFI_ERROR(Status);
+        if (EFI_ERROR(Status)) return Status;
+
+        addr_adjustment = addr % Granularity;
+
+        if (((addr+size) % Granularity) != 0) {
+            size_adjustment = Granularity - ((addr+size) % Granularity);
+        }
+
+        // Adjust the address to align with the granularity
+        addr -= addr_adjustment;
+        // Adjust the size to align with the granularity
+        size += addr_adjustment;    // Align left
+        size += size_adjustment;
+
+    }
+
+    // moved these outside the if (size) for case when size = 0
+    if (LockUnlockAddr != NULL) *LockUnlockAddr = addr;
+    if (LockUnlockSize != NULL) *LockUnlockSize = size;
+
+    //
+    // Finally make CSM16 area writable for the cases where
+    // CSM16 area needs to be updated during DispatchOptionRom
+    // call, e.g. for non-BBS OpROMs.
+    //
+    Status = CoreBiosInfo->iRegion->UnLock (
+        CoreBiosInfo->iRegion,
+        (UINT32)gMaxOpRomAddress+1,
+        0xFFFFF-(UINT32)gMaxOpRomAddress,
+        NULL
+    );
+    ASSERT_EFI_ERROR(Status);
+
+    return EFI_SUCCESS;
+}
+
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Name:        LockShadow
+//
+// Description: Locks the shadow region(s).
+//
+// Input:   LockAddr    - Starting address of the area to be locked
+//          LockSize    - Size of the area to be locked
+//
+// Output:  Status of the lock operation.
+//
+// Notes:   This function will also clear the R/W attribute for the region
+//          from LockAddr+LockSize to gMaxOpRomAddress; this is needed for
+//          some OS drivers to be loaded properly (Win PCMCIA driver)
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+LockShadow(
+    IN UINT32  LockAddr,
+    IN UINT32  LockSize
+)
+{
+    UINT32      Granularity;
+    EFI_STATUS  Status = EFI_SUCCESS;
+
+    if (LockSize && ((LockAddr+LockSize) < gMaxOpRomAddress)) {
+        Status = CoreBiosInfo->iRegion->Lock (CoreBiosInfo->iRegion, LockAddr, LockSize, &Granularity);
+        ASSERT_EFI_ERROR(Status);
+        //
+        // Disable Shadow W/R for the unused shadow regions
+        // Take care of the boundary conditions: LockAddr+LockSize is not nesessarily
+        // within Granularity boundaries. For example, if LockAddr is 0xC0000, LockSize
+        // is 0x1400 and Granularity is 0x1000, then area from 0xC0000 to 0xC2000 is
+        // locked. The next call must not use 0xC0000+LockSize, otherwise part of the
+        // OpROM becomes unreadable.
+        //
+        if (LockSize % Granularity) LockSize += Granularity;
+        LockSize = (LockSize/Granularity)*Granularity;
+    }
+	
+	if( LockAddr!=0 && LockSize!=0 ) {
+		BOOLEAN On=FALSE;
+		if ((LockAddr+LockSize) < gMaxOpRomAddress) {
+			Status = CoreBiosInfo->iRegion->Decode (CoreBiosInfo->iRegion,
+													LockAddr+LockSize,
+													(UINT32)gMaxOpRomAddress-LockSize-LockAddr+1,
+													&On);
+			ASSERT_EFI_ERROR(Status);
+		}
+	}
+
+    CoreBiosInfo->iRegion->Lock (
+        CoreBiosInfo->iRegion,
+        (UINT32)gMaxOpRomAddress+1,
+        0xFFFFF-(UINT32)gMaxOpRomAddress,
+        NULL
+    );
+
+    return Status;
+}
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Name:        RemoveDecodingForShadow
+//
+// Description: This function will clear the R/W attribute for the region
+//              from DecodeAddr to gMaxOpRomAddress; this is needed for
+//              some OS drivers to be loaded properly (Win PCMCIA driver).
+//
+// Input:       DecodeAddr    - Starting address of the area to remove the decoding
+//
+// Output:      Status of the decoding operation.
+//
+// Notes:
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+RemoveDecodingForShadow(
+    IN UINT32  DecodeAddr
+)
+{
+    BOOLEAN     On=FALSE;
+    EFI_STATUS  Status=EFI_SUCCESS;
+    UINT32      Granularity;
+    UINT32      addr, size=1;
+    UINT32      addr_adjustment, size_adjustment;
+
+    addr = DecodeAddr;
+
+    //
+    //Find the nearest starting address
+    //
+    if (size) {
+TRACE((TRACE_ALWAYS, "RemoveDecoding: addr %x\n", addr));
+        Status = CoreBiosInfo->iRegion->UnLock (CoreBiosInfo->iRegion,
+                    addr, size, &Granularity);
+        ASSERT_EFI_ERROR(Status);
+        if (EFI_ERROR(Status)) return Status;
+
+        addr_adjustment = addr % Granularity;
+        size_adjustment = Granularity - ((addr+size) % Granularity);
+        // Adjust the address to align with the granularity
+        addr -= addr_adjustment;
+        // Adjust the size to align with the granularity
+        size += addr_adjustment;    // Align left
+        size += size_adjustment;
+    }
+
+    Status = CoreBiosInfo->iRegion->Lock (CoreBiosInfo->iRegion, addr, size, &Granularity);
+
+    if(addr == DecodeAddr) {
+        DecodeAddr=addr;
+    } else {
+        DecodeAddr=addr+size;
+    }
+
+    if (DecodeAddr < gMaxOpRomAddress) {
+
+        Status = CoreBiosInfo->iRegion->Decode (CoreBiosInfo->iRegion,
+                     DecodeAddr,
+                    (UINT32)((gMaxOpRomAddress+1)-DecodeAddr),
+                    &On);
+        ASSERT_EFI_ERROR(Status);
+    }
+
+    return Status;
+}
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:        GetBbsTable
+//
+// Description: This function returns a pointer to the BBS table and the
+//              number of entries.
+//
+// Output:      BbsTable - Pointer to BBS table.
+//              BbsCount - Number of entries in table.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+GetBbsTable (
+    IN OUT BBS_TABLE **BbsTable,
+    IN OUT UINT8 *BbsCount
+)
+{
+    if ((BbsTable == NULL) || (BbsCount == NULL)) 
+        return EFI_INVALID_PARAMETER;
+
+    if (CoreBiosInfo == NULL) 
+        return EFI_NOT_READY;
+
+    if (CoreBiosInfo->BbsTable == NULL)
+        return EFI_NOT_READY;
+
+    *BbsTable = CoreBiosInfo->BbsTable;
+    *BbsCount = CoreBiosInfo->BbsEntriesNo;
+
+    return EFI_SUCCESS;
+}
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:        AddBbsEntry
+//
+// Description: This function adds given BBS entry to a BBS table.
+//
+// Input:       BbsEntry - BBS table entry to be added to a table.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+AddBbsEntry (
+    IN BBS_TABLE *BbsEntry
+)
+{
+    if (gBbsUpdateInProgress) return EFI_NOT_READY;
+
+    gBbsUpdateInProgress = TRUE;
+
+    CoreBiosInfo->BbsTable[CoreBiosInfo->BbsEntriesNo] = *BbsEntry;
+    CoreBiosInfo->BbsTable[CoreBiosInfo->BbsEntriesNo].BootPriority = BBS_UNPRIORITIZED_ENTRY;
+    CoreBiosInfo->BbsEntriesNo++;
+
+    gBbsUpdateInProgress = FALSE;
+
+    return EFI_SUCCESS;
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:        InsertBbsEntryAt
+//
+// Description: This function is an extension of AddBbsEntry function; it
+//              allows to add a BBS_ENTRY at a particular location or add
+//              a new entry and return its new location.
+//
+// Input:       This        - Instance of LegacyBiosExt protocol.
+//              EntryNumber - Pointer to 0-based index in BBS table. The
+//                            value of 0xFF will generate a new entry.
+//
+// Output:      EFI_INVALID_PARAMETER - EntryNumber is NULL.
+//              EFI_SUCCESS - EntryNumber is updated with the index of updated
+//                            BBS entry.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+InsertBbsEntryAt (
+    IN EFI_LEGACY_BIOS_EXT_PROTOCOL *This,
+    IN BBS_TABLE *BbsEntry,
+    IN OUT UINT8 *EntryNumber
+)
+{
+    UINT8 EntryNo;
+
+    if (gBbsUpdateInProgress) return EFI_NOT_READY;
+
+    if (EntryNumber == NULL) return EFI_INVALID_PARAMETER;
+
+    gBbsUpdateInProgress = TRUE;
+
+    if (*EntryNumber != 0xff) {
+        EntryNo = *EntryNumber;
+    } else {
+        //
+        // Find an empty entry within MAX_IDE_CONTROLLER*2+1..BbsEntriesNo-1
+        //
+        for (EntryNo = MAX_IDE_CONTROLLER*2+1; EntryNo < CoreBiosInfo->BbsEntriesNo; EntryNo++)
+        {
+            if (CoreBiosInfo->BbsTable[EntryNo].BootPriority == BBS_IGNORE_ENTRY)
+            {
+                break;
+            }
+        }
+        //
+        // If not found, EntryNo will be equal BbsEntriesNo
+        //
+    }
+    CoreBiosInfo->BbsTable[EntryNo] = *BbsEntry;
+    CoreBiosInfo->BbsTable[EntryNo].BootPriority = BBS_UNPRIORITIZED_ENTRY;
+
+    //
+    // BbsEntriesNo should not be incremented for the BBS entries
+    // with indexes from 0 to CoreBiosInfo->BbsEntriesNo-1
+    //
+    if (EntryNo >= CoreBiosInfo->BbsEntriesNo) {
+        CoreBiosInfo->BbsEntriesNo++;
+    }
+    *EntryNumber = EntryNo;
+
+    gBbsUpdateInProgress = FALSE;
+
+    return EFI_SUCCESS;
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:        RemoveBbsEntryAt
+//
+// Description: This function removes BBS entry from BBS table.
+//
+// Input:       This        - Instance of LegacyBiosExt protocol.
+//              EntryNumber - Entry index to be removed.
+//
+// Output:      EFI_INVALID_PARAMETER - EntryNumber exceeds the current table.
+//              EFI_NOT_FOUND - Entry does not exist.
+//              EFI_SUCCESS - Entry has been successfully removed.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+RemoveBbsEntryAt (
+    IN EFI_LEGACY_BIOS_EXT_PROTOCOL *This,
+    IN UINT8 EntryNumber
+)
+{
+    EFI_STATUS Status = EFI_SUCCESS;
+
+    if (gBbsUpdateInProgress) return EFI_NOT_READY;
+
+    gBbsUpdateInProgress = TRUE;
+
+    //
+    // Can only remove a particular entry within 0..CoreBiosInfo->BbsEntriesNo-1 range;
+    //
+    if (EntryNumber >= CoreBiosInfo->BbsEntriesNo) Status = EFI_INVALID_PARAMETER;
+
+    if (!EFI_ERROR(Status)) {
+        if (CoreBiosInfo->BbsTable[EntryNumber].BootPriority == BBS_IGNORE_ENTRY) {
+            Status = EFI_NOT_FOUND;
+        }
+    }
+
+    if (!EFI_ERROR(Status)) {
+        //
+        // Decrement CoreBiosInfo->BbsEntriesNo only if requested index equals
+        // CoreBiosInfo->BbsEntriesNo-1
+        //
+        if (EntryNumber == (CoreBiosInfo->BbsEntriesNo-1)) {
+            CoreBiosInfo->BbsEntriesNo--;
+        }
+    
+        pBS->SetMem(&CoreBiosInfo->BbsTable[EntryNumber], sizeof(BBS_TABLE), 0);
+        CoreBiosInfo->BbsTable[EntryNumber].BootPriority = BBS_IGNORE_ENTRY;
+    }
+
+    gBbsUpdateInProgress = FALSE;
+
+    return Status;
+}
+
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Procedure:	SignalProtocolEvent
+//
+// Description:	Internal function that installs/uninstall protocol
+//				with a specified GUID and NULL interface.
+//              Such protocols can be used as event signaling mechanism.
+//
+// Input:		ProtocolGuid Pointer to the protocol GUID
+//
+// Output:		None
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+VOID
+SignalAmiLegacyBootEvent()
+{
+    EFI_HANDLE  Handle = NULL;
+    static EFI_GUID ProtocolGuid = EFI_AMI_LEGACYBOOT_PROTOCOL_GUID;
+    pBS->InstallProtocolInterface (
+        &Handle, &ProtocolGuid, EFI_NATIVE_INTERFACE, NULL
+    );
+    pBS->UninstallProtocolInterface (
+        Handle, &ProtocolGuid, NULL
+    );
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:        ConnectSerialIO
+//
+// Description: Connect all the serial IO that was disconnected before.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+VOID ConnectSerialIO()
+{
+    UINTN       n; 
+
+    for (n = 0; n < gSerialIoHandleCount; n++) {
+        pBS->ConnectController(gSerialIoHandleBuffer[n],NULL,NULL,TRUE);
+    }
+
+    return;
+
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:        DisconnectSerialIO
+//
+// Description: Disconnect the All the Serial io Handles
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+VOID DisconnectSerialIO()
+{
+    UINTN       n; 
+    EFI_STATUS  Status;
+    EFI_DEVICE_PATH_PROTOCOL    *DevicePath;
+  
+    //
+    // Locate all Serial IO handles
+    //
+    Status = pBS->LocateHandleBuffer (
+        ByProtocol,
+        &gEfiSerialIoProtocolGuid,
+        NULL,
+        &gSerialIoHandleCount,
+        &gSerialIoHandleBuffer);
+
+    if (EFI_ERROR (Status)) {
+        return ;
+    }
+
+    for (n = 0; n < gSerialIoHandleCount; n++) {
+        //
+        // Check if we have DevicePath Protocol installed on Controller handle.
+        // If not, do not disconnect the controller because it may not be handled
+        // by the Serial IO drvier. 
+        // 
+        Status = pBS->HandleProtocol (
+                        gSerialIoHandleBuffer[n],
+                        &gEfiDevicePathProtocolGuid,
+                        &DevicePath);
+
+        if (!EFI_ERROR (Status)) {
+            pBS->DisconnectController(gSerialIoHandleBuffer[n],NULL,NULL);
+        }
+    }
+
+    return;
+}
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:        IsAMICSM16
+//
+// Description:
+//  This function checks whether the CSM16 image is made by AMI.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+BOOLEAN
+IsAMICSM16(
+    EFI_COMPATIBILITY16_TABLE* Csm16Header
+)
+{
+    // Check for "AMIBIOS(" at F000:F500
+    return (*(UINT32*)0xff500 == 0x42494d41 &&
+            *(UINT32*)0xff504 == 0x28534f49);
+}
+
+
+//<AMI_PHDR_START>
+//----------------------------------------------------------------------------
+// Name:        ChecksumCSM16Header
+//
+// Description:
+//  Calculates and updates a checksum field of $EFI header.
+//
+// Input:
+//  Csm16Header Pointer to the EFI_COMPATIBILITY16_TABLE structure
+//
+// Output:
+//  Checksum byte
+//
+// Notes:
+//  Shadow region must be open for writing
+//
+//----------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+UINT8
+ChecksumCSM16Header (
+    EFI_COMPATIBILITY16_TABLE   *Csm16Header
+)
+{
+    UINT8   i;
+    UINT8   chksum;
+    UINT8   *p;
+
+    Csm16Header->TableChecksum = 0;
+    p = (UINT8*)CoreBiosInfo->Csm16Header;
+    for (chksum = 0, i = 0; i < Csm16Header->TableLength; i++) {
+        chksum += *p++;
+    }
+    Csm16Header->TableChecksum = ~(--chksum);
+
+    return Csm16Header->TableChecksum;
+}
+
+typedef struct {
+    CSM16_FEATURE Feature;
+    UINT8 Bit;
+    UINT8 InfoByteOfs;
+} CSM16_FEATURE_LOOKUP;
+
+
+//<AMI_PHDR_START>
+//---------------------------------------------------------------------------
+//
+// Name:        Csm16Configuration
+//
+// Description:
+//  This is LegacyBiosExt interface function that manages CSM16 configuration
+//  settings.
+//
+//---------------------------------------------------------------------------
+//<AMI_PHDR_END>
+
+EFI_STATUS
+Csm16Configuration(
+    IN CSM16_CONFIGURATION_ACTION ConfigAction,
+    IN CSM16_FEATURE Param,
+    OUT OPTIONAL UINT32 *Data
+)
+{
+    LEGACY16_TO_EFI_DATA_TABLE_STRUC *Csm16Data;
+    UINT8 MiscInfo;
+    UINT8 RtCmosByte;
+    volatile UINT8 ProbeData = *(UINT8*)0xf0000;
+    UINT32 Granularity;
+    EFI_STATUS Status;
+    BOOLEAN F000WasOpen;
+    UINT32 i;
+    UINT32 Count;
+
+    static CSM16_FEATURE_LOOKUP Csm16Feature[] = {
+        { Csm16HeadlessI19Retry, CSM16_HEADLESS_INT19_RETRY_BIT, 0 },
+        { Csm16I13MbrWriteProtect, CSM16_I13_HDD_MBR_WP_BIT, 0 },
+        { Csm16LegacyFree, CSM16_NO_KBC_PRESENT_BIT, 0 },
+        { Csm16ZipHddEmulation, CSM16_ZIP_HDD_EMUL_BIT, 0 },
+        { Csm16NoUsbBoot, CSM16_NO_USB_BOOT_BIT, 0 },
+        { Csm16I19Trap, CSM16_I19_TRAP_BIT, 0 },
+        { Csm16Flexboot, CSM16_FLEXBOOT_ENABLE_BIT, 0 },
+        { Csm16GA20, CSM16_FAST_GATE_A20_BIT, 0 },
+        { Csm16SkipGA20Deactivation, CSM_RT_CMOS_SKIP_GA20_DEACTIVATION_BIT, 1 },
+        { Csm16Nmi, CSM_RT_CMOS_PARITY_BIT, 1 },
+        { Csm16CpuRealModeOnBoot, CSM_RT_CPU_RM_ONBOOT_BIT, 1 },
+        { Csm16PS2, CSM_RT_CMOS_PS2_BIT, 1 },
+        { Csm16LegacyToEfi, CSM_RT_CMOS_LTE_BIT, 1 },
+        { Csm16LegacyToEfiPonr, CSM_RT_CMOS_LTE_PONR_BIT, 1 }
+    };
+
+    Csm16Data = (LEGACY16_TO_EFI_DATA_TABLE_STRUC*)(UINTN)(0xf0000 + *(UINT16*)0xfff4c);
+    MiscInfo = *(UINT8*)(UINTN)Csm16Data->MiscInfoAddress;
+    RtCmosByte = *(UINT8*)(UINTN)Csm16Data->RtCmosByteAddress;
+    
+    // see if F000 needs to be made writable
+    *(UINT8*)0xf0000 = ProbeData + 1;
+    F000WasOpen = *(UINT8*)0xf0000 != ProbeData;
+    if (F000WasOpen) {
+        *(UINT8*)0xf0000 = ProbeData;    // restore byte
+    } else {
+        Status = CoreBiosInfo->iRegion->UnLock (CoreBiosInfo->iRegion, 0xf0000, 0x10000, &Granularity);
+        ASSERT_EFI_ERROR(Status);
+        if (EFI_ERROR(Status)) return EFI_ACCESS_DENIED;
+    }
+
+    // Find parameter in the lookup table
+    Count = sizeof(Csm16Feature)/sizeof(CSM16_FEATURE_LOOKUP);
+    for (i = 0; i < Count; i++) {
+        if (Csm16Feature[i].Feature == Param) break;
+    }
+    
+    if (i == Count) {
+        Status = EFI_INVALID_PARAMETER;
+        goto Done;
+    }
+
+    Status = EFI_SUCCESS;
+    
+    switch (ConfigAction) {
+        case Csm16FeatureGet:
+            if (Data == NULL) {
+                Status = EFI_INVALID_PARAMETER; break;
+            }
+            if (Csm16Feature[i].InfoByteOfs == 0)
+                *Data = (MiscInfo & Csm16Feature[i].Bit)? 1 : 0;
+            else
+                *Data = (RtCmosByte & Csm16Feature[i].Bit)? 1 : 0;
+            break;
+
+        case Csm16FeatureSet:
+            if (Csm16Feature[i].InfoByteOfs == 0) {
+                MiscInfo |= Csm16Feature[i].Bit;
+                *(UINT8*)(UINTN)Csm16Data->MiscInfoAddress = MiscInfo;
+            } else {
+                RtCmosByte |= Csm16Feature[i].Bit;
+                *(UINT8*)(UINTN)Csm16Data->RtCmosByteAddress = RtCmosByte;
+            }
+            break;
+
+        case Csm16FeatureReset:
+            if (Csm16Feature[i].InfoByteOfs == 0) {
+                MiscInfo &= ~Csm16Feature[i].Bit;
+                *(UINT8*)(UINTN)Csm16Data->MiscInfoAddress = MiscInfo;
+            } else {
+                RtCmosByte &= ~Csm16Feature[i].Bit;
+                *(UINT8*)(UINTN)Csm16Data->RtCmosByteAddress = RtCmosByte;
+            }
+            break;
+
+        default: ASSERT(FALSE); Status = EFI_INVALID_PARAMETER;
+    }
+
+Done:
+
+    if (!F000WasOpen) {
+        CoreBiosInfo->iRegion->Lock (CoreBiosInfo->iRegion, 0xf0000, 0x10000, &Granularity);
+    }
+
+    return Status;
+}
+
+//****************************************************************************
+//****************************************************************************
+//**                                                                        **
+//**             (C)Copyright 1985-2009, American Megatrends, Inc.          **
+//**                                                                        **
+//**                          All Rights Reserved.                          **
+//**                                                                        **
+//**                  5555 Oakbrook Pkwy, Norcross, GA 30093                **
+//**                                                                        **
+//**                          Phone (770)-246-8600                          **
+//**                                                                        **
+//****************************************************************************
+//****************************************************************************