2 * Link physical devices with ACPI devices support
4 * Copyright (c) 2005 David Shaohua Li <shaohua.li@intel.com>
5 * Copyright (c) 2005 Intel Corp.
7 * This file is released under the GPLv2.
9 #include <linux/export.h>
10 #include <linux/init.h>
11 #include <linux/list.h>
12 #include <linux/device.h>
13 #include <linux/slab.h>
14 #include <linux/rwsem.h>
15 #include <linux/acpi.h>
16 #include <linux/dma-mapping.h>
20 #define ACPI_GLUE_DEBUG 0
22 #define DBG(fmt, ...) \
23 printk(KERN_DEBUG PREFIX fmt, ##__VA_ARGS__)
25 #define DBG(fmt, ...) \
28 printk(KERN_DEBUG PREFIX fmt, ##__VA_ARGS__); \
31 static LIST_HEAD(bus_type_list);
32 static DECLARE_RWSEM(bus_type_sem);
34 #define PHYSICAL_NODE_STRING "physical_node"
35 #define PHYSICAL_NODE_NAME_SIZE (sizeof(PHYSICAL_NODE_STRING) + 10)
37 int register_acpi_bus_type(struct acpi_bus_type *type)
41 if (type && type->match && type->find_companion) {
42 down_write(&bus_type_sem);
43 list_add_tail(&type->list, &bus_type_list);
44 up_write(&bus_type_sem);
45 printk(KERN_INFO PREFIX "bus type %s registered\n", type->name);
50 EXPORT_SYMBOL_GPL(register_acpi_bus_type);
52 int unregister_acpi_bus_type(struct acpi_bus_type *type)
57 down_write(&bus_type_sem);
58 list_del_init(&type->list);
59 up_write(&bus_type_sem);
60 printk(KERN_INFO PREFIX "bus type %s unregistered\n",
66 EXPORT_SYMBOL_GPL(unregister_acpi_bus_type);
68 static struct acpi_bus_type *acpi_get_bus_type(struct device *dev)
70 struct acpi_bus_type *tmp, *ret = NULL;
72 down_read(&bus_type_sem);
73 list_for_each_entry(tmp, &bus_type_list, list) {
74 if (tmp->match(dev)) {
79 up_read(&bus_type_sem);
83 #define FIND_CHILD_MIN_SCORE 1
84 #define FIND_CHILD_MAX_SCORE 2
86 static int find_child_checks(struct acpi_device *adev, bool check_children)
88 bool sta_present = true;
89 unsigned long long sta;
92 status = acpi_evaluate_integer(adev->handle, "_STA", NULL, &sta);
93 if (status == AE_NOT_FOUND)
95 else if (ACPI_FAILURE(status) || !(sta & ACPI_STA_DEVICE_ENABLED))
98 if (check_children && list_empty(&adev->children))
102 * If the device has a _HID returning a valid ACPI/PNP device ID, it is
103 * better to make it look less attractive here, so that the other device
104 * with the same _ADR value (that may not have a valid device ID) can be
105 * matched going forward. [This means a second spec violation in a row,
106 * so whatever we do here is best effort anyway.]
108 return sta_present && !adev->pnp.type.platform_id ?
109 FIND_CHILD_MAX_SCORE : FIND_CHILD_MIN_SCORE;
112 struct acpi_device *acpi_find_child_device(struct acpi_device *parent,
113 u64 address, bool check_children)
115 struct acpi_device *adev, *ret = NULL;
121 list_for_each_entry(adev, &parent->children, node) {
122 unsigned long long addr;
126 status = acpi_evaluate_integer(adev->handle, METHOD_NAME__ADR,
128 if (ACPI_FAILURE(status) || addr != address)
132 /* This is the first matching object. Save it. */
137 * There is more than one matching device object with the same
138 * _ADR value. That really is unexpected, so we are kind of
139 * beyond the scope of the spec here. We have to choose which
140 * one to return, though.
142 * First, check if the previously found object is good enough
143 * and return it if so. Second, do the same for the object that
147 ret_score = find_child_checks(ret, check_children);
148 if (ret_score == FIND_CHILD_MAX_SCORE)
151 score = find_child_checks(adev, check_children);
152 if (score == FIND_CHILD_MAX_SCORE) {
154 } else if (score > ret_score) {
161 EXPORT_SYMBOL_GPL(acpi_find_child_device);
163 static void acpi_physnode_link_name(char *buf, unsigned int node_id)
166 snprintf(buf, PHYSICAL_NODE_NAME_SIZE,
167 PHYSICAL_NODE_STRING "%u", node_id);
169 strcpy(buf, PHYSICAL_NODE_STRING);
172 int acpi_bind_one(struct device *dev, struct acpi_device *acpi_dev)
174 struct acpi_device_physical_node *physical_node, *pn;
175 char physical_node_name[PHYSICAL_NODE_NAME_SIZE];
176 struct list_head *physnode_list;
177 unsigned int node_id;
178 int retval = -EINVAL;
180 if (has_acpi_companion(dev)) {
182 dev_warn(dev, "ACPI companion already set\n");
185 acpi_dev = ACPI_COMPANION(dev);
191 get_device(&acpi_dev->dev);
193 physical_node = kzalloc(sizeof(*physical_node), GFP_KERNEL);
194 if (!physical_node) {
199 mutex_lock(&acpi_dev->physical_node_lock);
202 * Keep the list sorted by node_id so that the IDs of removed nodes can
203 * be recycled easily.
205 physnode_list = &acpi_dev->physical_node_list;
207 list_for_each_entry(pn, &acpi_dev->physical_node_list, node) {
209 if (pn->dev == dev) {
210 mutex_unlock(&acpi_dev->physical_node_lock);
212 dev_warn(dev, "Already associated with ACPI node\n");
213 kfree(physical_node);
214 if (ACPI_COMPANION(dev) != acpi_dev)
218 put_device(&acpi_dev->dev);
221 if (pn->node_id == node_id) {
222 physnode_list = &pn->node;
227 physical_node->node_id = node_id;
228 physical_node->dev = dev;
229 list_add(&physical_node->node, physnode_list);
230 acpi_dev->physical_node_count++;
232 if (!has_acpi_companion(dev))
233 ACPI_COMPANION_SET(dev, acpi_dev);
235 acpi_physnode_link_name(physical_node_name, node_id);
236 retval = sysfs_create_link(&acpi_dev->dev.kobj, &dev->kobj,
239 dev_err(&acpi_dev->dev, "Failed to create link %s (%d)\n",
240 physical_node_name, retval);
242 retval = sysfs_create_link(&dev->kobj, &acpi_dev->dev.kobj,
245 dev_err(dev, "Failed to create link firmware_node (%d)\n",
248 mutex_unlock(&acpi_dev->physical_node_lock);
250 if (acpi_dev->wakeup.flags.valid)
251 device_set_wakeup_capable(dev, true);
256 ACPI_COMPANION_SET(dev, NULL);
258 put_device(&acpi_dev->dev);
261 EXPORT_SYMBOL_GPL(acpi_bind_one);
263 int acpi_unbind_one(struct device *dev)
265 struct acpi_device *acpi_dev = ACPI_COMPANION(dev);
266 struct acpi_device_physical_node *entry;
271 mutex_lock(&acpi_dev->physical_node_lock);
273 list_for_each_entry(entry, &acpi_dev->physical_node_list, node)
274 if (entry->dev == dev) {
275 char physnode_name[PHYSICAL_NODE_NAME_SIZE];
277 list_del(&entry->node);
278 acpi_dev->physical_node_count--;
280 acpi_physnode_link_name(physnode_name, entry->node_id);
281 sysfs_remove_link(&acpi_dev->dev.kobj, physnode_name);
282 sysfs_remove_link(&dev->kobj, "firmware_node");
283 ACPI_COMPANION_SET(dev, NULL);
284 /* Drop references taken by acpi_bind_one(). */
286 put_device(&acpi_dev->dev);
291 mutex_unlock(&acpi_dev->physical_node_lock);
294 EXPORT_SYMBOL_GPL(acpi_unbind_one);
296 static int acpi_platform_notify(struct device *dev)
298 struct acpi_bus_type *type = acpi_get_bus_type(dev);
299 struct acpi_device *adev;
302 ret = acpi_bind_one(dev, NULL);
304 struct acpi_device *adev;
306 adev = type->find_companion(dev);
308 DBG("Unable to get handle for %s\n", dev_name(dev));
312 ret = acpi_bind_one(dev, adev);
316 adev = ACPI_COMPANION(dev);
320 if (type && type->setup)
322 else if (adev->handler && adev->handler->bind)
323 adev->handler->bind(dev);
328 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
330 acpi_get_name(ACPI_HANDLE(dev), ACPI_FULL_PATHNAME, &buffer);
331 DBG("Device %s -> %s\n", dev_name(dev), (char *)buffer.pointer);
332 kfree(buffer.pointer);
334 DBG("Device %s -> No ACPI support\n", dev_name(dev));
340 static int acpi_platform_notify_remove(struct device *dev)
342 struct acpi_device *adev = ACPI_COMPANION(dev);
343 struct acpi_bus_type *type;
348 type = acpi_get_bus_type(dev);
349 if (type && type->cleanup)
351 else if (adev->handler && adev->handler->unbind)
352 adev->handler->unbind(dev);
354 acpi_unbind_one(dev);
358 void __init init_acpi_device_notify(void)
360 if (platform_notify || platform_notify_remove) {
361 printk(KERN_ERR PREFIX "Can't use platform_notify\n");
364 platform_notify = acpi_platform_notify;
365 platform_notify_remove = acpi_platform_notify_remove;