scan.c 40.2 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6
/*
 * scan.c - support for transforming the ACPI namespace into individual objects
 */

#include <linux/module.h>
#include <linux/init.h>
7
#include <linux/slab.h>
8
#include <linux/kernel.h>
L
Linus Torvalds 已提交
9
#include <linux/acpi.h>
10 11
#include <linux/signal.h>
#include <linux/kthread.h>
12
#include <linux/dmi.h>
L
Linus Torvalds 已提交
13 14 15

#include <acpi/acpi_drivers.h>

16 17
#include "internal.h"

L
Linus Torvalds 已提交
18
#define _COMPONENT		ACPI_BUS_COMPONENT
19
ACPI_MODULE_NAME("scan");
L
Linus Torvalds 已提交
20
#define STRUCT_TO_INT(s)	(*((int*)&s))
L
Len Brown 已提交
21
extern struct acpi_device *acpi_root;
L
Linus Torvalds 已提交
22 23

#define ACPI_BUS_CLASS			"system_bus"
24
#define ACPI_BUS_HID			"LNXSYBUS"
L
Linus Torvalds 已提交
25 26
#define ACPI_BUS_DEVICE_NAME		"System Bus"

27 28
#define ACPI_IS_ROOT_DEVICE(device)    (!(device)->parent)

29
static const char *dummy_hid = "device";
30

L
Linus Torvalds 已提交
31
static LIST_HEAD(acpi_device_list);
32
static LIST_HEAD(acpi_bus_id_list);
33
DEFINE_MUTEX(acpi_device_lock);
L
Linus Torvalds 已提交
34 35
LIST_HEAD(acpi_wakeup_device_list);

36
struct acpi_device_bus_id{
37
	char bus_id[15];
38 39
	unsigned int instance_no;
	struct list_head node;
L
Linus Torvalds 已提交
40
};
41 42 43 44 45 46

/*
 * Creates hid/cid(s) string needed for modalias and uevent
 * e.g. on a device with hid:IBM0001 and cid:ACPI0001 you get:
 * char *modalias: "acpi:IBM0001:ACPI0001"
*/
47 48 49
static int create_modalias(struct acpi_device *acpi_dev, char *modalias,
			   int size)
{
50
	int len;
51
	int count;
52
	struct acpi_hardware_id *id;
53

54 55 56
	if (list_empty(&acpi_dev->pnp.ids))
		return 0;

57
	len = snprintf(modalias, size, "acpi:");
58 59
	size -= len;

60 61
	list_for_each_entry(id, &acpi_dev->pnp.ids, list) {
		count = snprintf(&modalias[len], size, "%s:", id->id);
62 63 64 65 66 67
		if (count < 0 || count >= size)
			return -EINVAL;
		len += count;
		size -= count;
	}

68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85
	modalias[len] = '\0';
	return len;
}

static ssize_t
acpi_device_modalias_show(struct device *dev, struct device_attribute *attr, char *buf) {
	struct acpi_device *acpi_dev = to_acpi_device(dev);
	int len;

	/* Device has no HID and no CID or string is >1024 */
	len = create_modalias(acpi_dev, buf, 1024);
	if (len <= 0)
		return 0;
	buf[len++] = '\n';
	return len;
}
static DEVICE_ATTR(modalias, 0444, acpi_device_modalias_show, NULL);

86
static void acpi_bus_hot_remove_device(void *context)
L
Linus Torvalds 已提交
87
{
88 89
	struct acpi_device *device;
	acpi_handle handle = context;
L
Linus Torvalds 已提交
90 91 92 93
	struct acpi_object_list arg_list;
	union acpi_object arg;
	acpi_status status = AE_OK;

94
	if (acpi_bus_get_device(handle, &device))
95
		return;
96 97

	if (!device)
98
		return;
99 100

	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
101
		"Hot-removing device %s...\n", dev_name(&device->dev)));
102 103

	if (acpi_bus_trim(device, 1)) {
104 105
		printk(KERN_ERR PREFIX
				"Removing device failed\n");
106
		return;
107
	}
L
Linus Torvalds 已提交
108

109 110 111
	/* power off device */
	status = acpi_evaluate_object(handle, "_PS3", NULL, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND)
112 113
		printk(KERN_WARNING PREFIX
				"Power-off device failed\n");
114 115

	if (device->flags.lockable) {
L
Linus Torvalds 已提交
116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131
		arg_list.count = 1;
		arg_list.pointer = &arg;
		arg.type = ACPI_TYPE_INTEGER;
		arg.integer.value = 0;
		acpi_evaluate_object(handle, "_LCK", &arg_list, NULL);
	}

	arg_list.count = 1;
	arg_list.pointer = &arg;
	arg.type = ACPI_TYPE_INTEGER;
	arg.integer.value = 1;

	/*
	 * TBD: _EJD support.
	 */
	status = acpi_evaluate_object(handle, "_EJ0", &arg_list, NULL);
132
	if (ACPI_FAILURE(status))
133 134
		printk(KERN_WARNING PREFIX
				"Eject device failed\n");
L
Linus Torvalds 已提交
135

136
	return;
L
Linus Torvalds 已提交
137 138 139
}

static ssize_t
P
Patrick Mochel 已提交
140 141
acpi_eject_store(struct device *d, struct device_attribute *attr,
		const char *buf, size_t count)
L
Linus Torvalds 已提交
142
{
L
Len Brown 已提交
143 144 145
	int ret = count;
	acpi_status status;
	acpi_object_type type = 0;
P
Patrick Mochel 已提交
146
	struct acpi_device *acpi_device = to_acpi_device(d);
L
Linus Torvalds 已提交
147 148 149 150 151

	if ((!count) || (buf[0] != '1')) {
		return -EINVAL;
	}
#ifndef FORCE_EJECT
P
Patrick Mochel 已提交
152
	if (acpi_device->driver == NULL) {
L
Linus Torvalds 已提交
153 154 155 156
		ret = -ENODEV;
		goto err;
	}
#endif
P
Patrick Mochel 已提交
157 158
	status = acpi_get_type(acpi_device->handle, &type);
	if (ACPI_FAILURE(status) || (!acpi_device->flags.ejectable)) {
L
Linus Torvalds 已提交
159 160 161 162
		ret = -ENODEV;
		goto err;
	}

163
	acpi_os_hotplug_execute(acpi_bus_hot_remove_device, acpi_device->handle);
164
err:
L
Linus Torvalds 已提交
165 166 167
	return ret;
}

P
Patrick Mochel 已提交
168
static DEVICE_ATTR(eject, 0200, NULL, acpi_eject_store);
L
Linus Torvalds 已提交
169

170 171 172
static ssize_t
acpi_device_hid_show(struct device *dev, struct device_attribute *attr, char *buf) {
	struct acpi_device *acpi_dev = to_acpi_device(dev);
L
Linus Torvalds 已提交
173

174
	return sprintf(buf, "%s\n", acpi_device_hid(acpi_dev));
L
Linus Torvalds 已提交
175
}
176
static DEVICE_ATTR(hid, 0444, acpi_device_hid_show, NULL);
L
Linus Torvalds 已提交
177

178 179 180 181 182
static ssize_t
acpi_device_path_show(struct device *dev, struct device_attribute *attr, char *buf) {
	struct acpi_device *acpi_dev = to_acpi_device(dev);
	struct acpi_buffer path = {ACPI_ALLOCATE_BUFFER, NULL};
	int result;
L
Linus Torvalds 已提交
183

184
	result = acpi_get_name(acpi_dev->handle, ACPI_FULL_PATHNAME, &path);
185
	if (result)
186
		goto end;
L
Linus Torvalds 已提交
187

188 189
	result = sprintf(buf, "%s\n", (char*)path.pointer);
	kfree(path.pointer);
190
end:
191
	return result;
L
Linus Torvalds 已提交
192
}
193
static DEVICE_ATTR(path, 0444, acpi_device_path_show, NULL);
L
Linus Torvalds 已提交
194

195
static int acpi_device_setup_files(struct acpi_device *dev)
L
Linus Torvalds 已提交
196
{
P
Patrick Mochel 已提交
197 198
	acpi_status status;
	acpi_handle temp;
199
	int result = 0;
L
Linus Torvalds 已提交
200 201

	/*
202
	 * Devices gotten from FADT don't have a "path" attribute
L
Linus Torvalds 已提交
203
	 */
204
	if (dev->handle) {
205
		result = device_create_file(&dev->dev, &dev_attr_path);
206
		if (result)
207
			goto end;
L
Linus Torvalds 已提交
208 209
	}

210 211 212 213
	if (!list_empty(&dev->pnp.ids)) {
		result = device_create_file(&dev->dev, &dev_attr_hid);
		if (result)
			goto end;
L
Linus Torvalds 已提交
214

215 216 217 218
		result = device_create_file(&dev->dev, &dev_attr_modalias);
		if (result)
			goto end;
	}
219

220 221 222 223
        /*
         * If device has _EJ0, 'eject' file is created that is used to trigger
         * hot-removal function from userland.
         */
P
Patrick Mochel 已提交
224 225
	status = acpi_get_handle(dev->handle, "_EJ0", &temp);
	if (ACPI_SUCCESS(status))
226
		result = device_create_file(&dev->dev, &dev_attr_eject);
227
end:
228
	return result;
L
Linus Torvalds 已提交
229 230
}

P
Patrick Mochel 已提交
231
static void acpi_device_remove_files(struct acpi_device *dev)
L
Linus Torvalds 已提交
232
{
P
Patrick Mochel 已提交
233 234
	acpi_status status;
	acpi_handle temp;
L
Linus Torvalds 已提交
235

P
Patrick Mochel 已提交
236 237 238 239 240 241 242
	/*
	 * If device has _EJ0, 'eject' file is created that is used to trigger
	 * hot-removal function from userland.
	 */
	status = acpi_get_handle(dev->handle, "_EJ0", &temp);
	if (ACPI_SUCCESS(status))
		device_remove_file(&dev->dev, &dev_attr_eject);
L
Linus Torvalds 已提交
243

244 245
	device_remove_file(&dev->dev, &dev_attr_modalias);
	device_remove_file(&dev->dev, &dev_attr_hid);
246
	if (dev->handle)
247
		device_remove_file(&dev->dev, &dev_attr_path);
L
Linus Torvalds 已提交
248 249
}
/* --------------------------------------------------------------------------
Z
Zhang Rui 已提交
250
			ACPI Bus operations
L
Linus Torvalds 已提交
251
   -------------------------------------------------------------------------- */
252 253 254 255 256

int acpi_match_device_ids(struct acpi_device *device,
			  const struct acpi_device_id *ids)
{
	const struct acpi_device_id *id;
257
	struct acpi_hardware_id *hwid;
258

259 260 261 262 263 264 265
	/*
	 * If the device is not present, it is unnecessary to load device
	 * driver for it.
	 */
	if (!device->status.present)
		return -ENODEV;

266 267 268
	for (id = ids; id->id[0]; id++)
		list_for_each_entry(hwid, &device->pnp.ids, list)
			if (!strcmp((char *) id->id, hwid->id))
269 270 271 272 273 274
				return 0;

	return -ENOENT;
}
EXPORT_SYMBOL(acpi_match_device_ids);

275 276 277 278 279 280 281 282 283 284
static void acpi_free_ids(struct acpi_device *device)
{
	struct acpi_hardware_id *id, *tmp;

	list_for_each_entry_safe(id, tmp, &device->pnp.ids, list) {
		kfree(id->id);
		kfree(id);
	}
}

285
static void acpi_device_release(struct device *dev)
L
Linus Torvalds 已提交
286
{
287
	struct acpi_device *acpi_dev = to_acpi_device(dev);
L
Linus Torvalds 已提交
288

289
	acpi_free_ids(acpi_dev);
290
	kfree(acpi_dev);
L
Linus Torvalds 已提交
291 292
}

293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310
#define ACPI_DEV_PM_CALLBACK(dev, callback, legacy_cb)		\
({								\
	struct acpi_device *__acpi_dev = to_acpi_device(dev);	\
	struct acpi_driver *__acpi_drv = __acpi_dev->driver;	\
	struct device_driver *__drv = dev->driver;		\
	int __ret;						\
								\
	if (__acpi_drv && __acpi_drv->ops.legacy_cb)		\
		__ret = __acpi_drv->ops.legacy_cb(__acpi_dev);	\
	else if (__drv && __drv->pm && __drv->pm->callback)	\
		__ret = __drv->pm->callback(dev);		\
	else							\
		__ret = 0;					\
								\
	__ret;							\
})

static int acpi_pm_suspend(struct device *dev)
L
Linus Torvalds 已提交
311
{
312 313
	return ACPI_DEV_PM_CALLBACK(dev, suspend, suspend);
}
L
Linus Torvalds 已提交
314

315 316 317
static int acpi_pm_resume(struct device *dev)
{
	return ACPI_DEV_PM_CALLBACK(dev, resume, resume);
L
Linus Torvalds 已提交
318 319
}

320
static int acpi_pm_freeze(struct device *dev)
Z
Zhang Rui 已提交
321
{
322 323
	return ACPI_DEV_PM_CALLBACK(dev, freeze, suspend);
}
L
Linus Torvalds 已提交
324

325 326 327
static int acpi_pm_thaw(struct device *dev)
{
	return ACPI_DEV_PM_CALLBACK(dev, thaw, resume);
L
Linus Torvalds 已提交
328 329
}

330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347
static int acpi_pm_poweroff(struct device *dev)
{
	return ACPI_DEV_PM_CALLBACK(dev, poweroff, suspend);
}

static int acpi_pm_restore(struct device *dev)
{
	return ACPI_DEV_PM_CALLBACK(dev, restore, resume);
}

static const struct dev_pm_ops acpi_bus_pm = {
	.suspend = acpi_pm_suspend,
	.resume = acpi_pm_resume,
	.freeze = acpi_pm_freeze,
	.thaw = acpi_pm_thaw,
	.poweroff = acpi_pm_poweroff,
	.restore = acpi_pm_restore,
};
348

349
static int acpi_bus_match(struct device *dev, struct device_driver *drv)
Z
Zhang Rui 已提交
350
{
351 352
	struct acpi_device *acpi_dev = to_acpi_device(dev);
	struct acpi_driver *acpi_drv = to_acpi_driver(drv);
L
Linus Torvalds 已提交
353

354
	return !acpi_match_device_ids(acpi_dev, acpi_drv->ids);
355
}
L
Linus Torvalds 已提交
356

357
static int acpi_device_uevent(struct device *dev, struct kobj_uevent_env *env)
L
Linus Torvalds 已提交
358
{
359
	struct acpi_device *acpi_dev = to_acpi_device(dev);
360
	int len;
361

362 363 364
	if (list_empty(&acpi_dev->pnp.ids))
		return 0;

365 366 367 368 369 370 371
	if (add_uevent_var(env, "MODALIAS="))
		return -ENOMEM;
	len = create_modalias(acpi_dev, &env->buf[env->buflen - 1],
			      sizeof(env->buf) - env->buflen);
	if (len >= (sizeof(env->buf) - env->buflen))
		return -ENOMEM;
	env->buflen += len;
Z
Zhang Rui 已提交
372
	return 0;
L
Linus Torvalds 已提交
373 374
}

375 376 377 378 379 380 381 382 383 384 385
static void acpi_device_notify(acpi_handle handle, u32 event, void *data)
{
	struct acpi_device *device = data;

	device->driver->ops.notify(device, event);
}

static acpi_status acpi_device_notify_fixed(void *data)
{
	struct acpi_device *device = data;

386 387
	/* Fixed hardware devices have no handles */
	acpi_device_notify(NULL, ACPI_FIXED_HARDWARE_EVENT, device);
388 389 390 391 392 393 394
	return AE_OK;
}

static int acpi_device_install_notify_handler(struct acpi_device *device)
{
	acpi_status status;

395
	if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
396 397 398 399
		status =
		    acpi_install_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
						     acpi_device_notify_fixed,
						     device);
400
	else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417
		status =
		    acpi_install_fixed_event_handler(ACPI_EVENT_SLEEP_BUTTON,
						     acpi_device_notify_fixed,
						     device);
	else
		status = acpi_install_notify_handler(device->handle,
						     ACPI_DEVICE_NOTIFY,
						     acpi_device_notify,
						     device);

	if (ACPI_FAILURE(status))
		return -EINVAL;
	return 0;
}

static void acpi_device_remove_notify_handler(struct acpi_device *device)
{
418
	if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
419 420
		acpi_remove_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
						acpi_device_notify_fixed);
421
	else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
422 423 424 425 426 427 428
		acpi_remove_fixed_event_handler(ACPI_EVENT_SLEEP_BUTTON,
						acpi_device_notify_fixed);
	else
		acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY,
					   acpi_device_notify);
}

429 430 431
static int acpi_bus_driver_init(struct acpi_device *, struct acpi_driver *);
static int acpi_start_single_object(struct acpi_device *);
static int acpi_device_probe(struct device * dev)
L
Linus Torvalds 已提交
432
{
433 434 435 436 437 438
	struct acpi_device *acpi_dev = to_acpi_device(dev);
	struct acpi_driver *acpi_drv = to_acpi_driver(dev->driver);
	int ret;

	ret = acpi_bus_driver_init(acpi_dev, acpi_drv);
	if (!ret) {
L
Li Shaohua 已提交
439 440
		if (acpi_dev->bus_ops.acpi_op_start)
			acpi_start_single_object(acpi_dev);
441 442 443 444 445 446 447 448 449 450 451

		if (acpi_drv->ops.notify) {
			ret = acpi_device_install_notify_handler(acpi_dev);
			if (ret) {
				if (acpi_drv->ops.remove)
					acpi_drv->ops.remove(acpi_dev,
						     acpi_dev->removal_type);
				return ret;
			}
		}

452 453 454 455 456 457 458
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			"Found driver [%s] for device [%s]\n",
			acpi_drv->name, acpi_dev->pnp.bus_id));
		get_device(dev);
	}
	return ret;
}
L
Linus Torvalds 已提交
459

460 461 462 463 464 465
static int acpi_device_remove(struct device * dev)
{
	struct acpi_device *acpi_dev = to_acpi_device(dev);
	struct acpi_driver *acpi_drv = acpi_dev->driver;

	if (acpi_drv) {
466 467
		if (acpi_drv->ops.notify)
			acpi_device_remove_notify_handler(acpi_dev);
468
		if (acpi_drv->ops.remove)
469
			acpi_drv->ops.remove(acpi_dev, acpi_dev->removal_type);
L
Linus Torvalds 已提交
470
	}
471
	acpi_dev->driver = NULL;
472
	acpi_dev->driver_data = NULL;
L
Linus Torvalds 已提交
473

474
	put_device(dev);
Z
Zhang Rui 已提交
475 476
	return 0;
}
L
Linus Torvalds 已提交
477

478
struct bus_type acpi_bus_type = {
Z
Zhang Rui 已提交
479
	.name		= "acpi",
480 481 482 483
	.match		= acpi_bus_match,
	.probe		= acpi_device_probe,
	.remove		= acpi_device_remove,
	.uevent		= acpi_device_uevent,
484
	.pm		= &acpi_bus_pm,
Z
Zhang Rui 已提交
485 486
};

487
static int acpi_device_register(struct acpi_device *device)
L
Linus Torvalds 已提交
488
{
L
Len Brown 已提交
489
	int result;
490 491
	struct acpi_device_bus_id *acpi_device_bus_id, *new_bus_id;
	int found = 0;
492

Z
Zhang Rui 已提交
493 494 495 496 497 498 499 500
	/*
	 * Linkage
	 * -------
	 * Link this device to its parent and siblings.
	 */
	INIT_LIST_HEAD(&device->children);
	INIT_LIST_HEAD(&device->node);
	INIT_LIST_HEAD(&device->wakeup_list);
L
Linus Torvalds 已提交
501

502 503 504 505
	new_bus_id = kzalloc(sizeof(struct acpi_device_bus_id), GFP_KERNEL);
	if (!new_bus_id) {
		printk(KERN_ERR PREFIX "Memory allocation error\n");
		return -ENOMEM;
L
Linus Torvalds 已提交
506
	}
507

508
	mutex_lock(&acpi_device_lock);
509 510 511 512 513
	/*
	 * Find suitable bus_id and instance number in acpi_bus_id_list
	 * If failed, create one and link it into acpi_bus_id_list
	 */
	list_for_each_entry(acpi_device_bus_id, &acpi_bus_id_list, node) {
514 515 516
		if (!strcmp(acpi_device_bus_id->bus_id,
			    acpi_device_hid(device))) {
			acpi_device_bus_id->instance_no++;
517 518 519 520
			found = 1;
			kfree(new_bus_id);
			break;
		}
L
Linus Torvalds 已提交
521
	}
522
	if (!found) {
523
		acpi_device_bus_id = new_bus_id;
524
		strcpy(acpi_device_bus_id->bus_id, acpi_device_hid(device));
525 526
		acpi_device_bus_id->instance_no = 0;
		list_add_tail(&acpi_device_bus_id->node, &acpi_bus_id_list);
L
Linus Torvalds 已提交
527
	}
528
	dev_set_name(&device->dev, "%s:%02x", acpi_device_bus_id->bus_id, acpi_device_bus_id->instance_no);
L
Linus Torvalds 已提交
529

L
Len Brown 已提交
530
	if (device->parent)
Z
Zhang Rui 已提交
531
		list_add_tail(&device->node, &device->parent->children);
L
Len Brown 已提交
532

Z
Zhang Rui 已提交
533 534
	if (device->wakeup.flags.valid)
		list_add_tail(&device->wakeup_list, &acpi_wakeup_device_list);
535
	mutex_unlock(&acpi_device_lock);
L
Linus Torvalds 已提交
536

537
	if (device->parent)
538
		device->dev.parent = &device->parent->dev;
539 540
	device->dev.bus = &acpi_bus_type;
	device->dev.release = &acpi_device_release;
541
	result = device_register(&device->dev);
542
	if (result) {
543
		dev_err(&device->dev, "Error registering device\n");
544
		goto end;
L
Linus Torvalds 已提交
545 546
	}

547
	result = acpi_device_setup_files(device);
548
	if (result)
549 550
		printk(KERN_ERR PREFIX "Error creating sysfs interface for device %s\n",
		       dev_name(&device->dev));
L
Linus Torvalds 已提交
551

552
	device->removal_type = ACPI_BUS_REMOVAL_NORMAL;
L
Linus Torvalds 已提交
553
	return 0;
554
end:
555
	mutex_lock(&acpi_device_lock);
L
Len Brown 已提交
556
	if (device->parent)
557 558
		list_del(&device->node);
	list_del(&device->wakeup_list);
559
	mutex_unlock(&acpi_device_lock);
560
	return result;
L
Linus Torvalds 已提交
561 562
}

Z
Zhang Rui 已提交
563 564
static void acpi_device_unregister(struct acpi_device *device, int type)
{
565
	mutex_lock(&acpi_device_lock);
L
Len Brown 已提交
566
	if (device->parent)
Z
Zhang Rui 已提交
567
		list_del(&device->node);
L
Linus Torvalds 已提交
568

Z
Zhang Rui 已提交
569
	list_del(&device->wakeup_list);
570
	mutex_unlock(&acpi_device_lock);
L
Linus Torvalds 已提交
571

Z
Zhang Rui 已提交
572
	acpi_detach_data(device->handle, acpi_bus_data_handler);
573

P
Patrick Mochel 已提交
574
	acpi_device_remove_files(device);
575
	device_unregister(&device->dev);
L
Linus Torvalds 已提交
576 577
}

Z
Zhang Rui 已提交
578 579 580
/* --------------------------------------------------------------------------
                                 Driver Management
   -------------------------------------------------------------------------- */
L
Linus Torvalds 已提交
581
/**
582 583 584 585
 * acpi_bus_driver_init - add a device to a driver
 * @device: the device to add and initialize
 * @driver: driver for the device
 *
586
 * Used to initialize a device via its device driver.  Called whenever a
587
 * driver is bound to a device.  Invokes the driver's add() ops.
L
Linus Torvalds 已提交
588 589
 */
static int
L
Len Brown 已提交
590
acpi_bus_driver_init(struct acpi_device *device, struct acpi_driver *driver)
L
Linus Torvalds 已提交
591
{
L
Len Brown 已提交
592
	int result = 0;
L
Linus Torvalds 已提交
593 594

	if (!device || !driver)
595
		return -EINVAL;
L
Linus Torvalds 已提交
596 597

	if (!driver->ops.add)
598
		return -ENOSYS;
L
Linus Torvalds 已提交
599 600 601 602

	result = driver->ops.add(device);
	if (result) {
		device->driver = NULL;
603
		device->driver_data = NULL;
604
		return result;
L
Linus Torvalds 已提交
605 606 607 608 609 610 611 612 613
	}

	device->driver = driver;

	/*
	 * TBD - Configuration Management: Assign resources to device based
	 * upon possible configuration and currently allocated resources.
	 */

L
Len Brown 已提交
614 615
	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			  "Driver successfully bound to device\n"));
616
	return 0;
617 618
}

619
static int acpi_start_single_object(struct acpi_device *device)
620 621 622 623 624 625
{
	int result = 0;
	struct acpi_driver *driver;


	if (!(driver = device->driver))
626
		return 0;
627

L
Linus Torvalds 已提交
628 629 630 631 632 633
	if (driver->ops.start) {
		result = driver->ops.start(device);
		if (result && driver->ops.remove)
			driver->ops.remove(device, ACPI_BUS_REMOVAL_NORMAL);
	}

634
	return result;
L
Linus Torvalds 已提交
635 636
}

Z
Zhang Rui 已提交
637 638 639 640 641 642 643 644 645
/**
 * acpi_bus_register_driver - register a driver with the ACPI bus
 * @driver: driver being registered
 *
 * Registers a driver with the ACPI bus.  Searches the namespace for all
 * devices that match the driver's criteria and binds.  Returns zero for
 * success or a negative error status for failure.
 */
int acpi_bus_register_driver(struct acpi_driver *driver)
L
Linus Torvalds 已提交
646
{
647
	int ret;
L
Linus Torvalds 已提交
648

Z
Zhang Rui 已提交
649 650
	if (acpi_disabled)
		return -ENODEV;
651 652 653
	driver->drv.name = driver->name;
	driver->drv.bus = &acpi_bus_type;
	driver->drv.owner = driver->owner;
L
Linus Torvalds 已提交
654

655 656
	ret = driver_register(&driver->drv);
	return ret;
Z
Zhang Rui 已提交
657
}
L
Linus Torvalds 已提交
658

Z
Zhang Rui 已提交
659 660 661 662 663 664 665 666 667 668 669
EXPORT_SYMBOL(acpi_bus_register_driver);

/**
 * acpi_bus_unregister_driver - unregisters a driver with the APIC bus
 * @driver: driver to unregister
 *
 * Unregisters a driver with the ACPI bus.  Searches the namespace for all
 * devices that match the driver's criteria and unbinds.
 */
void acpi_bus_unregister_driver(struct acpi_driver *driver)
{
670
	driver_unregister(&driver->drv);
Z
Zhang Rui 已提交
671 672 673 674 675 676 677
}

EXPORT_SYMBOL(acpi_bus_unregister_driver);

/* --------------------------------------------------------------------------
                                 Device Enumeration
   -------------------------------------------------------------------------- */
678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704
static struct acpi_device *acpi_bus_get_parent(acpi_handle handle)
{
	acpi_status status;
	int ret;
	struct acpi_device *device;

	/*
	 * Fixed hardware devices do not appear in the namespace and do not
	 * have handles, but we fabricate acpi_devices for them, so we have
	 * to deal with them specially.
	 */
	if (handle == NULL)
		return acpi_root;

	do {
		status = acpi_get_parent(handle, &handle);
		if (status == AE_NULL_ENTRY)
			return NULL;
		if (ACPI_FAILURE(status))
			return acpi_root;

		ret = acpi_bus_get_device(handle, &device);
		if (ret == 0)
			return device;
	} while (1);
}

Z
Zhang Rui 已提交
705 706 707 708 709 710 711 712 713 714 715 716 717 718 719
acpi_status
acpi_bus_get_ejd(acpi_handle handle, acpi_handle *ejd)
{
	acpi_status status;
	acpi_handle tmp;
	struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
	union acpi_object *obj;

	status = acpi_get_handle(handle, "_EJD", &tmp);
	if (ACPI_FAILURE(status))
		return status;

	status = acpi_evaluate_object(handle, "_EJD", NULL, &buffer);
	if (ACPI_SUCCESS(status)) {
		obj = buffer.pointer;
720 721
		status = acpi_get_handle(ACPI_ROOT_OBJECT, obj->string.pointer,
					 ejd);
Z
Zhang Rui 已提交
722 723 724 725 726 727
		kfree(buffer.pointer);
	}
	return status;
}
EXPORT_SYMBOL_GPL(acpi_bus_get_ejd);

728
void acpi_bus_data_handler(acpi_handle handle, void *context)
Z
Zhang Rui 已提交
729 730 731 732 733 734 735 736 737 738 739 740 741 742
{

	/* TBD */

	return;
}

static int acpi_bus_get_perf_flags(struct acpi_device *device)
{
	device->performance.state = ACPI_STATE_UNKNOWN;
	return 0;
}

static acpi_status
743 744
acpi_bus_extract_wakeup_device_power_package(acpi_handle handle,
					     struct acpi_device_wakeup *wakeup)
Z
Zhang Rui 已提交
745
{
746 747
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *package = NULL;
Z
Zhang Rui 已提交
748
	union acpi_object *element = NULL;
749 750
	acpi_status status;
	int i = 0;
Z
Zhang Rui 已提交
751

752
	if (!wakeup)
Z
Zhang Rui 已提交
753 754
		return AE_BAD_PARAMETER;

755 756 757 758 759 760 761 762 763 764 765 766 767 768
	/* _PRW */
	status = acpi_evaluate_object(handle, "_PRW", NULL, &buffer);
	if (ACPI_FAILURE(status)) {
		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PRW"));
		return status;
	}

	package = (union acpi_object *)buffer.pointer;

	if (!package || (package->package.count < 2)) {
		status = AE_BAD_DATA;
		goto out;
	}

Z
Zhang Rui 已提交
769
	element = &(package->package.elements[0]);
770 771 772 773
	if (!element) {
		status = AE_BAD_DATA;
		goto out;
	}
Z
Zhang Rui 已提交
774 775 776 777
	if (element->type == ACPI_TYPE_PACKAGE) {
		if ((element->package.count < 2) ||
		    (element->package.elements[0].type !=
		     ACPI_TYPE_LOCAL_REFERENCE)
778 779 780 781 782
		    || (element->package.elements[1].type != ACPI_TYPE_INTEGER)) {
			status = AE_BAD_DATA;
			goto out;
		}
		wakeup->gpe_device =
Z
Zhang Rui 已提交
783
		    element->package.elements[0].reference.handle;
784
		wakeup->gpe_number =
Z
Zhang Rui 已提交
785 786
		    (u32) element->package.elements[1].integer.value;
	} else if (element->type == ACPI_TYPE_INTEGER) {
787 788 789 790 791 792
		wakeup->gpe_device = NULL;
		wakeup->gpe_number = element->integer.value;
	} else {
		status = AE_BAD_DATA;
		goto out;
	}
Z
Zhang Rui 已提交
793 794 795

	element = &(package->package.elements[1]);
	if (element->type != ACPI_TYPE_INTEGER) {
796 797
		status = AE_BAD_DATA;
		goto out;
Z
Zhang Rui 已提交
798
	}
799
	wakeup->sleep_state = element->integer.value;
Z
Zhang Rui 已提交
800 801

	if ((package->package.count - 2) > ACPI_MAX_HANDLES) {
802 803
		status = AE_NO_MEMORY;
		goto out;
Z
Zhang Rui 已提交
804
	}
805 806
	wakeup->resources.count = package->package.count - 2;
	for (i = 0; i < wakeup->resources.count; i++) {
Z
Zhang Rui 已提交
807
		element = &(package->package.elements[i + 2]);
808 809 810 811
		if (element->type != ACPI_TYPE_LOCAL_REFERENCE) {
			status = AE_BAD_DATA;
			goto out;
		}
Z
Zhang Rui 已提交
812

813
		wakeup->resources.handles[i] = element->reference.handle;
L
Linus Torvalds 已提交
814
	}
Z
Zhang Rui 已提交
815

L
Lin Ming 已提交
816
	acpi_setup_gpe_for_wake(handle, wakeup->gpe_device, wakeup->gpe_number);
817

818 819 820 821
 out:
	kfree(buffer.pointer);

	return status;
L
Linus Torvalds 已提交
822 823
}

824
static void acpi_bus_set_run_wake_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
825
{
826 827 828 829 830 831
	struct acpi_device_id button_device_ids[] = {
		{"PNP0C0D", 0},
		{"PNP0C0C", 0},
		{"PNP0C0E", 0},
		{"", 0},
	};
832 833 834
	acpi_status status;
	acpi_event_status event_status;

835
	device->wakeup.flags.notifier_present = 0;
836 837 838 839

	/* Power button, Lid switch always enable wakeup */
	if (!acpi_match_device_ids(device, button_device_ids)) {
		device->wakeup.flags.run_wake = 1;
840
		device_set_wakeup_capable(&device->dev, true);
841 842 843
		return;
	}

844 845 846
	status = acpi_get_gpe_status(device->wakeup.gpe_device,
					device->wakeup.gpe_number,
						&event_status);
847 848 849 850 851
	if (status == AE_OK)
		device->wakeup.flags.run_wake =
				!!(event_status & ACPI_EVENT_FLAG_HANDLE);
}

852
static void acpi_bus_get_wakeup_device_flags(struct acpi_device *device)
853
{
854
	acpi_handle temp;
855 856
	acpi_status status = 0;
	int psw_error;
857

858 859 860 861 862
	/* Presence of _PRW indicates wake capable */
	status = acpi_get_handle(device->handle, "_PRW", &temp);
	if (ACPI_FAILURE(status))
		return;

863 864
	status = acpi_bus_extract_wakeup_device_power_package(device->handle,
							      &device->wakeup);
Z
Zhang Rui 已提交
865 866
	if (ACPI_FAILURE(status)) {
		ACPI_EXCEPTION((AE_INFO, status, "Extracting _PRW package"));
867
		return;
Z
Zhang Rui 已提交
868
	}
L
Linus Torvalds 已提交
869

Z
Zhang Rui 已提交
870
	device->wakeup.flags.valid = 1;
871
	device->wakeup.prepare_count = 0;
872
	acpi_bus_set_run_wake_flags(device);
873 874 875 876 877 878
	/* Call _PSW/_DSW object to disable its ability to wake the sleeping
	 * system for the ACPI device with the _PRW object.
	 * The _PSW object is depreciated in ACPI 3.0 and is replaced by _DSW.
	 * So it is necessary to call _DSW object first. Only when it is not
	 * present will the _PSW object used.
	 */
879 880 881 882
	psw_error = acpi_device_sleep_wake(device, 0, 0, 0);
	if (psw_error)
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				"error in _DSW or _PSW evaluation\n"));
L
Linus Torvalds 已提交
883 884
}

885 886
static void acpi_bus_add_power_resource(acpi_handle handle);

Z
Zhang Rui 已提交
887
static int acpi_bus_get_power_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
888
{
Z
Zhang Rui 已提交
889 890 891
	acpi_status status = 0;
	acpi_handle handle = NULL;
	u32 i = 0;
B
Bjorn Helgaas 已提交
892

L
Len Brown 已提交
893

Z
Zhang Rui 已提交
894 895 896 897 898 899 900 901 902
	/*
	 * Power Management Flags
	 */
	status = acpi_get_handle(device->handle, "_PSC", &handle);
	if (ACPI_SUCCESS(status))
		device->power.flags.explicit_get = 1;
	status = acpi_get_handle(device->handle, "_IRC", &handle);
	if (ACPI_SUCCESS(status))
		device->power.flags.inrush_current = 1;
L
Linus Torvalds 已提交
903

Z
Zhang Rui 已提交
904 905 906
	/*
	 * Enumerate supported power management states
	 */
L
Lin Ming 已提交
907
	for (i = ACPI_STATE_D0; i <= ACPI_STATE_D3_HOT; i++) {
Z
Zhang Rui 已提交
908 909
		struct acpi_device_power_state *ps = &device->power.states[i];
		char object_name[5] = { '_', 'P', 'R', '0' + i, '\0' };
L
Linus Torvalds 已提交
910

Z
Zhang Rui 已提交
911 912 913 914
		/* Evaluate "_PRx" to se if power resources are referenced */
		acpi_evaluate_reference(device->handle, object_name, NULL,
					&ps->resources);
		if (ps->resources.count) {
915 916
			int j;

Z
Zhang Rui 已提交
917
			device->power.flags.power_resources = 1;
918 919
			for (j = 0; j < ps->resources.count; j++)
				acpi_bus_add_power_resource(ps->resources.handles[j]);
L
Linus Torvalds 已提交
920 921
		}

Z
Zhang Rui 已提交
922 923 924
		/* Evaluate "_PSx" to see if we can do explicit sets */
		object_name[2] = 'S';
		status = acpi_get_handle(device->handle, object_name, &handle);
A
Alex He 已提交
925
		if (ACPI_SUCCESS(status))
Z
Zhang Rui 已提交
926
			ps->flags.explicit_set = 1;
L
Linus Torvalds 已提交
927

L
Lin Ming 已提交
928 929 930 931 932 933
		/*
		 * State is valid if there are means to put the device into it.
		 * D3hot is only valid if _PR3 present.
		 */
		if (ps->resources.count ||
		    (ps->flags.explicit_set && i < ACPI_STATE_D3_HOT))
Z
Zhang Rui 已提交
934
			ps->flags.valid = 1;
L
Linus Torvalds 已提交
935

Z
Zhang Rui 已提交
936 937 938
		ps->power = -1;	/* Unknown - driver assigned */
		ps->latency = -1;	/* Unknown - driver assigned */
	}
L
Linus Torvalds 已提交
939

Z
Zhang Rui 已提交
940 941 942 943 944
	/* Set defaults for D0 and D3 states (always valid) */
	device->power.states[ACPI_STATE_D0].flags.valid = 1;
	device->power.states[ACPI_STATE_D0].power = 100;
	device->power.states[ACPI_STATE_D3].flags.valid = 1;
	device->power.states[ACPI_STATE_D3].power = 0;
L
Len Brown 已提交
945

946 947 948 949
	/* Set D3cold's explicit_set flag if _PS3 exists. */
	if (device->power.states[ACPI_STATE_D3_HOT].flags.explicit_set)
		device->power.states[ACPI_STATE_D3_COLD].flags.explicit_set = 1;

950
	acpi_bus_init_power(device);
L
Len Brown 已提交
951

Z
Zhang Rui 已提交
952 953
	return 0;
}
L
Len Brown 已提交
954

L
Len Brown 已提交
955
static int acpi_bus_get_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
956
{
L
Len Brown 已提交
957 958
	acpi_status status = AE_OK;
	acpi_handle temp = NULL;
L
Linus Torvalds 已提交
959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985


	/* Presence of _STA indicates 'dynamic_status' */
	status = acpi_get_handle(device->handle, "_STA", &temp);
	if (ACPI_SUCCESS(status))
		device->flags.dynamic_status = 1;

	/* Presence of _RMV indicates 'removable' */
	status = acpi_get_handle(device->handle, "_RMV", &temp);
	if (ACPI_SUCCESS(status))
		device->flags.removable = 1;

	/* Presence of _EJD|_EJ0 indicates 'ejectable' */
	status = acpi_get_handle(device->handle, "_EJD", &temp);
	if (ACPI_SUCCESS(status))
		device->flags.ejectable = 1;
	else {
		status = acpi_get_handle(device->handle, "_EJ0", &temp);
		if (ACPI_SUCCESS(status))
			device->flags.ejectable = 1;
	}

	/* Presence of _LCK indicates 'lockable' */
	status = acpi_get_handle(device->handle, "_LCK", &temp);
	if (ACPI_SUCCESS(status))
		device->flags.lockable = 1;

986 987 988 989
	/* Power resources cannot be power manageable. */
	if (device->device_type == ACPI_BUS_TYPE_POWER)
		return 0;

L
Linus Torvalds 已提交
990 991 992 993 994 995 996
	/* Presence of _PS0|_PR0 indicates 'power manageable' */
	status = acpi_get_handle(device->handle, "_PS0", &temp);
	if (ACPI_FAILURE(status))
		status = acpi_get_handle(device->handle, "_PR0", &temp);
	if (ACPI_SUCCESS(status))
		device->flags.power_manageable = 1;

J
Joe Perches 已提交
997
	/* TBD: Performance management */
L
Linus Torvalds 已提交
998

999
	return 0;
L
Linus Torvalds 已提交
1000 1001
}

1002
static void acpi_device_get_busid(struct acpi_device *device)
L
Linus Torvalds 已提交
1003
{
L
Len Brown 已提交
1004 1005 1006
	char bus_id[5] = { '?', 0 };
	struct acpi_buffer buffer = { sizeof(bus_id), bus_id };
	int i = 0;
L
Linus Torvalds 已提交
1007 1008 1009 1010 1011 1012 1013

	/*
	 * Bus ID
	 * ------
	 * The device's Bus ID is simply the object name.
	 * TBD: Shouldn't this value be unique (within the ACPI namespace)?
	 */
1014
	if (ACPI_IS_ROOT_DEVICE(device)) {
L
Linus Torvalds 已提交
1015
		strcpy(device->pnp.bus_id, "ACPI");
1016 1017 1018 1019
		return;
	}

	switch (device->device_type) {
L
Linus Torvalds 已提交
1020 1021 1022 1023 1024 1025 1026
	case ACPI_BUS_TYPE_POWER_BUTTON:
		strcpy(device->pnp.bus_id, "PWRF");
		break;
	case ACPI_BUS_TYPE_SLEEP_BUTTON:
		strcpy(device->pnp.bus_id, "SLPF");
		break;
	default:
1027
		acpi_get_name(device->handle, ACPI_SINGLE_NAME, &buffer);
L
Linus Torvalds 已提交
1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039
		/* Clean up trailing underscores (if any) */
		for (i = 3; i > 1; i--) {
			if (bus_id[i] == '_')
				bus_id[i] = '\0';
			else
				break;
		}
		strcpy(device->pnp.bus_id, bus_id);
		break;
	}
}

1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075
/*
 * acpi_bay_match - see if a device is an ejectable driver bay
 *
 * If an acpi object is ejectable and has one of the ACPI ATA methods defined,
 * then we can safely call it an ejectable drive bay
 */
static int acpi_bay_match(struct acpi_device *device){
	acpi_status status;
	acpi_handle handle;
	acpi_handle tmp;
	acpi_handle phandle;

	handle = device->handle;

	status = acpi_get_handle(handle, "_EJ0", &tmp);
	if (ACPI_FAILURE(status))
		return -ENODEV;

	if ((ACPI_SUCCESS(acpi_get_handle(handle, "_GTF", &tmp))) ||
		(ACPI_SUCCESS(acpi_get_handle(handle, "_GTM", &tmp))) ||
		(ACPI_SUCCESS(acpi_get_handle(handle, "_STM", &tmp))) ||
		(ACPI_SUCCESS(acpi_get_handle(handle, "_SDD", &tmp))))
		return 0;

	if (acpi_get_parent(handle, &phandle))
		return -ENODEV;

        if ((ACPI_SUCCESS(acpi_get_handle(phandle, "_GTF", &tmp))) ||
                (ACPI_SUCCESS(acpi_get_handle(phandle, "_GTM", &tmp))) ||
                (ACPI_SUCCESS(acpi_get_handle(phandle, "_STM", &tmp))) ||
                (ACPI_SUCCESS(acpi_get_handle(phandle, "_SDD", &tmp))))
                return 0;

	return -ENODEV;
}

1076 1077 1078 1079 1080 1081 1082 1083 1084
/*
 * acpi_dock_match - see if a device has a _DCK method
 */
static int acpi_dock_match(struct acpi_device *device)
{
	acpi_handle tmp;
	return acpi_get_handle(device->handle, "_DCK", &tmp);
}

1085
const char *acpi_device_hid(struct acpi_device *device)
1086
{
1087
	struct acpi_hardware_id *hid;
1088

1089 1090 1091
	if (list_empty(&device->pnp.ids))
		return dummy_hid;

1092 1093 1094 1095
	hid = list_first_entry(&device->pnp.ids, struct acpi_hardware_id, list);
	return hid->id;
}
EXPORT_SYMBOL(acpi_device_hid);
1096

1097 1098 1099
static void acpi_add_id(struct acpi_device *device, const char *dev_id)
{
	struct acpi_hardware_id *id;
1100

1101 1102 1103
	id = kmalloc(sizeof(*id), GFP_KERNEL);
	if (!id)
		return;
1104

T
Thomas Meyer 已提交
1105
	id->id = kstrdup(dev_id, GFP_KERNEL);
1106 1107 1108
	if (!id->id) {
		kfree(id);
		return;
1109 1110
	}

1111
	list_add_tail(&id->list, &device->pnp.ids);
1112 1113
}

1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148
/*
 * Old IBM workstations have a DSDT bug wherein the SMBus object
 * lacks the SMBUS01 HID and the methods do not have the necessary "_"
 * prefix.  Work around this.
 */
static int acpi_ibm_smbus_match(struct acpi_device *device)
{
	acpi_handle h_dummy;
	struct acpi_buffer path = {ACPI_ALLOCATE_BUFFER, NULL};
	int result;

	if (!dmi_name_in_vendors("IBM"))
		return -ENODEV;

	/* Look for SMBS object */
	result = acpi_get_name(device->handle, ACPI_SINGLE_NAME, &path);
	if (result)
		return result;

	if (strcmp("SMBS", path.pointer)) {
		result = -ENODEV;
		goto out;
	}

	/* Does it have the necessary (but misnamed) methods? */
	result = -ENODEV;
	if (ACPI_SUCCESS(acpi_get_handle(device->handle, "SBI", &h_dummy)) &&
	    ACPI_SUCCESS(acpi_get_handle(device->handle, "SBR", &h_dummy)) &&
	    ACPI_SUCCESS(acpi_get_handle(device->handle, "SBW", &h_dummy)))
		result = 0;
out:
	kfree(path.pointer);
	return result;
}

1149
static void acpi_device_set_id(struct acpi_device *device)
L
Linus Torvalds 已提交
1150
{
L
Len Brown 已提交
1151
	acpi_status status;
1152 1153
	struct acpi_device_info *info;
	struct acpica_device_id_list *cid_list;
1154
	int i;
L
Linus Torvalds 已提交
1155

1156
	switch (device->device_type) {
L
Linus Torvalds 已提交
1157
	case ACPI_BUS_TYPE_DEVICE:
1158
		if (ACPI_IS_ROOT_DEVICE(device)) {
1159
			acpi_add_id(device, ACPI_SYSTEM_HID);
1160 1161 1162
			break;
		}

1163
		status = acpi_get_object_info(device->handle, &info);
L
Linus Torvalds 已提交
1164
		if (ACPI_FAILURE(status)) {
1165
			printk(KERN_ERR PREFIX "%s: Error reading device info\n", __func__);
L
Linus Torvalds 已提交
1166 1167 1168 1169
			return;
		}

		if (info->valid & ACPI_VALID_HID)
1170 1171
			acpi_add_id(device, info->hardware_id.string);
		if (info->valid & ACPI_VALID_CID) {
1172
			cid_list = &info->compatible_id_list;
1173 1174 1175
			for (i = 0; i < cid_list->count; i++)
				acpi_add_id(device, cid_list->ids[i].string);
		}
L
Linus Torvalds 已提交
1176 1177 1178 1179
		if (info->valid & ACPI_VALID_ADR) {
			device->pnp.bus_address = info->address;
			device->flags.bus_address = 1;
		}
1180

1181 1182
		kfree(info);

1183 1184 1185 1186
		/*
		 * Some devices don't reliably have _HIDs & _CIDs, so add
		 * synthetic HIDs to make sure drivers can find them.
		 */
1187
		if (acpi_is_video_device(device))
1188
			acpi_add_id(device, ACPI_VIDEO_HID);
1189
		else if (ACPI_SUCCESS(acpi_bay_match(device)))
1190
			acpi_add_id(device, ACPI_BAY_HID);
1191
		else if (ACPI_SUCCESS(acpi_dock_match(device)))
1192
			acpi_add_id(device, ACPI_DOCK_HID);
1193 1194
		else if (!acpi_ibm_smbus_match(device))
			acpi_add_id(device, ACPI_SMBUS_IBM_HID);
1195 1196 1197 1198 1199 1200
		else if (!acpi_device_hid(device) &&
			 ACPI_IS_ROOT_DEVICE(device->parent)) {
			acpi_add_id(device, ACPI_BUS_HID); /* \_SB, LNXSYBUS */
			strcpy(device->pnp.device_name, ACPI_BUS_DEVICE_NAME);
			strcpy(device->pnp.device_class, ACPI_BUS_CLASS);
		}
1201

L
Linus Torvalds 已提交
1202 1203
		break;
	case ACPI_BUS_TYPE_POWER:
1204
		acpi_add_id(device, ACPI_POWER_HID);
L
Linus Torvalds 已提交
1205 1206
		break;
	case ACPI_BUS_TYPE_PROCESSOR:
1207
		acpi_add_id(device, ACPI_PROCESSOR_OBJECT_HID);
L
Linus Torvalds 已提交
1208 1209
		break;
	case ACPI_BUS_TYPE_THERMAL:
1210
		acpi_add_id(device, ACPI_THERMAL_HID);
L
Linus Torvalds 已提交
1211 1212
		break;
	case ACPI_BUS_TYPE_POWER_BUTTON:
1213
		acpi_add_id(device, ACPI_BUTTON_HID_POWERF);
L
Linus Torvalds 已提交
1214 1215
		break;
	case ACPI_BUS_TYPE_SLEEP_BUTTON:
1216
		acpi_add_id(device, ACPI_BUTTON_HID_SLEEPF);
L
Linus Torvalds 已提交
1217 1218 1219 1220
		break;
	}
}

1221
static int acpi_device_set_context(struct acpi_device *device)
L
Linus Torvalds 已提交
1222
{
1223 1224
	acpi_status status;

L
Linus Torvalds 已提交
1225 1226 1227 1228
	/*
	 * Context
	 * -------
	 * Attach this 'struct acpi_device' to the ACPI object.  This makes
1229 1230
	 * resolutions from handle->device very efficient.  Fixed hardware
	 * devices have no handles, so we skip them.
L
Linus Torvalds 已提交
1231
	 */
1232 1233
	if (!device->handle)
		return 0;
L
Linus Torvalds 已提交
1234

1235 1236 1237 1238 1239 1240 1241
	status = acpi_attach_data(device->handle,
				  acpi_bus_data_handler, device);
	if (ACPI_SUCCESS(status))
		return 0;

	printk(KERN_ERR PREFIX "Error attaching device data\n");
	return -ENODEV;
L
Linus Torvalds 已提交
1242 1243
}

L
Len Brown 已提交
1244
static int acpi_bus_remove(struct acpi_device *dev, int rmdevice)
L
Linus Torvalds 已提交
1245 1246
{
	if (!dev)
1247
		return -EINVAL;
L
Linus Torvalds 已提交
1248

1249
	dev->removal_type = ACPI_BUS_REMOVAL_EJECT;
1250
	device_release_driver(&dev->dev);
L
Linus Torvalds 已提交
1251 1252

	if (!rmdevice)
1253
		return 0;
L
Linus Torvalds 已提交
1254

1255 1256 1257
	/*
	 * unbind _ADR-Based Devices when hot removal
	 */
L
Linus Torvalds 已提交
1258 1259 1260 1261 1262 1263
	if (dev->flags.bus_address) {
		if ((dev->parent) && (dev->parent->ops.unbind))
			dev->parent->ops.unbind(dev);
	}
	acpi_device_unregister(dev, ACPI_BUS_REMOVAL_EJECT);

1264
	return 0;
L
Linus Torvalds 已提交
1265 1266
}

1267 1268
static int acpi_add_single_object(struct acpi_device **child,
				  acpi_handle handle, int type,
1269
				  unsigned long long sta,
1270
				  struct acpi_bus_ops *ops)
L
Linus Torvalds 已提交
1271
{
1272 1273
	int result;
	struct acpi_device *device;
1274
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
L
Linus Torvalds 已提交
1275

1276
	device = kzalloc(sizeof(struct acpi_device), GFP_KERNEL);
L
Linus Torvalds 已提交
1277
	if (!device) {
1278
		printk(KERN_ERR PREFIX "Memory allocation error\n");
1279
		return -ENOMEM;
L
Linus Torvalds 已提交
1280 1281
	}

1282
	INIT_LIST_HEAD(&device->pnp.ids);
1283
	device->device_type = type;
L
Linus Torvalds 已提交
1284
	device->handle = handle;
1285
	device->parent = acpi_bus_get_parent(handle);
L
Li Shaohua 已提交
1286
	device->bus_ops = *ops; /* workround for not call .start */
1287
	STRUCT_TO_INT(device->status) = sta;
L
Li Shaohua 已提交
1288

1289
	acpi_device_get_busid(device);
L
Linus Torvalds 已提交
1290 1291 1292 1293

	/*
	 * Flags
	 * -----
1294 1295
	 * Note that we only look for object handles -- cannot evaluate objects
	 * until we know the device is present and properly initialized.
L
Linus Torvalds 已提交
1296 1297 1298 1299 1300 1301 1302 1303 1304 1305
	 */
	result = acpi_bus_get_flags(device);
	if (result)
		goto end;

	/*
	 * Initialize Device
	 * -----------------
	 * TBD: Synch with Core's enumeration/initialization process.
	 */
1306
	acpi_device_set_id(device);
L
Linus Torvalds 已提交
1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317

	/*
	 * Power Management
	 * ----------------
	 */
	if (device->flags.power_manageable) {
		result = acpi_bus_get_power_flags(device);
		if (result)
			goto end;
	}

L
Len Brown 已提交
1318
	/*
L
Linus Torvalds 已提交
1319 1320 1321
	 * Wakeup device management
	 *-----------------------
	 */
1322
	acpi_bus_get_wakeup_device_flags(device);
L
Linus Torvalds 已提交
1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333

	/*
	 * Performance Management
	 * ----------------------
	 */
	if (device->flags.performance_manageable) {
		result = acpi_bus_get_perf_flags(device);
		if (result)
			goto end;
	}

1334
	if ((result = acpi_device_set_context(device)))
1335
		goto end;
L
Linus Torvalds 已提交
1336

1337
	result = acpi_device_register(device);
L
Linus Torvalds 已提交
1338 1339

	/*
1340
	 * Bind _ADR-Based Devices when hot add
L
Linus Torvalds 已提交
1341 1342 1343 1344 1345 1346
	 */
	if (device->flags.bus_address) {
		if (device->parent && device->parent->ops.bind)
			device->parent->ops.bind(device);
	}

1347
end:
1348 1349 1350 1351 1352 1353 1354 1355
	if (!result) {
		acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			"Adding %s [%s] parent %s\n", dev_name(&device->dev),
			 (char *) buffer.pointer,
			 device->parent ? dev_name(&device->parent->dev) :
					  "(null)"));
		kfree(buffer.pointer);
L
Linus Torvalds 已提交
1356
		*child = device;
1357
	} else
1358
		acpi_device_release(&device->dev);
L
Linus Torvalds 已提交
1359

1360
	return result;
L
Linus Torvalds 已提交
1361 1362
}

1363 1364 1365
#define ACPI_STA_DEFAULT (ACPI_STA_DEVICE_PRESENT | ACPI_STA_DEVICE_ENABLED | \
			  ACPI_STA_DEVICE_UI      | ACPI_STA_DEVICE_FUNCTIONING)

1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379
static void acpi_bus_add_power_resource(acpi_handle handle)
{
	struct acpi_bus_ops ops = {
		.acpi_op_add = 1,
		.acpi_op_start = 1,
	};
	struct acpi_device *device = NULL;

	acpi_bus_get_device(handle, &device);
	if (!device)
		acpi_add_single_object(&device, handle, ACPI_BUS_TYPE_POWER,
					ACPI_STA_DEFAULT, &ops);
}

1380 1381
static int acpi_bus_type_and_status(acpi_handle handle, int *type,
				    unsigned long long *sta)
L
Linus Torvalds 已提交
1382
{
1383 1384
	acpi_status status;
	acpi_object_type acpi_type;
L
Linus Torvalds 已提交
1385

1386
	status = acpi_get_type(handle, &acpi_type);
1387
	if (ACPI_FAILURE(status))
1388
		return -ENODEV;
L
Len Brown 已提交
1389

1390
	switch (acpi_type) {
1391 1392
	case ACPI_TYPE_ANY:		/* for ACPI_ROOT_OBJECT */
	case ACPI_TYPE_DEVICE:
1393 1394 1395 1396
		*type = ACPI_BUS_TYPE_DEVICE;
		status = acpi_bus_get_status_handle(handle, sta);
		if (ACPI_FAILURE(status))
			return -ENODEV;
1397 1398
		break;
	case ACPI_TYPE_PROCESSOR:
1399 1400 1401 1402
		*type = ACPI_BUS_TYPE_PROCESSOR;
		status = acpi_bus_get_status_handle(handle, sta);
		if (ACPI_FAILURE(status))
			return -ENODEV;
1403 1404
		break;
	case ACPI_TYPE_THERMAL:
1405 1406
		*type = ACPI_BUS_TYPE_THERMAL;
		*sta = ACPI_STA_DEFAULT;
1407 1408
		break;
	case ACPI_TYPE_POWER:
1409 1410
		*type = ACPI_BUS_TYPE_POWER;
		*sta = ACPI_STA_DEFAULT;
1411 1412
		break;
	default:
1413
		return -ENODEV;
1414
	}
L
Linus Torvalds 已提交
1415

1416 1417 1418 1419 1420 1421 1422 1423 1424
	return 0;
}

static acpi_status acpi_bus_check_add(acpi_handle handle, u32 lvl,
				      void *context, void **return_value)
{
	struct acpi_bus_ops *ops = context;
	int type;
	unsigned long long sta;
1425 1426
	struct acpi_device *device;
	acpi_status status;
1427 1428 1429 1430 1431 1432 1433
	int result;

	result = acpi_bus_type_and_status(handle, &type, &sta);
	if (result)
		return AE_OK;

	if (!(sta & ACPI_STA_DEVICE_PRESENT) &&
1434
	    !(sta & ACPI_STA_DEVICE_FUNCTIONING)) {
1435 1436 1437 1438 1439 1440 1441
		struct acpi_device_wakeup wakeup;
		acpi_handle temp;

		status = acpi_get_handle(handle, "_PRW", &temp);
		if (ACPI_SUCCESS(status))
			acpi_bus_extract_wakeup_device_power_package(handle,
								     &wakeup);
1442
		return AE_CTRL_DEPTH;
1443
	}
1444

1445 1446 1447 1448 1449 1450 1451 1452
	/*
	 * We may already have an acpi_device from a previous enumeration.  If
	 * so, we needn't add it again, but we may still have to start it.
	 */
	device = NULL;
	acpi_bus_get_device(handle, &device);
	if (ops->acpi_op_add && !device)
		acpi_add_single_object(&device, handle, type, sta, ops);
L
Linus Torvalds 已提交
1453

1454
	if (!device)
1455
		return AE_CTRL_DEPTH;
L
Linus Torvalds 已提交
1456

1457 1458
	if (ops->acpi_op_start && !(ops->acpi_op_add)) {
		status = acpi_start_single_object(device);
L
Linus Torvalds 已提交
1459
		if (ACPI_FAILURE(status))
1460 1461
			return AE_CTRL_DEPTH;
	}
L
Linus Torvalds 已提交
1462

1463 1464 1465 1466
	if (!*return_value)
		*return_value = device;
	return AE_OK;
}
1467

1468 1469 1470 1471 1472
static int acpi_bus_scan(acpi_handle handle, struct acpi_bus_ops *ops,
			 struct acpi_device **child)
{
	acpi_status status;
	void *device = NULL;
1473

1474 1475 1476
	status = acpi_bus_check_add(handle, 0, ops, &device);
	if (ACPI_SUCCESS(status))
		acpi_walk_namespace(ACPI_TYPE_ANY, handle, ACPI_UINT32_MAX,
1477
				    acpi_bus_check_add, NULL, ops, &device);
L
Linus Torvalds 已提交
1478

1479 1480
	if (child)
		*child = device;
1481 1482 1483 1484 1485

	if (device)
		return 0;
	else
		return -ENODEV;
L
Linus Torvalds 已提交
1486 1487
}

1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499
/*
 * acpi_bus_add and acpi_bus_start
 *
 * scan a given ACPI tree and (probably recently hot-plugged)
 * create and add or starts found devices.
 *
 * If no devices were found -ENODEV is returned which does not
 * mean that this is a real error, there just have been no suitable
 * ACPI objects in the table trunk from which the kernel could create
 * a device and add/start an appropriate driver.
 */

1500
int
L
Len Brown 已提交
1501 1502
acpi_bus_add(struct acpi_device **child,
	     struct acpi_device *parent, acpi_handle handle, int type)
1503 1504 1505
{
	struct acpi_bus_ops ops;

L
Li Shaohua 已提交
1506 1507
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
1508

1509
	return acpi_bus_scan(handle, &ops, child);
1510 1511 1512
}
EXPORT_SYMBOL(acpi_bus_add);

L
Len Brown 已提交
1513
int acpi_bus_start(struct acpi_device *device)
1514 1515
{
	struct acpi_bus_ops ops;
1516
	int result;
1517

1518 1519 1520
	if (!device)
		return -EINVAL;

1521 1522
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_start = 1;
1523

1524 1525
	result = acpi_bus_scan(device->handle, &ops, NULL);

1526
	acpi_update_all_gpes();
1527 1528

	return result;
1529 1530
}
EXPORT_SYMBOL(acpi_bus_start);
L
Linus Torvalds 已提交
1531

1532
int acpi_bus_trim(struct acpi_device *start, int rmdevice)
L
Linus Torvalds 已提交
1533
{
L
Len Brown 已提交
1534 1535 1536 1537 1538 1539 1540 1541
	acpi_status status;
	struct acpi_device *parent, *child;
	acpi_handle phandle, chandle;
	acpi_object_type type;
	u32 level = 1;
	int err = 0;

	parent = start;
L
Linus Torvalds 已提交
1542 1543 1544 1545 1546
	phandle = start->handle;
	child = chandle = NULL;

	while ((level > 0) && parent && (!err)) {
		status = acpi_get_next_object(ACPI_TYPE_ANY, phandle,
L
Len Brown 已提交
1547
					      chandle, &chandle);
L
Linus Torvalds 已提交
1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584

		/*
		 * If this scope is exhausted then move our way back up.
		 */
		if (ACPI_FAILURE(status)) {
			level--;
			chandle = phandle;
			acpi_get_parent(phandle, &phandle);
			child = parent;
			parent = parent->parent;

			if (level == 0)
				err = acpi_bus_remove(child, rmdevice);
			else
				err = acpi_bus_remove(child, 1);

			continue;
		}

		status = acpi_get_type(chandle, &type);
		if (ACPI_FAILURE(status)) {
			continue;
		}
		/*
		 * If there is a device corresponding to chandle then
		 * parse it (depth-first).
		 */
		if (acpi_bus_get_device(chandle, &child) == 0) {
			level++;
			phandle = chandle;
			chandle = NULL;
			parent = child;
		}
		continue;
	}
	return err;
}
1585 1586
EXPORT_SYMBOL_GPL(acpi_bus_trim);

1587
static int acpi_bus_scan_fixed(void)
L
Linus Torvalds 已提交
1588
{
L
Len Brown 已提交
1589 1590
	int result = 0;
	struct acpi_device *device = NULL;
L
Li Shaohua 已提交
1591
	struct acpi_bus_ops ops;
L
Linus Torvalds 已提交
1592

L
Li Shaohua 已提交
1593 1594 1595 1596
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
	ops.acpi_op_start = 1;

L
Linus Torvalds 已提交
1597 1598 1599
	/*
	 * Enumerate all fixed-feature devices.
	 */
1600
	if ((acpi_gbl_FADT.flags & ACPI_FADT_POWER_BUTTON) == 0) {
1601
		result = acpi_add_single_object(&device, NULL,
L
Li Shaohua 已提交
1602
						ACPI_BUS_TYPE_POWER_BUTTON,
1603
						ACPI_STA_DEFAULT,
L
Li Shaohua 已提交
1604
						&ops);
1605
		device_init_wakeup(&device->dev, true);
1606
	}
L
Linus Torvalds 已提交
1607

1608
	if ((acpi_gbl_FADT.flags & ACPI_FADT_SLEEP_BUTTON) == 0) {
1609
		result = acpi_add_single_object(&device, NULL,
L
Li Shaohua 已提交
1610
						ACPI_BUS_TYPE_SLEEP_BUTTON,
1611
						ACPI_STA_DEFAULT,
L
Li Shaohua 已提交
1612
						&ops);
1613
	}
L
Linus Torvalds 已提交
1614

1615
	return result;
L
Linus Torvalds 已提交
1616 1617
}

1618
int __init acpi_scan_init(void)
L
Linus Torvalds 已提交
1619 1620
{
	int result;
1621
	struct acpi_bus_ops ops;
L
Linus Torvalds 已提交
1622

L
Li Shaohua 已提交
1623 1624 1625
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
	ops.acpi_op_start = 1;
L
Linus Torvalds 已提交
1626

1627 1628 1629 1630 1631 1632
	result = bus_register(&acpi_bus_type);
	if (result) {
		/* We don't want to quit even if we failed to add suspend/resume */
		printk(KERN_ERR PREFIX "Could not register bus type\n");
	}

1633 1634
	acpi_power_init();

L
Linus Torvalds 已提交
1635 1636 1637
	/*
	 * Enumerate devices in the ACPI namespace.
	 */
1638
	result = acpi_bus_scan(ACPI_ROOT_OBJECT, &ops, &acpi_root);
1639

L
Li Shaohua 已提交
1640
	if (!result)
1641
		result = acpi_bus_scan_fixed();
L
Linus Torvalds 已提交
1642 1643 1644

	if (result)
		acpi_device_unregister(acpi_root, ACPI_BUS_REMOVAL_NORMAL);
1645
	else
1646
		acpi_update_all_gpes();
L
Linus Torvalds 已提交
1647

1648
	return result;
L
Linus Torvalds 已提交
1649
}