1 // SPDX-License-Identifier: GPL-2.0+
5 * Copyright (c) 2018 Heinrich Schuchardt <xypron.glpk@gmx.de>
6 * Copyright (c) 2022 Ventana Micro Systems Inc
8 * Check the device tree, test the RISCV_EFI_BOOT_PROTOCOL.
11 #include <efi_riscv.h>
12 #include <efi_selftest.h>
13 #include <linux/libfdt.h>
15 static const struct efi_system_table
*systemtab
;
16 static const struct efi_boot_services
*boottime
;
17 static const char *fdt
;
19 /* This should be sufficient for */
20 #define BUFFERSIZE 0x100000
22 static const efi_guid_t fdt_guid
= EFI_FDT_GUID
;
23 static const efi_guid_t acpi_guid
= EFI_ACPI_TABLE_GUID
;
24 static const efi_guid_t riscv_efi_boot_protocol_guid
=
25 RISCV_EFI_BOOT_PROTOCOL_GUID
;
28 * f2h() - convert FDT value to host endianness.
30 * UEFI code is always low endian. The FDT is big endian.
33 * Return: converted value
35 static uint32_t f2h(fdt32_t val
)
37 char *buf
= (char *)&val
;
41 i
= buf
[0]; buf
[0] = buf
[3]; buf
[3] = i
;
42 i
= buf
[1]; buf
[1] = buf
[2]; buf
[2] = i
;
48 * get_property() - return value of a property of an FDT node
50 * A property of the root node or one of its direct children can be
53 * @property name of the property
54 * @node name of the node or NULL for root node
55 * Return: value of the property
57 static char *get_property(const u16
*property
, const u16
*node
)
59 struct fdt_header
*header
= (struct fdt_header
*)fdt
;
64 const char *nodelabel
= NULL
;
67 efi_st_error("Missing device tree\n");
71 if (f2h(header
->magic
) != FDT_MAGIC
) {
72 efi_st_error("Wrong device tree magic\n");
76 pos
= (fdt32_t
*)(fdt
+ f2h(header
->off_dt_struct
));
77 end
= &pos
[f2h(header
->totalsize
) >> 2];
78 strings
= fdt
+ f2h(header
->off_dt_strings
);
81 switch (f2h(pos
[0])) {
82 case FDT_BEGIN_NODE
: {
83 const char *c
= (char *)&pos
[1];
89 for (i
= 0; c
[i
]; ++i
)
91 pos
= &pos
[2 + (i
>> 2)];
95 struct fdt_property
*prop
= (struct fdt_property
*)pos
;
96 const char *label
= &strings
[f2h(prop
->nameoff
)];
99 /* Check if this is the property to be returned */
100 if (!efi_st_strcmp_16_8(property
, label
) &&
101 ((level
== 1 && !node
) ||
102 (level
== 2 && node
&&
103 !efi_st_strcmp_16_8(node
, nodelabel
)))) {
105 efi_uintn_t len
= f2h(prop
->len
);
110 * The string might not be 0 terminated.
111 * It is safer to make a copy.
113 ret
= boottime
->allocate_pool(
114 EFI_LOADER_DATA
, len
+ 1,
116 if (ret
!= EFI_SUCCESS
) {
117 efi_st_error("AllocatePool failed\n");
120 boottime
->copy_mem(str
, &pos
[3], len
);
126 pos
= &pos
[3 + ((f2h(prop
->len
) + 3) >> 2)];
139 efi_st_error("Invalid device tree token\n");
143 efi_st_error("Missing FDT_END token\n");
150 * @handle: handle of the loaded image
151 * @systable: system table
152 * Return: EFI_ST_SUCCESS for success
154 static int setup(const efi_handle_t img_handle
,
155 const struct efi_system_table
*systable
)
159 systemtab
= systable
;
160 boottime
= systable
->boottime
;
162 acpi
= efi_st_get_config_table(&acpi_guid
);
163 fdt
= efi_st_get_config_table(&fdt_guid
);
166 efi_st_error("Missing device tree\n");
167 return EFI_ST_FAILURE
;
170 efi_st_error("Found ACPI table and device tree\n");
171 return EFI_ST_FAILURE
;
173 return EFI_ST_SUCCESS
;
176 __maybe_unused
static efi_status_t
get_boot_hartid(efi_uintn_t
*efi_hartid
)
179 struct riscv_efi_boot_protocol
*prot
;
181 /* Get RISC-V boot protocol */
182 ret
= boottime
->locate_protocol(&riscv_efi_boot_protocol_guid
, NULL
,
184 if (ret
!= EFI_SUCCESS
) {
185 efi_st_error("RISC-V Boot Protocol not available\n");
186 return EFI_ST_FAILURE
;
189 /* Get boot hart ID from EFI protocol */
190 ret
= prot
->get_boot_hartid(prot
, efi_hartid
);
191 if (ret
!= EFI_SUCCESS
) {
192 efi_st_error("Could not retrieve boot hart ID\n");
193 return EFI_ST_FAILURE
;
196 return EFI_ST_SUCCESS
;
202 * Return: EFI_ST_SUCCESS for success
204 static int execute(void)
209 str
= get_property(u
"compatible", NULL
);
211 efi_st_printf("compatible: %s\n", str
);
212 ret
= boottime
->free_pool(str
);
213 if (ret
!= EFI_SUCCESS
) {
214 efi_st_error("FreePool failed\n");
215 return EFI_ST_FAILURE
;
218 efi_st_error("Missing property 'compatible'\n");
219 return EFI_ST_FAILURE
;
221 str
= get_property(u
"serial-number", NULL
);
223 efi_st_printf("serial-number: %s\n", str
);
224 ret
= boottime
->free_pool(str
);
225 if (ret
!= EFI_SUCCESS
) {
226 efi_st_error("FreePool failed\n");
227 return EFI_ST_FAILURE
;
230 if (IS_ENABLED(CONFIG_RISCV
)) {
233 str
= get_property(u
"boot-hartid", u
"chosen");
235 efi_st_error("boot-hartid missing in devicetree\n");
236 return EFI_ST_FAILURE
;
238 fdt_hartid
= f2h(*(fdt32_t
*)str
);
239 efi_st_printf("boot-hartid: %u\n", fdt_hartid
);
241 ret
= boottime
->free_pool(str
);
242 if (ret
!= EFI_SUCCESS
) {
243 efi_st_error("FreePool failed\n");
244 return EFI_ST_FAILURE
;
247 if (IS_ENABLED(CONFIG_EFI_RISCV_BOOT_PROTOCOL
)) {
248 efi_uintn_t efi_hartid
;
251 r
= get_boot_hartid(&efi_hartid
);
252 if (r
!= EFI_ST_SUCCESS
)
254 /* Boot hart ID should be same */
255 if (efi_hartid
!= fdt_hartid
) {
256 efi_st_error("boot-hartid differs: prot 0x%p, DT 0x%.8x\n",
257 (void *)(uintptr_t)efi_hartid
,
259 return EFI_ST_FAILURE
;
264 return EFI_ST_SUCCESS
;
267 EFI_UNIT_TEST(fdt
) = {
268 .name
= "device tree",
269 .phase
= EFI_EXECUTE_BEFORE_BOOTTIME_EXIT
,