hc
2024-03-26 e0728245c89800c2038c23308f2d88969d5b41c8
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
/** @file
*
*  Copyright (c) 2018, Hisilicon Limited. All rights reserved.
*  Copyright (c) 2018, Linaro Limited. All rights reserved.
*
*  SPDX-License-Identifier: BSD-2-Clause-Patent
*
**/
 
#include "ErrorSource/Ghes.h"
#include "Hest.h"
#include <IndustryStandard/Acpi62.h>
#include <Library/BaseLib.h>
#include <Library/DebugLib.h>
#include <Library/MemoryAllocationLib.h>
#include <Library/UefiBootServicesTableLib.h>
#include <PlatformArch.h>
 
EFI_STATUS HestAddErrorSourceDescriptor (
  IN OUT HEST_CONTEXT  *Context,
  IN VOID              *ErrorSourceDescriptor,
  IN UINT32            SizeOfDescriptor
)
{
  UINT16                                          *pSourceId;
  VOID                                            *Descriptor;
  EFI_ACPI_6_1_HARDWARE_ERROR_SOURCE_TABLE_HEADER *HestHeader;
 
  if ((Context == NULL) || (ErrorSourceDescriptor == NULL)) {
    return EFI_INVALID_PARAMETER;
  }
  HestHeader = Context->HestHeader;
  if (HestHeader->Header.Length + SizeOfDescriptor > Context->OccupiedMemorySize) {
    DEBUG ((DEBUG_ERROR, "[%a]:[%dL]: Hest Size Too small\n", __FUNCTION__, __LINE__));
    return EFI_BUFFER_TOO_SMALL;
  }
  Descriptor = (UINT8*)HestHeader + HestHeader->Header.Length;
  gBS->CopyMem ((VOID*)Descriptor , ErrorSourceDescriptor, SizeOfDescriptor);
  pSourceId = Descriptor + sizeof (UINT16);
  *pSourceId = HestHeader->ErrorSourceCount;
  HestHeader->Header.Length += SizeOfDescriptor;
  HestHeader->ErrorSourceCount++;
  Context->KeyErrorSource = Descriptor;
  return EFI_SUCCESS;
}
 
VOID
HestSetAcpiTable (
  IN HEST_CONTEXT  *Context
)
{
  UINTN                     AcpiTableHandle;
  EFI_STATUS                Status;
  UINT8                     Checksum;
  EFI_ACPI_6_1_HARDWARE_ERROR_SOURCE_TABLE_HEADER *HestHeader;
  EFI_ACPI_SDT_HEADER       *Table;
  EFI_ACPI_TABLE_VERSION    TableVersion;
  UINTN                     TableKey;
  UINT32                    Index;
  if (Context == NULL) {
    DEBUG ((DEBUG_ERROR, "[%a]:[%dL]: ERROR\n", __FUNCTION__, __LINE__));
    return;
  }
 
  HestHeader = Context->HestHeader;
  Checksum = CalculateCheckSum8 ((UINT8*)(HestHeader),  HestHeader->Header.Length);
  HestHeader->Header.Checksum = Checksum;
  AcpiTableHandle = 0;
  // see AcpiTableProtocol.c InstallAcpiTable
  Status = mAcpiTableProtocol->InstallAcpiTable (
                                  mAcpiTableProtocol,
                                  HestHeader,
                                  HestHeader->Header.Length,
                                  &AcpiTableHandle);
  for (Index = 0; Index < EFI_ACPI_MAX_NUM_TABLES; Index++) {
    Status = mAcpiSdtProtocol->GetAcpiTable (Index, &Table, &TableVersion, &TableKey);
    if (EFI_ERROR (Status)) {
      break;
    }
    if (Table->Signature != EFI_ACPI_6_1_HARDWARE_ERROR_SOURCE_TABLE_SIGNATURE) {
      continue;
    }
    mApeiTrustedfirmwareData->HestTableAddress = (EFI_PHYSICAL_ADDRESS)Table;
    DEBUG ((DEBUG_INFO, "Acpi HestSetAcpiTable Table = 0x%x.\n", (EFI_PHYSICAL_ADDRESS)Table));
  }
  DEBUG ((DEBUG_INFO, "[%a]:[%dL]:OUT %llx, IN %llx \n", __FUNCTION__, __LINE__,
          AcpiTableHandle, Context->HestHeader));
  return;
}
 
EFI_STATUS
HestHeaderCreator (
  HEST_CONTEXT  *Context,
  UINT32        PreAllocatedHestSize
)
{
  if (PreAllocatedHestSize < sizeof (EFI_ACPI_6_1_HARDWARE_ERROR_SOURCE_TABLE_HEADER)) {
    return EFI_BUFFER_TOO_SMALL;
  }
  Context->HestHeader = AllocateReservedZeroPool (PreAllocatedHestSize);
  *Context->HestHeader = (EFI_ACPI_6_1_HARDWARE_ERROR_SOURCE_TABLE_HEADER) {
   ARM_ACPI_HEADER (
      EFI_ACPI_6_1_HARDWARE_ERROR_SOURCE_TABLE_SIGNATURE,
      EFI_ACPI_6_1_HARDWARE_ERROR_SOURCE_TABLE_HEADER,
      EFI_ACPI_6_1_HARDWARE_ERROR_SOURCE_TABLE_REVISION
    ),
    0x0
  };
  Context->KeyErrorSource = Context->HestHeader + 1;
  Context->OccupiedMemorySize = PreAllocatedHestSize;
  return EFI_SUCCESS;
}