mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-23 10:28:51 +09:00
![Heinrich Schuchardt](/assets/img/avatar_default.png)
Provide device path nodes for SATA devices. This avoids creation of two handles with the same device path indicating our root node. This is what the device paths for a SATA drive with four partitions could like: /VenHw(..)/Sata(0x0,0xffff,0x0) /VenHw(..)/Sata(0x0,0xffff,0x0)/HD(1,MBR,0x81ea591f,0x800,0x63ff830) /VenHw(..)/Sata(0x0,0xffff,0x0)/HD(2,MBR,0x81ea591f,0x6400800,0x9ff830) /VenHw(..)/Sata(0x0,0xffff,0x0)/HD(3,MBR,0x81ea591f,0x6e00800,0x16ef2ab0) /VenHw(..)/Sata(0x0,0xffff,0x0)/HD(4,MBR,0x81ea591f,0x1dcf3800,0x1dcedab0) Signed-off-by: Heinrich Schuchardt <xypron.glpk@gmx.de>
381 lines
9.3 KiB
C
381 lines
9.3 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* EFI device path interface
|
|
*
|
|
* Copyright (c) 2017 Heinrich Schuchardt
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <blk.h>
|
|
#include <efi_loader.h>
|
|
|
|
#define MAC_OUTPUT_LEN 22
|
|
#define UNKNOWN_OUTPUT_LEN 23
|
|
|
|
#define MAX_NODE_LEN 512
|
|
#define MAX_PATH_LEN 1024
|
|
|
|
const efi_guid_t efi_guid_device_path_to_text_protocol =
|
|
EFI_DEVICE_PATH_TO_TEXT_PROTOCOL_GUID;
|
|
|
|
/**
|
|
* efi_str_to_u16() - convert ASCII string to UTF-16
|
|
*
|
|
* A u16 buffer is allocated from pool. The ASCII string is copied to the u16
|
|
* buffer.
|
|
*
|
|
* @str: ASCII string
|
|
* Return: UTF-16 string. NULL if out of memory.
|
|
*/
|
|
static u16 *efi_str_to_u16(char *str)
|
|
{
|
|
efi_uintn_t len;
|
|
u16 *out, *dst;
|
|
efi_status_t ret;
|
|
|
|
len = sizeof(u16) * (utf8_utf16_strlen(str) + 1);
|
|
ret = efi_allocate_pool(EFI_ALLOCATE_ANY_PAGES, len, (void **)&out);
|
|
if (ret != EFI_SUCCESS)
|
|
return NULL;
|
|
dst = out;
|
|
utf8_utf16_strcpy(&dst, str);
|
|
return out;
|
|
}
|
|
|
|
static char *dp_unknown(char *s, struct efi_device_path *dp)
|
|
{
|
|
s += sprintf(s, "UNKNOWN(%04x,%04x)", dp->type, dp->sub_type);
|
|
return s;
|
|
}
|
|
|
|
static char *dp_hardware(char *s, struct efi_device_path *dp)
|
|
{
|
|
switch (dp->sub_type) {
|
|
case DEVICE_PATH_SUB_TYPE_MEMORY: {
|
|
struct efi_device_path_memory *mdp =
|
|
(struct efi_device_path_memory *)dp;
|
|
s += sprintf(s, "MemoryMapped(0x%x,0x%llx,0x%llx)",
|
|
mdp->memory_type,
|
|
mdp->start_address,
|
|
mdp->end_address);
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_VENDOR: {
|
|
int i, n;
|
|
struct efi_device_path_vendor *vdp =
|
|
(struct efi_device_path_vendor *)dp;
|
|
|
|
s += sprintf(s, "VenHw(%pUl", &vdp->guid);
|
|
n = (int)vdp->dp.length - sizeof(struct efi_device_path_vendor);
|
|
if (n > 0) {
|
|
s += sprintf(s, ",");
|
|
for (i = 0; i < n; ++i)
|
|
s += sprintf(s, "%02x", vdp->vendor_data[i]);
|
|
}
|
|
s += sprintf(s, ")");
|
|
break;
|
|
}
|
|
default:
|
|
s = dp_unknown(s, dp);
|
|
break;
|
|
}
|
|
return s;
|
|
}
|
|
|
|
static char *dp_acpi(char *s, struct efi_device_path *dp)
|
|
{
|
|
switch (dp->sub_type) {
|
|
case DEVICE_PATH_SUB_TYPE_ACPI_DEVICE: {
|
|
struct efi_device_path_acpi_path *adp =
|
|
(struct efi_device_path_acpi_path *)dp;
|
|
|
|
s += sprintf(s, "Acpi(PNP%04X,%d)", EISA_PNP_NUM(adp->hid),
|
|
adp->uid);
|
|
break;
|
|
}
|
|
default:
|
|
s = dp_unknown(s, dp);
|
|
break;
|
|
}
|
|
return s;
|
|
}
|
|
|
|
static char *dp_msging(char *s, struct efi_device_path *dp)
|
|
{
|
|
switch (dp->sub_type) {
|
|
case DEVICE_PATH_SUB_TYPE_MSG_ATAPI: {
|
|
struct efi_device_path_atapi *ide =
|
|
(struct efi_device_path_atapi *)dp;
|
|
s += sprintf(s, "Ata(%d,%d,%d)", ide->primary_secondary,
|
|
ide->slave_master, ide->logical_unit_number);
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_MSG_SCSI: {
|
|
struct efi_device_path_scsi *ide =
|
|
(struct efi_device_path_scsi *)dp;
|
|
s += sprintf(s, "Scsi(%u,%u)", ide->target_id,
|
|
ide->logical_unit_number);
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_MSG_USB: {
|
|
struct efi_device_path_usb *udp =
|
|
(struct efi_device_path_usb *)dp;
|
|
s += sprintf(s, "USB(0x%x,0x%x)", udp->parent_port_number,
|
|
udp->usb_interface);
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_MSG_MAC_ADDR: {
|
|
int i, n = sizeof(struct efi_mac_addr);
|
|
struct efi_device_path_mac_addr *mdp =
|
|
(struct efi_device_path_mac_addr *)dp;
|
|
|
|
if (mdp->if_type <= 1)
|
|
n = 6;
|
|
s += sprintf(s, "MAC(");
|
|
for (i = 0; i < n; ++i)
|
|
s += sprintf(s, "%02x", mdp->mac.addr[i]);
|
|
s += sprintf(s, ",%u)", mdp->if_type);
|
|
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_MSG_USB_CLASS: {
|
|
struct efi_device_path_usb_class *ucdp =
|
|
(struct efi_device_path_usb_class *)dp;
|
|
|
|
s += sprintf(s, "UsbClass(0x%x,0x%x,0x%x,0x%x,0x%x)",
|
|
ucdp->vendor_id, ucdp->product_id,
|
|
ucdp->device_class, ucdp->device_subclass,
|
|
ucdp->device_protocol);
|
|
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_MSG_SATA: {
|
|
struct efi_device_path_sata *sdp =
|
|
(struct efi_device_path_sata *) dp;
|
|
|
|
s += sprintf(s, "Sata(0x%x,0x%x,0x%x)",
|
|
sdp->hba_port,
|
|
sdp->port_multiplier_port,
|
|
sdp->logical_unit_number);
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_MSG_NVME: {
|
|
struct efi_device_path_nvme *ndp =
|
|
(struct efi_device_path_nvme *)dp;
|
|
u32 ns_id;
|
|
int i;
|
|
|
|
memcpy(&ns_id, &ndp->ns_id, sizeof(ns_id));
|
|
s += sprintf(s, "NVMe(0x%x,", ns_id);
|
|
for (i = 0; i < sizeof(ndp->eui64); ++i)
|
|
s += sprintf(s, "%s%02x", i ? "-" : "",
|
|
ndp->eui64[i]);
|
|
s += sprintf(s, ")");
|
|
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_MSG_SD:
|
|
case DEVICE_PATH_SUB_TYPE_MSG_MMC: {
|
|
const char *typename =
|
|
(dp->sub_type == DEVICE_PATH_SUB_TYPE_MSG_SD) ?
|
|
"SD" : "eMMC";
|
|
struct efi_device_path_sd_mmc_path *sddp =
|
|
(struct efi_device_path_sd_mmc_path *)dp;
|
|
s += sprintf(s, "%s(%u)", typename, sddp->slot_number);
|
|
break;
|
|
}
|
|
default:
|
|
s = dp_unknown(s, dp);
|
|
break;
|
|
}
|
|
return s;
|
|
}
|
|
|
|
/*
|
|
* Convert a media device path node to text.
|
|
*
|
|
* @s output buffer
|
|
* @dp device path node
|
|
* @return next unused buffer address
|
|
*/
|
|
static char *dp_media(char *s, struct efi_device_path *dp)
|
|
{
|
|
switch (dp->sub_type) {
|
|
case DEVICE_PATH_SUB_TYPE_HARD_DRIVE_PATH: {
|
|
struct efi_device_path_hard_drive_path *hddp =
|
|
(struct efi_device_path_hard_drive_path *)dp;
|
|
void *sig = hddp->partition_signature;
|
|
u64 start;
|
|
u64 end;
|
|
|
|
/* Copy from packed structure to aligned memory */
|
|
memcpy(&start, &hddp->partition_start, sizeof(start));
|
|
memcpy(&end, &hddp->partition_end, sizeof(end));
|
|
|
|
switch (hddp->signature_type) {
|
|
case SIG_TYPE_MBR: {
|
|
u32 signature;
|
|
|
|
memcpy(&signature, sig, sizeof(signature));
|
|
s += sprintf(
|
|
s, "HD(%d,MBR,0x%08x,0x%llx,0x%llx)",
|
|
hddp->partition_number, signature, start, end);
|
|
break;
|
|
}
|
|
case SIG_TYPE_GUID:
|
|
s += sprintf(
|
|
s, "HD(%d,GPT,%pUl,0x%llx,0x%llx)",
|
|
hddp->partition_number, sig, start, end);
|
|
break;
|
|
default:
|
|
s += sprintf(
|
|
s, "HD(%d,0x%02x,0,0x%llx,0x%llx)",
|
|
hddp->partition_number, hddp->partmap_type,
|
|
start, end);
|
|
break;
|
|
}
|
|
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_CDROM_PATH: {
|
|
struct efi_device_path_cdrom_path *cddp =
|
|
(struct efi_device_path_cdrom_path *)dp;
|
|
s += sprintf(s, "CDROM(%u,0x%llx,0x%llx)", cddp->boot_entry,
|
|
cddp->partition_start, cddp->partition_size);
|
|
break;
|
|
}
|
|
case DEVICE_PATH_SUB_TYPE_FILE_PATH: {
|
|
struct efi_device_path_file_path *fp =
|
|
(struct efi_device_path_file_path *)dp;
|
|
int slen = (dp->length - sizeof(*dp)) / 2;
|
|
if (slen > MAX_NODE_LEN - 2)
|
|
slen = MAX_NODE_LEN - 2;
|
|
s += sprintf(s, "%-.*ls", slen, fp->str);
|
|
break;
|
|
}
|
|
default:
|
|
s = dp_unknown(s, dp);
|
|
break;
|
|
}
|
|
return s;
|
|
}
|
|
|
|
/*
|
|
* Converts a single node to a char string.
|
|
*
|
|
* @buffer output buffer
|
|
* @dp device path or node
|
|
* @return end of string
|
|
*/
|
|
static char *efi_convert_single_device_node_to_text(
|
|
char *buffer,
|
|
struct efi_device_path *dp)
|
|
{
|
|
char *str = buffer;
|
|
|
|
switch (dp->type) {
|
|
case DEVICE_PATH_TYPE_HARDWARE_DEVICE:
|
|
str = dp_hardware(str, dp);
|
|
break;
|
|
case DEVICE_PATH_TYPE_ACPI_DEVICE:
|
|
str = dp_acpi(str, dp);
|
|
break;
|
|
case DEVICE_PATH_TYPE_MESSAGING_DEVICE:
|
|
str = dp_msging(str, dp);
|
|
break;
|
|
case DEVICE_PATH_TYPE_MEDIA_DEVICE:
|
|
str = dp_media(str, dp);
|
|
break;
|
|
case DEVICE_PATH_TYPE_END:
|
|
break;
|
|
default:
|
|
str = dp_unknown(str, dp);
|
|
}
|
|
|
|
*str = '\0';
|
|
return str;
|
|
}
|
|
|
|
/*
|
|
* This function implements the ConvertDeviceNodeToText service of the
|
|
* EFI_DEVICE_PATH_TO_TEXT_PROTOCOL.
|
|
* See the Unified Extensible Firmware Interface (UEFI) specification
|
|
* for details.
|
|
*
|
|
* device_node device node to be converted
|
|
* display_only true if the shorter text representation shall be used
|
|
* allow_shortcuts true if shortcut forms may be used
|
|
* @return text representation of the device path
|
|
* NULL if out of memory of device_path is NULL
|
|
*/
|
|
static uint16_t EFIAPI *efi_convert_device_node_to_text(
|
|
struct efi_device_path *device_node,
|
|
bool display_only,
|
|
bool allow_shortcuts)
|
|
{
|
|
char str[MAX_NODE_LEN];
|
|
uint16_t *text = NULL;
|
|
|
|
EFI_ENTRY("%p, %d, %d", device_node, display_only, allow_shortcuts);
|
|
|
|
if (!device_node)
|
|
goto out;
|
|
efi_convert_single_device_node_to_text(str, device_node);
|
|
|
|
text = efi_str_to_u16(str);
|
|
|
|
out:
|
|
EFI_EXIT(EFI_SUCCESS);
|
|
return text;
|
|
}
|
|
|
|
/*
|
|
* This function implements the ConvertDevicePathToText service of the
|
|
* EFI_DEVICE_PATH_TO_TEXT_PROTOCOL.
|
|
* See the Unified Extensible Firmware Interface (UEFI) specification
|
|
* for details.
|
|
*
|
|
* device_path device path to be converted
|
|
* display_only true if the shorter text representation shall be used
|
|
* allow_shortcuts true if shortcut forms may be used
|
|
* @return text representation of the device path
|
|
* NULL if out of memory of device_path is NULL
|
|
*/
|
|
static uint16_t EFIAPI *efi_convert_device_path_to_text(
|
|
struct efi_device_path *device_path,
|
|
bool display_only,
|
|
bool allow_shortcuts)
|
|
{
|
|
uint16_t *text = NULL;
|
|
char buffer[MAX_PATH_LEN];
|
|
char *str = buffer;
|
|
|
|
EFI_ENTRY("%p, %d, %d", device_path, display_only, allow_shortcuts);
|
|
|
|
if (!device_path)
|
|
goto out;
|
|
while (device_path &&
|
|
str + MAX_NODE_LEN < buffer + MAX_PATH_LEN) {
|
|
*str++ = '/';
|
|
str = efi_convert_single_device_node_to_text(str, device_path);
|
|
device_path = efi_dp_next(device_path);
|
|
}
|
|
|
|
text = efi_str_to_u16(buffer);
|
|
|
|
out:
|
|
EFI_EXIT(EFI_SUCCESS);
|
|
return text;
|
|
}
|
|
|
|
/* helper for debug prints.. efi_free_pool() the result. */
|
|
uint16_t *efi_dp_str(struct efi_device_path *dp)
|
|
{
|
|
return EFI_CALL(efi_convert_device_path_to_text(dp, true, true));
|
|
}
|
|
|
|
const struct efi_device_path_to_text_protocol efi_device_path_to_text = {
|
|
.convert_device_node_to_text = efi_convert_device_node_to_text,
|
|
.convert_device_path_to_text = efi_convert_device_path_to_text,
|
|
};
|