12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121 |
- /*
- * ACPI device specific properties support.
- *
- * Copyright (C) 2014, Intel Corporation
- * All rights reserved.
- *
- * Authors: Mika Westerberg <mika.westerberg@linux.intel.com>
- * Darren Hart <dvhart@linux.intel.com>
- * Rafael J. Wysocki <rafael.j.wysocki@intel.com>
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 as
- * published by the Free Software Foundation.
- */
- #include <linux/acpi.h>
- #include <linux/device.h>
- #include <linux/export.h>
- #include "internal.h"
- static int acpi_data_get_property_array(struct acpi_device_data *data,
- const char *name,
- acpi_object_type type,
- const union acpi_object **obj);
- /* ACPI _DSD device properties UUID: daffd814-6eba-4d8c-8a91-bc9bbf4aa301 */
- static const u8 prp_uuid[16] = {
- 0x14, 0xd8, 0xff, 0xda, 0xba, 0x6e, 0x8c, 0x4d,
- 0x8a, 0x91, 0xbc, 0x9b, 0xbf, 0x4a, 0xa3, 0x01
- };
- /* ACPI _DSD data subnodes UUID: dbb8e3e6-5886-4ba6-8795-1319f52a966b */
- static const u8 ads_uuid[16] = {
- 0xe6, 0xe3, 0xb8, 0xdb, 0x86, 0x58, 0xa6, 0x4b,
- 0x87, 0x95, 0x13, 0x19, 0xf5, 0x2a, 0x96, 0x6b
- };
- static bool acpi_enumerate_nondev_subnodes(acpi_handle scope,
- const union acpi_object *desc,
- struct acpi_device_data *data,
- struct fwnode_handle *parent);
- static bool acpi_extract_properties(const union acpi_object *desc,
- struct acpi_device_data *data);
- static bool acpi_nondev_subnode_extract(const union acpi_object *desc,
- acpi_handle handle,
- const union acpi_object *link,
- struct list_head *list,
- struct fwnode_handle *parent)
- {
- struct acpi_data_node *dn;
- bool result;
- dn = kzalloc(sizeof(*dn), GFP_KERNEL);
- if (!dn)
- return false;
- dn->name = link->package.elements[0].string.pointer;
- dn->fwnode.type = FWNODE_ACPI_DATA;
- dn->parent = parent;
- INIT_LIST_HEAD(&dn->data.subnodes);
- result = acpi_extract_properties(desc, &dn->data);
- if (handle) {
- acpi_handle scope;
- acpi_status status;
- /*
- * The scope for the subnode object lookup is the one of the
- * namespace node (device) containing the object that has
- * returned the package. That is, it's the scope of that
- * object's parent.
- */
- status = acpi_get_parent(handle, &scope);
- if (ACPI_SUCCESS(status)
- && acpi_enumerate_nondev_subnodes(scope, desc, &dn->data,
- &dn->fwnode))
- result = true;
- } else if (acpi_enumerate_nondev_subnodes(NULL, desc, &dn->data,
- &dn->fwnode)) {
- result = true;
- }
- if (result) {
- dn->handle = handle;
- dn->data.pointer = desc;
- list_add_tail(&dn->sibling, list);
- return true;
- }
- kfree(dn);
- acpi_handle_debug(handle, "Invalid properties/subnodes data, skipping\n");
- return false;
- }
- static bool acpi_nondev_subnode_data_ok(acpi_handle handle,
- const union acpi_object *link,
- struct list_head *list,
- struct fwnode_handle *parent)
- {
- struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER };
- acpi_status status;
- status = acpi_evaluate_object_typed(handle, NULL, NULL, &buf,
- ACPI_TYPE_PACKAGE);
- if (ACPI_FAILURE(status))
- return false;
- if (acpi_nondev_subnode_extract(buf.pointer, handle, link, list,
- parent))
- return true;
- ACPI_FREE(buf.pointer);
- return false;
- }
- static bool acpi_nondev_subnode_ok(acpi_handle scope,
- const union acpi_object *link,
- struct list_head *list,
- struct fwnode_handle *parent)
- {
- acpi_handle handle;
- acpi_status status;
- if (!scope)
- return false;
- status = acpi_get_handle(scope, link->package.elements[1].string.pointer,
- &handle);
- if (ACPI_FAILURE(status))
- return false;
- return acpi_nondev_subnode_data_ok(handle, link, list, parent);
- }
- static int acpi_add_nondev_subnodes(acpi_handle scope,
- const union acpi_object *links,
- struct list_head *list,
- struct fwnode_handle *parent)
- {
- bool ret = false;
- int i;
- for (i = 0; i < links->package.count; i++) {
- const union acpi_object *link, *desc;
- acpi_handle handle;
- bool result;
- link = &links->package.elements[i];
- /* Only two elements allowed. */
- if (link->package.count != 2)
- continue;
- /* The first one must be a string. */
- if (link->package.elements[0].type != ACPI_TYPE_STRING)
- continue;
- /* The second one may be a string, a reference or a package. */
- switch (link->package.elements[1].type) {
- case ACPI_TYPE_STRING:
- result = acpi_nondev_subnode_ok(scope, link, list,
- parent);
- break;
- case ACPI_TYPE_LOCAL_REFERENCE:
- handle = link->package.elements[1].reference.handle;
- result = acpi_nondev_subnode_data_ok(handle, link, list,
- parent);
- break;
- case ACPI_TYPE_PACKAGE:
- desc = &link->package.elements[1];
- result = acpi_nondev_subnode_extract(desc, NULL, link,
- list, parent);
- break;
- default:
- result = false;
- break;
- }
- ret = ret || result;
- }
- return ret;
- }
- static bool acpi_enumerate_nondev_subnodes(acpi_handle scope,
- const union acpi_object *desc,
- struct acpi_device_data *data,
- struct fwnode_handle *parent)
- {
- int i;
- /* Look for the ACPI data subnodes UUID. */
- for (i = 0; i < desc->package.count; i += 2) {
- const union acpi_object *uuid, *links;
- uuid = &desc->package.elements[i];
- links = &desc->package.elements[i + 1];
- /*
- * The first element must be a UUID and the second one must be
- * a package.
- */
- if (uuid->type != ACPI_TYPE_BUFFER || uuid->buffer.length != 16
- || links->type != ACPI_TYPE_PACKAGE)
- break;
- if (memcmp(uuid->buffer.pointer, ads_uuid, sizeof(ads_uuid)))
- continue;
- return acpi_add_nondev_subnodes(scope, links, &data->subnodes,
- parent);
- }
- return false;
- }
- static bool acpi_property_value_ok(const union acpi_object *value)
- {
- int j;
- /*
- * The value must be an integer, a string, a reference, or a package
- * whose every element must be an integer, a string, or a reference.
- */
- switch (value->type) {
- case ACPI_TYPE_INTEGER:
- case ACPI_TYPE_STRING:
- case ACPI_TYPE_LOCAL_REFERENCE:
- return true;
- case ACPI_TYPE_PACKAGE:
- for (j = 0; j < value->package.count; j++)
- switch (value->package.elements[j].type) {
- case ACPI_TYPE_INTEGER:
- case ACPI_TYPE_STRING:
- case ACPI_TYPE_LOCAL_REFERENCE:
- continue;
- default:
- return false;
- }
- return true;
- }
- return false;
- }
- static bool acpi_properties_format_valid(const union acpi_object *properties)
- {
- int i;
- for (i = 0; i < properties->package.count; i++) {
- const union acpi_object *property;
- property = &properties->package.elements[i];
- /*
- * Only two elements allowed, the first one must be a string and
- * the second one has to satisfy certain conditions.
- */
- if (property->package.count != 2
- || property->package.elements[0].type != ACPI_TYPE_STRING
- || !acpi_property_value_ok(&property->package.elements[1]))
- return false;
- }
- return true;
- }
- static void acpi_init_of_compatible(struct acpi_device *adev)
- {
- const union acpi_object *of_compatible;
- int ret;
- ret = acpi_data_get_property_array(&adev->data, "compatible",
- ACPI_TYPE_STRING, &of_compatible);
- if (ret) {
- ret = acpi_dev_get_property(adev, "compatible",
- ACPI_TYPE_STRING, &of_compatible);
- if (ret) {
- if (adev->parent
- && adev->parent->flags.of_compatible_ok)
- goto out;
- return;
- }
- }
- adev->data.of_compatible = of_compatible;
- out:
- adev->flags.of_compatible_ok = 1;
- }
- static bool acpi_extract_properties(const union acpi_object *desc,
- struct acpi_device_data *data)
- {
- int i;
- if (desc->package.count % 2)
- return false;
- /* Look for the device properties UUID. */
- for (i = 0; i < desc->package.count; i += 2) {
- const union acpi_object *uuid, *properties;
- uuid = &desc->package.elements[i];
- properties = &desc->package.elements[i + 1];
- /*
- * The first element must be a UUID and the second one must be
- * a package.
- */
- if (uuid->type != ACPI_TYPE_BUFFER || uuid->buffer.length != 16
- || properties->type != ACPI_TYPE_PACKAGE)
- break;
- if (memcmp(uuid->buffer.pointer, prp_uuid, sizeof(prp_uuid)))
- continue;
- /*
- * We found the matching UUID. Now validate the format of the
- * package immediately following it.
- */
- if (!acpi_properties_format_valid(properties))
- break;
- data->properties = properties;
- return true;
- }
- return false;
- }
- void acpi_init_properties(struct acpi_device *adev)
- {
- struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER };
- struct acpi_hardware_id *hwid;
- acpi_status status;
- bool acpi_of = false;
- INIT_LIST_HEAD(&adev->data.subnodes);
- /*
- * Check if ACPI_DT_NAMESPACE_HID is present and inthat case we fill in
- * Device Tree compatible properties for this device.
- */
- list_for_each_entry(hwid, &adev->pnp.ids, list) {
- if (!strcmp(hwid->id, ACPI_DT_NAMESPACE_HID)) {
- acpi_of = true;
- break;
- }
- }
- status = acpi_evaluate_object_typed(adev->handle, "_DSD", NULL, &buf,
- ACPI_TYPE_PACKAGE);
- if (ACPI_FAILURE(status))
- goto out;
- if (acpi_extract_properties(buf.pointer, &adev->data)) {
- adev->data.pointer = buf.pointer;
- if (acpi_of)
- acpi_init_of_compatible(adev);
- }
- if (acpi_enumerate_nondev_subnodes(adev->handle, buf.pointer,
- &adev->data, acpi_fwnode_handle(adev)))
- adev->data.pointer = buf.pointer;
- if (!adev->data.pointer) {
- acpi_handle_debug(adev->handle, "Invalid _DSD data, skipping\n");
- ACPI_FREE(buf.pointer);
- }
- out:
- if (acpi_of && !adev->flags.of_compatible_ok)
- acpi_handle_info(adev->handle,
- ACPI_DT_NAMESPACE_HID " requires 'compatible' property\n");
- }
- static void acpi_destroy_nondev_subnodes(struct list_head *list)
- {
- struct acpi_data_node *dn, *next;
- if (list_empty(list))
- return;
- list_for_each_entry_safe_reverse(dn, next, list, sibling) {
- acpi_destroy_nondev_subnodes(&dn->data.subnodes);
- wait_for_completion(&dn->kobj_done);
- list_del(&dn->sibling);
- ACPI_FREE((void *)dn->data.pointer);
- kfree(dn);
- }
- }
- void acpi_free_properties(struct acpi_device *adev)
- {
- acpi_destroy_nondev_subnodes(&adev->data.subnodes);
- ACPI_FREE((void *)adev->data.pointer);
- adev->data.of_compatible = NULL;
- adev->data.pointer = NULL;
- adev->data.properties = NULL;
- }
- /**
- * acpi_data_get_property - return an ACPI property with given name
- * @data: ACPI device deta object to get the property from
- * @name: Name of the property
- * @type: Expected property type
- * @obj: Location to store the property value (if not %NULL)
- *
- * Look up a property with @name and store a pointer to the resulting ACPI
- * object at the location pointed to by @obj if found.
- *
- * Callers must not attempt to free the returned objects. These objects will be
- * freed by the ACPI core automatically during the removal of @data.
- *
- * Return: %0 if property with @name has been found (success),
- * %-EINVAL if the arguments are invalid,
- * %-EINVAL if the property doesn't exist,
- * %-EPROTO if the property value type doesn't match @type.
- */
- static int acpi_data_get_property(struct acpi_device_data *data,
- const char *name, acpi_object_type type,
- const union acpi_object **obj)
- {
- const union acpi_object *properties;
- int i;
- if (!data || !name)
- return -EINVAL;
- if (!data->pointer || !data->properties)
- return -EINVAL;
- properties = data->properties;
- for (i = 0; i < properties->package.count; i++) {
- const union acpi_object *propname, *propvalue;
- const union acpi_object *property;
- property = &properties->package.elements[i];
- propname = &property->package.elements[0];
- propvalue = &property->package.elements[1];
- if (!strcmp(name, propname->string.pointer)) {
- if (type != ACPI_TYPE_ANY && propvalue->type != type)
- return -EPROTO;
- if (obj)
- *obj = propvalue;
- return 0;
- }
- }
- return -EINVAL;
- }
- /**
- * acpi_dev_get_property - return an ACPI property with given name.
- * @adev: ACPI device to get the property from.
- * @name: Name of the property.
- * @type: Expected property type.
- * @obj: Location to store the property value (if not %NULL).
- */
- int acpi_dev_get_property(struct acpi_device *adev, const char *name,
- acpi_object_type type, const union acpi_object **obj)
- {
- return adev ? acpi_data_get_property(&adev->data, name, type, obj) : -EINVAL;
- }
- EXPORT_SYMBOL_GPL(acpi_dev_get_property);
- static struct acpi_device_data *acpi_device_data_of_node(struct fwnode_handle *fwnode)
- {
- if (fwnode->type == FWNODE_ACPI) {
- struct acpi_device *adev = to_acpi_device_node(fwnode);
- return &adev->data;
- } else if (fwnode->type == FWNODE_ACPI_DATA) {
- struct acpi_data_node *dn = to_acpi_data_node(fwnode);
- return &dn->data;
- }
- return NULL;
- }
- /**
- * acpi_node_prop_get - return an ACPI property with given name.
- * @fwnode: Firmware node to get the property from.
- * @propname: Name of the property.
- * @valptr: Location to store a pointer to the property value (if not %NULL).
- */
- int acpi_node_prop_get(struct fwnode_handle *fwnode, const char *propname,
- void **valptr)
- {
- return acpi_data_get_property(acpi_device_data_of_node(fwnode),
- propname, ACPI_TYPE_ANY,
- (const union acpi_object **)valptr);
- }
- /**
- * acpi_data_get_property_array - return an ACPI array property with given name
- * @adev: ACPI data object to get the property from
- * @name: Name of the property
- * @type: Expected type of array elements
- * @obj: Location to store a pointer to the property value (if not NULL)
- *
- * Look up an array property with @name and store a pointer to the resulting
- * ACPI object at the location pointed to by @obj if found.
- *
- * Callers must not attempt to free the returned objects. Those objects will be
- * freed by the ACPI core automatically during the removal of @data.
- *
- * Return: %0 if array property (package) with @name has been found (success),
- * %-EINVAL if the arguments are invalid,
- * %-EINVAL if the property doesn't exist,
- * %-EPROTO if the property is not a package or the type of its elements
- * doesn't match @type.
- */
- static int acpi_data_get_property_array(struct acpi_device_data *data,
- const char *name,
- acpi_object_type type,
- const union acpi_object **obj)
- {
- const union acpi_object *prop;
- int ret, i;
- ret = acpi_data_get_property(data, name, ACPI_TYPE_PACKAGE, &prop);
- if (ret)
- return ret;
- if (type != ACPI_TYPE_ANY) {
- /* Check that all elements are of correct type. */
- for (i = 0; i < prop->package.count; i++)
- if (prop->package.elements[i].type != type)
- return -EPROTO;
- }
- if (obj)
- *obj = prop;
- return 0;
- }
- /**
- * __acpi_node_get_property_reference - returns handle to the referenced object
- * @fwnode: Firmware node to get the property from
- * @propname: Name of the property
- * @index: Index of the reference to return
- * @num_args: Maximum number of arguments after each reference
- * @args: Location to store the returned reference with optional arguments
- *
- * Find property with @name, verifify that it is a package containing at least
- * one object reference and if so, store the ACPI device object pointer to the
- * target object in @args->adev. If the reference includes arguments, store
- * them in the @args->args[] array.
- *
- * If there's more than one reference in the property value package, @index is
- * used to select the one to return.
- *
- * It is possible to leave holes in the property value set like in the
- * example below:
- *
- * Package () {
- * "cs-gpios",
- * Package () {
- * ^GPIO, 19, 0, 0,
- * ^GPIO, 20, 0, 0,
- * 0,
- * ^GPIO, 21, 0, 0,
- * }
- * }
- *
- * Calling this function with index %2 return %-ENOENT and with index %3
- * returns the last entry. If the property does not contain any more values
- * %-ENODATA is returned. The NULL entry must be single integer and
- * preferably contain value %0.
- *
- * Return: %0 on success, negative error code on failure.
- */
- int __acpi_node_get_property_reference(struct fwnode_handle *fwnode,
- const char *propname, size_t index, size_t num_args,
- struct acpi_reference_args *args)
- {
- const union acpi_object *element, *end;
- const union acpi_object *obj;
- struct acpi_device_data *data;
- struct acpi_device *device;
- int ret, idx = 0;
- data = acpi_device_data_of_node(fwnode);
- if (!data)
- return -EINVAL;
- ret = acpi_data_get_property(data, propname, ACPI_TYPE_ANY, &obj);
- if (ret)
- return ret;
- /*
- * The simplest case is when the value is a single reference. Just
- * return that reference then.
- */
- if (obj->type == ACPI_TYPE_LOCAL_REFERENCE) {
- if (index)
- return -EINVAL;
- ret = acpi_bus_get_device(obj->reference.handle, &device);
- if (ret)
- return ret;
- args->adev = device;
- args->nargs = 0;
- return 0;
- }
- /*
- * If it is not a single reference, then it is a package of
- * references followed by number of ints as follows:
- *
- * Package () { REF, INT, REF, INT, INT }
- *
- * The index argument is then used to determine which reference
- * the caller wants (along with the arguments).
- */
- if (obj->type != ACPI_TYPE_PACKAGE || index >= obj->package.count)
- return -EPROTO;
- element = obj->package.elements;
- end = element + obj->package.count;
- while (element < end) {
- u32 nargs, i;
- if (element->type == ACPI_TYPE_LOCAL_REFERENCE) {
- ret = acpi_bus_get_device(element->reference.handle,
- &device);
- if (ret)
- return -ENODEV;
- nargs = 0;
- element++;
- /* assume following integer elements are all args */
- for (i = 0; element + i < end && i < num_args; i++) {
- int type = element[i].type;
- if (type == ACPI_TYPE_INTEGER)
- nargs++;
- else if (type == ACPI_TYPE_LOCAL_REFERENCE)
- break;
- else
- return -EPROTO;
- }
- if (nargs > MAX_ACPI_REFERENCE_ARGS)
- return -EPROTO;
- if (idx == index) {
- args->adev = device;
- args->nargs = nargs;
- for (i = 0; i < nargs; i++)
- args->args[i] = element[i].integer.value;
- return 0;
- }
- element += nargs;
- } else if (element->type == ACPI_TYPE_INTEGER) {
- if (idx == index)
- return -ENOENT;
- element++;
- } else {
- return -EPROTO;
- }
- idx++;
- }
- return -ENODATA;
- }
- EXPORT_SYMBOL_GPL(__acpi_node_get_property_reference);
- static int acpi_data_prop_read_single(struct acpi_device_data *data,
- const char *propname,
- enum dev_prop_type proptype, void *val)
- {
- const union acpi_object *obj;
- int ret;
- if (!val)
- return -EINVAL;
- if (proptype >= DEV_PROP_U8 && proptype <= DEV_PROP_U64) {
- ret = acpi_data_get_property(data, propname, ACPI_TYPE_INTEGER, &obj);
- if (ret)
- return ret;
- switch (proptype) {
- case DEV_PROP_U8:
- if (obj->integer.value > U8_MAX)
- return -EOVERFLOW;
- *(u8 *)val = obj->integer.value;
- break;
- case DEV_PROP_U16:
- if (obj->integer.value > U16_MAX)
- return -EOVERFLOW;
- *(u16 *)val = obj->integer.value;
- break;
- case DEV_PROP_U32:
- if (obj->integer.value > U32_MAX)
- return -EOVERFLOW;
- *(u32 *)val = obj->integer.value;
- break;
- default:
- *(u64 *)val = obj->integer.value;
- break;
- }
- } else if (proptype == DEV_PROP_STRING) {
- ret = acpi_data_get_property(data, propname, ACPI_TYPE_STRING, &obj);
- if (ret)
- return ret;
- *(char **)val = obj->string.pointer;
- return 1;
- } else {
- ret = -EINVAL;
- }
- return ret;
- }
- int acpi_dev_prop_read_single(struct acpi_device *adev, const char *propname,
- enum dev_prop_type proptype, void *val)
- {
- int ret;
- if (!adev)
- return -EINVAL;
- ret = acpi_data_prop_read_single(&adev->data, propname, proptype, val);
- if (ret < 0 || proptype != ACPI_TYPE_STRING)
- return ret;
- return 0;
- }
- static int acpi_copy_property_array_u8(const union acpi_object *items, u8 *val,
- size_t nval)
- {
- int i;
- for (i = 0; i < nval; i++) {
- if (items[i].type != ACPI_TYPE_INTEGER)
- return -EPROTO;
- if (items[i].integer.value > U8_MAX)
- return -EOVERFLOW;
- val[i] = items[i].integer.value;
- }
- return 0;
- }
- static int acpi_copy_property_array_u16(const union acpi_object *items,
- u16 *val, size_t nval)
- {
- int i;
- for (i = 0; i < nval; i++) {
- if (items[i].type != ACPI_TYPE_INTEGER)
- return -EPROTO;
- if (items[i].integer.value > U16_MAX)
- return -EOVERFLOW;
- val[i] = items[i].integer.value;
- }
- return 0;
- }
- static int acpi_copy_property_array_u32(const union acpi_object *items,
- u32 *val, size_t nval)
- {
- int i;
- for (i = 0; i < nval; i++) {
- if (items[i].type != ACPI_TYPE_INTEGER)
- return -EPROTO;
- if (items[i].integer.value > U32_MAX)
- return -EOVERFLOW;
- val[i] = items[i].integer.value;
- }
- return 0;
- }
- static int acpi_copy_property_array_u64(const union acpi_object *items,
- u64 *val, size_t nval)
- {
- int i;
- for (i = 0; i < nval; i++) {
- if (items[i].type != ACPI_TYPE_INTEGER)
- return -EPROTO;
- val[i] = items[i].integer.value;
- }
- return 0;
- }
- static int acpi_copy_property_array_string(const union acpi_object *items,
- char **val, size_t nval)
- {
- int i;
- for (i = 0; i < nval; i++) {
- if (items[i].type != ACPI_TYPE_STRING)
- return -EPROTO;
- val[i] = items[i].string.pointer;
- }
- return nval;
- }
- static int acpi_data_prop_read(struct acpi_device_data *data,
- const char *propname,
- enum dev_prop_type proptype,
- void *val, size_t nval)
- {
- const union acpi_object *obj;
- const union acpi_object *items;
- int ret;
- if (val && nval == 1) {
- ret = acpi_data_prop_read_single(data, propname, proptype, val);
- if (ret >= 0)
- return ret;
- }
- ret = acpi_data_get_property_array(data, propname, ACPI_TYPE_ANY, &obj);
- if (ret)
- return ret;
- if (!val)
- return obj->package.count;
- if (proptype != DEV_PROP_STRING && nval > obj->package.count)
- return -EOVERFLOW;
- else if (nval <= 0)
- return -EINVAL;
- items = obj->package.elements;
- switch (proptype) {
- case DEV_PROP_U8:
- ret = acpi_copy_property_array_u8(items, (u8 *)val, nval);
- break;
- case DEV_PROP_U16:
- ret = acpi_copy_property_array_u16(items, (u16 *)val, nval);
- break;
- case DEV_PROP_U32:
- ret = acpi_copy_property_array_u32(items, (u32 *)val, nval);
- break;
- case DEV_PROP_U64:
- ret = acpi_copy_property_array_u64(items, (u64 *)val, nval);
- break;
- case DEV_PROP_STRING:
- ret = acpi_copy_property_array_string(
- items, (char **)val,
- min_t(u32, nval, obj->package.count));
- break;
- default:
- ret = -EINVAL;
- break;
- }
- return ret;
- }
- int acpi_dev_prop_read(struct acpi_device *adev, const char *propname,
- enum dev_prop_type proptype, void *val, size_t nval)
- {
- return adev ? acpi_data_prop_read(&adev->data, propname, proptype, val, nval) : -EINVAL;
- }
- /**
- * acpi_node_prop_read - retrieve the value of an ACPI property with given name.
- * @fwnode: Firmware node to get the property from.
- * @propname: Name of the property.
- * @proptype: Expected property type.
- * @val: Location to store the property value (if not %NULL).
- * @nval: Size of the array pointed to by @val.
- *
- * If @val is %NULL, return the number of array elements comprising the value
- * of the property. Otherwise, read at most @nval values to the array at the
- * location pointed to by @val.
- */
- int acpi_node_prop_read(struct fwnode_handle *fwnode, const char *propname,
- enum dev_prop_type proptype, void *val, size_t nval)
- {
- return acpi_data_prop_read(acpi_device_data_of_node(fwnode),
- propname, proptype, val, nval);
- }
- /**
- * acpi_get_next_subnode - Return the next child node handle for a fwnode
- * @fwnode: Firmware node to find the next child node for.
- * @child: Handle to one of the device's child nodes or a null handle.
- */
- struct fwnode_handle *acpi_get_next_subnode(struct fwnode_handle *fwnode,
- struct fwnode_handle *child)
- {
- struct acpi_device *adev = to_acpi_device_node(fwnode);
- struct list_head *head, *next;
- if (!child || child->type == FWNODE_ACPI) {
- if (adev)
- head = &adev->children;
- else
- goto nondev;
- if (list_empty(head))
- goto nondev;
- if (child) {
- adev = to_acpi_device_node(child);
- next = adev->node.next;
- if (next == head) {
- child = NULL;
- goto nondev;
- }
- adev = list_entry(next, struct acpi_device, node);
- } else {
- adev = list_first_entry(head, struct acpi_device, node);
- }
- return acpi_fwnode_handle(adev);
- }
- nondev:
- if (!child || child->type == FWNODE_ACPI_DATA) {
- struct acpi_data_node *data = to_acpi_data_node(fwnode);
- struct acpi_data_node *dn;
- if (adev)
- head = &adev->data.subnodes;
- else if (data)
- head = &data->data.subnodes;
- else
- return NULL;
- if (list_empty(head))
- return NULL;
- if (child) {
- dn = to_acpi_data_node(child);
- next = dn->sibling.next;
- if (next == head)
- return NULL;
- dn = list_entry(next, struct acpi_data_node, sibling);
- } else {
- dn = list_first_entry(head, struct acpi_data_node, sibling);
- }
- return &dn->fwnode;
- }
- return NULL;
- }
- /**
- * acpi_node_get_parent - Return parent fwnode of this fwnode
- * @fwnode: Firmware node whose parent to get
- *
- * Returns parent node of an ACPI device or data firmware node or %NULL if
- * not available.
- */
- struct fwnode_handle *acpi_node_get_parent(struct fwnode_handle *fwnode)
- {
- if (is_acpi_data_node(fwnode)) {
- /* All data nodes have parent pointer so just return that */
- return to_acpi_data_node(fwnode)->parent;
- } else if (is_acpi_device_node(fwnode)) {
- acpi_handle handle, parent_handle;
- handle = to_acpi_device_node(fwnode)->handle;
- if (ACPI_SUCCESS(acpi_get_parent(handle, &parent_handle))) {
- struct acpi_device *adev;
- if (!acpi_bus_get_device(parent_handle, &adev))
- return acpi_fwnode_handle(adev);
- }
- }
- return NULL;
- }
- /**
- * acpi_graph_get_next_endpoint - Get next endpoint ACPI firmware node
- * @fwnode: Pointer to the parent firmware node
- * @prev: Previous endpoint node or %NULL to get the first
- *
- * Looks up next endpoint ACPI firmware node below a given @fwnode. Returns
- * %NULL if there is no next endpoint, ERR_PTR() in case of error. In case
- * of success the next endpoint is returned.
- */
- struct fwnode_handle *acpi_graph_get_next_endpoint(struct fwnode_handle *fwnode,
- struct fwnode_handle *prev)
- {
- struct fwnode_handle *port = NULL;
- struct fwnode_handle *endpoint;
- if (!prev) {
- do {
- port = fwnode_get_next_child_node(fwnode, port);
- /* Ports must have port property */
- if (fwnode_property_present(port, "port"))
- break;
- } while (port);
- } else {
- port = fwnode_get_parent(prev);
- }
- if (!port)
- return NULL;
- endpoint = fwnode_get_next_child_node(port, prev);
- while (!endpoint) {
- port = fwnode_get_next_child_node(fwnode, port);
- if (!port)
- break;
- if (fwnode_property_present(port, "port"))
- endpoint = fwnode_get_next_child_node(port, NULL);
- }
- if (endpoint) {
- /* Endpoints must have "endpoint" property */
- if (!fwnode_property_present(endpoint, "endpoint"))
- return ERR_PTR(-EPROTO);
- }
- return endpoint;
- }
- /**
- * acpi_graph_get_child_prop_value - Return a child with a given property value
- * @fwnode: device fwnode
- * @prop_name: The name of the property to look for
- * @val: the desired property value
- *
- * Return the port node corresponding to a given port number. Returns
- * the child node on success, NULL otherwise.
- */
- static struct fwnode_handle *acpi_graph_get_child_prop_value(
- struct fwnode_handle *fwnode, const char *prop_name, unsigned int val)
- {
- struct fwnode_handle *child;
- fwnode_for_each_child_node(fwnode, child) {
- u32 nr;
- if (!fwnode_property_read_u32(fwnode, prop_name, &nr))
- continue;
- if (val == nr)
- return child;
- }
- return NULL;
- }
- /**
- * acpi_graph_get_remote_enpoint - Parses and returns remote end of an endpoint
- * @fwnode: Endpoint firmware node pointing to a remote device
- * @parent: Firmware node of remote port parent is filled here if not %NULL
- * @port: Firmware node of remote port is filled here if not %NULL
- * @endpoint: Firmware node of remote endpoint is filled here if not %NULL
- *
- * Function parses remote end of ACPI firmware remote endpoint and fills in
- * fields requested by the caller. Returns %0 in case of success and
- * negative errno otherwise.
- */
- int acpi_graph_get_remote_endpoint(struct fwnode_handle *fwnode,
- struct fwnode_handle **parent,
- struct fwnode_handle **port,
- struct fwnode_handle **endpoint)
- {
- unsigned int port_nr, endpoint_nr;
- struct acpi_reference_args args;
- int ret;
- memset(&args, 0, sizeof(args));
- ret = acpi_node_get_property_reference(fwnode, "remote-endpoint", 0,
- &args);
- if (ret)
- return ret;
- /*
- * Always require two arguments with the reference: port and
- * endpoint indices.
- */
- if (args.nargs != 2)
- return -EPROTO;
- fwnode = acpi_fwnode_handle(args.adev);
- port_nr = args.args[0];
- endpoint_nr = args.args[1];
- if (parent)
- *parent = fwnode;
- if (!port && !endpoint)
- return 0;
- fwnode = acpi_graph_get_child_prop_value(fwnode, "port", port_nr);
- if (!fwnode)
- return -EPROTO;
- if (port)
- *port = fwnode;
- if (!endpoint)
- return 0;
- fwnode = acpi_graph_get_child_prop_value(fwnode, "endpoint",
- endpoint_nr);
- if (!fwnode)
- return -EPROTO;
- *endpoint = fwnode;
- return 0;
- }
|