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>
19 #define ACPI_GLUE_DEBUG 0
21 #define DBG(fmt, ...) \
22 printk(KERN_DEBUG PREFIX fmt, ##__VA_ARGS__)
24 #define DBG(fmt, ...) \
27 printk(KERN_DEBUG PREFIX fmt, ##__VA_ARGS__); \
30 static LIST_HEAD(bus_type_list
);
31 static DECLARE_RWSEM(bus_type_sem
);
33 #define PHYSICAL_NODE_STRING "physical_node"
35 int register_acpi_bus_type(struct acpi_bus_type
*type
)
39 if (type
&& type
->bus
&& type
->find_device
) {
40 down_write(&bus_type_sem
);
41 list_add_tail(&type
->list
, &bus_type_list
);
42 up_write(&bus_type_sem
);
43 printk(KERN_INFO PREFIX
"bus type %s registered\n",
49 EXPORT_SYMBOL_GPL(register_acpi_bus_type
);
51 int unregister_acpi_bus_type(struct acpi_bus_type
*type
)
56 down_write(&bus_type_sem
);
57 list_del_init(&type
->list
);
58 up_write(&bus_type_sem
);
59 printk(KERN_INFO PREFIX
"ACPI bus type %s unregistered\n",
65 EXPORT_SYMBOL_GPL(unregister_acpi_bus_type
);
67 static struct acpi_bus_type
*acpi_get_bus_type(struct bus_type
*type
)
69 struct acpi_bus_type
*tmp
, *ret
= NULL
;
74 down_read(&bus_type_sem
);
75 list_for_each_entry(tmp
, &bus_type_list
, list
) {
76 if (tmp
->bus
== type
) {
81 up_read(&bus_type_sem
);
85 static int acpi_find_bridge_device(struct device
*dev
, acpi_handle
* handle
)
87 struct acpi_bus_type
*tmp
;
90 down_read(&bus_type_sem
);
91 list_for_each_entry(tmp
, &bus_type_list
, list
) {
92 if (tmp
->find_bridge
&& !tmp
->find_bridge(dev
, handle
)) {
97 up_read(&bus_type_sem
);
101 static acpi_status
do_acpi_find_child(acpi_handle handle
, u32 lvl_not_used
,
102 void *addr_p
, void **ret_p
)
104 unsigned long long addr
;
107 status
= acpi_evaluate_integer(handle
, METHOD_NAME__ADR
, NULL
, &addr
);
108 if (ACPI_SUCCESS(status
) && addr
== *((u64
*)addr_p
)) {
110 return AE_CTRL_TERMINATE
;
115 acpi_handle
acpi_get_child(acpi_handle parent
, u64 address
)
122 acpi_walk_namespace(ACPI_TYPE_DEVICE
, parent
, 1, NULL
,
123 do_acpi_find_child
, &address
, &ret
);
124 return (acpi_handle
)ret
;
126 EXPORT_SYMBOL(acpi_get_child
);
128 static int acpi_bind_one(struct device
*dev
, acpi_handle handle
)
130 struct acpi_device
*acpi_dev
;
132 struct acpi_device_physical_node
*physical_node
, *pn
;
133 char physical_node_name
[sizeof(PHYSICAL_NODE_STRING
) + 2];
134 int retval
= -EINVAL
;
136 if (ACPI_HANDLE(dev
)) {
138 dev_warn(dev
, "ACPI handle is already set\n");
141 handle
= ACPI_HANDLE(dev
);
148 status
= acpi_bus_get_device(handle
, &acpi_dev
);
149 if (ACPI_FAILURE(status
))
152 physical_node
= kzalloc(sizeof(*physical_node
), GFP_KERNEL
);
153 if (!physical_node
) {
158 mutex_lock(&acpi_dev
->physical_node_lock
);
161 list_for_each_entry(pn
, &acpi_dev
->physical_node_list
, node
)
162 if (pn
->dev
== dev
) {
163 dev_warn(dev
, "Already associated with ACPI node\n");
167 /* allocate physical node id according to physical_node_id_bitmap */
168 physical_node
->node_id
=
169 find_first_zero_bit(acpi_dev
->physical_node_id_bitmap
,
170 ACPI_MAX_PHYSICAL_NODE
);
171 if (physical_node
->node_id
>= ACPI_MAX_PHYSICAL_NODE
) {
176 set_bit(physical_node
->node_id
, acpi_dev
->physical_node_id_bitmap
);
177 physical_node
->dev
= dev
;
178 list_add_tail(&physical_node
->node
, &acpi_dev
->physical_node_list
);
179 acpi_dev
->physical_node_count
++;
181 mutex_unlock(&acpi_dev
->physical_node_lock
);
183 if (!ACPI_HANDLE(dev
))
184 ACPI_HANDLE_SET(dev
, acpi_dev
->handle
);
186 if (!physical_node
->node_id
)
187 strcpy(physical_node_name
, PHYSICAL_NODE_STRING
);
189 sprintf(physical_node_name
,
190 "physical_node%d", physical_node
->node_id
);
191 retval
= sysfs_create_link(&acpi_dev
->dev
.kobj
, &dev
->kobj
,
193 retval
= sysfs_create_link(&dev
->kobj
, &acpi_dev
->dev
.kobj
,
196 if (acpi_dev
->wakeup
.flags
.valid
)
197 device_set_wakeup_capable(dev
, true);
202 ACPI_HANDLE_SET(dev
, NULL
);
207 mutex_unlock(&acpi_dev
->physical_node_lock
);
208 kfree(physical_node
);
212 static int acpi_unbind_one(struct device
*dev
)
214 struct acpi_device_physical_node
*entry
;
215 struct acpi_device
*acpi_dev
;
217 struct list_head
*node
, *next
;
219 if (!ACPI_HANDLE(dev
))
222 status
= acpi_bus_get_device(ACPI_HANDLE(dev
), &acpi_dev
);
223 if (ACPI_FAILURE(status
))
226 mutex_lock(&acpi_dev
->physical_node_lock
);
227 list_for_each_safe(node
, next
, &acpi_dev
->physical_node_list
) {
228 char physical_node_name
[sizeof(PHYSICAL_NODE_STRING
) + 2];
230 entry
= list_entry(node
, struct acpi_device_physical_node
,
232 if (entry
->dev
!= dev
)
236 clear_bit(entry
->node_id
, acpi_dev
->physical_node_id_bitmap
);
238 acpi_dev
->physical_node_count
--;
241 strcpy(physical_node_name
, PHYSICAL_NODE_STRING
);
243 sprintf(physical_node_name
,
244 "physical_node%d", entry
->node_id
);
246 sysfs_remove_link(&acpi_dev
->dev
.kobj
, physical_node_name
);
247 sysfs_remove_link(&dev
->kobj
, "firmware_node");
248 ACPI_HANDLE_SET(dev
, NULL
);
249 /* acpi_bind_one increase refcnt by one */
253 mutex_unlock(&acpi_dev
->physical_node_lock
);
258 dev_err(dev
, "Oops, 'acpi_handle' corrupt\n");
262 static int acpi_platform_notify(struct device
*dev
)
264 struct acpi_bus_type
*type
;
268 ret
= acpi_bind_one(dev
, NULL
);
269 if (ret
&& (!dev
->bus
|| !dev
->parent
)) {
270 /* bridge devices genernally haven't bus or parent */
271 ret
= acpi_find_bridge_device(dev
, &handle
);
273 ret
= acpi_bind_one(dev
, handle
);
279 type
= acpi_get_bus_type(dev
->bus
);
281 if (!type
|| !type
->find_device
) {
282 DBG("No ACPI bus support for %s\n", dev_name(dev
));
287 ret
= type
->find_device(dev
, &handle
);
289 DBG("Unable to get handle for %s\n", dev_name(dev
));
292 ret
= acpi_bind_one(dev
, handle
);
297 if (type
&& type
->setup
)
303 struct acpi_buffer buffer
= { ACPI_ALLOCATE_BUFFER
, NULL
};
305 acpi_get_name(ACPI_HANDLE(dev
), ACPI_FULL_PATHNAME
, &buffer
);
306 DBG("Device %s -> %s\n", dev_name(dev
), (char *)buffer
.pointer
);
307 kfree(buffer
.pointer
);
309 DBG("Device %s -> No ACPI support\n", dev_name(dev
));
315 static int acpi_platform_notify_remove(struct device
*dev
)
317 struct acpi_bus_type
*type
;
319 type
= acpi_get_bus_type(dev
->bus
);
320 if (type
&& type
->cleanup
)
323 acpi_unbind_one(dev
);
327 int __init
init_acpi_device_notify(void)
329 if (platform_notify
|| platform_notify_remove
) {
330 printk(KERN_ERR PREFIX
"Can't use platform_notify\n");
333 platform_notify
= acpi_platform_notify
;
334 platform_notify_remove
= acpi_platform_notify_remove
;