mirror of https://github.com/acidanthera/audk.git
139 lines
4.1 KiB
C
139 lines
4.1 KiB
C
/**@file
|
|
|
|
Copyright (c) 2006, Intel Corporation
|
|
All rights reserved. This program and the accompanying materials
|
|
are licensed and made available under the terms and conditions of the BSD License
|
|
which accompanies this distribution. The full text of the license may be found at
|
|
http://opensource.org/licenses/bsd-license.php
|
|
|
|
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
|
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
|
|
|
**/
|
|
|
|
|
|
#include "pcibus.h"
|
|
|
|
/**
|
|
Initializes a PCI Driver Override Instance
|
|
|
|
@param PciIoDevice Device instance
|
|
|
|
@retval EFI_SUCCESS Operation success
|
|
**/
|
|
EFI_STATUS
|
|
InitializePciDriverOverrideInstance (
|
|
PCI_IO_DEVICE *PciIoDevice
|
|
)
|
|
{
|
|
PciIoDevice->PciDriverOverride.GetDriver = GetDriver;
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
Get a overriding driver image
|
|
@param This Pointer to instance of EFI_BUS_SPECIFIC_DRIVER_OVERRIDE_PROTOCOL
|
|
@param DriverImageHandle Override driver image,
|
|
|
|
@retval EFI_SUCCESS Success to get driver image handle
|
|
@retval EFI_NOT_FOUND can not find override driver image
|
|
@retval EFI_INVALID_PARAMETER Invalid parameter
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
GetDriver (
|
|
IN EFI_BUS_SPECIFIC_DRIVER_OVERRIDE_PROTOCOL *This,
|
|
IN OUT EFI_HANDLE *DriverImageHandle
|
|
)
|
|
{
|
|
PCI_IO_DEVICE *PciIoDevice;
|
|
LIST_ENTRY *CurrentLink;
|
|
PCI_DRIVER_OVERRIDE_LIST *Node;
|
|
|
|
PciIoDevice = PCI_IO_DEVICE_FROM_PCI_DRIVER_OVERRIDE_THIS (This);
|
|
|
|
CurrentLink = PciIoDevice->OptionRomDriverList.ForwardLink;
|
|
|
|
while (CurrentLink && CurrentLink != &PciIoDevice->OptionRomDriverList) {
|
|
|
|
Node = DRIVER_OVERRIDE_FROM_LINK (CurrentLink);
|
|
|
|
if (*DriverImageHandle == NULL) {
|
|
|
|
*DriverImageHandle = Node->DriverImageHandle;
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
if (*DriverImageHandle == Node->DriverImageHandle) {
|
|
|
|
if (CurrentLink->ForwardLink == &PciIoDevice->OptionRomDriverList ||
|
|
CurrentLink->ForwardLink == NULL) {
|
|
return EFI_NOT_FOUND;
|
|
}
|
|
|
|
//
|
|
// Get next node
|
|
//
|
|
Node = DRIVER_OVERRIDE_FROM_LINK (CurrentLink->ForwardLink);
|
|
*DriverImageHandle = Node->DriverImageHandle;
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
CurrentLink = CurrentLink->ForwardLink;
|
|
}
|
|
|
|
return EFI_INVALID_PARAMETER;
|
|
}
|
|
|
|
/**
|
|
Add an overriding driver image
|
|
|
|
@param PciIoDevice Instance of PciIo device
|
|
@param DriverImageHandle new added driver image
|
|
|
|
@retval EFI_OUT_OF_RESOURCES no memory resource for new driver instance
|
|
@retval EFI_SUCCESS Success add driver
|
|
**/
|
|
EFI_STATUS
|
|
AddDriver (
|
|
IN PCI_IO_DEVICE *PciIoDevice,
|
|
IN EFI_HANDLE DriverImageHandle
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
EFI_IMAGE_DOS_HEADER *DosHdr;
|
|
EFI_IMAGE_NT_HEADERS *PeHdr;
|
|
EFI_LOADED_IMAGE_PROTOCOL *LoadedImage;
|
|
PCI_DRIVER_OVERRIDE_LIST *Node;
|
|
|
|
Status = gBS->HandleProtocol (DriverImageHandle, &gEfiLoadedImageProtocolGuid, (VOID **) &LoadedImage);
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
|
|
Node = AllocatePool (sizeof (PCI_DRIVER_OVERRIDE_LIST));
|
|
if (Node == NULL) {
|
|
return EFI_OUT_OF_RESOURCES;
|
|
}
|
|
|
|
Node->Signature = DRIVER_OVERRIDE_SIGNATURE;
|
|
Node->DriverImageHandle = DriverImageHandle;
|
|
|
|
InsertTailList (&PciIoDevice->OptionRomDriverList, &(Node->Link));
|
|
|
|
PciIoDevice->BusOverride = TRUE;
|
|
|
|
DosHdr = (EFI_IMAGE_DOS_HEADER *) LoadedImage->ImageBase;
|
|
if (DosHdr->e_magic != EFI_IMAGE_DOS_SIGNATURE) {
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
PeHdr = (EFI_IMAGE_NT_HEADERS *) ((UINTN) LoadedImage->ImageBase + DosHdr->e_lfanew);
|
|
|
|
if (PeHdr->FileHeader.Machine != EFI_IMAGE_MACHINE_EBC) {
|
|
return EFI_SUCCESS;
|
|
}
|
|
return EFI_SUCCESS;
|
|
}
|
|
|