Bhyve.c 4.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133
  1. /*
  2. * Copyright (c) 2020, Rebecca Cran <rebecca@bsdio.com>
  3. * Copyright (c) 2008 - 2012, Intel Corporation. All rights reserved.<BR>
  4. * Copyright (C) 2012, Red Hat, Inc.
  5. * Copyright (c) 2014, Pluribus Networks, Inc.
  6. *
  7. * SPDX-License-Identifier: BSD-2-Clause-Patent
  8. */
  9. #include "AcpiPlatform.h"
  10. #include <Library/BaseMemoryLib.h>
  11. #include <Library/BhyveFwCtlLib.h>
  12. #include <Library/MemoryAllocationLib.h>
  13. STATIC
  14. EFI_STATUS
  15. EFIAPI
  16. BhyveInstallAcpiMadtTable (
  17. IN EFI_ACPI_TABLE_PROTOCOL *AcpiProtocol,
  18. IN VOID *AcpiTableBuffer,
  19. IN UINTN AcpiTableBufferSize,
  20. OUT UINTN *TableKey
  21. )
  22. {
  23. UINT32 CpuCount;
  24. UINTN cSize;
  25. UINTN NewBufferSize;
  26. EFI_ACPI_1_0_MULTIPLE_APIC_DESCRIPTION_TABLE_HEADER *Madt;
  27. EFI_ACPI_1_0_PROCESSOR_LOCAL_APIC_STRUCTURE *LocalApic;
  28. EFI_ACPI_1_0_IO_APIC_STRUCTURE *IoApic;
  29. EFI_ACPI_1_0_INTERRUPT_SOURCE_OVERRIDE_STRUCTURE *Iso;
  30. VOID *Ptr;
  31. UINTN Loop;
  32. EFI_STATUS Status;
  33. ASSERT (AcpiTableBufferSize >= sizeof (EFI_ACPI_DESCRIPTION_HEADER));
  34. // Query the host for the number of vCPUs
  35. CpuCount = 0;
  36. cSize = sizeof (CpuCount);
  37. if (BhyveFwCtlGet ("hw.ncpu", &CpuCount, &cSize) == RETURN_SUCCESS) {
  38. DEBUG ((DEBUG_INFO, "Retrieved CpuCount %d\n", CpuCount));
  39. ASSERT (CpuCount >= 1);
  40. } else {
  41. DEBUG ((DEBUG_INFO, "CpuCount retrieval error\n"));
  42. CpuCount = 1;
  43. }
  44. NewBufferSize = 1 * sizeof (*Madt) +
  45. CpuCount * sizeof (*LocalApic) +
  46. 1 * sizeof (*IoApic) +
  47. 1 * sizeof (*Iso);
  48. Madt = AllocatePool (NewBufferSize);
  49. if (Madt == NULL) {
  50. return EFI_OUT_OF_RESOURCES;
  51. }
  52. CopyMem (&(Madt->Header), AcpiTableBuffer, sizeof (EFI_ACPI_DESCRIPTION_HEADER));
  53. Madt->Header.Length = (UINT32)NewBufferSize;
  54. Madt->LocalApicAddress = 0xFEE00000;
  55. Madt->Flags = EFI_ACPI_1_0_PCAT_COMPAT;
  56. Ptr = Madt + 1;
  57. LocalApic = Ptr;
  58. for (Loop = 0; Loop < CpuCount; ++Loop) {
  59. LocalApic->Type = EFI_ACPI_1_0_PROCESSOR_LOCAL_APIC;
  60. LocalApic->Length = sizeof (*LocalApic);
  61. LocalApic->AcpiProcessorId = (UINT8)Loop;
  62. LocalApic->ApicId = (UINT8)Loop;
  63. LocalApic->Flags = 1; // enabled
  64. ++LocalApic;
  65. }
  66. Ptr = LocalApic;
  67. IoApic = Ptr;
  68. IoApic->Type = EFI_ACPI_1_0_IO_APIC;
  69. IoApic->Length = sizeof (*IoApic);
  70. IoApic->IoApicId = (UINT8)CpuCount;
  71. IoApic->Reserved = EFI_ACPI_RESERVED_BYTE;
  72. IoApic->IoApicAddress = 0xFEC00000;
  73. IoApic->SystemVectorBase = 0x00000000;
  74. Ptr = IoApic + 1;
  75. //
  76. // IRQ0 (8254 Timer) => IRQ2 (PIC) Interrupt Source Override Structure
  77. //
  78. Iso = Ptr;
  79. Iso->Type = EFI_ACPI_1_0_INTERRUPT_SOURCE_OVERRIDE;
  80. Iso->Length = sizeof (*Iso);
  81. Iso->Bus = 0x00; // ISA
  82. Iso->Source = 0x00; // IRQ0
  83. Iso->GlobalSystemInterruptVector = 0x00000002;
  84. Iso->Flags = 0x0000; // Conforms to specs of the bus
  85. Ptr = Iso + 1;
  86. ASSERT ((UINTN)((UINT8 *)Ptr - (UINT8 *)Madt) == NewBufferSize);
  87. Status = InstallAcpiTable (AcpiProtocol, Madt, NewBufferSize, TableKey);
  88. FreePool (Madt);
  89. return Status;
  90. }
  91. EFI_STATUS
  92. EFIAPI
  93. BhyveInstallAcpiTable (
  94. IN EFI_ACPI_TABLE_PROTOCOL *AcpiProtocol,
  95. IN VOID *AcpiTableBuffer,
  96. IN UINTN AcpiTableBufferSize,
  97. OUT UINTN *TableKey
  98. )
  99. {
  100. EFI_ACPI_DESCRIPTION_HEADER *Hdr;
  101. EFI_ACPI_TABLE_INSTALL_ACPI_TABLE TableInstallFunction;
  102. Hdr = (EFI_ACPI_DESCRIPTION_HEADER *)AcpiTableBuffer;
  103. switch (Hdr->Signature) {
  104. case EFI_ACPI_1_0_APIC_SIGNATURE:
  105. TableInstallFunction = BhyveInstallAcpiMadtTable;
  106. break;
  107. default:
  108. TableInstallFunction = InstallAcpiTable;
  109. }
  110. return TableInstallFunction (
  111. AcpiProtocol,
  112. AcpiTableBuffer,
  113. AcpiTableBufferSize,
  114. TableKey
  115. );
  116. }