githubmirror/efivar

src/dp-acpi.c
267 строк7 KB
Gabriel Majeri
Use `__typeof__` instead of `typeof`
25 сен 2017, 18:46
25 сен 2017, 18:46651cf8a
/*
 * libefivar - library for the manipulation of EFI variables
 * Copyright 2012-2015 Red Hat, Inc.
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public License as
 * published by the Free Software Foundation; either version 2.1 of the
 * License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, see
 * <http://www.gnu.org/licenses/>.
 *
 */

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

#include <efivar/efivar.h>
#include "dp.h"

static ssize_t
_format_acpi_adr(char *buf, size_t size,
		 const char *dp_type __attribute__((__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)

ssize_t
_format_acpi_dn(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) {
		format_acpi_adr(buf, size, off, dp);
		return off;
	} else if (dp->subtype != EFIDP_ACPI_HID_EX &&
		   dp->subtype != EFIDP_ACPI_HID) {
		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);

		hidstr = dp->acpi_hid_ex.hidstr;
		hidlen = strnlen(hidstr, limit);
		limit -= hidlen + 1;

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

		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_PCIE_ROOT_HID:
				format(buf, size, off, "PcieRoot",
				       "PcieRoot(%s)", uidstr);
				return off;
			}
		}
	}

	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_PCIE_ROOT_HID:
		format(buf, size, off, "PcieRoot", "PcieRoot(0x%"PRIx32")",
		       dp->acpi_hid.uid);
		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, "Keyboard", "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:
		switch (dp->subtype) {
		case EFIDP_ACPI_HID_EX:
			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.uid);
				}
				break;
			}
			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.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.uid);
			}
			break;
		case EFIDP_ACPI_HID:
			format(buf, size, off, "Acpi",
			       "Acpi(0x%"PRIx32",0x%"PRIx32")",
			       dp->acpi_hid.hid, dp->acpi_hid.uid);
			break;
		}
	}

	return off;
}

ssize_t
__attribute__((__visibility__ ("default")))
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
__attribute__((__visibility__ ("default")))
__attribute__((__nonnull__ (6,7,8)))
efidp_make_acpi_hid_ex(uint8_t *buf, ssize_t size,
		       uint32_t hid, uint32_t uid, uint32_t cid,
		       char *hidstr, char *uidstr, char *cidstr)
{
	efidp_acpi_hid_ex *acpi_hid = (efidp_acpi_hid_ex *)buf;
	ssize_t req;
	ssize_t sz;

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

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

	return sz;
}