Fix one bug in PeiMain to make it output correct ImageStartAddress. And in DxeIplX64P...

[mirror_edk2.git] / EdkModulePkg / Core / Pei / Image / Image.c

/*++\r
\r
Copyright (c) 2006, Intel Corporation                                                         \r
All rights reserved. This program and the accompanying materials                          \r
are licensed and made available under the terms and conditions of the BSD License         \r
which accompanies this distribution.  The full text of the license may be found at        \r
http://opensource.org/licenses/bsd-license.php                                            \r
                                                                                          \r
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,                     \r
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.             \r
\r
Module Name:\r
\r
  Image.c\r
\r
Abstract:\r
\r
  Pei Core Load Image Support\r
\r
--*/\r
\r
#include <PeiMain.h>\r
\r
\r
\r
EFI_STATUS\r
PeiLoadImage (\r
  IN EFI_PEI_SERVICES         **PeiServices,\r
  IN EFI_FFS_FILE_HEADER      *PeimFileHeader,\r
  OUT VOID                    **EntryPoint\r
  )\r
/*++\r
\r
Routine Description:\r
\r
  Routine for loading file image.\r
\r
Arguments:\r
\r
  PeiServices     - The PEI core services table.\r
  PeimFileHeader  - Pointer to the FFS file header of the image.\r
  EntryPoint      - Pointer to entry point of specified image file for output.\r
\r
Returns:\r
\r
  Status - EFI_SUCCESS    - Image is successfully loaded.\r
           EFI_NOT_FOUND  - Fail to locate necessary PPI\r
           Others         - Fail to load file.\r
\r
--*/\r
{\r
  EFI_STATUS                  Status;\r
  VOID                        *Pe32Data;\r
  EFI_PEI_FV_FILE_LOADER_PPI  *FvLoadFilePpi;\r
  EFI_PHYSICAL_ADDRESS        ImageAddress;\r
  UINT64                      ImageSize;\r
  EFI_PHYSICAL_ADDRESS        ImageEntryPoint;\r
  EFI_TE_IMAGE_HEADER         *TEImageHeader;\r
\r
  *EntryPoint   = NULL;\r
  TEImageHeader = NULL;\r
\r
  //\r
  // Try to find a PE32 section.\r
  //\r
  Status = PeiServicesFfsFindSectionData (\r
             EFI_SECTION_PE32,\r
             PeimFileHeader,\r
             &Pe32Data\r
             );\r
  //\r
  // If we didn't find a PE32 section, try to find a TE section.\r
  //\r
  if (EFI_ERROR (Status)) {\r
    Status = PeiServicesFfsFindSectionData (\r
               EFI_SECTION_TE,\r
               PeimFileHeader,\r
               (VOID **) &TEImageHeader\r
               );\r
    if (EFI_ERROR (Status) || TEImageHeader == NULL) {\r
      //\r
      // There was not a PE32 or a TE section, so assume that it's a Compressed section\r
      // and use the LoadFile\r
      //\r
      Status = PeiServicesLocatePpi (\r
                &gEfiPeiFvFileLoaderPpiGuid,\r
                0,\r
                NULL,\r
                (VOID **)&FvLoadFilePpi\r
                );\r
      if (EFI_ERROR (Status)) {\r
        return EFI_NOT_FOUND;\r
      }\r
\r
      Status = FvLoadFilePpi->FvLoadFile (\r
                                FvLoadFilePpi,\r
                                PeimFileHeader,\r
                                &ImageAddress,\r
                                &ImageSize,\r
                                &ImageEntryPoint\r
                                );\r
\r
      if (EFI_ERROR (Status)) {\r
        return EFI_NOT_FOUND;\r
      }\r
\r
      //\r
      // Got the entry point from ImageEntryPoint\r
      //\r
      *EntryPoint = (VOID *) ((UINTN) ImageEntryPoint);\r
      return EFI_SUCCESS;\r
    } else {\r
      //\r
      // Retrieve the entry point from the TE image header\r
      //\r
      ImageAddress = (EFI_PHYSICAL_ADDRESS) (UINTN) TEImageHeader;\r
      *EntryPoint = (VOID *)((UINTN) TEImageHeader + sizeof (EFI_TE_IMAGE_HEADER) +\r
                    TEImageHeader->AddressOfEntryPoint - TEImageHeader->StrippedSize);\r
    }\r
  } else {\r
    //\r
    // Retrieve the entry point from the PE/COFF image header\r
    //\r
    ImageAddress = (EFI_PHYSICAL_ADDRESS) (UINTN) Pe32Data;\r
    Status = PeCoffLoaderGetEntryPoint (Pe32Data, EntryPoint);\r
    if (EFI_ERROR (Status)) {\r
      return EFI_NOT_FOUND;\r
    }\r
  }\r
\r
  //\r
  // Print debug message: Loading PEIM at 0x12345678 EntryPoint=0x12345688 Driver.efi\r
  //\r
  DEBUG ((EFI_D_INFO | EFI_D_LOAD, "Loading PEIM at 0x%08x EntryPoint=0x%08x ", (UINTN) ImageAddress, *EntryPoint));\r
  DEBUG_CODE_BEGIN ();\r
    EFI_IMAGE_DATA_DIRECTORY            *DirectoryEntry;\r
    EFI_IMAGE_DEBUG_DIRECTORY_ENTRY     *DebugEntry;\r
    UINTN                               DirCount;\r
    UINTN                               Index;\r
    UINTN                               Index1;\r
    BOOLEAN                             FileNameFound;\r
    CHAR8                               *AsciiString;\r
    CHAR8                               AsciiBuffer[512];\r
    VOID                                *CodeViewEntryPointer;\r
    INTN                                TEImageAdjust;\r
    EFI_IMAGE_DOS_HEADER                *DosHeader;\r
    EFI_IMAGE_OPTIONAL_HEADER_PTR_UNION Hdr;\r
    UINT32                              NumberOfRvaAndSizes;\r
\r
    Hdr.Pe32 = NULL;\r
    if (TEImageHeader == NULL) {\r
      DosHeader = (EFI_IMAGE_DOS_HEADER *)Pe32Data;\r
      if (DosHeader->e_magic == EFI_IMAGE_DOS_SIGNATURE) {\r
        //\r
        // DOS image header is present, so read the PE header after the DOS image header\r
        //\r
        Hdr.Pe32 = (EFI_IMAGE_NT_HEADERS32 *)((UINTN)Pe32Data + (UINTN)((DosHeader->e_lfanew) & 0x0ffff));\r
      } else {\r
        //\r
        // DOS image header is not present, so PE header is at the image base\r
        //\r
        Hdr.Pe32 = (EFI_IMAGE_NT_HEADERS32 *)Pe32Data;\r
      }\r
    }\r
\r
    //\r
    // Find the codeview info in the image and display the file name\r
    // being loaded.\r
    //\r
    // Per the PE/COFF spec, you can't assume that a given data directory\r
    // is present in the image. You have to check the NumberOfRvaAndSizes in\r
    // the optional header to verify a desired directory entry is there.\r
    //\r
    DebugEntry      = NULL;\r
    DirectoryEntry  = NULL;\r
    TEImageAdjust   = 0;\r
    if (TEImageHeader == NULL) {\r
      if (Hdr.Pe32->OptionalHeader.Magic == EFI_IMAGE_NT_OPTIONAL_HDR32_MAGIC) {\r
        //     \r
        // Use PE32 offset\r
        //\r
        NumberOfRvaAndSizes = Hdr.Pe32->OptionalHeader.NumberOfRvaAndSizes;\r
        DirectoryEntry = (EFI_IMAGE_DATA_DIRECTORY *)&(Hdr.Pe32->OptionalHeader.DataDirectory[EFI_IMAGE_DIRECTORY_ENTRY_DEBUG]);\r
      } else {\r
        //     \r
        // Use PE32+ offset\r
        //\r
        NumberOfRvaAndSizes = Hdr.Pe32Plus->OptionalHeader.NumberOfRvaAndSizes;\r
        DirectoryEntry = (EFI_IMAGE_DATA_DIRECTORY *)&(Hdr.Pe32Plus->OptionalHeader.DataDirectory[EFI_IMAGE_DIRECTORY_ENTRY_DEBUG]);\r
      }    \r
\r
      if (NumberOfRvaAndSizes <= EFI_IMAGE_DIRECTORY_ENTRY_DEBUG) {\r
        DirectoryEntry = NULL;\r
        DebugEntry = NULL;\r
      }\r
    } else {\r
      if (TEImageHeader->DataDirectory[EFI_TE_IMAGE_DIRECTORY_ENTRY_DEBUG].VirtualAddress != 0) {\r
        DirectoryEntry  = &TEImageHeader->DataDirectory[EFI_TE_IMAGE_DIRECTORY_ENTRY_DEBUG];\r
        TEImageAdjust   = sizeof (EFI_TE_IMAGE_HEADER) - TEImageHeader->StrippedSize;\r
        DebugEntry = (EFI_IMAGE_DEBUG_DIRECTORY_ENTRY *)((UINTN) TEImageHeader +\r
                      TEImageHeader->DataDirectory[EFI_TE_IMAGE_DIRECTORY_ENTRY_DEBUG].VirtualAddress +\r
                      TEImageAdjust);\r
      }\r
    }\r
\r
    if (DebugEntry != NULL && DirectoryEntry != NULL) {\r
      for (DirCount = 0; DirCount < DirectoryEntry->Size; DirCount++, DebugEntry++) {\r
        if (DebugEntry->Type == EFI_IMAGE_DEBUG_TYPE_CODEVIEW) {\r
          if (DebugEntry->SizeOfData > 0) {\r
            CodeViewEntryPointer = (VOID *) ((UINTN) DebugEntry->RVA + (UINTN) ImageAddress + (UINTN)TEImageAdjust);\r
            switch (* (UINT32 *) CodeViewEntryPointer) {\r
              case CODEVIEW_SIGNATURE_NB10:\r
                AsciiString = (CHAR8 *)CodeViewEntryPointer + sizeof (EFI_IMAGE_DEBUG_CODEVIEW_NB10_ENTRY);\r
                break;\r
\r
              case CODEVIEW_SIGNATURE_RSDS:\r
                AsciiString = (CHAR8 *)CodeViewEntryPointer + sizeof (EFI_IMAGE_DEBUG_CODEVIEW_RSDS_ENTRY);\r
                break;\r
\r
              default:\r
                AsciiString = NULL;\r
                break;\r
            }\r
            if (AsciiString != NULL) {\r
              FileNameFound = FALSE;\r
              for (Index = 0, Index1 = 0; (AsciiString[Index] != 0) && (Index < sizeof (AsciiString)); Index++) {\r
                if (AsciiString[Index] == '\\') {\r
                  Index1 = Index;\r
                  FileNameFound = TRUE;\r
                }\r
              }\r
\r
              if (FileNameFound) {\r
                for (Index = Index1 + 1; AsciiString[Index] != '.'; Index++) {\r
                  AsciiBuffer[Index - (Index1 + 1)] = AsciiString[Index];\r
                }\r
                AsciiBuffer[Index - (Index1 + 1)] = 0;\r
                DEBUG ((EFI_D_INFO | EFI_D_LOAD, "%a.efi", AsciiBuffer));\r
                break;\r
              }\r
            }\r
          }\r
        }\r
      }\r
    }\r
  DEBUG_CODE_END ();\r
\r
  DEBUG ((EFI_D_INFO | EFI_D_LOAD, "\n"));\r
\r
  return EFI_SUCCESS;\r
}\r