OvmfPkg: Apply uncrustify changes

[mirror_edk2.git] / OvmfPkg / Bhyve / AcpiPlatformDxe / Bhyve.c

/*\r
 * Copyright (c) 2020, Rebecca Cran <rebecca@bsdio.com>\r
 * Copyright (c) 2008 - 2012, Intel Corporation. All rights reserved.<BR>\r
 * Copyright (C) 2012, Red Hat, Inc.\r
 * Copyright (c) 2014, Pluribus Networks, Inc.\r
 *\r
 * SPDX-License-Identifier: BSD-2-Clause-Patent\r
 */\r
#include "AcpiPlatform.h"\r
\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/BhyveFwCtlLib.h>\r
#include <Library/MemoryAllocationLib.h>\r
\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
BhyveInstallAcpiMadtTable (\r
  IN   EFI_ACPI_TABLE_PROTOCOL  *AcpiProtocol,\r
  IN   VOID                     *AcpiTableBuffer,\r
  IN   UINTN                    AcpiTableBufferSize,\r
  OUT  UINTN                    *TableKey\r
  )\r
{\r
  UINT32                                               CpuCount;\r
  UINTN                                                cSize;\r
  UINTN                                                NewBufferSize;\r
  EFI_ACPI_1_0_MULTIPLE_APIC_DESCRIPTION_TABLE_HEADER  *Madt;\r
  EFI_ACPI_1_0_PROCESSOR_LOCAL_APIC_STRUCTURE          *LocalApic;\r
  EFI_ACPI_1_0_IO_APIC_STRUCTURE                       *IoApic;\r
  EFI_ACPI_1_0_INTERRUPT_SOURCE_OVERRIDE_STRUCTURE     *Iso;\r
  VOID                                                 *Ptr;\r
  UINTN                                                Loop;\r
  EFI_STATUS                                           Status;\r
\r
  ASSERT (AcpiTableBufferSize >= sizeof (EFI_ACPI_DESCRIPTION_HEADER));\r
\r
  // Query the host for the number of vCPUs\r
  CpuCount = 0;\r
  cSize    = sizeof (CpuCount);\r
  if (BhyveFwCtlGet ("hw.ncpu", &CpuCount, &cSize) == RETURN_SUCCESS) {\r
    DEBUG ((DEBUG_INFO, "Retrieved CpuCount %d\n", CpuCount));\r
    ASSERT (CpuCount >= 1);\r
  } else {\r
    DEBUG ((DEBUG_INFO, "CpuCount retrieval error\n"));\r
    CpuCount = 1;\r
  }\r
\r
  NewBufferSize = 1                     * sizeof (*Madt) +\r
                  CpuCount              * sizeof (*LocalApic) +\r
                  1                     * sizeof (*IoApic) +\r
                  1                     * sizeof (*Iso);\r
\r
  Madt = AllocatePool (NewBufferSize);\r
  if (Madt == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  CopyMem (&(Madt->Header), AcpiTableBuffer, sizeof (EFI_ACPI_DESCRIPTION_HEADER));\r
  Madt->Header.Length    = (UINT32)NewBufferSize;\r
  Madt->LocalApicAddress = 0xFEE00000;\r
  Madt->Flags            = EFI_ACPI_1_0_PCAT_COMPAT;\r
  Ptr                    = Madt + 1;\r
\r
  LocalApic = Ptr;\r
  for (Loop = 0; Loop < CpuCount; ++Loop) {\r
    LocalApic->Type            = EFI_ACPI_1_0_PROCESSOR_LOCAL_APIC;\r
    LocalApic->Length          = sizeof (*LocalApic);\r
    LocalApic->AcpiProcessorId = (UINT8)Loop;\r
    LocalApic->ApicId          = (UINT8)Loop;\r
    LocalApic->Flags           = 1; // enabled\r
    ++LocalApic;\r
  }\r
\r
  Ptr = LocalApic;\r
\r
  IoApic                   = Ptr;\r
  IoApic->Type             = EFI_ACPI_1_0_IO_APIC;\r
  IoApic->Length           = sizeof (*IoApic);\r
  IoApic->IoApicId         = (UINT8)CpuCount;\r
  IoApic->Reserved         = EFI_ACPI_RESERVED_BYTE;\r
  IoApic->IoApicAddress    = 0xFEC00000;\r
  IoApic->SystemVectorBase = 0x00000000;\r
  Ptr                      = IoApic + 1;\r
\r
  //\r
  // IRQ0 (8254 Timer) => IRQ2 (PIC) Interrupt Source Override Structure\r
  //\r
  Iso                              = Ptr;\r
  Iso->Type                        = EFI_ACPI_1_0_INTERRUPT_SOURCE_OVERRIDE;\r
  Iso->Length                      = sizeof (*Iso);\r
  Iso->Bus                         = 0x00; // ISA\r
  Iso->Source                      = 0x00; // IRQ0\r
  Iso->GlobalSystemInterruptVector = 0x00000002;\r
  Iso->Flags                       = 0x0000; // Conforms to specs of the bus\r
  Ptr                              = Iso + 1;\r
\r
  ASSERT ((UINTN)((UINT8 *)Ptr - (UINT8 *)Madt) == NewBufferSize);\r
  Status = InstallAcpiTable (AcpiProtocol, Madt, NewBufferSize, TableKey);\r
\r
  FreePool (Madt);\r
\r
  return Status;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
BhyveInstallAcpiTable (\r
  IN   EFI_ACPI_TABLE_PROTOCOL  *AcpiProtocol,\r
  IN   VOID                     *AcpiTableBuffer,\r
  IN   UINTN                    AcpiTableBufferSize,\r
  OUT  UINTN                    *TableKey\r
  )\r
{\r
  EFI_ACPI_DESCRIPTION_HEADER        *Hdr;\r
  EFI_ACPI_TABLE_INSTALL_ACPI_TABLE  TableInstallFunction;\r
\r
  Hdr = (EFI_ACPI_DESCRIPTION_HEADER *)AcpiTableBuffer;\r
  switch (Hdr->Signature) {\r
    case EFI_ACPI_1_0_APIC_SIGNATURE:\r
      TableInstallFunction = BhyveInstallAcpiMadtTable;\r
      break;\r
    default:\r
      TableInstallFunction = InstallAcpiTable;\r
  }\r
\r
  return TableInstallFunction (\r
           AcpiProtocol,\r
           AcpiTableBuffer,\r
           AcpiTableBufferSize,\r
           TableKey\r
           );\r
}\r