scan.c 46.3 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>
13
#include <linux/nls.h>
L
Linus Torvalds 已提交
14 15 16

#include <acpi/acpi_drivers.h>

17 18
#include "internal.h"

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

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

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

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

32 33 34 35 36 37
/*
 * The following ACPI IDs are known to be suitable for representing as
 * platform devices.
 */
static const struct acpi_device_id acpi_platform_device_ids[] = {

38 39
	{ "PNP0D40" },

40 41 42 43 44 45 46 47 48 49
	/* Haswell LPSS devices */
	{ "INT33C0", 0 },
	{ "INT33C1", 0 },
	{ "INT33C2", 0 },
	{ "INT33C3", 0 },
	{ "INT33C4", 0 },
	{ "INT33C5", 0 },
	{ "INT33C6", 0 },
	{ "INT33C7", 0 },

50 51 52
	{ }
};

L
Linus Torvalds 已提交
53
static LIST_HEAD(acpi_device_list);
54
static LIST_HEAD(acpi_bus_id_list);
55
DEFINE_MUTEX(acpi_device_lock);
L
Linus Torvalds 已提交
56 57
LIST_HEAD(acpi_wakeup_device_list);

58
struct acpi_device_bus_id{
59
	char bus_id[15];
60 61
	unsigned int instance_no;
	struct list_head node;
L
Linus Torvalds 已提交
62
};
63 64 65 66 67 68

/*
 * 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"
*/
69 70 71
static int create_modalias(struct acpi_device *acpi_dev, char *modalias,
			   int size)
{
72
	int len;
73
	int count;
74
	struct acpi_hardware_id *id;
75

76 77 78
	if (list_empty(&acpi_dev->pnp.ids))
		return 0;

79
	len = snprintf(modalias, size, "acpi:");
80 81
	size -= len;

82 83
	list_for_each_entry(id, &acpi_dev->pnp.ids, list) {
		count = snprintf(&modalias[len], size, "%s:", id->id);
84 85 86 87 88 89
		if (count < 0 || count >= size)
			return -EINVAL;
		len += count;
		size -= count;
	}

90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107
	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);

108 109 110 111 112 113 114 115 116
/**
 * acpi_bus_hot_remove_device: hot-remove a device and its children
 * @context: struct acpi_eject_event pointer (freed in this func)
 *
 * Hot-remove a device and its children. This function frees up the
 * memory space passed by arg context, so that the caller may call
 * this function asynchronously through acpi_os_hotplug_execute().
 */
void acpi_bus_hot_remove_device(void *context)
L
Linus Torvalds 已提交
117
{
118
	struct acpi_eject_event *ej_event = (struct acpi_eject_event *) context;
119
	struct acpi_device *device;
120
	acpi_handle handle = ej_event->handle;
121
	acpi_handle temp;
L
Linus Torvalds 已提交
122 123 124
	struct acpi_object_list arg_list;
	union acpi_object arg;
	acpi_status status = AE_OK;
125
	u32 ost_code = ACPI_OST_SC_NON_SPECIFIC_FAILURE; /* default */
L
Linus Torvalds 已提交
126

127
	if (acpi_bus_get_device(handle, &device))
128
		goto err_out;
129 130

	if (!device)
131
		goto err_out;
132 133

	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
134
		"Hot-removing device %s...\n", dev_name(&device->dev)));
135 136

	if (acpi_bus_trim(device, 1)) {
137 138
		printk(KERN_ERR PREFIX
				"Removing device failed\n");
139
		goto err_out;
140
	}
L
Linus Torvalds 已提交
141

142 143 144
	/* device has been freed */
	device = NULL;

145 146 147
	/* power off device */
	status = acpi_evaluate_object(handle, "_PS3", NULL, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND)
148 149
		printk(KERN_WARNING PREFIX
				"Power-off device failed\n");
150

151
	if (ACPI_SUCCESS(acpi_get_handle(handle, "_LCK", &temp))) {
L
Linus Torvalds 已提交
152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167
		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);
168 169 170 171 172 173
	if (ACPI_FAILURE(status)) {
		if (status != AE_NOT_FOUND)
			printk(KERN_WARNING PREFIX
					"Eject device failed\n");
		goto err_out;
	}
L
Linus Torvalds 已提交
174

175 176
	kfree(context);
	return;
L
Linus Torvalds 已提交
177

178 179 180 181 182
err_out:
	/* Inform firmware the hot-remove operation has completed w/ error */
	(void) acpi_evaluate_hotplug_ost(handle,
				ej_event->event, ost_code, NULL);
	kfree(context);
183
	return;
L
Linus Torvalds 已提交
184
}
T
Toshi Kani 已提交
185
EXPORT_SYMBOL(acpi_bus_hot_remove_device);
L
Linus Torvalds 已提交
186 187

static ssize_t
P
Patrick Mochel 已提交
188 189
acpi_eject_store(struct device *d, struct device_attribute *attr,
		const char *buf, size_t count)
L
Linus Torvalds 已提交
190
{
L
Len Brown 已提交
191 192 193
	int ret = count;
	acpi_status status;
	acpi_object_type type = 0;
P
Patrick Mochel 已提交
194
	struct acpi_device *acpi_device = to_acpi_device(d);
195
	struct acpi_eject_event *ej_event;
L
Linus Torvalds 已提交
196 197 198 199 200

	if ((!count) || (buf[0] != '1')) {
		return -EINVAL;
	}
#ifndef FORCE_EJECT
P
Patrick Mochel 已提交
201
	if (acpi_device->driver == NULL) {
L
Linus Torvalds 已提交
202 203 204 205
		ret = -ENODEV;
		goto err;
	}
#endif
P
Patrick Mochel 已提交
206 207
	status = acpi_get_type(acpi_device->handle, &type);
	if (ACPI_FAILURE(status) || (!acpi_device->flags.ejectable)) {
L
Linus Torvalds 已提交
208 209 210 211
		ret = -ENODEV;
		goto err;
	}

212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230
	ej_event = kmalloc(sizeof(*ej_event), GFP_KERNEL);
	if (!ej_event) {
		ret = -ENOMEM;
		goto err;
	}

	ej_event->handle = acpi_device->handle;
	if (acpi_device->flags.eject_pending) {
		/* event originated from ACPI eject notification */
		ej_event->event = ACPI_NOTIFY_EJECT_REQUEST;
		acpi_device->flags.eject_pending = 0;
	} else {
		/* event originated from user */
		ej_event->event = ACPI_OST_EC_OSPM_EJECT;
		(void) acpi_evaluate_hotplug_ost(ej_event->handle,
			ej_event->event, ACPI_OST_SC_EJECT_IN_PROGRESS, NULL);
	}

	acpi_os_hotplug_execute(acpi_bus_hot_remove_device, (void *)ej_event);
231
err:
L
Linus Torvalds 已提交
232 233 234
	return ret;
}

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

237 238 239
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 已提交
240

241
	return sprintf(buf, "%s\n", acpi_device_hid(acpi_dev));
L
Linus Torvalds 已提交
242
}
243
static DEVICE_ATTR(hid, 0444, acpi_device_hid_show, NULL);
L
Linus Torvalds 已提交
244

245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
static ssize_t acpi_device_uid_show(struct device *dev,
				    struct device_attribute *attr, char *buf)
{
	struct acpi_device *acpi_dev = to_acpi_device(dev);

	return sprintf(buf, "%s\n", acpi_dev->pnp.unique_id);
}
static DEVICE_ATTR(uid, 0444, acpi_device_uid_show, NULL);

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

	return sprintf(buf, "0x%08x\n",
		       (unsigned int)(acpi_dev->pnp.bus_address));
}
static DEVICE_ATTR(adr, 0444, acpi_device_adr_show, NULL);

264 265 266 267 268
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 已提交
269

270
	result = acpi_get_name(acpi_dev->handle, ACPI_FULL_PATHNAME, &path);
271
	if (result)
272
		goto end;
L
Linus Torvalds 已提交
273

274 275
	result = sprintf(buf, "%s\n", (char*)path.pointer);
	kfree(path.pointer);
276
end:
277
	return result;
L
Linus Torvalds 已提交
278
}
279
static DEVICE_ATTR(path, 0444, acpi_device_path_show, NULL);
L
Linus Torvalds 已提交
280

281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306
/* sysfs file that shows description text from the ACPI _STR method */
static ssize_t description_show(struct device *dev,
				struct device_attribute *attr,
				char *buf) {
	struct acpi_device *acpi_dev = to_acpi_device(dev);
	int result;

	if (acpi_dev->pnp.str_obj == NULL)
		return 0;

	/*
	 * The _STR object contains a Unicode identifier for a device.
	 * We need to convert to utf-8 so it can be displayed.
	 */
	result = utf16s_to_utf8s(
		(wchar_t *)acpi_dev->pnp.str_obj->buffer.pointer,
		acpi_dev->pnp.str_obj->buffer.length,
		UTF16_LITTLE_ENDIAN, buf,
		PAGE_SIZE);

	buf[result++] = '\n';

	return result;
}
static DEVICE_ATTR(description, 0444, description_show, NULL);

Y
Yasuaki Ishimatsu 已提交
307 308 309 310 311 312 313 314 315
static ssize_t
acpi_device_sun_show(struct device *dev, struct device_attribute *attr,
		     char *buf) {
	struct acpi_device *acpi_dev = to_acpi_device(dev);

	return sprintf(buf, "%lu\n", acpi_dev->pnp.sun);
}
static DEVICE_ATTR(sun, 0444, acpi_device_sun_show, NULL);

316
static int acpi_device_setup_files(struct acpi_device *dev)
L
Linus Torvalds 已提交
317
{
318
	struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
P
Patrick Mochel 已提交
319 320
	acpi_status status;
	acpi_handle temp;
Y
Yasuaki Ishimatsu 已提交
321
	unsigned long long sun;
322
	int result = 0;
L
Linus Torvalds 已提交
323 324

	/*
325
	 * Devices gotten from FADT don't have a "path" attribute
L
Linus Torvalds 已提交
326
	 */
327
	if (dev->handle) {
328
		result = device_create_file(&dev->dev, &dev_attr_path);
329
		if (result)
330
			goto end;
L
Linus Torvalds 已提交
331 332
	}

333 334 335 336
	if (!list_empty(&dev->pnp.ids)) {
		result = device_create_file(&dev->dev, &dev_attr_hid);
		if (result)
			goto end;
L
Linus Torvalds 已提交
337

338 339 340 341
		result = device_create_file(&dev->dev, &dev_attr_modalias);
		if (result)
			goto end;
	}
342

343 344 345 346 347 348 349 350 351 352 353 354 355 356 357
	/*
	 * If device has _STR, 'description' file is created
	 */
	status = acpi_get_handle(dev->handle, "_STR", &temp);
	if (ACPI_SUCCESS(status)) {
		status = acpi_evaluate_object(dev->handle, "_STR",
					NULL, &buffer);
		if (ACPI_FAILURE(status))
			buffer.pointer = NULL;
		dev->pnp.str_obj = buffer.pointer;
		result = device_create_file(&dev->dev, &dev_attr_description);
		if (result)
			goto end;
	}

358 359 360 361 362
	if (dev->flags.bus_address)
		result = device_create_file(&dev->dev, &dev_attr_adr);
	if (dev->pnp.unique_id)
		result = device_create_file(&dev->dev, &dev_attr_uid);

Y
Yasuaki Ishimatsu 已提交
363 364 365 366 367 368 369 370 371 372
	status = acpi_evaluate_integer(dev->handle, "_SUN", NULL, &sun);
	if (ACPI_SUCCESS(status)) {
		dev->pnp.sun = (unsigned long)sun;
		result = device_create_file(&dev->dev, &dev_attr_sun);
		if (result)
			goto end;
	} else {
		dev->pnp.sun = (unsigned long)-1;
	}

373 374 375 376
        /*
         * If device has _EJ0, 'eject' file is created that is used to trigger
         * hot-removal function from userland.
         */
P
Patrick Mochel 已提交
377 378
	status = acpi_get_handle(dev->handle, "_EJ0", &temp);
	if (ACPI_SUCCESS(status))
379
		result = device_create_file(&dev->dev, &dev_attr_eject);
380
end:
381
	return result;
L
Linus Torvalds 已提交
382 383
}

P
Patrick Mochel 已提交
384
static void acpi_device_remove_files(struct acpi_device *dev)
L
Linus Torvalds 已提交
385
{
P
Patrick Mochel 已提交
386 387
	acpi_status status;
	acpi_handle temp;
L
Linus Torvalds 已提交
388

P
Patrick Mochel 已提交
389
	/*
390 391 392 393 394 395 396 397 398
	 * If device has _STR, remove 'description' file
	 */
	status = acpi_get_handle(dev->handle, "_STR", &temp);
	if (ACPI_SUCCESS(status)) {
		kfree(dev->pnp.str_obj);
		device_remove_file(&dev->dev, &dev_attr_description);
	}
	/*
	 * If device has _EJ0, remove 'eject' file.
P
Patrick Mochel 已提交
399 400 401 402
	 */
	status = acpi_get_handle(dev->handle, "_EJ0", &temp);
	if (ACPI_SUCCESS(status))
		device_remove_file(&dev->dev, &dev_attr_eject);
L
Linus Torvalds 已提交
403

Y
Yasuaki Ishimatsu 已提交
404 405 406 407
	status = acpi_get_handle(dev->handle, "_SUN", &temp);
	if (ACPI_SUCCESS(status))
		device_remove_file(&dev->dev, &dev_attr_sun);

408 409 410 411
	if (dev->pnp.unique_id)
		device_remove_file(&dev->dev, &dev_attr_uid);
	if (dev->flags.bus_address)
		device_remove_file(&dev->dev, &dev_attr_adr);
412 413
	device_remove_file(&dev->dev, &dev_attr_modalias);
	device_remove_file(&dev->dev, &dev_attr_hid);
414
	if (dev->handle)
415
		device_remove_file(&dev->dev, &dev_attr_path);
L
Linus Torvalds 已提交
416 417
}
/* --------------------------------------------------------------------------
Z
Zhang Rui 已提交
418
			ACPI Bus operations
L
Linus Torvalds 已提交
419
   -------------------------------------------------------------------------- */
420

421 422
static const struct acpi_device_id *__acpi_match_device(
	struct acpi_device *device, const struct acpi_device_id *ids)
423 424
{
	const struct acpi_device_id *id;
425
	struct acpi_hardware_id *hwid;
426

427 428 429 430 431
	/*
	 * If the device is not present, it is unnecessary to load device
	 * driver for it.
	 */
	if (!device->status.present)
432
		return NULL;
433

434 435 436
	for (id = ids; id->id[0]; id++)
		list_for_each_entry(hwid, &device->pnp.ids, list)
			if (!strcmp((char *) id->id, hwid->id))
437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457
				return id;

	return NULL;
}

/**
 * acpi_match_device - Match a struct device against a given list of ACPI IDs
 * @ids: Array of struct acpi_device_id object to match against.
 * @dev: The device structure to match.
 *
 * Check if @dev has a valid ACPI handle and if there is a struct acpi_device
 * object for that handle and use that object to match against a given list of
 * device IDs.
 *
 * Return a pointer to the first matching ID on success or %NULL on failure.
 */
const struct acpi_device_id *acpi_match_device(const struct acpi_device_id *ids,
					       const struct device *dev)
{
	struct acpi_device *adev;

458 459
	if (!ids || !ACPI_HANDLE(dev)
	    || ACPI_FAILURE(acpi_bus_get_device(ACPI_HANDLE(dev), &adev)))
460 461 462 463 464
		return NULL;

	return __acpi_match_device(adev, ids);
}
EXPORT_SYMBOL_GPL(acpi_match_device);
465

466 467 468 469
int acpi_match_device_ids(struct acpi_device *device,
			  const struct acpi_device_id *ids)
{
	return __acpi_match_device(device, ids) ? 0 : -ENOENT;
470 471 472
}
EXPORT_SYMBOL(acpi_match_device_ids);

473 474 475 476 477 478 479 480 481 482
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);
	}
}

483
static void acpi_device_release(struct device *dev)
L
Linus Torvalds 已提交
484
{
485
	struct acpi_device *acpi_dev = to_acpi_device(dev);
L
Linus Torvalds 已提交
486

487
	acpi_free_ids(acpi_dev);
488
	kfree(acpi_dev->pnp.unique_id);
489
	kfree(acpi_dev);
L
Linus Torvalds 已提交
490 491
}

492
static int acpi_bus_match(struct device *dev, struct device_driver *drv)
Z
Zhang Rui 已提交
493
{
494 495
	struct acpi_device *acpi_dev = to_acpi_device(dev);
	struct acpi_driver *acpi_drv = to_acpi_driver(drv);
L
Linus Torvalds 已提交
496

497 498
	return acpi_dev->bus_ops.acpi_op_match
		&& !acpi_match_device_ids(acpi_dev, acpi_drv->ids);
499
}
L
Linus Torvalds 已提交
500

501
static int acpi_device_uevent(struct device *dev, struct kobj_uevent_env *env)
L
Linus Torvalds 已提交
502
{
503
	struct acpi_device *acpi_dev = to_acpi_device(dev);
504
	int len;
505

506 507 508
	if (list_empty(&acpi_dev->pnp.ids))
		return 0;

509 510 511 512 513 514 515
	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 已提交
516
	return 0;
L
Linus Torvalds 已提交
517 518
}

519 520 521 522 523 524 525 526 527 528 529
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;

530 531
	/* Fixed hardware devices have no handles */
	acpi_device_notify(NULL, ACPI_FIXED_HARDWARE_EVENT, device);
532 533 534 535 536 537 538
	return AE_OK;
}

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

539
	if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
540 541 542 543
		status =
		    acpi_install_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
						     acpi_device_notify_fixed,
						     device);
544
	else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561
		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)
{
562
	if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
563 564
		acpi_remove_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
						acpi_device_notify_fixed);
565
	else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
566 567 568 569 570 571 572
		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);
}

573 574 575
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 已提交
576
{
577 578 579 580 581 582
	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 已提交
583 584
		if (acpi_dev->bus_ops.acpi_op_start)
			acpi_start_single_object(acpi_dev);
585 586 587 588 589 590 591 592 593 594 595

		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;
			}
		}

596 597 598 599 600 601 602
		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 已提交
603

604 605 606 607 608 609
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) {
610 611
		if (acpi_drv->ops.notify)
			acpi_device_remove_notify_handler(acpi_dev);
612
		if (acpi_drv->ops.remove)
613
			acpi_drv->ops.remove(acpi_dev, acpi_dev->removal_type);
L
Linus Torvalds 已提交
614
	}
615
	acpi_dev->driver = NULL;
616
	acpi_dev->driver_data = NULL;
L
Linus Torvalds 已提交
617

618
	put_device(dev);
Z
Zhang Rui 已提交
619 620
	return 0;
}
L
Linus Torvalds 已提交
621

622
struct bus_type acpi_bus_type = {
Z
Zhang Rui 已提交
623
	.name		= "acpi",
624 625 626 627
	.match		= acpi_bus_match,
	.probe		= acpi_device_probe,
	.remove		= acpi_device_remove,
	.uevent		= acpi_device_uevent,
Z
Zhang Rui 已提交
628 629
};

630
static int acpi_device_register(struct acpi_device *device)
L
Linus Torvalds 已提交
631
{
L
Len Brown 已提交
632
	int result;
633 634
	struct acpi_device_bus_id *acpi_device_bus_id, *new_bus_id;
	int found = 0;
635

Z
Zhang Rui 已提交
636 637 638 639 640 641 642 643
	/*
	 * 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);
644 645
	INIT_LIST_HEAD(&device->physical_node_list);
	mutex_init(&device->physical_node_lock);
L
Linus Torvalds 已提交
646

647 648 649 650
	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 已提交
651
	}
652

653
	mutex_lock(&acpi_device_lock);
654 655 656 657 658
	/*
	 * 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) {
659 660 661
		if (!strcmp(acpi_device_bus_id->bus_id,
			    acpi_device_hid(device))) {
			acpi_device_bus_id->instance_no++;
662 663 664 665
			found = 1;
			kfree(new_bus_id);
			break;
		}
L
Linus Torvalds 已提交
666
	}
667
	if (!found) {
668
		acpi_device_bus_id = new_bus_id;
669
		strcpy(acpi_device_bus_id->bus_id, acpi_device_hid(device));
670 671
		acpi_device_bus_id->instance_no = 0;
		list_add_tail(&acpi_device_bus_id->node, &acpi_bus_id_list);
L
Linus Torvalds 已提交
672
	}
673
	dev_set_name(&device->dev, "%s:%02x", acpi_device_bus_id->bus_id, acpi_device_bus_id->instance_no);
L
Linus Torvalds 已提交
674

L
Len Brown 已提交
675
	if (device->parent)
Z
Zhang Rui 已提交
676
		list_add_tail(&device->node, &device->parent->children);
L
Len Brown 已提交
677

Z
Zhang Rui 已提交
678 679
	if (device->wakeup.flags.valid)
		list_add_tail(&device->wakeup_list, &acpi_wakeup_device_list);
680
	mutex_unlock(&acpi_device_lock);
L
Linus Torvalds 已提交
681

682
	if (device->parent)
683
		device->dev.parent = &device->parent->dev;
684 685
	device->dev.bus = &acpi_bus_type;
	device->dev.release = &acpi_device_release;
686
	result = device_register(&device->dev);
687
	if (result) {
688
		dev_err(&device->dev, "Error registering device\n");
689
		goto end;
L
Linus Torvalds 已提交
690 691
	}

692
	result = acpi_device_setup_files(device);
693
	if (result)
694 695
		printk(KERN_ERR PREFIX "Error creating sysfs interface for device %s\n",
		       dev_name(&device->dev));
L
Linus Torvalds 已提交
696

697
	device->removal_type = ACPI_BUS_REMOVAL_NORMAL;
L
Linus Torvalds 已提交
698
	return 0;
699
end:
700
	mutex_lock(&acpi_device_lock);
L
Len Brown 已提交
701
	if (device->parent)
702 703
		list_del(&device->node);
	list_del(&device->wakeup_list);
704
	mutex_unlock(&acpi_device_lock);
705
	return result;
L
Linus Torvalds 已提交
706 707
}

Z
Zhang Rui 已提交
708 709
static void acpi_device_unregister(struct acpi_device *device, int type)
{
710
	mutex_lock(&acpi_device_lock);
L
Len Brown 已提交
711
	if (device->parent)
Z
Zhang Rui 已提交
712
		list_del(&device->node);
L
Linus Torvalds 已提交
713

Z
Zhang Rui 已提交
714
	list_del(&device->wakeup_list);
715
	mutex_unlock(&acpi_device_lock);
L
Linus Torvalds 已提交
716

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

P
Patrick Mochel 已提交
719
	acpi_device_remove_files(device);
720
	device_unregister(&device->dev);
L
Linus Torvalds 已提交
721 722
}

Z
Zhang Rui 已提交
723 724 725
/* --------------------------------------------------------------------------
                                 Driver Management
   -------------------------------------------------------------------------- */
L
Linus Torvalds 已提交
726
/**
727 728 729 730
 * acpi_bus_driver_init - add a device to a driver
 * @device: the device to add and initialize
 * @driver: driver for the device
 *
731
 * Used to initialize a device via its device driver.  Called whenever a
732
 * driver is bound to a device.  Invokes the driver's add() ops.
L
Linus Torvalds 已提交
733 734
 */
static int
L
Len Brown 已提交
735
acpi_bus_driver_init(struct acpi_device *device, struct acpi_driver *driver)
L
Linus Torvalds 已提交
736
{
L
Len Brown 已提交
737
	int result = 0;
L
Linus Torvalds 已提交
738 739

	if (!device || !driver)
740
		return -EINVAL;
L
Linus Torvalds 已提交
741 742

	if (!driver->ops.add)
743
		return -ENOSYS;
L
Linus Torvalds 已提交
744 745 746 747

	result = driver->ops.add(device);
	if (result) {
		device->driver = NULL;
748
		device->driver_data = NULL;
749
		return result;
L
Linus Torvalds 已提交
750 751 752 753 754 755 756 757 758
	}

	device->driver = driver;

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

L
Len Brown 已提交
759 760
	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			  "Driver successfully bound to device\n"));
761
	return 0;
762 763
}

764
static int acpi_start_single_object(struct acpi_device *device)
765 766 767 768 769 770
{
	int result = 0;
	struct acpi_driver *driver;


	if (!(driver = device->driver))
771
		return 0;
772

L
Linus Torvalds 已提交
773 774 775 776 777 778
	if (driver->ops.start) {
		result = driver->ops.start(device);
		if (result && driver->ops.remove)
			driver->ops.remove(device, ACPI_BUS_REMOVAL_NORMAL);
	}

779
	return result;
L
Linus Torvalds 已提交
780 781
}

Z
Zhang Rui 已提交
782 783 784 785 786 787 788 789 790
/**
 * 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 已提交
791
{
792
	int ret;
L
Linus Torvalds 已提交
793

Z
Zhang Rui 已提交
794 795
	if (acpi_disabled)
		return -ENODEV;
796 797 798
	driver->drv.name = driver->name;
	driver->drv.bus = &acpi_bus_type;
	driver->drv.owner = driver->owner;
L
Linus Torvalds 已提交
799

800 801
	ret = driver_register(&driver->drv);
	return ret;
Z
Zhang Rui 已提交
802
}
L
Linus Torvalds 已提交
803

Z
Zhang Rui 已提交
804 805 806 807 808 809 810 811 812 813 814
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)
{
815
	driver_unregister(&driver->drv);
Z
Zhang Rui 已提交
816 817 818 819 820 821 822
}

EXPORT_SYMBOL(acpi_bus_unregister_driver);

/* --------------------------------------------------------------------------
                                 Device Enumeration
   -------------------------------------------------------------------------- */
823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849
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 已提交
850 851 852 853 854 855 856 857 858 859 860 861 862 863 864
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;
865 866
		status = acpi_get_handle(ACPI_ROOT_OBJECT, obj->string.pointer,
					 ejd);
Z
Zhang Rui 已提交
867 868 869 870 871 872
		kfree(buffer.pointer);
	}
	return status;
}
EXPORT_SYMBOL_GPL(acpi_bus_get_ejd);

873
void acpi_bus_data_handler(acpi_handle handle, void *context)
Z
Zhang Rui 已提交
874 875 876 877 878 879 880 881 882 883 884 885 886 887
{

	/* TBD */

	return;
}

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

static acpi_status
888 889
acpi_bus_extract_wakeup_device_power_package(acpi_handle handle,
					     struct acpi_device_wakeup *wakeup)
Z
Zhang Rui 已提交
890
{
891 892
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *package = NULL;
Z
Zhang Rui 已提交
893
	union acpi_object *element = NULL;
894 895
	acpi_status status;
	int i = 0;
Z
Zhang Rui 已提交
896

897
	if (!wakeup)
Z
Zhang Rui 已提交
898 899
		return AE_BAD_PARAMETER;

900 901 902 903 904 905 906 907 908 909 910 911 912 913
	/* _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 已提交
914
	element = &(package->package.elements[0]);
915 916 917 918
	if (!element) {
		status = AE_BAD_DATA;
		goto out;
	}
Z
Zhang Rui 已提交
919 920 921 922
	if (element->type == ACPI_TYPE_PACKAGE) {
		if ((element->package.count < 2) ||
		    (element->package.elements[0].type !=
		     ACPI_TYPE_LOCAL_REFERENCE)
923 924 925 926 927
		    || (element->package.elements[1].type != ACPI_TYPE_INTEGER)) {
			status = AE_BAD_DATA;
			goto out;
		}
		wakeup->gpe_device =
Z
Zhang Rui 已提交
928
		    element->package.elements[0].reference.handle;
929
		wakeup->gpe_number =
Z
Zhang Rui 已提交
930 931
		    (u32) element->package.elements[1].integer.value;
	} else if (element->type == ACPI_TYPE_INTEGER) {
932 933 934 935 936 937
		wakeup->gpe_device = NULL;
		wakeup->gpe_number = element->integer.value;
	} else {
		status = AE_BAD_DATA;
		goto out;
	}
Z
Zhang Rui 已提交
938 939 940

	element = &(package->package.elements[1]);
	if (element->type != ACPI_TYPE_INTEGER) {
941 942
		status = AE_BAD_DATA;
		goto out;
Z
Zhang Rui 已提交
943
	}
944
	wakeup->sleep_state = element->integer.value;
Z
Zhang Rui 已提交
945 946

	if ((package->package.count - 2) > ACPI_MAX_HANDLES) {
947 948
		status = AE_NO_MEMORY;
		goto out;
Z
Zhang Rui 已提交
949
	}
950 951
	wakeup->resources.count = package->package.count - 2;
	for (i = 0; i < wakeup->resources.count; i++) {
Z
Zhang Rui 已提交
952
		element = &(package->package.elements[i + 2]);
953 954 955 956
		if (element->type != ACPI_TYPE_LOCAL_REFERENCE) {
			status = AE_BAD_DATA;
			goto out;
		}
Z
Zhang Rui 已提交
957

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

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

963 964 965 966
 out:
	kfree(buffer.pointer);

	return status;
L
Linus Torvalds 已提交
967 968
}

969
static void acpi_bus_set_run_wake_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
970
{
971 972
	struct acpi_device_id button_device_ids[] = {
		{"PNP0C0C", 0},
973
		{"PNP0C0D", 0},
974 975 976
		{"PNP0C0E", 0},
		{"", 0},
	};
977 978 979
	acpi_status status;
	acpi_event_status event_status;

980
	device->wakeup.flags.notifier_present = 0;
981 982 983 984

	/* Power button, Lid switch always enable wakeup */
	if (!acpi_match_device_ids(device, button_device_ids)) {
		device->wakeup.flags.run_wake = 1;
985 986 987 988 989
		if (!acpi_match_device_ids(device, &button_device_ids[1])) {
			/* Do not use Lid/sleep button for S5 wakeup */
			if (device->wakeup.sleep_state == ACPI_STATE_S5)
				device->wakeup.sleep_state = ACPI_STATE_S4;
		}
990
		device_set_wakeup_capable(&device->dev, true);
991 992 993
		return;
	}

994 995 996
	status = acpi_get_gpe_status(device->wakeup.gpe_device,
					device->wakeup.gpe_number,
						&event_status);
997 998 999 1000 1001
	if (status == AE_OK)
		device->wakeup.flags.run_wake =
				!!(event_status & ACPI_EVENT_FLAG_HANDLE);
}

1002
static void acpi_bus_get_wakeup_device_flags(struct acpi_device *device)
1003
{
1004
	acpi_handle temp;
1005 1006
	acpi_status status = 0;
	int psw_error;
1007

1008 1009 1010 1011 1012
	/* Presence of _PRW indicates wake capable */
	status = acpi_get_handle(device->handle, "_PRW", &temp);
	if (ACPI_FAILURE(status))
		return;

1013 1014
	status = acpi_bus_extract_wakeup_device_power_package(device->handle,
							      &device->wakeup);
Z
Zhang Rui 已提交
1015 1016
	if (ACPI_FAILURE(status)) {
		ACPI_EXCEPTION((AE_INFO, status, "Extracting _PRW package"));
1017
		return;
Z
Zhang Rui 已提交
1018
	}
L
Linus Torvalds 已提交
1019

Z
Zhang Rui 已提交
1020
	device->wakeup.flags.valid = 1;
1021
	device->wakeup.prepare_count = 0;
1022
	acpi_bus_set_run_wake_flags(device);
1023 1024 1025 1026 1027 1028
	/* 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.
	 */
1029 1030 1031 1032
	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 已提交
1033 1034
}

1035 1036
static void acpi_bus_add_power_resource(acpi_handle handle);

Z
Zhang Rui 已提交
1037
static int acpi_bus_get_power_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
1038
{
Z
Zhang Rui 已提交
1039 1040 1041
	acpi_status status = 0;
	acpi_handle handle = NULL;
	u32 i = 0;
B
Bjorn Helgaas 已提交
1042

L
Len Brown 已提交
1043

Z
Zhang Rui 已提交
1044 1045 1046 1047 1048 1049 1050 1051 1052
	/*
	 * 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 已提交
1053

Z
Zhang Rui 已提交
1054 1055 1056
	/*
	 * Enumerate supported power management states
	 */
L
Lin Ming 已提交
1057
	for (i = ACPI_STATE_D0; i <= ACPI_STATE_D3_HOT; i++) {
Z
Zhang Rui 已提交
1058 1059
		struct acpi_device_power_state *ps = &device->power.states[i];
		char object_name[5] = { '_', 'P', 'R', '0' + i, '\0' };
L
Linus Torvalds 已提交
1060

Z
Zhang Rui 已提交
1061 1062 1063 1064
		/* Evaluate "_PRx" to se if power resources are referenced */
		acpi_evaluate_reference(device->handle, object_name, NULL,
					&ps->resources);
		if (ps->resources.count) {
1065 1066
			int j;

Z
Zhang Rui 已提交
1067
			device->power.flags.power_resources = 1;
1068 1069
			for (j = 0; j < ps->resources.count; j++)
				acpi_bus_add_power_resource(ps->resources.handles[j]);
L
Linus Torvalds 已提交
1070 1071
		}

Z
Zhang Rui 已提交
1072 1073 1074
		/* 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 已提交
1075
		if (ACPI_SUCCESS(status))
Z
Zhang Rui 已提交
1076
			ps->flags.explicit_set = 1;
L
Linus Torvalds 已提交
1077

L
Lin Ming 已提交
1078 1079 1080 1081 1082
		/*
		 * State is valid if there are means to put the device into it.
		 * D3hot is only valid if _PR3 present.
		 */
		if (ps->resources.count ||
1083
		    (ps->flags.explicit_set && i < ACPI_STATE_D3_HOT)) {
Z
Zhang Rui 已提交
1084
			ps->flags.valid = 1;
1085 1086
			ps->flags.os_accessible = 1;
		}
L
Linus Torvalds 已提交
1087

Z
Zhang Rui 已提交
1088 1089 1090
		ps->power = -1;	/* Unknown - driver assigned */
		ps->latency = -1;	/* Unknown - driver assigned */
	}
L
Linus Torvalds 已提交
1091

Z
Zhang Rui 已提交
1092 1093 1094 1095 1096
	/* 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 已提交
1097

1098 1099 1100 1101
	/* 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;

1102 1103 1104 1105 1106
	/* Presence of _PS3 or _PRx means we can put the device into D3 cold */
	if (device->power.states[ACPI_STATE_D3_HOT].flags.explicit_set ||
			device->power.flags.power_resources)
		device->power.states[ACPI_STATE_D3_COLD].flags.os_accessible = 1;

1107
	acpi_bus_init_power(device);
L
Len Brown 已提交
1108

Z
Zhang Rui 已提交
1109 1110
	return 0;
}
L
Len Brown 已提交
1111

L
Len Brown 已提交
1112
static int acpi_bus_get_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
1113
{
L
Len Brown 已提交
1114 1115
	acpi_status status = AE_OK;
	acpi_handle temp = NULL;
L
Linus Torvalds 已提交
1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137


	/* 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;
	}

1138 1139 1140 1141
	/* Power resources cannot be power manageable. */
	if (device->device_type == ACPI_BUS_TYPE_POWER)
		return 0;

L
Linus Torvalds 已提交
1142 1143 1144 1145 1146 1147 1148
	/* 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 已提交
1149
	/* TBD: Performance management */
L
Linus Torvalds 已提交
1150

1151
	return 0;
L
Linus Torvalds 已提交
1152 1153
}

1154
static void acpi_device_get_busid(struct acpi_device *device)
L
Linus Torvalds 已提交
1155
{
L
Len Brown 已提交
1156 1157 1158
	char bus_id[5] = { '?', 0 };
	struct acpi_buffer buffer = { sizeof(bus_id), bus_id };
	int i = 0;
L
Linus Torvalds 已提交
1159 1160 1161 1162 1163 1164 1165

	/*
	 * Bus ID
	 * ------
	 * The device's Bus ID is simply the object name.
	 * TBD: Shouldn't this value be unique (within the ACPI namespace)?
	 */
1166
	if (ACPI_IS_ROOT_DEVICE(device)) {
L
Linus Torvalds 已提交
1167
		strcpy(device->pnp.bus_id, "ACPI");
1168 1169 1170 1171
		return;
	}

	switch (device->device_type) {
L
Linus Torvalds 已提交
1172 1173 1174 1175 1176 1177 1178
	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:
1179
		acpi_get_name(device->handle, ACPI_SINGLE_NAME, &buffer);
L
Linus Torvalds 已提交
1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191
		/* 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;
	}
}

1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227
/*
 * 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;
}

1228 1229 1230 1231 1232 1233 1234 1235 1236
/*
 * 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);
}

1237
const char *acpi_device_hid(struct acpi_device *device)
1238
{
1239
	struct acpi_hardware_id *hid;
1240

1241 1242 1243
	if (list_empty(&device->pnp.ids))
		return dummy_hid;

1244 1245 1246 1247
	hid = list_first_entry(&device->pnp.ids, struct acpi_hardware_id, list);
	return hid->id;
}
EXPORT_SYMBOL(acpi_device_hid);
1248

1249 1250 1251
static void acpi_add_id(struct acpi_device *device, const char *dev_id)
{
	struct acpi_hardware_id *id;
1252

1253 1254 1255
	id = kmalloc(sizeof(*id), GFP_KERNEL);
	if (!id)
		return;
1256

T
Thomas Meyer 已提交
1257
	id->id = kstrdup(dev_id, GFP_KERNEL);
1258 1259 1260
	if (!id->id) {
		kfree(id);
		return;
1261 1262
	}

1263
	list_add_tail(&id->list, &device->pnp.ids);
1264 1265
}

1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300
/*
 * 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;
}

1301
static void acpi_device_set_id(struct acpi_device *device)
L
Linus Torvalds 已提交
1302
{
L
Len Brown 已提交
1303
	acpi_status status;
1304
	struct acpi_device_info *info;
1305
	struct acpi_pnp_device_id_list *cid_list;
1306
	int i;
L
Linus Torvalds 已提交
1307

1308
	switch (device->device_type) {
L
Linus Torvalds 已提交
1309
	case ACPI_BUS_TYPE_DEVICE:
1310
		if (ACPI_IS_ROOT_DEVICE(device)) {
1311
			acpi_add_id(device, ACPI_SYSTEM_HID);
1312 1313 1314
			break;
		}

1315
		status = acpi_get_object_info(device->handle, &info);
L
Linus Torvalds 已提交
1316
		if (ACPI_FAILURE(status)) {
1317
			printk(KERN_ERR PREFIX "%s: Error reading device info\n", __func__);
L
Linus Torvalds 已提交
1318 1319 1320 1321
			return;
		}

		if (info->valid & ACPI_VALID_HID)
1322 1323
			acpi_add_id(device, info->hardware_id.string);
		if (info->valid & ACPI_VALID_CID) {
1324
			cid_list = &info->compatible_id_list;
1325 1326 1327
			for (i = 0; i < cid_list->count; i++)
				acpi_add_id(device, cid_list->ids[i].string);
		}
L
Linus Torvalds 已提交
1328 1329 1330 1331
		if (info->valid & ACPI_VALID_ADR) {
			device->pnp.bus_address = info->address;
			device->flags.bus_address = 1;
		}
1332 1333 1334
		if (info->valid & ACPI_VALID_UID)
			device->pnp.unique_id = kstrdup(info->unique_id.string,
							GFP_KERNEL);
1335

1336 1337
		kfree(info);

1338 1339 1340 1341
		/*
		 * Some devices don't reliably have _HIDs & _CIDs, so add
		 * synthetic HIDs to make sure drivers can find them.
		 */
1342
		if (acpi_is_video_device(device))
1343
			acpi_add_id(device, ACPI_VIDEO_HID);
1344
		else if (ACPI_SUCCESS(acpi_bay_match(device)))
1345
			acpi_add_id(device, ACPI_BAY_HID);
1346
		else if (ACPI_SUCCESS(acpi_dock_match(device)))
1347
			acpi_add_id(device, ACPI_DOCK_HID);
1348 1349
		else if (!acpi_ibm_smbus_match(device))
			acpi_add_id(device, ACPI_SMBUS_IBM_HID);
1350 1351 1352 1353 1354 1355
		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);
		}
1356

L
Linus Torvalds 已提交
1357 1358
		break;
	case ACPI_BUS_TYPE_POWER:
1359
		acpi_add_id(device, ACPI_POWER_HID);
L
Linus Torvalds 已提交
1360 1361
		break;
	case ACPI_BUS_TYPE_PROCESSOR:
1362
		acpi_add_id(device, ACPI_PROCESSOR_OBJECT_HID);
L
Linus Torvalds 已提交
1363 1364
		break;
	case ACPI_BUS_TYPE_THERMAL:
1365
		acpi_add_id(device, ACPI_THERMAL_HID);
L
Linus Torvalds 已提交
1366 1367
		break;
	case ACPI_BUS_TYPE_POWER_BUTTON:
1368
		acpi_add_id(device, ACPI_BUTTON_HID_POWERF);
L
Linus Torvalds 已提交
1369 1370
		break;
	case ACPI_BUS_TYPE_SLEEP_BUTTON:
1371
		acpi_add_id(device, ACPI_BUTTON_HID_SLEEPF);
L
Linus Torvalds 已提交
1372 1373 1374 1375
		break;
	}
}

1376
static int acpi_device_set_context(struct acpi_device *device)
L
Linus Torvalds 已提交
1377
{
1378 1379
	acpi_status status;

L
Linus Torvalds 已提交
1380 1381 1382 1383
	/*
	 * Context
	 * -------
	 * Attach this 'struct acpi_device' to the ACPI object.  This makes
1384 1385
	 * resolutions from handle->device very efficient.  Fixed hardware
	 * devices have no handles, so we skip them.
L
Linus Torvalds 已提交
1386
	 */
1387 1388
	if (!device->handle)
		return 0;
L
Linus Torvalds 已提交
1389

1390 1391 1392 1393 1394 1395 1396
	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 已提交
1397 1398
}

L
Len Brown 已提交
1399
static int acpi_bus_remove(struct acpi_device *dev, int rmdevice)
L
Linus Torvalds 已提交
1400 1401
{
	if (!dev)
1402
		return -EINVAL;
L
Linus Torvalds 已提交
1403

1404
	dev->removal_type = ACPI_BUS_REMOVAL_EJECT;
1405
	device_release_driver(&dev->dev);
L
Linus Torvalds 已提交
1406 1407

	if (!rmdevice)
1408
		return 0;
L
Linus Torvalds 已提交
1409

1410 1411 1412
	/*
	 * unbind _ADR-Based Devices when hot removal
	 */
L
Linus Torvalds 已提交
1413 1414 1415 1416 1417 1418
	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);

1419
	return 0;
L
Linus Torvalds 已提交
1420 1421
}

1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432
/*
 * acpi_hot_add_bind - Bind _ADR-based devices on hot-add.
 * @device: ACPI device node to bind.
 */
static void acpi_hot_add_bind(struct acpi_device *device)
{
	if (device->flags.bus_address
	    && device->parent && device->parent->ops.bind)
		device->parent->ops.bind(device);
}

1433 1434
static int acpi_add_single_object(struct acpi_device **child,
				  acpi_handle handle, int type,
1435
				  unsigned long long sta,
1436
				  struct acpi_bus_ops *ops)
L
Linus Torvalds 已提交
1437
{
1438 1439
	int result;
	struct acpi_device *device;
1440
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
L
Linus Torvalds 已提交
1441

1442
	device = kzalloc(sizeof(struct acpi_device), GFP_KERNEL);
L
Linus Torvalds 已提交
1443
	if (!device) {
1444
		printk(KERN_ERR PREFIX "Memory allocation error\n");
1445
		return -ENOMEM;
L
Linus Torvalds 已提交
1446 1447
	}

1448
	INIT_LIST_HEAD(&device->pnp.ids);
1449
	device->device_type = type;
L
Linus Torvalds 已提交
1450
	device->handle = handle;
1451
	device->parent = acpi_bus_get_parent(handle);
L
Li Shaohua 已提交
1452
	device->bus_ops = *ops; /* workround for not call .start */
1453
	STRUCT_TO_INT(device->status) = sta;
L
Li Shaohua 已提交
1454

1455
	acpi_device_get_busid(device);
L
Linus Torvalds 已提交
1456 1457 1458 1459

	/*
	 * Flags
	 * -----
1460 1461
	 * Note that we only look for object handles -- cannot evaluate objects
	 * until we know the device is present and properly initialized.
L
Linus Torvalds 已提交
1462 1463 1464 1465 1466 1467 1468 1469 1470 1471
	 */
	result = acpi_bus_get_flags(device);
	if (result)
		goto end;

	/*
	 * Initialize Device
	 * -----------------
	 * TBD: Synch with Core's enumeration/initialization process.
	 */
1472
	acpi_device_set_id(device);
L
Linus Torvalds 已提交
1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483

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

L
Len Brown 已提交
1484
	/*
L
Linus Torvalds 已提交
1485 1486 1487
	 * Wakeup device management
	 *-----------------------
	 */
1488
	acpi_bus_get_wakeup_device_flags(device);
L
Linus Torvalds 已提交
1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499

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

1500
	if ((result = acpi_device_set_context(device)))
1501
		goto end;
L
Linus Torvalds 已提交
1502

1503
	result = acpi_device_register(device);
L
Linus Torvalds 已提交
1504

1505 1506
	if (device->bus_ops.acpi_op_match)
		acpi_hot_add_bind(device);
L
Linus Torvalds 已提交
1507

1508
end:
1509 1510 1511 1512 1513 1514 1515 1516
	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 已提交
1517
		*child = device;
1518
	} else
1519
		acpi_device_release(&device->dev);
L
Linus Torvalds 已提交
1520

1521
	return result;
L
Linus Torvalds 已提交
1522 1523
}

1524 1525 1526
#define ACPI_STA_DEFAULT (ACPI_STA_DEVICE_PRESENT | ACPI_STA_DEVICE_ENABLED | \
			  ACPI_STA_DEVICE_UI      | ACPI_STA_DEVICE_FUNCTIONING)

1527 1528 1529 1530 1531
static void acpi_bus_add_power_resource(acpi_handle handle)
{
	struct acpi_bus_ops ops = {
		.acpi_op_add = 1,
		.acpi_op_start = 1,
1532
		.acpi_op_match = 1,
1533 1534 1535 1536 1537 1538 1539 1540 1541
	};
	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);
}

1542 1543
static int acpi_bus_type_and_status(acpi_handle handle, int *type,
				    unsigned long long *sta)
L
Linus Torvalds 已提交
1544
{
1545 1546
	acpi_status status;
	acpi_object_type acpi_type;
L
Linus Torvalds 已提交
1547

1548
	status = acpi_get_type(handle, &acpi_type);
1549
	if (ACPI_FAILURE(status))
1550
		return -ENODEV;
L
Len Brown 已提交
1551

1552
	switch (acpi_type) {
1553 1554
	case ACPI_TYPE_ANY:		/* for ACPI_ROOT_OBJECT */
	case ACPI_TYPE_DEVICE:
1555 1556 1557 1558
		*type = ACPI_BUS_TYPE_DEVICE;
		status = acpi_bus_get_status_handle(handle, sta);
		if (ACPI_FAILURE(status))
			return -ENODEV;
1559 1560
		break;
	case ACPI_TYPE_PROCESSOR:
1561 1562 1563 1564
		*type = ACPI_BUS_TYPE_PROCESSOR;
		status = acpi_bus_get_status_handle(handle, sta);
		if (ACPI_FAILURE(status))
			return -ENODEV;
1565 1566
		break;
	case ACPI_TYPE_THERMAL:
1567 1568
		*type = ACPI_BUS_TYPE_THERMAL;
		*sta = ACPI_STA_DEFAULT;
1569 1570
		break;
	case ACPI_TYPE_POWER:
1571 1572
		*type = ACPI_BUS_TYPE_POWER;
		*sta = ACPI_STA_DEFAULT;
1573 1574
		break;
	default:
1575
		return -ENODEV;
1576
	}
L
Linus Torvalds 已提交
1577

1578 1579 1580 1581 1582 1583 1584
	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;
1585
	struct acpi_device *device = NULL;
1586 1587
	int type;
	unsigned long long sta;
1588
	acpi_status status;
1589 1590 1591 1592 1593 1594 1595
	int result;

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

	if (!(sta & ACPI_STA_DEVICE_PRESENT) &&
1596
	    !(sta & ACPI_STA_DEVICE_FUNCTIONING)) {
1597 1598 1599 1600 1601 1602 1603
		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);
1604
		return AE_CTRL_DEPTH;
1605
	}
1606

1607
	acpi_bus_get_device(handle, &device);
1608
	if (ops->acpi_op_add && !device) {
1609
		struct acpi_bus_ops add_ops = *ops;
L
Linus Torvalds 已提交
1610

1611 1612 1613
		add_ops.acpi_op_match = 0;
		acpi_add_single_object(&device, handle, type, sta, &add_ops);
		if (!device)
1614
			return AE_CTRL_DEPTH;
1615 1616 1617

		device->bus_ops.acpi_op_match = 1;
		acpi_hot_add_bind(device);
1618
	}
L
Linus Torvalds 已提交
1619

1620 1621
	if (!*return_value)
		*return_value = device;
1622

1623 1624
	return AE_OK;
}
1625

1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658
static acpi_status acpi_bus_probe_start(acpi_handle handle, u32 lvl,
					void *context, void **not_used)
{
	struct acpi_bus_ops *ops = context;
	acpi_status status = AE_OK;
	struct acpi_device *device;
	unsigned long long sta_not_used;
	int type_not_used;

	/*
	 * Ignore errors ignored by acpi_bus_check_add() to avoid terminating
	 * namespace walks prematurely.
	 */
	if (acpi_bus_type_and_status(handle, &type_not_used, &sta_not_used))
		return AE_OK;

	if (acpi_bus_get_device(handle, &device))
		return AE_CTRL_DEPTH;

	if (ops->acpi_op_add) {
		if (!acpi_match_device_ids(device, acpi_platform_device_ids)) {
			/* This is a known good platform device. */
			acpi_create_platform_device(device);
		} else if (device_attach(&device->dev)) {
			status = AE_CTRL_DEPTH;
		}
	} else if (ops->acpi_op_start) {
		if (ACPI_FAILURE(acpi_start_single_object(device)))
			status = AE_CTRL_DEPTH;
	}
	return status;
}

1659 1660 1661 1662
static int acpi_bus_scan(acpi_handle handle, struct acpi_bus_ops *ops,
			 struct acpi_device **child)
{
	void *device = NULL;
1663 1664
	acpi_status status;
	int ret = -ENODEV;
1665

1666 1667 1668
	status = acpi_bus_check_add(handle, 0, ops, &device);
	if (ACPI_SUCCESS(status))
		acpi_walk_namespace(ACPI_TYPE_ANY, handle, ACPI_UINT32_MAX,
1669
				    acpi_bus_check_add, NULL, ops, &device);
L
Linus Torvalds 已提交
1670

1671 1672 1673 1674 1675 1676 1677 1678 1679 1680
	if (!device)
		goto out;

	ret = 0;
	status = acpi_bus_probe_start(handle, 0, ops, NULL);
	if (ACPI_SUCCESS(status))
		acpi_walk_namespace(ACPI_TYPE_ANY, handle, ACPI_UINT32_MAX,
				    acpi_bus_probe_start, NULL, ops, NULL);

 out:
1681 1682
	if (child)
		*child = device;
1683

1684
	return ret;
L
Linus Torvalds 已提交
1685 1686
}

1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698
/*
 * 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.
 */

1699
int
L
Len Brown 已提交
1700 1701
acpi_bus_add(struct acpi_device **child,
	     struct acpi_device *parent, acpi_handle handle, int type)
1702 1703 1704
{
	struct acpi_bus_ops ops;

L
Li Shaohua 已提交
1705 1706
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
1707

1708
	return acpi_bus_scan(handle, &ops, child);
1709 1710 1711
}
EXPORT_SYMBOL(acpi_bus_add);

L
Len Brown 已提交
1712
int acpi_bus_start(struct acpi_device *device)
1713 1714
{
	struct acpi_bus_ops ops;
1715
	int result;
1716

1717 1718 1719
	if (!device)
		return -EINVAL;

1720 1721
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_start = 1;
1722

1723 1724
	result = acpi_bus_scan(device->handle, &ops, NULL);

1725
	acpi_update_all_gpes();
1726 1727

	return result;
1728 1729
}
EXPORT_SYMBOL(acpi_bus_start);
L
Linus Torvalds 已提交
1730

1731
int acpi_bus_trim(struct acpi_device *start, int rmdevice)
L
Linus Torvalds 已提交
1732
{
L
Len Brown 已提交
1733 1734 1735 1736 1737 1738 1739 1740
	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 已提交
1741 1742 1743 1744 1745
	phandle = start->handle;
	child = chandle = NULL;

	while ((level > 0) && parent && (!err)) {
		status = acpi_get_next_object(ACPI_TYPE_ANY, phandle,
L
Len Brown 已提交
1746
					      chandle, &chandle);
L
Linus Torvalds 已提交
1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783

		/*
		 * 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;
}
1784 1785
EXPORT_SYMBOL_GPL(acpi_bus_trim);

1786
static int acpi_bus_scan_fixed(void)
L
Linus Torvalds 已提交
1787
{
L
Len Brown 已提交
1788 1789
	int result = 0;
	struct acpi_device *device = NULL;
L
Li Shaohua 已提交
1790
	struct acpi_bus_ops ops;
L
Linus Torvalds 已提交
1791

L
Li Shaohua 已提交
1792 1793 1794
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
	ops.acpi_op_start = 1;
1795
	ops.acpi_op_match = 1;
L
Li Shaohua 已提交
1796

L
Linus Torvalds 已提交
1797 1798 1799
	/*
	 * Enumerate all fixed-feature devices.
	 */
1800
	if ((acpi_gbl_FADT.flags & ACPI_FADT_POWER_BUTTON) == 0) {
1801
		result = acpi_add_single_object(&device, NULL,
L
Li Shaohua 已提交
1802
						ACPI_BUS_TYPE_POWER_BUTTON,
1803
						ACPI_STA_DEFAULT,
L
Li Shaohua 已提交
1804
						&ops);
1805
		device_init_wakeup(&device->dev, true);
1806
	}
L
Linus Torvalds 已提交
1807

1808
	if ((acpi_gbl_FADT.flags & ACPI_FADT_SLEEP_BUTTON) == 0) {
1809
		result = acpi_add_single_object(&device, NULL,
L
Li Shaohua 已提交
1810
						ACPI_BUS_TYPE_SLEEP_BUTTON,
1811
						ACPI_STA_DEFAULT,
L
Li Shaohua 已提交
1812
						&ops);
1813
	}
L
Linus Torvalds 已提交
1814

1815
	return result;
L
Linus Torvalds 已提交
1816 1817
}

1818
int __init acpi_scan_init(void)
L
Linus Torvalds 已提交
1819 1820
{
	int result;
1821
	struct acpi_bus_ops ops;
L
Linus Torvalds 已提交
1822

L
Li Shaohua 已提交
1823 1824 1825
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
	ops.acpi_op_start = 1;
L
Linus Torvalds 已提交
1826

1827 1828 1829 1830 1831 1832
	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");
	}

1833
	acpi_power_init();
1834
	acpi_pci_root_init();
1835

L
Linus Torvalds 已提交
1836 1837 1838
	/*
	 * Enumerate devices in the ACPI namespace.
	 */
1839
	result = acpi_bus_scan(ACPI_ROOT_OBJECT, &ops, &acpi_root);
1840

L
Li Shaohua 已提交
1841
	if (!result)
1842
		result = acpi_bus_scan_fixed();
L
Linus Torvalds 已提交
1843 1844 1845

	if (result)
		acpi_device_unregister(acpi_root, ACPI_BUS_REMOVAL_NORMAL);
1846
	else
1847
		acpi_update_all_gpes();
L
Linus Torvalds 已提交
1848

1849
	return result;
L
Linus Torvalds 已提交
1850
}