githubmirror/efivar

src/dp-acpi.c
324 строки8 KB
Peter Jones
SPDX-ify all the license text in source files.
03 фев 2020, 21:37
03 фев 2020, 21:37ce42f1d
// SPDX-License-Identifier: LGPL-2.1-or-later
/*
 * libefivar - library for the manipulation of EFI variables
 * Copyright 2012-2019 Red Hat, Inc.
 */

#include "fix_coverity.h"

#include <errno.h>
#include <inttypes.h>
#include <stdarg.h>
#include <stddef.h>

#include "efivar.h"

static ssize_t
_format_acpi_adr(unsigned char *buf, size_t size,
		 const char *dp_type UNUSED,
		 const_efidp dp)
{
	ssize_t off = 0;
	format(buf, size, off, "AcpiAdr", "AcpiAdr(");
	format_array(buf, size, off, "AcpiAdr", "0x%"PRIx32,
		     __typeof__(dp->acpi_adr.adr[0]), dp->acpi_adr.adr,
		     (efidp_node_size(dp)-4) / sizeof (dp->acpi_adr.adr[0]));
	format(buf, size, off, "AcpiAdr", ")");
	return off;
}

#define format_acpi_adr(buf, size, off, dp)				\
	format_helper(_format_acpi_adr, buf, size, off, "AcpiAdr", dp)

static ssize_t
_format_acpi_hid_ex(unsigned char *buf, size_t size,
		    const char *dp_type UNUSED, const_efidp dp,
		    const char *hidstr, const char *cidstr,
		    const char *uidstr)
{
	ssize_t off = 0;

	debug("hid:0x%08x hidstr:'%s'", dp->acpi_hid_ex.hid, hidstr);
	debug("cid:0x%08x cidstr:'%s'", dp->acpi_hid_ex.cid, cidstr);
	debug("uid:0x%08x uidstr:'%s'", dp->acpi_hid_ex.uid, uidstr);

	if (!hidstr && !cidstr && (uidstr || dp->acpi_hid_ex.uid)) {
		format(buf, size, off, "AcpiExp",
		       "AcpiExp(0x%"PRIx32",0x%"PRIx32",",
		       dp->acpi_hid_ex.hid, dp->acpi_hid_ex.cid);
		if (uidstr) {
			format(buf, size, off, "AcpiExp", "%s)", uidstr);
		} else {
			format(buf, size, off, "AcpiExp", "0x%"PRIx32")",
			       dp->acpi_hid_ex.uid);
		}
		return off;
	}

	format(buf, size, off, "AcpiEx", "AcpiEx(");
	if (hidstr) {
		format(buf, size, off, "AcpiEx", "%s,", hidstr);
	} else {
		format(buf, size, off, "AcpiEx", "0x%"PRIx32",",
		       dp->acpi_hid_ex.hid);
	}

	if (cidstr) {
		format(buf, size, off, "AcpiEx", "%s,", cidstr);
	} else {
		format(buf, size, off, "AcpiEx", "0x%"PRIx32",",
		       dp->acpi_hid_ex.cid);
	}

	if (uidstr) {
		format(buf, size, off, "AcpiEx", "%s)", uidstr);
	} else {
		format(buf, size, off, "AcpiEx", "0x%"PRIx32")",
		       dp->acpi_hid_ex.uid);
	}

	return off;
}

#define format_acpi_hid_ex(buf, size, off, dp, hidstr, cidstr, uidstr)  \
	format_helper(_format_acpi_hid_ex, buf, size, off, "AcpiEx", dp,\
		      hidstr, cidstr, uidstr)

ssize_t
_format_acpi_dn(unsigned char *buf, size_t size, const_efidp dp)
{
	ssize_t off = 0;
	const char *hidstr = NULL;
	size_t hidlen = 0;
	const char *uidstr = NULL;
	size_t uidlen = 0;
	const char *cidstr = NULL;
	// size_t cidlen = 0;

	if (dp->subtype == EFIDP_ACPI_ADR) {
		debug("formatting ACPI _ADR");
		format_acpi_adr(buf, size, off, dp);
		return off;
	} else if (dp->subtype != EFIDP_ACPI_HID_EX &&
		   dp->subtype != EFIDP_ACPI_HID) {
		debug("DP subtype %d, formatting as ACPI Path", dp->subtype);
		format(buf, size, off, "AcpiPath", "AcpiPath(%d,", dp->subtype);
		format_hex(buf, size, off, "AcpiPath", (uint8_t *)dp+4,
			   (efidp_node_size(dp)-4) / 2);
		format(buf, size, off, "AcpiPath", ")");
		return off;
	} else if (dp->subtype == EFIDP_ACPI_HID_EX) {
		ssize_t limit = efidp_node_size(dp)
				- offsetof(efidp_acpi_hid_ex, hidstr);

		debug("formatting ACPI HID EX");
		hidstr = dp->acpi_hid_ex.hidstr;
		hidlen = strnlen(hidstr, limit);
		limit -= hidlen + 1;

		if (limit) {
			uidstr = hidstr + hidlen + 1;
			uidlen = strnlen(uidstr, limit);
			limit -= uidlen + 1;
		}

		if (limit) {
			cidstr = uidstr + uidlen + 1;
			// cidlen = strnlen(cidstr, limit);
			// limit -= cidlen + 1;
		}

		if (uidstr) {
			switch (dp->acpi_hid.hid) {
			case EFIDP_ACPI_PCI_ROOT_HID:
				format(buf, size, off, "PciRoot",
				       "PciRoot(%s)", uidstr);
				return off;
			case EFIDP_ACPI_CONTAINER_0A05_HID:
			case EFIDP_ACPI_CONTAINER_0A06_HID:
				format(buf, size, off, "AcpiContainer",
				       "AcpiContainer(%s)", uidstr);
				break;
			case EFIDP_ACPI_PCIE_ROOT_HID:
				format(buf, size, off, "PcieRoot",
				       "PcieRoot(%s)", uidstr);
				return off;
			case EFIDP_ACPI_EC_HID:
				format(buf, size, off, "EmbeddedController",
				       "EmbeddedController()");
				return off;
			default:
				format_acpi_hid_ex(buf, size, off, dp,
						   hidstr, cidstr, uidstr);
				return off;
			}
		}
	} else if (dp->subtype == EFIDP_ACPI_HID) {
		debug("formatting ACPI HID 0x%08x", dp->acpi_hid.hid);

		switch (dp->acpi_hid.hid) {
		case EFIDP_ACPI_PCI_ROOT_HID:
			format(buf, size, off, "PciRoot",
			       "PciRoot(0x%"PRIx32")",
			       dp->acpi_hid.uid);
			break;
		case EFIDP_ACPI_CONTAINER_0A05_HID:
		case EFIDP_ACPI_CONTAINER_0A06_HID:
			format(buf, size, off, "AcpiContainer",
			       "AcpiContainer()");
			break;
		case EFIDP_ACPI_PCIE_ROOT_HID:
			format(buf, size, off, "PcieRoot",
			       "PcieRoot(0x%"PRIx32")",
			       dp->acpi_hid.uid);
			break;
		case EFIDP_ACPI_EC_HID:
			format(buf, size, off, "EmbeddedController",
			       "EmbeddedController()");
			break;
		case EFIDP_ACPI_FLOPPY_HID:
			format(buf, size, off, "Floppy",
			       "Floppy(0x%"PRIx32")",
			       dp->acpi_hid.uid);
			break;
		case EFIDP_ACPI_KEYBOARD_HID:
			format(buf, size, off, "Keyboard",
			       "Keyboard(0x%"PRIx32")",
			       dp->acpi_hid.uid);
			break;
		case EFIDP_ACPI_SERIAL_HID:
			format(buf, size, off, "Serial",
			       "Serial(0x%"PRIx32")",
			       dp->acpi_hid.uid);
			break;
		case EFIDP_ACPI_NVDIMM_HID: {
			int rc;
			const_efidp next = NULL;
			efidp_acpi_adr *adrdp;
			int end;

			format(buf, size, off, "NvRoot()", "NvRoot()");

			rc = efidp_next_node(dp, &next);
			if (rc < 0 || !next) {
				efi_error("could not format DP");
				return rc;
			}

			if (efidp_type(next) != EFIDP_ACPI_TYPE ||
			    efidp_subtype(next) != EFIDP_ACPI_ADR) {
				efi_error("Invalid child node type (0x%02x,0x%02x)",
					  efidp_type(next), efidp_subtype(next));
				return -EINVAL;
			}
			adrdp = (efidp_acpi_adr *)next;

			end = efidp_size_after(adrdp, header)
				/ sizeof(adrdp->adr[0]);

			for (int i = 0; i < end; i++) {
				uint32_t node_controller, socket, memory_controller;
				uint32_t memory_channel, dimm;
				uint32_t adr = adrdp->adr[i];

				efidp_decode_acpi_nvdimm_adr(adr,
					&node_controller, &socket,
					&memory_controller, &memory_channel,
					&dimm);

				if (i != 0)
					format(buf, size, off, "NvDimm", ",");

				format(buf, size, off, "NvDimm",
				       "NvDimm(0x%03x,0x%01x,0x%01x,0x%01x,0x%01x)",
				       node_controller, socket, memory_controller,
				       memory_channel, dimm);
			}
			break;
					    }
		default:
			debug("Decoding non-well-known HID");
			switch (dp->subtype) {
			case EFIDP_ACPI_HID_EX:
				format_acpi_hid_ex(buf, size, off, dp,
						   hidstr, cidstr, uidstr);
				break;
			case EFIDP_ACPI_HID:
				debug("Decoding ACPI HID");
				format(buf, size, off, "Acpi",
				       "Acpi(0x%08x,0x%"PRIx32")",
				       dp->acpi_hid.hid, dp->acpi_hid.uid);
				break;
			default:
				debug("ACPI subtype %d???",
				      dp->subtype);
				errno = EINVAL;
				return -1;
			}
		}
	} else {
		debug("Unknown ACPI device path type {0x%04hhx,0x%04hhx}",
		      dp->type, dp->subtype);
	}

	return off;
}

ssize_t PUBLIC
efidp_make_acpi_hid(uint8_t *buf, ssize_t size, uint32_t hid, uint32_t uid)
{
	efidp_acpi_hid *acpi_hid = (efidp_acpi_hid *)buf;
	ssize_t req = sizeof (*acpi_hid);
	ssize_t sz;

	sz = efidp_make_generic(buf, size, EFIDP_ACPI_TYPE, EFIDP_ACPI_HID,
				sizeof (*acpi_hid));
	if (size && sz == req) {
		acpi_hid->uid = uid;
		acpi_hid->hid = hid;
	}

	if (sz < 0)
		efi_error("efidp_make_generic failed");

	return sz;
}

ssize_t PUBLIC
efidp_make_acpi_hid_ex(uint8_t *buf, ssize_t size,
		       uint32_t hid, uint32_t uid, uint32_t cid,
		       const char *hidstr, const char *uidstr,
		       const char *cidstr)
{
	efidp_acpi_hid_ex *acpi_hid = (efidp_acpi_hid_ex *)buf;
	ssize_t req;
	ssize_t sz;
	size_t hidlen = hidstr ? strlen(hidstr) : 0;
	size_t uidlen = uidstr ? strlen(uidstr) : 0;
	size_t cidlen = cidstr ? strlen(cidstr) : 0;

	req = sizeof (*acpi_hid) + 3 + hidlen + uidlen + cidlen;
	sz = efidp_make_generic(buf, size, EFIDP_ACPI_TYPE, EFIDP_ACPI_HID_EX,
				req);
	if (size && sz == req) {
		acpi_hid->hid = hidlen ? 0 : hid;
		acpi_hid->uid = uidlen ? 0 : uid;
		acpi_hid->cid = cidlen ? 0 : cid;
		char *next = (char *)buf+offsetof(efidp_acpi_hid_ex, hidstr);
		if (hidlen)
			strcpy(next, hidstr);
		next += hidlen + 1;
		if (uidlen)
			strcpy(next, uidstr);
		next += uidlen + 1;
		if (cidlen)
			strcpy(next, cidstr);
	}

	if (sz < 0)
		efi_error("efidp_make_generic failed");

	return sz;
}

// vim:fenc=utf-8:tw=75:noet