git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@8025 6f19259b-4bc3-4df7-8a09-765794883524
		
			
				
	
	
		
			141 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			141 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.
 | 
						|
 | 
						|
**/
 | 
						|
VOID
 | 
						|
InitializePciDriverOverrideInstance (
 | 
						|
  PCI_IO_DEVICE  *PciIoDevice
 | 
						|
  )
 | 
						|
{
 | 
						|
  PciIoDevice->PciDriverOverride.GetDriver = GetDriver;
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
  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 != NULL && 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_LOADED_IMAGE_PROTOCOL     *LoadedImage;
 | 
						|
  PE_COFF_LOADER_IMAGE_CONTEXT  ImageContext;
 | 
						|
  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;
 | 
						|
 | 
						|
  ImageContext.Handle    = LoadedImage->ImageBase;
 | 
						|
  ImageContext.ImageRead = PeCoffLoaderImageReadFromMemory;
 | 
						|
 | 
						|
  //
 | 
						|
  // Get information about the image 
 | 
						|
  //
 | 
						|
  Status = PeCoffLoaderGetImageInfo (&ImageContext);
 | 
						|
  if (EFI_ERROR (Status)) {
 | 
						|
    return EFI_SUCCESS;
 | 
						|
  }
 | 
						|
 | 
						|
  if (ImageContext.Machine != EFI_IMAGE_MACHINE_EBC) {
 | 
						|
    return EFI_SUCCESS;
 | 
						|
  }
 | 
						|
 | 
						|
  return EFI_SUCCESS;
 | 
						|
}
 | 
						|
 |