[mirror_edk2.git] / OvmfPkg / Library / LoadLinuxLib / Linux.c

/** @file\r
\r
  Copyright (c) 2011 - 2013, Intel Corporation. All rights reserved.<BR>\r
\r
  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
**/\r
\r
#include "LoadLinuxLib.h"\r
\r
\r
/**\r
  A simple check of the kernel setup image\r
\r
  An assumption is made that the size of the data is at least the\r
  size of struct boot_params.\r
\r
  @param[in]    KernelSetup - The kernel setup image\r
\r
  @retval    EFI_SUCCESS - The kernel setup looks valid and supported\r
  @retval    EFI_INVALID_PARAMETER - KernelSetup was NULL\r
  @retval    EFI_UNSUPPORTED - The kernel setup is not valid or supported\r
\r
**/\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
BasicKernelSetupCheck (\r
  IN VOID        *KernelSetup\r
  )\r
{\r
  return LoadLinuxCheckKernelSetup(KernelSetup, sizeof (struct boot_params));\r
}\r
\r
\r
EFI_STATUS\r
EFIAPI\r
LoadLinuxCheckKernelSetup (\r
  IN VOID        *KernelSetup,\r
  IN UINTN       KernelSetupSize\r
  )\r
{\r
  struct boot_params        *Bp;\r
\r
  if (KernelSetup == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (KernelSetupSize < sizeof (*Bp)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  Bp = (struct boot_params*) KernelSetup;\r
\r
  if ((Bp->hdr.signature != 0xAA55) || // Check boot sector signature\r
      (Bp->hdr.header != SETUP_HDR) ||\r
      (Bp->hdr.version < 0x205) || // We only support relocatable kernels\r
      (!Bp->hdr.relocatable_kernel)\r
     ) {\r
    return EFI_UNSUPPORTED;\r
  } else {\r
    return EFI_SUCCESS;\r
  }\r
}\r
\r
\r
UINTN\r
EFIAPI\r
LoadLinuxGetKernelSize (\r
  IN VOID        *KernelSetup,\r
  IN UINTN       KernelSize\r
  )\r
{\r
  struct boot_params        *Bp;\r
\r
  if (EFI_ERROR (BasicKernelSetupCheck (KernelSetup))) {\r
    return 0;\r
  }\r
\r
  Bp = (struct boot_params*) KernelSetup;\r
\r
  if (Bp->hdr.version > 0x20a) {\r
    return Bp->hdr.init_size;\r
  } else {\r
    //\r
    // Add extra size for kernel decompression\r
    //\r
    return 3 * KernelSize;\r
  }\r
}\r
\r
\r
VOID*\r
EFIAPI\r
LoadLinuxAllocateKernelSetupPages (\r
  IN UINTN                  Pages\r
  )\r
{\r
  EFI_STATUS                Status;\r
  EFI_PHYSICAL_ADDRESS      Address;\r
\r
  Address = BASE_1GB;\r
  Status = gBS->AllocatePages (\r
                  AllocateMaxAddress,\r
                  EfiLoaderData,\r
                  Pages,\r
                  &Address\r
                  );\r
  if (!EFI_ERROR (Status)) {\r
    return (VOID*)(UINTN) Address;\r
  } else {\r
    return NULL;\r
  }\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
LoadLinuxInitializeKernelSetup (\r
  IN VOID        *KernelSetup\r
  )\r
{\r
  EFI_STATUS                Status;\r
  UINTN                     SetupEnd;\r
  struct boot_params        *Bp;\r
\r
  Status = BasicKernelSetupCheck (KernelSetup);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Bp = (struct boot_params*) KernelSetup;\r
\r
  SetupEnd = 0x202 + (Bp->hdr.jump & 0xff);\r
\r
  //\r
  // Clear all but the setup_header\r
  //\r
  ZeroMem (KernelSetup, 0x1f1);\r
  ZeroMem (((UINT8 *)KernelSetup) + SetupEnd, 4096 - SetupEnd);\r
  DEBUG ((EFI_D_INFO, "Cleared kernel setup 0-0x1f1, 0x%x-0x1000\n", SetupEnd));\r
\r
  return EFI_SUCCESS;\r
}\r
\r
VOID*\r
EFIAPI\r
LoadLinuxAllocateKernelPages (\r
  IN VOID                   *KernelSetup,\r
  IN UINTN                  Pages\r
  )\r
{\r
  EFI_STATUS                Status;\r
  EFI_PHYSICAL_ADDRESS      KernelAddress;\r
  UINT32                    Loop;\r
  struct boot_params        *Bp;\r
\r
  if (EFI_ERROR (BasicKernelSetupCheck (KernelSetup))) {\r
    return NULL;\r
  }\r
\r
  Bp = (struct boot_params*) KernelSetup;\r
\r
  for (Loop = 1; Loop < 512; Loop++) {\r
    KernelAddress = MultU64x32 (\r
                      2 * Bp->hdr.kernel_alignment,\r
                      Loop\r
                      );\r
    Status = gBS->AllocatePages (\r
                    AllocateAddress,\r
                    EfiLoaderData,\r
                    Pages,\r
                    &KernelAddress\r
                    );\r
    if (!EFI_ERROR (Status)) {\r
      return (VOID*)(UINTN) KernelAddress;\r
    }\r
  }\r
\r
  return NULL;\r
}\r
\r
\r
VOID*\r
EFIAPI\r
LoadLinuxAllocateCommandLinePages (\r
  IN UINTN                  Pages\r
  )\r
{\r
  EFI_STATUS                Status;\r
  EFI_PHYSICAL_ADDRESS      Address;\r
\r
  Address = 0xa0000;\r
  Status = gBS->AllocatePages (\r
                  AllocateMaxAddress,\r
                  EfiLoaderData,\r
                  Pages,\r
                  &Address\r
                  );\r
  if (!EFI_ERROR (Status)) {\r
    return (VOID*)(UINTN) Address;\r
  } else {\r
    return NULL;\r
  }\r
}\r
\r
\r
VOID*\r
EFIAPI\r
LoadLinuxAllocateInitrdPages (\r
  IN VOID                   *KernelSetup,\r
  IN UINTN                  Pages\r
  )\r
{\r
  EFI_STATUS                Status;\r
  EFI_PHYSICAL_ADDRESS      Address;\r
\r
  struct boot_params        *Bp;\r
\r
  if (EFI_ERROR (BasicKernelSetupCheck (KernelSetup))) {\r
    return NULL;\r
  }\r
\r
  Bp = (struct boot_params*) KernelSetup;\r
\r
  Address = (EFI_PHYSICAL_ADDRESS)(UINTN) Bp->hdr.ramdisk_max;\r
  Status = gBS->AllocatePages (\r
                  AllocateMaxAddress,\r
                  EfiLoaderData,\r
                  Pages,\r
                  &Address\r
                  );\r
  if (!EFI_ERROR (Status)) {\r
    return (VOID*)(UINTN) Address;\r
  } else {\r
    return NULL;\r
  }\r
}\r
\r
\r
STATIC\r
VOID\r
SetupLinuxMemmap (\r
  IN OUT struct boot_params        *Bp\r
  )\r
{\r
  EFI_STATUS                           Status;\r
  UINT8                                TmpMemoryMap[1];\r
  UINTN                                MapKey;\r
  UINTN                                DescriptorSize;\r
  UINT32                               DescriptorVersion;\r
  UINTN                                MemoryMapSize;\r
  EFI_MEMORY_DESCRIPTOR                *MemoryMap;\r
  EFI_MEMORY_DESCRIPTOR                *MemoryMapPtr;\r
  UINTN                                Index;\r
  struct efi_info                      *Efi;\r
  struct e820_entry                    *LastE820;\r
  struct e820_entry                    *E820;\r
  UINTN                                E820EntryCount;\r
  EFI_PHYSICAL_ADDRESS                 LastEndAddr;\r
\r
  //\r
  // Get System MemoryMapSize\r
  //\r
  MemoryMapSize = sizeof (TmpMemoryMap);\r
  Status = gBS->GetMemoryMap (\r
                  &MemoryMapSize,\r
                  (EFI_MEMORY_DESCRIPTOR *)TmpMemoryMap,\r
                  &MapKey,\r
                  &DescriptorSize,\r
                  &DescriptorVersion\r
                  );\r
  ASSERT (Status == EFI_BUFFER_TOO_SMALL);\r
  //\r
  // Enlarge space here, because we will allocate pool now.\r
  //\r
  MemoryMapSize += EFI_PAGE_SIZE;\r
  Status = gBS->AllocatePool (\r
                  EfiLoaderData,\r
                  MemoryMapSize,\r
                  (VOID **) &MemoryMap\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  //\r
  // Get System MemoryMap\r
  //\r
  Status = gBS->GetMemoryMap (\r
                  &MemoryMapSize,\r
                  MemoryMap,\r
                  &MapKey,\r
                  &DescriptorSize,\r
                  &DescriptorVersion\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  LastE820 = NULL;\r
  E820 = &Bp->e820_map[0];\r
  E820EntryCount = 0;\r
  LastEndAddr = 0;\r
  MemoryMapPtr = MemoryMap;\r
  for (Index = 0; Index < (MemoryMapSize / DescriptorSize); Index++) {\r
    UINTN E820Type = 0;\r
\r
    if (MemoryMap->NumberOfPages == 0) {\r
      continue;\r
    }\r
\r
    switch(MemoryMap->Type) {\r
    case EfiReservedMemoryType:\r
    case EfiRuntimeServicesCode:\r
    case EfiRuntimeServicesData:\r
    case EfiMemoryMappedIO:\r
    case EfiMemoryMappedIOPortSpace:\r
    case EfiPalCode:\r
      E820Type = E820_RESERVED;\r
      break;\r
\r
    case EfiUnusableMemory:\r
      E820Type = E820_UNUSABLE;\r
      break;\r
\r
    case EfiACPIReclaimMemory:\r
      E820Type = E820_ACPI;\r
      break;\r
\r
    case EfiLoaderCode:\r
    case EfiLoaderData:\r
    case EfiBootServicesCode:\r
    case EfiBootServicesData:\r
    case EfiConventionalMemory:\r
      E820Type = E820_RAM;\r
      break;\r
\r
    case EfiACPIMemoryNVS:\r
      E820Type = E820_NVS;\r
      break;\r
\r
    default:\r
      DEBUG ((\r
        EFI_D_ERROR,\r
        "Invalid EFI memory descriptor type (0x%x)!\n",\r
        MemoryMap->Type\r
        ));\r
      continue;\r
    }\r
\r
    if ((LastE820 != NULL) &&\r
        (LastE820->type == (UINT32) E820Type) &&\r
        (MemoryMap->PhysicalStart == LastEndAddr)) {\r
      LastE820->size += EFI_PAGES_TO_SIZE ((UINTN) MemoryMap->NumberOfPages);\r
      LastEndAddr += EFI_PAGES_TO_SIZE ((UINTN) MemoryMap->NumberOfPages);\r
    } else {\r
      if (E820EntryCount >= (sizeof (Bp->e820_map) / sizeof (Bp->e820_map[0]))) {\r
        break;\r
      }\r
      E820->type = (UINT32) E820Type;\r
      E820->addr = MemoryMap->PhysicalStart;\r
      E820->size = EFI_PAGES_TO_SIZE ((UINTN) MemoryMap->NumberOfPages);\r
      LastE820 = E820;\r
      LastEndAddr = E820->addr + E820->size;\r
      E820++;\r
      E820EntryCount++;\r
    }\r
\r
    //\r
    // Get next item\r
    //\r
    MemoryMap = (EFI_MEMORY_DESCRIPTOR *)((UINTN)MemoryMap + DescriptorSize);\r
  }\r
  Bp->e820_entries = (UINT8) E820EntryCount;\r
\r
  Efi = &Bp->efi_info;\r
  Efi->efi_systab = (UINT32)(UINTN) gST;\r
  Efi->efi_memdesc_size = (UINT32) DescriptorSize;\r
  Efi->efi_memdesc_version = DescriptorVersion;\r
  Efi->efi_memmap = (UINT32)(UINTN) MemoryMapPtr;\r
  Efi->efi_memmap_size = (UINT32) MemoryMapSize;\r
#ifdef MDE_CPU_IA32\r
  Efi->efi_loader_signature = SIGNATURE_32 ('E', 'L', '3', '2');\r
#else\r
  Efi->efi_systab_hi = ((UINT64)(UINTN) gST) >> 32;\r
  Efi->efi_memmap_hi = ((UINT64)(UINTN) MemoryMapPtr) >> 32;\r
  Efi->efi_loader_signature = SIGNATURE_32 ('E', 'L', '6', '4');\r
#endif\r
\r
  gBS->ExitBootServices (gImageHandle, MapKey);\r
}\r
\r
\r
EFI_STATUS\r
EFIAPI\r
LoadLinuxSetCommandLine (\r
  IN OUT VOID    *KernelSetup,\r
  IN CHAR8       *CommandLine\r
  )\r
{\r
  EFI_STATUS             Status;\r
  struct boot_params     *Bp;\r
\r
  Status = BasicKernelSetupCheck (KernelSetup);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Bp = (struct boot_params*) KernelSetup;\r
\r
  Bp->hdr.cmd_line_ptr = (UINT32)(UINTN) CommandLine;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
EFI_STATUS\r
EFIAPI\r
LoadLinuxSetInitrd (\r
  IN OUT VOID    *KernelSetup,\r
  IN VOID        *Initrd,\r
  IN UINTN       InitrdSize\r
  )\r
{\r
  EFI_STATUS             Status;\r
  struct boot_params     *Bp;\r
\r
  Status = BasicKernelSetupCheck (KernelSetup);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Bp = (struct boot_params*) KernelSetup;\r
\r
  Bp->hdr.ramdisk_start = (UINT32)(UINTN) Initrd;\r
  Bp->hdr.ramdisk_len = (UINT32) InitrdSize;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
STATIC VOID\r
FindBits (\r
  unsigned long Mask,\r
  UINT8 *Pos,\r
  UINT8 *Size\r
  )\r
{\r
  UINT8 First, Len;\r
\r
  First = 0;\r
  Len = 0;\r
\r
  if (Mask) {\r
    while (!(Mask & 0x1)) {\r
      Mask = Mask >> 1;\r
      First++;\r
    }\r
\r
    while (Mask & 0x1) {\r
      Mask = Mask >> 1;\r
      Len++;\r
    }\r
  }\r
  *Pos = First;\r
  *Size = Len;\r
}\r
\r
\r
STATIC\r
EFI_STATUS\r
SetupGraphicsFromGop (\r
  struct screen_info           *Si,\r
  EFI_GRAPHICS_OUTPUT_PROTOCOL *Gop\r
  )\r
{\r
  EFI_GRAPHICS_OUTPUT_MODE_INFORMATION *Info;\r
  EFI_STATUS                           Status;\r
  UINTN                                Size;\r
\r
  Status = Gop->QueryMode(Gop, Gop->Mode->Mode, &Size, &Info);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  /* We found a GOP */\r
\r
  /* EFI framebuffer */\r
  Si->orig_video_isVGA = 0x70;\r
\r
  Si->orig_x = 0;\r
  Si->orig_y = 0;\r
  Si->orig_video_page = 0;\r
  Si->orig_video_mode = 0;\r
  Si->orig_video_cols = 0;\r
  Si->orig_video_lines = 0;\r
  Si->orig_video_ega_bx = 0;\r
  Si->orig_video_points = 0;\r
\r
  Si->lfb_base = (UINT32) Gop->Mode->FrameBufferBase;\r
  Si->lfb_size = (UINT32) Gop->Mode->FrameBufferSize;\r
  Si->lfb_width = (UINT16) Info->HorizontalResolution;\r
  Si->lfb_height = (UINT16) Info->VerticalResolution;\r
  Si->pages = 1;\r
  Si->vesapm_seg = 0;\r
  Si->vesapm_off = 0;\r
\r
  if (Info->PixelFormat == PixelRedGreenBlueReserved8BitPerColor) {\r
    Si->lfb_depth = 32;\r
    Si->red_size = 8;\r
    Si->red_pos = 0;\r
    Si->green_size = 8;\r
    Si->green_pos = 8;\r
    Si->blue_size = 8;\r
    Si->blue_pos = 16;\r
    Si->rsvd_size = 8;\r
    Si->rsvd_pos = 24;\r
    Si->lfb_linelength = (UINT16) (Info->PixelsPerScanLine * 4);\r
\r
  } else if (Info->PixelFormat == PixelBlueGreenRedReserved8BitPerColor) {\r
    Si->lfb_depth = 32;\r
    Si->red_size = 8;\r
    Si->red_pos = 16;\r
    Si->green_size = 8;\r
    Si->green_pos = 8;\r
    Si->blue_size = 8;\r
    Si->blue_pos = 0;\r
    Si->rsvd_size = 8;\r
    Si->rsvd_pos = 24;\r
    Si->lfb_linelength = (UINT16) (Info->PixelsPerScanLine * 4);\r
  } else if (Info->PixelFormat == PixelBitMask) {\r
    FindBits(Info->PixelInformation.RedMask,\r
        &Si->red_pos, &Si->red_size);\r
    FindBits(Info->PixelInformation.GreenMask,\r
        &Si->green_pos, &Si->green_size);\r
    FindBits(Info->PixelInformation.BlueMask,\r
        &Si->blue_pos, &Si->blue_size);\r
    FindBits(Info->PixelInformation.ReservedMask,\r
        &Si->rsvd_pos, &Si->rsvd_size);\r
    Si->lfb_depth = Si->red_size + Si->green_size +\r
      Si->blue_size + Si->rsvd_size;\r
    Si->lfb_linelength = (UINT16) ((Info->PixelsPerScanLine * Si->lfb_depth) / 8);\r
  } else {\r
    Si->lfb_depth = 4;\r
    Si->red_size = 0;\r
    Si->red_pos = 0;\r
    Si->green_size = 0;\r
    Si->green_pos = 0;\r
    Si->blue_size = 0;\r
    Si->blue_pos = 0;\r
    Si->rsvd_size = 0;\r
    Si->rsvd_pos = 0;\r
    Si->lfb_linelength = Si->lfb_width / 2;\r
  }\r
\r
  return Status;\r
}\r
\r
\r
STATIC\r
EFI_STATUS\r
SetupGraphics (\r
  IN OUT struct boot_params *Bp\r
  )\r
{\r
  EFI_STATUS                      Status;\r
  EFI_HANDLE                      *HandleBuffer;\r
  UINTN                           HandleCount;\r
  UINTN                           Index;\r
  EFI_GRAPHICS_OUTPUT_PROTOCOL    *Gop;\r
\r
  ZeroMem ((VOID*)&Bp->screen_info, sizeof(Bp->screen_info));\r
\r
  Status = gBS->LocateHandleBuffer (\r
                  ByProtocol,\r
                  &gEfiGraphicsOutputProtocolGuid,\r
                  NULL,\r
                  &HandleCount,\r
                  &HandleBuffer\r
                  );\r
  if (!EFI_ERROR (Status)) {\r
    for (Index = 0; Index < HandleCount; Index++) {\r
      Status = gBS->HandleProtocol (\r
                      HandleBuffer[Index],\r
                      &gEfiGraphicsOutputProtocolGuid,\r
                      (VOID*) &Gop\r
                      );\r
      if (EFI_ERROR (Status)) {\r
        continue;\r
      }\r
\r
      Status = SetupGraphicsFromGop (&Bp->screen_info, Gop);\r
      if (!EFI_ERROR (Status)) {\r
        FreePool (HandleBuffer);\r
        return EFI_SUCCESS;\r
      }\r
    }\r
\r
    FreePool (HandleBuffer);\r
  }\r
\r
  return EFI_NOT_FOUND;\r
}\r
\r
\r
STATIC\r
EFI_STATUS\r
SetupLinuxBootParams (\r
  IN OUT struct boot_params *Bp\r
  )\r
{\r
  SetupGraphics (Bp);\r
\r
  SetupLinuxMemmap (Bp);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
EFI_STATUS\r
EFIAPI\r
LoadLinux (\r
  IN VOID      *Kernel,\r
  IN OUT VOID  *KernelSetup\r
  )\r
{\r
  EFI_STATUS             Status;\r
  struct boot_params  *Bp;\r
\r
  Status = BasicKernelSetupCheck (KernelSetup);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Bp = (struct boot_params *) KernelSetup;\r
\r
  if (Bp->hdr.version < 0x205 || !Bp->hdr.relocatable_kernel) {\r
    //\r
    // We only support relocatable kernels\r
    //\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  InitLinuxDescriptorTables ();\r
\r
  Bp->hdr.code32_start = (UINT32)(UINTN) Kernel;\r
  if (Bp->hdr.version >= 0x20c && Bp->hdr.handover_offset &&\r
      (Bp->hdr.load_flags & (sizeof (UINTN) == 4 ? BIT2 : BIT3))) {\r
    DEBUG ((EFI_D_INFO, "Jumping to kernel EFI handover point at ofs %x\n", Bp->hdr.handover_offset));\r
\r
    DisableInterrupts ();\r
    JumpToUefiKernel ((VOID*) gImageHandle, (VOID*) gST, KernelSetup, Kernel);\r
  }\r
\r
  //\r
  // Old kernels without EFI handover protocol\r
  //\r
  SetupLinuxBootParams (KernelSetup);\r
\r
  DEBUG ((EFI_D_INFO, "Jumping to kernel\n"));\r
  DisableInterrupts ();\r
  SetLinuxDescriptorTables ();\r
  JumpToKernel (Kernel, (VOID*) KernelSetup);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
Commit	Line	Data
3c0a051f	1	/** @file\r
3c0a051f	2	\r
38851e78	3	Copyright (c) 2011 - 2013, Intel Corporation. All rights reserved.<BR>\r
3c0a051f	4	\r
	5	This program and the accompanying materials\r
	6	are licensed and made available under the terms and conditions of the BSD License\r
	7	which accompanies this distribution. The full text of the license may be found at\r
	8	http://opensource.org/licenses/bsd-license.php\r
	9	\r
	10	THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
	11	WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
	12	\r
	13	**/\r
	14	\r
	15	#include "LoadLinuxLib.h"\r
	16	\r
	17	\r
	18	/**\r
	19	A simple check of the kernel setup image\r
	20	\r
	21	An assumption is made that the size of the data is at least the\r
	22	size of struct boot_params.\r
	23	\r
	24	@param[in] KernelSetup - The kernel setup image\r
	25	\r
	26	@retval EFI_SUCCESS - The kernel setup looks valid and supported\r
	27	@retval EFI_INVALID_PARAMETER - KernelSetup was NULL\r
	28	@retval EFI_UNSUPPORTED - The kernel setup is not valid or supported\r
	29	\r
	30	**/\r
	31	STATIC\r
	32	EFI_STATUS\r
	33	EFIAPI\r
	34	BasicKernelSetupCheck (\r
	35	IN VOID *KernelSetup\r
	36	)\r
	37	{\r
	38	return LoadLinuxCheckKernelSetup(KernelSetup, sizeof (struct boot_params));\r
	39	}\r
	40	\r
	41	\r
	42	EFI_STATUS\r
	43	EFIAPI\r
	44	LoadLinuxCheckKernelSetup (\r
	45	IN VOID *KernelSetup,\r
	46	IN UINTN KernelSetupSize\r
	47	)\r
	48	{\r
	49	struct boot_params *Bp;\r
	50	\r
	51	if (KernelSetup == NULL) {\r
	52	return EFI_INVALID_PARAMETER;\r
	53	}\r
	54	\r
	55	if (KernelSetupSize < sizeof (*Bp)) {\r
	56	return EFI_UNSUPPORTED;\r
	57	}\r
	58	\r
	59	Bp = (struct boot_params*) KernelSetup;\r
	60	\r
	61	if ((Bp->hdr.signature != 0xAA55) \|\| // Check boot sector signature\r
	62	(Bp->hdr.header != SETUP_HDR) \|\|\r
38851e78	63	(Bp->hdr.version < 0x205) \|\| // We only support relocatable kernels\r
38851e78	64	(!Bp->hdr.relocatable_kernel)\r
3c0a051f	65	) {\r
	66	return EFI_UNSUPPORTED;\r
	67	} else {\r
	68	return EFI_SUCCESS;\r
	69	}\r
	70	}\r
	71	\r
	72	\r
	73	UINTN\r
	74	EFIAPI\r
	75	LoadLinuxGetKernelSize (\r
	76	IN VOID *KernelSetup,\r
	77	IN UINTN KernelSize\r
	78	)\r
	79	{\r
	80	struct boot_params *Bp;\r
	81	\r
	82	if (EFI_ERROR (BasicKernelSetupCheck (KernelSetup))) {\r
	83	return 0;\r
	84	}\r
	85	\r
	86	Bp = (struct boot_params*) KernelSetup;\r
	87	\r
	88	if (Bp->hdr.version > 0x20a) {\r
	89	return Bp->hdr.init_size;\r
	90	} else {\r
	91	//\r
	92	// Add extra size for kernel decompression\r
	93	//\r
	94	return 3 * KernelSize;\r
	95	}\r
	96	}\r
	97	\r
	98	\r
	99	VOID*\r
	100	EFIAPI\r
	101	LoadLinuxAllocateKernelSetupPages (\r
	102	IN UINTN Pages\r
	103	)\r
	104	{\r
	105	EFI_STATUS Status;\r
	106	EFI_PHYSICAL_ADDRESS Address;\r
	107	\r
	108	Address = BASE_1GB;\r
	109	Status = gBS->AllocatePages (\r
	110	AllocateMaxAddress,\r
	111	EfiLoaderData,\r
	112	Pages,\r
	113	&Address\r
	114	);\r
	115	if (!EFI_ERROR (Status)) {\r
	116	return (VOID*)(UINTN) Address;\r
	117	} else {\r
	118	return NULL;\r
	119	}\r
	120	}\r
	121	\r
c61a56f2	122	EFI_STATUS\r
	123	EFIAPI\r
	124	LoadLinuxInitializeKernelSetup (\r
	125	IN VOID *KernelSetup\r
	126	)\r
	127	{\r
	128	EFI_STATUS Status;\r
	129	UINTN SetupEnd;\r
	130	struct boot_params *Bp;\r
	131	\r
	132	Status = BasicKernelSetupCheck (KernelSetup);\r
	133	if (EFI_ERROR (Status)) {\r
	134	return Status;\r
	135	}\r
	136	\r
	137	Bp = (struct boot_params*) KernelSetup;\r
	138	\r
	139	SetupEnd = 0x202 + (Bp->hdr.jump & 0xff);\r
	140	\r
	141	//\r
	142	// Clear all but the setup_header\r
	143	//\r
	144	ZeroMem (KernelSetup, 0x1f1);\r
	145	ZeroMem (((UINT8 *)KernelSetup) + SetupEnd, 4096 - SetupEnd);\r
	146	DEBUG ((EFI_D_INFO, "Cleared kernel setup 0-0x1f1, 0x%x-0x1000\n", SetupEnd));\r
	147	\r
	148	return EFI_SUCCESS;\r
	149	}\r
3c0a051f	150	\r
	151	VOID*\r
	152	EFIAPI\r
	153	LoadLinuxAllocateKernelPages (\r
	154	IN VOID *KernelSetup,\r
	155	IN UINTN Pages\r
	156	)\r
	157	{\r
	158	EFI_STATUS Status;\r
	159	EFI_PHYSICAL_ADDRESS KernelAddress;\r
	160	UINT32 Loop;\r
	161	struct boot_params *Bp;\r
	162	\r
	163	if (EFI_ERROR (BasicKernelSetupCheck (KernelSetup))) {\r
	164	return NULL;\r
	165	}\r
	166	\r
	167	Bp = (struct boot_params*) KernelSetup;\r
	168	\r
	169	for (Loop = 1; Loop < 512; Loop++) {\r
	170	KernelAddress = MultU64x32 (\r
	171	2 * Bp->hdr.kernel_alignment,\r
	172	Loop\r
	173	);\r
	174	Status = gBS->AllocatePages (\r
	175	AllocateAddress,\r
	176	EfiLoaderData,\r
	177	Pages,\r
	178	&KernelAddress\r
	179	);\r
	180	if (!EFI_ERROR (Status)) {\r
	181	return (VOID*)(UINTN) KernelAddress;\r
	182	}\r
	183	}\r
	184	\r
	185	return NULL;\r
	186	}\r
	187	\r
	188	\r
	189	VOID*\r
	190	EFIAPI\r
	191	LoadLinuxAllocateCommandLinePages (\r
	192	IN UINTN Pages\r
	193	)\r
	194	{\r
	195	EFI_STATUS Status;\r
	196	EFI_PHYSICAL_ADDRESS Address;\r
	197	\r
	198	Address = 0xa0000;\r
	199	Status = gBS->AllocatePages (\r
	200	AllocateMaxAddress,\r
	201	EfiLoaderData,\r
	202	Pages,\r
	203	&Address\r
	204	);\r
	205	if (!EFI_ERROR (Status)) {\r
	206	return (VOID*)(UINTN) Address;\r
	207	} else {\r
	208	return NULL;\r
	209	}\r
	210	}\r
	211	\r
	212	\r
	213	VOID*\r
214	EFIAPI\r
215	LoadLinuxAllocateInitrdPages (\r
216	IN VOID *KernelSetup,\r
217	IN UINTN Pages\r
218	)\r
219	{\r
220	EFI_STATUS Status;\r
221	EFI_PHYSICAL_ADDRESS Address;\r
222	\r
223	struct boot_params *Bp;\r
224	\r
225	if (EFI_ERROR (BasicKernelSetupCheck (KernelSetup))) {\r
226	return NULL;\r
227	}\r
228	\r
229	Bp = (struct boot_params*) KernelSetup;\r
230	\r
231	Address = (EFI_PHYSICAL_ADDRESS)(UINTN) Bp->hdr.ramdisk_max;\r
232	Status = gBS->AllocatePages (\r
233	AllocateMaxAddress,\r
234	EfiLoaderData,\r
235	Pages,\r
236	&Address\r
237	);\r
238	if (!EFI_ERROR (Status)) {\r
239	return (VOID*)(UINTN) Address;\r
240	} else {\r
241	return NULL;\r
242	}\r
243	}\r
244	\r
245	\r
246	STATIC\r
247	VOID\r
248	SetupLinuxMemmap (\r
249	IN OUT struct boot_params *Bp\r
250	)\r
251	{\r
252	EFI_STATUS Status;\r
253	UINT8 TmpMemoryMap[1];\r
254	UINTN MapKey;\r
255	UINTN DescriptorSize;\r
256	UINT32 DescriptorVersion;\r
257	UINTN MemoryMapSize;\r
258	EFI_MEMORY_DESCRIPTOR *MemoryMap;\r
259	EFI_MEMORY_DESCRIPTOR *MemoryMapPtr;\r
260	UINTN Index;\r
261	struct efi_info *Efi;\r
262	struct e820_entry *LastE820;\r
263	struct e820_entry *E820;\r
264	UINTN E820EntryCount;\r
265	EFI_PHYSICAL_ADDRESS LastEndAddr;\r
266	\r
267	//\r
268	// Get System MemoryMapSize\r
269	//\r
270	MemoryMapSize = sizeof (TmpMemoryMap);\r
271	Status = gBS->GetMemoryMap (\r
272	&MemoryMapSize,\r
273	(EFI_MEMORY_DESCRIPTOR *)TmpMemoryMap,\r
274	&MapKey,\r
275	&DescriptorSize,\r
276	&DescriptorVersion\r
277	);\r
278	ASSERT (Status == EFI_BUFFER_TOO_SMALL);\r
279	//\r
280	// Enlarge space here, because we will allocate pool now.\r
281	//\r
282	MemoryMapSize += EFI_PAGE_SIZE;\r
4388b0ee LE	283	Status = gBS->AllocatePool (\r
	284	EfiLoaderData,\r
	285	MemoryMapSize,\r
	286	(VOID **) &MemoryMap\r
	287	);\r
	288	ASSERT_EFI_ERROR (Status);\r
3c0a051f	289	\r
	290	//\r
	291	// Get System MemoryMap\r
	292	//\r
	293	Status = gBS->GetMemoryMap (\r
	294	&MemoryMapSize,\r
	295	MemoryMap,\r
	296	&MapKey,\r
	297	&DescriptorSize,\r
	298	&DescriptorVersion\r
	299	);\r
	300	ASSERT_EFI_ERROR (Status);\r
	301	\r
	302	LastE820 = NULL;\r
	303	E820 = &Bp->e820_map[0];\r
	304	E820EntryCount = 0;\r
	305	LastEndAddr = 0;\r
	306	MemoryMapPtr = MemoryMap;\r
	307	for (Index = 0; Index < (MemoryMapSize / DescriptorSize); Index++) {\r
	308	UINTN E820Type = 0;\r
	309	\r
	310	if (MemoryMap->NumberOfPages == 0) {\r
	311	continue;\r
	312	}\r
	313	\r
	314	switch(MemoryMap->Type) {\r
	315	case EfiReservedMemoryType:\r
	316	case EfiRuntimeServicesCode:\r
	317	case EfiRuntimeServicesData:\r
	318	case EfiMemoryMappedIO:\r
	319	case EfiMemoryMappedIOPortSpace:\r
	320	case EfiPalCode:\r
	321	E820Type = E820_RESERVED;\r
	322	break;\r
	323	\r
	324	case EfiUnusableMemory:\r
	325	E820Type = E820_UNUSABLE;\r
	326	break;\r
	327	\r
	328	case EfiACPIReclaimMemory:\r
	329	E820Type = E820_ACPI;\r
	330	break;\r
	331	\r
	332	case EfiLoaderCode:\r
	333	case EfiLoaderData:\r
	334	case EfiBootServicesCode:\r
	335	case EfiBootServicesData:\r
	336	case EfiConventionalMemory:\r
	337	E820Type = E820_RAM;\r
	338	break;\r
	339	\r
	340	case EfiACPIMemoryNVS:\r
	341	E820Type = E820_NVS;\r
	342	break;\r
	343	\r
	344	default:\r
	345	DEBUG ((\r
	346	EFI_D_ERROR,\r
	347	"Invalid EFI memory descriptor type (0x%x)!\n",\r
	348	MemoryMap->Type\r
	349	));\r
	350	continue;\r
	351	}\r
	352	\r
353	if ((LastE820 != NULL) &&\r
354	(LastE820->type == (UINT32) E820Type) &&\r
355	(MemoryMap->PhysicalStart == LastEndAddr)) {\r
0086fca0 RN	356	LastE820->size += EFI_PAGES_TO_SIZE ((UINTN) MemoryMap->NumberOfPages);\r
0086fca0 RN	357	LastEndAddr += EFI_PAGES_TO_SIZE ((UINTN) MemoryMap->NumberOfPages);\r
3c0a051f	358	} else {\r
	359	if (E820EntryCount >= (sizeof (Bp->e820_map) / sizeof (Bp->e820_map[0]))) {\r
	360	break;\r
	361	}\r
	362	E820->type = (UINT32) E820Type;\r
	363	E820->addr = MemoryMap->PhysicalStart;\r
0086fca0	364	E820->size = EFI_PAGES_TO_SIZE ((UINTN) MemoryMap->NumberOfPages);\r
3c0a051f	365	LastE820 = E820;\r
	366	LastEndAddr = E820->addr + E820->size;\r
	367	E820++;\r
	368	E820EntryCount++;\r
	369	}\r
	370	\r
	371	//\r
	372	// Get next item\r
	373	//\r
	374	MemoryMap = (EFI_MEMORY_DESCRIPTOR *)((UINTN)MemoryMap + DescriptorSize);\r
	375	}\r
	376	Bp->e820_entries = (UINT8) E820EntryCount;\r
	377	\r
	378	Efi = &Bp->efi_info;\r
	379	Efi->efi_systab = (UINT32)(UINTN) gST;\r
	380	Efi->efi_memdesc_size = (UINT32) DescriptorSize;\r
	381	Efi->efi_memdesc_version = DescriptorVersion;\r
	382	Efi->efi_memmap = (UINT32)(UINTN) MemoryMapPtr;\r
	383	Efi->efi_memmap_size = (UINT32) MemoryMapSize;\r
	384	#ifdef MDE_CPU_IA32\r
	385	Efi->efi_loader_signature = SIGNATURE_32 ('E', 'L', '3', '2');\r
	386	#else\r
	387	Efi->efi_systab_hi = ((UINT64)(UINTN) gST) >> 32;\r
	388	Efi->efi_memmap_hi = ((UINT64)(UINTN) MemoryMapPtr) >> 32;\r
	389	Efi->efi_loader_signature = SIGNATURE_32 ('E', 'L', '6', '4');\r
	390	#endif\r
	391	\r
	392	gBS->ExitBootServices (gImageHandle, MapKey);\r
	393	}\r
	394	\r
	395	\r
	396	EFI_STATUS\r
	397	EFIAPI\r
	398	LoadLinuxSetCommandLine (\r
	399	IN OUT VOID *KernelSetup,\r
	400	IN CHAR8 *CommandLine\r
	401	)\r
	402	{\r
	403	EFI_STATUS Status;\r
	404	struct boot_params *Bp;\r
	405	\r
	406	Status = BasicKernelSetupCheck (KernelSetup);\r
	407	if (EFI_ERROR (Status)) {\r
	408	return Status;\r
	409	}\r
	410	\r
	411	Bp = (struct boot_params*) KernelSetup;\r
	412	\r
	413	Bp->hdr.cmd_line_ptr = (UINT32)(UINTN) CommandLine;\r
	414	\r
	415	return EFI_SUCCESS;\r
	416	}\r
	417	\r
	418	\r
	419	EFI_STATUS\r
	420	EFIAPI\r
	421	LoadLinuxSetInitrd (\r
	422	IN OUT VOID *KernelSetup,\r
	423	IN VOID *Initrd,\r
	424	IN UINTN InitrdSize\r
	425	)\r
	426	{\r
	427	EFI_STATUS Status;\r
	428	struct boot_params *Bp;\r
429	\r
430	Status = BasicKernelSetupCheck (KernelSetup);\r
431	if (EFI_ERROR (Status)) {\r
432	return Status;\r
433	}\r
434	\r
435	Bp = (struct boot_params*) KernelSetup;\r
436	\r
437	Bp->hdr.ramdisk_start = (UINT32)(UINTN) Initrd;\r
438	Bp->hdr.ramdisk_len = (UINT32) InitrdSize;\r
439	\r
440	return EFI_SUCCESS;\r
441	}\r
442	\r
443	\r
444	STATIC VOID\r
445	FindBits (\r
446	unsigned long Mask,\r
447	UINT8 *Pos,\r
448	UINT8 *Size\r
449	)\r
450	{\r
451	UINT8 First, Len;\r
452	\r
453	First = 0;\r
454	Len = 0;\r
455	\r
456	if (Mask) {\r
457	while (!(Mask & 0x1)) {\r
458	Mask = Mask >> 1;\r
459	First++;\r
460	}\r
461	\r
462	while (Mask & 0x1) {\r
463	Mask = Mask >> 1;\r
464	Len++;\r
465	}\r
466	}\r
467	*Pos = First;\r
468	*Size = Len;\r
469	}\r
470	\r
471	\r
472	STATIC\r
473	EFI_STATUS\r
474	SetupGraphicsFromGop (\r
475	struct screen_info *Si,\r
476	EFI_GRAPHICS_OUTPUT_PROTOCOL *Gop\r
477	)\r
478	{\r
479	EFI_GRAPHICS_OUTPUT_MODE_INFORMATION *Info;\r
480	EFI_STATUS Status;\r
481	UINTN Size;\r
482	\r
483	Status = Gop->QueryMode(Gop, Gop->Mode->Mode, &Size, &Info);\r
484	if (EFI_ERROR (Status)) {\r
485	return Status;\r
486	}\r
487	\r
488	/* We found a GOP */\r
489	\r
490	/* EFI framebuffer */\r
491	Si->orig_video_isVGA = 0x70;\r
492	\r
493	Si->orig_x = 0;\r
494	Si->orig_y = 0;\r
495	Si->orig_video_page = 0;\r
496	Si->orig_video_mode = 0;\r
497	Si->orig_video_cols = 0;\r
498	Si->orig_video_lines = 0;\r
499	Si->orig_video_ega_bx = 0;\r
500	Si->orig_video_points = 0;\r
501	\r
502	Si->lfb_base = (UINT32) Gop->Mode->FrameBufferBase;\r
503	Si->lfb_size = (UINT32) Gop->Mode->FrameBufferSize;\r
504	Si->lfb_width = (UINT16) Info->HorizontalResolution;\r
505	Si->lfb_height = (UINT16) Info->VerticalResolution;\r
506	Si->pages = 1;\r
507	Si->vesapm_seg = 0;\r
508	Si->vesapm_off = 0;\r
509	\r
510	if (Info->PixelFormat == PixelRedGreenBlueReserved8BitPerColor) {\r
511	Si->lfb_depth = 32;\r
512	Si->red_size = 8;\r
513	Si->red_pos = 0;\r
514	Si->green_size = 8;\r
515	Si->green_pos = 8;\r
516	Si->blue_size = 8;\r
517	Si->blue_pos = 16;\r
518	Si->rsvd_size = 8;\r
519	Si->rsvd_pos = 24;\r
520	Si->lfb_linelength = (UINT16) (Info->PixelsPerScanLine * 4);\r
521	\r
522	} else if (Info->PixelFormat == PixelBlueGreenRedReserved8BitPerColor) {\r
523	Si->lfb_depth = 32;\r
524	Si->red_size = 8;\r
525	Si->red_pos = 16;\r
526	Si->green_size = 8;\r
527	Si->green_pos = 8;\r
528	Si->blue_size = 8;\r
529	Si->blue_pos = 0;\r
530	Si->rsvd_size = 8;\r
531	Si->rsvd_pos = 24;\r
532	Si->lfb_linelength = (UINT16) (Info->PixelsPerScanLine * 4);\r
533	} else if (Info->PixelFormat == PixelBitMask) {\r
534	FindBits(Info->PixelInformation.RedMask,\r
535	&Si->red_pos, &Si->red_size);\r
536	FindBits(Info->PixelInformation.GreenMask,\r
537	&Si->green_pos, &Si->green_size);\r
538	FindBits(Info->PixelInformation.BlueMask,\r
539	&Si->blue_pos, &Si->blue_size);\r
540	FindBits(Info->PixelInformation.ReservedMask,\r
541	&Si->rsvd_pos, &Si->rsvd_size);\r
542	Si->lfb_depth = Si->red_size + Si->green_size +\r
543	Si->blue_size + Si->rsvd_size;\r
544	Si->lfb_linelength = (UINT16) ((Info->PixelsPerScanLine * Si->lfb_depth) / 8);\r
545	} else {\r
546	Si->lfb_depth = 4;\r
547	Si->red_size = 0;\r
548	Si->red_pos = 0;\r
549	Si->green_size = 0;\r
550	Si->green_pos = 0;\r
551	Si->blue_size = 0;\r
552	Si->blue_pos = 0;\r
553	Si->rsvd_size = 0;\r
554	Si->rsvd_pos = 0;\r
555	Si->lfb_linelength = Si->lfb_width / 2;\r
556	}\r
557	\r
558	return Status;\r
559	}\r
560	\r
561	\r
562	STATIC\r
563	EFI_STATUS\r
564	SetupGraphics (\r
565	IN OUT struct boot_params *Bp\r
566	)\r
567	{\r
568	EFI_STATUS Status;\r
569	EFI_HANDLE *HandleBuffer;\r
570	UINTN HandleCount;\r
571	UINTN Index;\r
572	EFI_GRAPHICS_OUTPUT_PROTOCOL *Gop;\r
573	\r
574	ZeroMem ((VOID*)&Bp->screen_info, sizeof(Bp->screen_info));\r
575	\r
576	Status = gBS->LocateHandleBuffer (\r
577	ByProtocol,\r
578	&gEfiGraphicsOutputProtocolGuid,\r
579	NULL,\r
580	&HandleCount,\r
581	&HandleBuffer\r
582	);\r
583	if (!EFI_ERROR (Status)) {\r
584	for (Index = 0; Index < HandleCount; Index++) {\r
585	Status = gBS->HandleProtocol (\r
586	HandleBuffer[Index],\r
587	&gEfiGraphicsOutputProtocolGuid,\r
588	(VOID*) &Gop\r
589	);\r
590	if (EFI_ERROR (Status)) {\r
591	continue;\r
592	}\r
593	\r
594	Status = SetupGraphicsFromGop (&Bp->screen_info, Gop);\r
595	if (!EFI_ERROR (Status)) {\r
596	FreePool (HandleBuffer);\r
597	return EFI_SUCCESS;\r
598	}\r
599	}\r
600	\r
601	FreePool (HandleBuffer);\r
602	}\r
603	\r
604	return EFI_NOT_FOUND;\r
605	}\r
606	\r
607	\r
608	STATIC\r
609	EFI_STATUS\r
610	SetupLinuxBootParams (\r
3c0a051f	611	IN OUT struct boot_params *Bp\r
	612	)\r
	613	{\r
	614	SetupGraphics (Bp);\r
	615	\r
3c0a051f	616	SetupLinuxMemmap (Bp);\r
	617	\r
	618	return EFI_SUCCESS;\r
	619	}\r
	620	\r
	621	\r
	622	EFI_STATUS\r
	623	EFIAPI\r
	624	LoadLinux (\r
	625	IN VOID *Kernel,\r
	626	IN OUT VOID *KernelSetup\r
	627	)\r
	628	{\r
	629	EFI_STATUS Status;\r
	630	struct boot_params *Bp;\r
	631	\r
	632	Status = BasicKernelSetupCheck (KernelSetup);\r
	633	if (EFI_ERROR (Status)) {\r
	634	return Status;\r
	635	}\r
	636	\r
	637	Bp = (struct boot_params *) KernelSetup;\r
	638	\r
38851e78	639	if (Bp->hdr.version < 0x205 \|\| !Bp->hdr.relocatable_kernel) {\r
3c0a051f	640	//\r
	641	// We only support relocatable kernels\r
	642	//\r
	643	return EFI_UNSUPPORTED;\r
	644	}\r
	645	\r
	646	InitLinuxDescriptorTables ();\r
	647	\r
dd71f6e2	648	Bp->hdr.code32_start = (UINT32)(UINTN) Kernel;\r
	649	if (Bp->hdr.version >= 0x20c && Bp->hdr.handover_offset &&\r
	650	(Bp->hdr.load_flags & (sizeof (UINTN) == 4 ? BIT2 : BIT3))) {\r
	651	DEBUG ((EFI_D_INFO, "Jumping to kernel EFI handover point at ofs %x\n", Bp->hdr.handover_offset));\r
	652	\r
	653	DisableInterrupts ();\r
	654	JumpToUefiKernel ((VOID) gImageHandle, (VOID) gST, KernelSetup, Kernel);\r
	655	}\r
	656	\r
	657	//\r
	658	// Old kernels without EFI handover protocol\r
	659	//\r
	660	SetupLinuxBootParams (KernelSetup);\r
3c0a051f	661	\r
	662	DEBUG ((EFI_D_INFO, "Jumping to kernel\n"));\r
	663	DisableInterrupts ();\r
	664	SetLinuxDescriptorTables ();\r
	665	JumpToKernel (Kernel, (VOID*) KernelSetup);\r
	666	\r
	667	return EFI_SUCCESS;\r
	668	}\r
	669	\r