scan.c 40.1 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 87 88 89 90 91 92 93 94
/**
 * 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 已提交
95
{
96
	struct acpi_eject_event *ej_event = (struct acpi_eject_event *) context;
97
	struct acpi_device *device;
98
	acpi_handle handle = ej_event->handle;
L
Linus Torvalds 已提交
99 100 101
	struct acpi_object_list arg_list;
	union acpi_object arg;
	acpi_status status = AE_OK;
102
	u32 ost_code = ACPI_OST_SC_NON_SPECIFIC_FAILURE; /* default */
L
Linus Torvalds 已提交
103

104
	if (acpi_bus_get_device(handle, &device))
105
		goto err_out;
106 107

	if (!device)
108
		goto err_out;
109 110

	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
111
		"Hot-removing device %s...\n", dev_name(&device->dev)));
112 113

	if (acpi_bus_trim(device, 1)) {
114 115
		printk(KERN_ERR PREFIX
				"Removing device failed\n");
116
		goto err_out;
117
	}
L
Linus Torvalds 已提交
118

119 120 121
	/* power off device */
	status = acpi_evaluate_object(handle, "_PS3", NULL, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND)
122 123
		printk(KERN_WARNING PREFIX
				"Power-off device failed\n");
124 125

	if (device->flags.lockable) {
L
Linus Torvalds 已提交
126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141
		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);
142 143 144 145 146 147
	if (ACPI_FAILURE(status)) {
		if (status != AE_NOT_FOUND)
			printk(KERN_WARNING PREFIX
					"Eject device failed\n");
		goto err_out;
	}
L
Linus Torvalds 已提交
148

149 150
	kfree(context);
	return;
L
Linus Torvalds 已提交
151

152 153 154 155 156
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);
157
	return;
L
Linus Torvalds 已提交
158 159 160
}

static ssize_t
P
Patrick Mochel 已提交
161 162
acpi_eject_store(struct device *d, struct device_attribute *attr,
		const char *buf, size_t count)
L
Linus Torvalds 已提交
163
{
L
Len Brown 已提交
164 165 166
	int ret = count;
	acpi_status status;
	acpi_object_type type = 0;
P
Patrick Mochel 已提交
167
	struct acpi_device *acpi_device = to_acpi_device(d);
168
	struct acpi_eject_event *ej_event;
L
Linus Torvalds 已提交
169 170 171 172 173

	if ((!count) || (buf[0] != '1')) {
		return -EINVAL;
	}
#ifndef FORCE_EJECT
P
Patrick Mochel 已提交
174
	if (acpi_device->driver == NULL) {
L
Linus Torvalds 已提交
175 176 177 178
		ret = -ENODEV;
		goto err;
	}
#endif
P
Patrick Mochel 已提交
179 180
	status = acpi_get_type(acpi_device->handle, &type);
	if (ACPI_FAILURE(status) || (!acpi_device->flags.ejectable)) {
L
Linus Torvalds 已提交
181 182 183 184
		ret = -ENODEV;
		goto err;
	}

185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203
	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);
204
err:
L
Linus Torvalds 已提交
205 206 207
	return ret;
}

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

210 211 212
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 已提交
213

214
	return sprintf(buf, "%s\n", acpi_device_hid(acpi_dev));
L
Linus Torvalds 已提交
215
}
216
static DEVICE_ATTR(hid, 0444, acpi_device_hid_show, NULL);
L
Linus Torvalds 已提交
217

218 219 220 221 222
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 已提交
223

224
	result = acpi_get_name(acpi_dev->handle, ACPI_FULL_PATHNAME, &path);
225
	if (result)
226
		goto end;
L
Linus Torvalds 已提交
227

228 229
	result = sprintf(buf, "%s\n", (char*)path.pointer);
	kfree(path.pointer);
230
end:
231
	return result;
L
Linus Torvalds 已提交
232
}
233
static DEVICE_ATTR(path, 0444, acpi_device_path_show, NULL);
L
Linus Torvalds 已提交
234

235
static int acpi_device_setup_files(struct acpi_device *dev)
L
Linus Torvalds 已提交
236
{
P
Patrick Mochel 已提交
237 238
	acpi_status status;
	acpi_handle temp;
239
	int result = 0;
L
Linus Torvalds 已提交
240 241

	/*
242
	 * Devices gotten from FADT don't have a "path" attribute
L
Linus Torvalds 已提交
243
	 */
244
	if (dev->handle) {
245
		result = device_create_file(&dev->dev, &dev_attr_path);
246
		if (result)
247
			goto end;
L
Linus Torvalds 已提交
248 249
	}

250 251 252 253
	if (!list_empty(&dev->pnp.ids)) {
		result = device_create_file(&dev->dev, &dev_attr_hid);
		if (result)
			goto end;
L
Linus Torvalds 已提交
254

255 256 257 258
		result = device_create_file(&dev->dev, &dev_attr_modalias);
		if (result)
			goto end;
	}
259

260 261 262 263
        /*
         * If device has _EJ0, 'eject' file is created that is used to trigger
         * hot-removal function from userland.
         */
P
Patrick Mochel 已提交
264 265
	status = acpi_get_handle(dev->handle, "_EJ0", &temp);
	if (ACPI_SUCCESS(status))
266
		result = device_create_file(&dev->dev, &dev_attr_eject);
267
end:
268
	return result;
L
Linus Torvalds 已提交
269 270
}

P
Patrick Mochel 已提交
271
static void acpi_device_remove_files(struct acpi_device *dev)
L
Linus Torvalds 已提交
272
{
P
Patrick Mochel 已提交
273 274
	acpi_status status;
	acpi_handle temp;
L
Linus Torvalds 已提交
275

P
Patrick Mochel 已提交
276 277 278 279 280 281 282
	/*
	 * 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 已提交
283

284 285
	device_remove_file(&dev->dev, &dev_attr_modalias);
	device_remove_file(&dev->dev, &dev_attr_hid);
286
	if (dev->handle)
287
		device_remove_file(&dev->dev, &dev_attr_path);
L
Linus Torvalds 已提交
288 289
}
/* --------------------------------------------------------------------------
Z
Zhang Rui 已提交
290
			ACPI Bus operations
L
Linus Torvalds 已提交
291
   -------------------------------------------------------------------------- */
292 293 294 295 296

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

299 300 301 302 303 304 305
	/*
	 * If the device is not present, it is unnecessary to load device
	 * driver for it.
	 */
	if (!device->status.present)
		return -ENODEV;

306 307 308
	for (id = ids; id->id[0]; id++)
		list_for_each_entry(hwid, &device->pnp.ids, list)
			if (!strcmp((char *) id->id, hwid->id))
309 310 311 312 313 314
				return 0;

	return -ENOENT;
}
EXPORT_SYMBOL(acpi_match_device_ids);

315 316 317 318 319 320 321 322 323 324
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);
	}
}

325
static void acpi_device_release(struct device *dev)
L
Linus Torvalds 已提交
326
{
327
	struct acpi_device *acpi_dev = to_acpi_device(dev);
L
Linus Torvalds 已提交
328

329
	acpi_free_ids(acpi_dev);
330
	kfree(acpi_dev);
L
Linus Torvalds 已提交
331 332
}

333
static int acpi_bus_match(struct device *dev, struct device_driver *drv)
Z
Zhang Rui 已提交
334
{
335 336
	struct acpi_device *acpi_dev = to_acpi_device(dev);
	struct acpi_driver *acpi_drv = to_acpi_driver(drv);
L
Linus Torvalds 已提交
337

338
	return !acpi_match_device_ids(acpi_dev, acpi_drv->ids);
339
}
L
Linus Torvalds 已提交
340

341
static int acpi_device_uevent(struct device *dev, struct kobj_uevent_env *env)
L
Linus Torvalds 已提交
342
{
343
	struct acpi_device *acpi_dev = to_acpi_device(dev);
344
	int len;
345

346 347 348
	if (list_empty(&acpi_dev->pnp.ids))
		return 0;

349 350 351 352 353 354 355
	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 已提交
356
	return 0;
L
Linus Torvalds 已提交
357 358
}

359 360 361 362 363 364 365 366 367 368 369
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;

370 371
	/* Fixed hardware devices have no handles */
	acpi_device_notify(NULL, ACPI_FIXED_HARDWARE_EVENT, device);
372 373 374 375 376 377 378
	return AE_OK;
}

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

379
	if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
380 381 382 383
		status =
		    acpi_install_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
						     acpi_device_notify_fixed,
						     device);
384
	else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401
		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)
{
402
	if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
403 404
		acpi_remove_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
						acpi_device_notify_fixed);
405
	else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
406 407 408 409 410 411 412
		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);
}

413 414 415
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 已提交
416
{
417 418 419 420 421 422
	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 已提交
423 424
		if (acpi_dev->bus_ops.acpi_op_start)
			acpi_start_single_object(acpi_dev);
425 426 427 428 429 430 431 432 433 434 435

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

436 437 438 439 440 441 442
		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 已提交
443

444 445 446 447 448 449
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) {
450 451
		if (acpi_drv->ops.notify)
			acpi_device_remove_notify_handler(acpi_dev);
452
		if (acpi_drv->ops.remove)
453
			acpi_drv->ops.remove(acpi_dev, acpi_dev->removal_type);
L
Linus Torvalds 已提交
454
	}
455
	acpi_dev->driver = NULL;
456
	acpi_dev->driver_data = NULL;
L
Linus Torvalds 已提交
457

458
	put_device(dev);
Z
Zhang Rui 已提交
459 460
	return 0;
}
L
Linus Torvalds 已提交
461

462
struct bus_type acpi_bus_type = {
Z
Zhang Rui 已提交
463
	.name		= "acpi",
464 465 466 467
	.match		= acpi_bus_match,
	.probe		= acpi_device_probe,
	.remove		= acpi_device_remove,
	.uevent		= acpi_device_uevent,
Z
Zhang Rui 已提交
468 469
};

470
static int acpi_device_register(struct acpi_device *device)
L
Linus Torvalds 已提交
471
{
L
Len Brown 已提交
472
	int result;
473 474
	struct acpi_device_bus_id *acpi_device_bus_id, *new_bus_id;
	int found = 0;
475

Z
Zhang Rui 已提交
476 477 478 479 480 481 482 483
	/*
	 * 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 已提交
484

485 486 487 488
	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 已提交
489
	}
490

491
	mutex_lock(&acpi_device_lock);
492 493 494 495 496
	/*
	 * 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) {
497 498 499
		if (!strcmp(acpi_device_bus_id->bus_id,
			    acpi_device_hid(device))) {
			acpi_device_bus_id->instance_no++;
500 501 502 503
			found = 1;
			kfree(new_bus_id);
			break;
		}
L
Linus Torvalds 已提交
504
	}
505
	if (!found) {
506
		acpi_device_bus_id = new_bus_id;
507
		strcpy(acpi_device_bus_id->bus_id, acpi_device_hid(device));
508 509
		acpi_device_bus_id->instance_no = 0;
		list_add_tail(&acpi_device_bus_id->node, &acpi_bus_id_list);
L
Linus Torvalds 已提交
510
	}
511
	dev_set_name(&device->dev, "%s:%02x", acpi_device_bus_id->bus_id, acpi_device_bus_id->instance_no);
L
Linus Torvalds 已提交
512

L
Len Brown 已提交
513
	if (device->parent)
Z
Zhang Rui 已提交
514
		list_add_tail(&device->node, &device->parent->children);
L
Len Brown 已提交
515

Z
Zhang Rui 已提交
516 517
	if (device->wakeup.flags.valid)
		list_add_tail(&device->wakeup_list, &acpi_wakeup_device_list);
518
	mutex_unlock(&acpi_device_lock);
L
Linus Torvalds 已提交
519

520
	if (device->parent)
521
		device->dev.parent = &device->parent->dev;
522 523
	device->dev.bus = &acpi_bus_type;
	device->dev.release = &acpi_device_release;
524
	result = device_register(&device->dev);
525
	if (result) {
526
		dev_err(&device->dev, "Error registering device\n");
527
		goto end;
L
Linus Torvalds 已提交
528 529
	}

530
	result = acpi_device_setup_files(device);
531
	if (result)
532 533
		printk(KERN_ERR PREFIX "Error creating sysfs interface for device %s\n",
		       dev_name(&device->dev));
L
Linus Torvalds 已提交
534

535
	device->removal_type = ACPI_BUS_REMOVAL_NORMAL;
L
Linus Torvalds 已提交
536
	return 0;
537
end:
538
	mutex_lock(&acpi_device_lock);
L
Len Brown 已提交
539
	if (device->parent)
540 541
		list_del(&device->node);
	list_del(&device->wakeup_list);
542
	mutex_unlock(&acpi_device_lock);
543
	return result;
L
Linus Torvalds 已提交
544 545
}

Z
Zhang Rui 已提交
546 547
static void acpi_device_unregister(struct acpi_device *device, int type)
{
548
	mutex_lock(&acpi_device_lock);
L
Len Brown 已提交
549
	if (device->parent)
Z
Zhang Rui 已提交
550
		list_del(&device->node);
L
Linus Torvalds 已提交
551

Z
Zhang Rui 已提交
552
	list_del(&device->wakeup_list);
553
	mutex_unlock(&acpi_device_lock);
L
Linus Torvalds 已提交
554

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

P
Patrick Mochel 已提交
557
	acpi_device_remove_files(device);
558
	device_unregister(&device->dev);
L
Linus Torvalds 已提交
559 560
}

Z
Zhang Rui 已提交
561 562 563
/* --------------------------------------------------------------------------
                                 Driver Management
   -------------------------------------------------------------------------- */
L
Linus Torvalds 已提交
564
/**
565 566 567 568
 * acpi_bus_driver_init - add a device to a driver
 * @device: the device to add and initialize
 * @driver: driver for the device
 *
569
 * Used to initialize a device via its device driver.  Called whenever a
570
 * driver is bound to a device.  Invokes the driver's add() ops.
L
Linus Torvalds 已提交
571 572
 */
static int
L
Len Brown 已提交
573
acpi_bus_driver_init(struct acpi_device *device, struct acpi_driver *driver)
L
Linus Torvalds 已提交
574
{
L
Len Brown 已提交
575
	int result = 0;
L
Linus Torvalds 已提交
576 577

	if (!device || !driver)
578
		return -EINVAL;
L
Linus Torvalds 已提交
579 580

	if (!driver->ops.add)
581
		return -ENOSYS;
L
Linus Torvalds 已提交
582 583 584 585

	result = driver->ops.add(device);
	if (result) {
		device->driver = NULL;
586
		device->driver_data = NULL;
587
		return result;
L
Linus Torvalds 已提交
588 589 590 591 592 593 594 595 596
	}

	device->driver = driver;

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

L
Len Brown 已提交
597 598
	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
			  "Driver successfully bound to device\n"));
599
	return 0;
600 601
}

602
static int acpi_start_single_object(struct acpi_device *device)
603 604 605 606 607 608
{
	int result = 0;
	struct acpi_driver *driver;


	if (!(driver = device->driver))
609
		return 0;
610

L
Linus Torvalds 已提交
611 612 613 614 615 616
	if (driver->ops.start) {
		result = driver->ops.start(device);
		if (result && driver->ops.remove)
			driver->ops.remove(device, ACPI_BUS_REMOVAL_NORMAL);
	}

617
	return result;
L
Linus Torvalds 已提交
618 619
}

Z
Zhang Rui 已提交
620 621 622 623 624 625 626 627 628
/**
 * 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 已提交
629
{
630
	int ret;
L
Linus Torvalds 已提交
631

Z
Zhang Rui 已提交
632 633
	if (acpi_disabled)
		return -ENODEV;
634 635 636
	driver->drv.name = driver->name;
	driver->drv.bus = &acpi_bus_type;
	driver->drv.owner = driver->owner;
L
Linus Torvalds 已提交
637

638 639
	ret = driver_register(&driver->drv);
	return ret;
Z
Zhang Rui 已提交
640
}
L
Linus Torvalds 已提交
641

Z
Zhang Rui 已提交
642 643 644 645 646 647 648 649 650 651 652
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)
{
653
	driver_unregister(&driver->drv);
Z
Zhang Rui 已提交
654 655 656 657 658 659 660
}

EXPORT_SYMBOL(acpi_bus_unregister_driver);

/* --------------------------------------------------------------------------
                                 Device Enumeration
   -------------------------------------------------------------------------- */
661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687
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 已提交
688 689 690 691 692 693 694 695 696 697 698 699 700 701 702
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;
703 704
		status = acpi_get_handle(ACPI_ROOT_OBJECT, obj->string.pointer,
					 ejd);
Z
Zhang Rui 已提交
705 706 707 708 709 710
		kfree(buffer.pointer);
	}
	return status;
}
EXPORT_SYMBOL_GPL(acpi_bus_get_ejd);

711
void acpi_bus_data_handler(acpi_handle handle, void *context)
Z
Zhang Rui 已提交
712 713 714 715 716 717 718 719 720 721 722 723 724 725
{

	/* TBD */

	return;
}

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

static acpi_status
726 727
acpi_bus_extract_wakeup_device_power_package(acpi_handle handle,
					     struct acpi_device_wakeup *wakeup)
Z
Zhang Rui 已提交
728
{
729 730
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *package = NULL;
Z
Zhang Rui 已提交
731
	union acpi_object *element = NULL;
732 733
	acpi_status status;
	int i = 0;
Z
Zhang Rui 已提交
734

735
	if (!wakeup)
Z
Zhang Rui 已提交
736 737
		return AE_BAD_PARAMETER;

738 739 740 741 742 743 744 745 746 747 748 749 750 751
	/* _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 已提交
752
	element = &(package->package.elements[0]);
753 754 755 756
	if (!element) {
		status = AE_BAD_DATA;
		goto out;
	}
Z
Zhang Rui 已提交
757 758 759 760
	if (element->type == ACPI_TYPE_PACKAGE) {
		if ((element->package.count < 2) ||
		    (element->package.elements[0].type !=
		     ACPI_TYPE_LOCAL_REFERENCE)
761 762 763 764 765
		    || (element->package.elements[1].type != ACPI_TYPE_INTEGER)) {
			status = AE_BAD_DATA;
			goto out;
		}
		wakeup->gpe_device =
Z
Zhang Rui 已提交
766
		    element->package.elements[0].reference.handle;
767
		wakeup->gpe_number =
Z
Zhang Rui 已提交
768 769
		    (u32) element->package.elements[1].integer.value;
	} else if (element->type == ACPI_TYPE_INTEGER) {
770 771 772 773 774 775
		wakeup->gpe_device = NULL;
		wakeup->gpe_number = element->integer.value;
	} else {
		status = AE_BAD_DATA;
		goto out;
	}
Z
Zhang Rui 已提交
776 777 778

	element = &(package->package.elements[1]);
	if (element->type != ACPI_TYPE_INTEGER) {
779 780
		status = AE_BAD_DATA;
		goto out;
Z
Zhang Rui 已提交
781
	}
782
	wakeup->sleep_state = element->integer.value;
Z
Zhang Rui 已提交
783 784

	if ((package->package.count - 2) > ACPI_MAX_HANDLES) {
785 786
		status = AE_NO_MEMORY;
		goto out;
Z
Zhang Rui 已提交
787
	}
788 789
	wakeup->resources.count = package->package.count - 2;
	for (i = 0; i < wakeup->resources.count; i++) {
Z
Zhang Rui 已提交
790
		element = &(package->package.elements[i + 2]);
791 792 793 794
		if (element->type != ACPI_TYPE_LOCAL_REFERENCE) {
			status = AE_BAD_DATA;
			goto out;
		}
Z
Zhang Rui 已提交
795

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

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

801 802 803 804
 out:
	kfree(buffer.pointer);

	return status;
L
Linus Torvalds 已提交
805 806
}

807
static void acpi_bus_set_run_wake_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
808
{
809 810 811 812 813 814
	struct acpi_device_id button_device_ids[] = {
		{"PNP0C0D", 0},
		{"PNP0C0C", 0},
		{"PNP0C0E", 0},
		{"", 0},
	};
815 816 817
	acpi_status status;
	acpi_event_status event_status;

818
	device->wakeup.flags.notifier_present = 0;
819 820 821 822

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

827 828 829
	status = acpi_get_gpe_status(device->wakeup.gpe_device,
					device->wakeup.gpe_number,
						&event_status);
830 831 832 833 834
	if (status == AE_OK)
		device->wakeup.flags.run_wake =
				!!(event_status & ACPI_EVENT_FLAG_HANDLE);
}

835
static void acpi_bus_get_wakeup_device_flags(struct acpi_device *device)
836
{
837
	acpi_handle temp;
838 839
	acpi_status status = 0;
	int psw_error;
840

841 842 843 844 845
	/* Presence of _PRW indicates wake capable */
	status = acpi_get_handle(device->handle, "_PRW", &temp);
	if (ACPI_FAILURE(status))
		return;

846 847
	status = acpi_bus_extract_wakeup_device_power_package(device->handle,
							      &device->wakeup);
Z
Zhang Rui 已提交
848 849
	if (ACPI_FAILURE(status)) {
		ACPI_EXCEPTION((AE_INFO, status, "Extracting _PRW package"));
850
		return;
Z
Zhang Rui 已提交
851
	}
L
Linus Torvalds 已提交
852

Z
Zhang Rui 已提交
853
	device->wakeup.flags.valid = 1;
854
	device->wakeup.prepare_count = 0;
855
	acpi_bus_set_run_wake_flags(device);
856 857 858 859 860 861
	/* 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.
	 */
862 863 864 865
	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 已提交
866 867
}

868 869
static void acpi_bus_add_power_resource(acpi_handle handle);

Z
Zhang Rui 已提交
870
static int acpi_bus_get_power_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
871
{
Z
Zhang Rui 已提交
872 873 874
	acpi_status status = 0;
	acpi_handle handle = NULL;
	u32 i = 0;
B
Bjorn Helgaas 已提交
875

L
Len Brown 已提交
876

Z
Zhang Rui 已提交
877 878 879 880 881 882 883 884 885
	/*
	 * 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 已提交
886

Z
Zhang Rui 已提交
887 888 889
	/*
	 * Enumerate supported power management states
	 */
L
Lin Ming 已提交
890
	for (i = ACPI_STATE_D0; i <= ACPI_STATE_D3_HOT; i++) {
Z
Zhang Rui 已提交
891 892
		struct acpi_device_power_state *ps = &device->power.states[i];
		char object_name[5] = { '_', 'P', 'R', '0' + i, '\0' };
L
Linus Torvalds 已提交
893

Z
Zhang Rui 已提交
894 895 896 897
		/* Evaluate "_PRx" to se if power resources are referenced */
		acpi_evaluate_reference(device->handle, object_name, NULL,
					&ps->resources);
		if (ps->resources.count) {
898 899
			int j;

Z
Zhang Rui 已提交
900
			device->power.flags.power_resources = 1;
901 902
			for (j = 0; j < ps->resources.count; j++)
				acpi_bus_add_power_resource(ps->resources.handles[j]);
L
Linus Torvalds 已提交
903 904
		}

Z
Zhang Rui 已提交
905 906 907
		/* 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 已提交
908
		if (ACPI_SUCCESS(status))
Z
Zhang Rui 已提交
909
			ps->flags.explicit_set = 1;
L
Linus Torvalds 已提交
910

L
Lin Ming 已提交
911 912 913 914 915 916
		/*
		 * 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 已提交
917
			ps->flags.valid = 1;
L
Linus Torvalds 已提交
918

Z
Zhang Rui 已提交
919 920 921
		ps->power = -1;	/* Unknown - driver assigned */
		ps->latency = -1;	/* Unknown - driver assigned */
	}
L
Linus Torvalds 已提交
922

Z
Zhang Rui 已提交
923 924 925 926 927
	/* 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 已提交
928

929 930 931 932
	/* 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;

933
	acpi_bus_init_power(device);
L
Len Brown 已提交
934

Z
Zhang Rui 已提交
935 936
	return 0;
}
L
Len Brown 已提交
937

L
Len Brown 已提交
938
static int acpi_bus_get_flags(struct acpi_device *device)
L
Linus Torvalds 已提交
939
{
L
Len Brown 已提交
940 941
	acpi_status status = AE_OK;
	acpi_handle temp = NULL;
L
Linus Torvalds 已提交
942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968


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

969 970 971 972
	/* Power resources cannot be power manageable. */
	if (device->device_type == ACPI_BUS_TYPE_POWER)
		return 0;

L
Linus Torvalds 已提交
973 974 975 976 977 978 979
	/* 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 已提交
980
	/* TBD: Performance management */
L
Linus Torvalds 已提交
981

982
	return 0;
L
Linus Torvalds 已提交
983 984
}

985
static void acpi_device_get_busid(struct acpi_device *device)
L
Linus Torvalds 已提交
986
{
L
Len Brown 已提交
987 988 989
	char bus_id[5] = { '?', 0 };
	struct acpi_buffer buffer = { sizeof(bus_id), bus_id };
	int i = 0;
L
Linus Torvalds 已提交
990 991 992 993 994 995 996

	/*
	 * Bus ID
	 * ------
	 * The device's Bus ID is simply the object name.
	 * TBD: Shouldn't this value be unique (within the ACPI namespace)?
	 */
997
	if (ACPI_IS_ROOT_DEVICE(device)) {
L
Linus Torvalds 已提交
998
		strcpy(device->pnp.bus_id, "ACPI");
999 1000 1001 1002
		return;
	}

	switch (device->device_type) {
L
Linus Torvalds 已提交
1003 1004 1005 1006 1007 1008 1009
	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:
1010
		acpi_get_name(device->handle, ACPI_SINGLE_NAME, &buffer);
L
Linus Torvalds 已提交
1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022
		/* 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;
	}
}

1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058
/*
 * 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;
}

1059 1060 1061 1062 1063 1064 1065 1066 1067
/*
 * 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);
}

1068
const char *acpi_device_hid(struct acpi_device *device)
1069
{
1070
	struct acpi_hardware_id *hid;
1071

1072 1073 1074
	if (list_empty(&device->pnp.ids))
		return dummy_hid;

1075 1076 1077 1078
	hid = list_first_entry(&device->pnp.ids, struct acpi_hardware_id, list);
	return hid->id;
}
EXPORT_SYMBOL(acpi_device_hid);
1079

1080 1081 1082
static void acpi_add_id(struct acpi_device *device, const char *dev_id)
{
	struct acpi_hardware_id *id;
1083

1084 1085 1086
	id = kmalloc(sizeof(*id), GFP_KERNEL);
	if (!id)
		return;
1087

T
Thomas Meyer 已提交
1088
	id->id = kstrdup(dev_id, GFP_KERNEL);
1089 1090 1091
	if (!id->id) {
		kfree(id);
		return;
1092 1093
	}

1094
	list_add_tail(&id->list, &device->pnp.ids);
1095 1096
}

1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131
/*
 * 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;
}

1132
static void acpi_device_set_id(struct acpi_device *device)
L
Linus Torvalds 已提交
1133
{
L
Len Brown 已提交
1134
	acpi_status status;
1135 1136
	struct acpi_device_info *info;
	struct acpica_device_id_list *cid_list;
1137
	int i;
L
Linus Torvalds 已提交
1138

1139
	switch (device->device_type) {
L
Linus Torvalds 已提交
1140
	case ACPI_BUS_TYPE_DEVICE:
1141
		if (ACPI_IS_ROOT_DEVICE(device)) {
1142
			acpi_add_id(device, ACPI_SYSTEM_HID);
1143 1144 1145
			break;
		}

1146
		status = acpi_get_object_info(device->handle, &info);
L
Linus Torvalds 已提交
1147
		if (ACPI_FAILURE(status)) {
1148
			printk(KERN_ERR PREFIX "%s: Error reading device info\n", __func__);
L
Linus Torvalds 已提交
1149 1150 1151 1152
			return;
		}

		if (info->valid & ACPI_VALID_HID)
1153 1154
			acpi_add_id(device, info->hardware_id.string);
		if (info->valid & ACPI_VALID_CID) {
1155
			cid_list = &info->compatible_id_list;
1156 1157 1158
			for (i = 0; i < cid_list->count; i++)
				acpi_add_id(device, cid_list->ids[i].string);
		}
L
Linus Torvalds 已提交
1159 1160 1161 1162
		if (info->valid & ACPI_VALID_ADR) {
			device->pnp.bus_address = info->address;
			device->flags.bus_address = 1;
		}
1163

1164 1165
		kfree(info);

1166 1167 1168 1169
		/*
		 * Some devices don't reliably have _HIDs & _CIDs, so add
		 * synthetic HIDs to make sure drivers can find them.
		 */
1170
		if (acpi_is_video_device(device))
1171
			acpi_add_id(device, ACPI_VIDEO_HID);
1172
		else if (ACPI_SUCCESS(acpi_bay_match(device)))
1173
			acpi_add_id(device, ACPI_BAY_HID);
1174
		else if (ACPI_SUCCESS(acpi_dock_match(device)))
1175
			acpi_add_id(device, ACPI_DOCK_HID);
1176 1177
		else if (!acpi_ibm_smbus_match(device))
			acpi_add_id(device, ACPI_SMBUS_IBM_HID);
1178 1179 1180 1181 1182 1183
		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);
		}
1184

L
Linus Torvalds 已提交
1185 1186
		break;
	case ACPI_BUS_TYPE_POWER:
1187
		acpi_add_id(device, ACPI_POWER_HID);
L
Linus Torvalds 已提交
1188 1189
		break;
	case ACPI_BUS_TYPE_PROCESSOR:
1190
		acpi_add_id(device, ACPI_PROCESSOR_OBJECT_HID);
L
Linus Torvalds 已提交
1191 1192
		break;
	case ACPI_BUS_TYPE_THERMAL:
1193
		acpi_add_id(device, ACPI_THERMAL_HID);
L
Linus Torvalds 已提交
1194 1195
		break;
	case ACPI_BUS_TYPE_POWER_BUTTON:
1196
		acpi_add_id(device, ACPI_BUTTON_HID_POWERF);
L
Linus Torvalds 已提交
1197 1198
		break;
	case ACPI_BUS_TYPE_SLEEP_BUTTON:
1199
		acpi_add_id(device, ACPI_BUTTON_HID_SLEEPF);
L
Linus Torvalds 已提交
1200 1201 1202 1203
		break;
	}
}

1204
static int acpi_device_set_context(struct acpi_device *device)
L
Linus Torvalds 已提交
1205
{
1206 1207
	acpi_status status;

L
Linus Torvalds 已提交
1208 1209 1210 1211
	/*
	 * Context
	 * -------
	 * Attach this 'struct acpi_device' to the ACPI object.  This makes
1212 1213
	 * resolutions from handle->device very efficient.  Fixed hardware
	 * devices have no handles, so we skip them.
L
Linus Torvalds 已提交
1214
	 */
1215 1216
	if (!device->handle)
		return 0;
L
Linus Torvalds 已提交
1217

1218 1219 1220 1221 1222 1223 1224
	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 已提交
1225 1226
}

L
Len Brown 已提交
1227
static int acpi_bus_remove(struct acpi_device *dev, int rmdevice)
L
Linus Torvalds 已提交
1228 1229
{
	if (!dev)
1230
		return -EINVAL;
L
Linus Torvalds 已提交
1231

1232
	dev->removal_type = ACPI_BUS_REMOVAL_EJECT;
1233
	device_release_driver(&dev->dev);
L
Linus Torvalds 已提交
1234 1235

	if (!rmdevice)
1236
		return 0;
L
Linus Torvalds 已提交
1237

1238 1239 1240
	/*
	 * unbind _ADR-Based Devices when hot removal
	 */
L
Linus Torvalds 已提交
1241 1242 1243 1244 1245 1246
	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);

1247
	return 0;
L
Linus Torvalds 已提交
1248 1249
}

1250 1251
static int acpi_add_single_object(struct acpi_device **child,
				  acpi_handle handle, int type,
1252
				  unsigned long long sta,
1253
				  struct acpi_bus_ops *ops)
L
Linus Torvalds 已提交
1254
{
1255 1256
	int result;
	struct acpi_device *device;
1257
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
L
Linus Torvalds 已提交
1258

1259
	device = kzalloc(sizeof(struct acpi_device), GFP_KERNEL);
L
Linus Torvalds 已提交
1260
	if (!device) {
1261
		printk(KERN_ERR PREFIX "Memory allocation error\n");
1262
		return -ENOMEM;
L
Linus Torvalds 已提交
1263 1264
	}

1265
	INIT_LIST_HEAD(&device->pnp.ids);
1266
	device->device_type = type;
L
Linus Torvalds 已提交
1267
	device->handle = handle;
1268
	device->parent = acpi_bus_get_parent(handle);
L
Li Shaohua 已提交
1269
	device->bus_ops = *ops; /* workround for not call .start */
1270
	STRUCT_TO_INT(device->status) = sta;
L
Li Shaohua 已提交
1271

1272
	acpi_device_get_busid(device);
L
Linus Torvalds 已提交
1273 1274 1275 1276

	/*
	 * Flags
	 * -----
1277 1278
	 * Note that we only look for object handles -- cannot evaluate objects
	 * until we know the device is present and properly initialized.
L
Linus Torvalds 已提交
1279 1280 1281 1282 1283 1284 1285 1286 1287 1288
	 */
	result = acpi_bus_get_flags(device);
	if (result)
		goto end;

	/*
	 * Initialize Device
	 * -----------------
	 * TBD: Synch with Core's enumeration/initialization process.
	 */
1289
	acpi_device_set_id(device);
L
Linus Torvalds 已提交
1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300

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

L
Len Brown 已提交
1301
	/*
L
Linus Torvalds 已提交
1302 1303 1304
	 * Wakeup device management
	 *-----------------------
	 */
1305
	acpi_bus_get_wakeup_device_flags(device);
L
Linus Torvalds 已提交
1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316

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

1317
	if ((result = acpi_device_set_context(device)))
1318
		goto end;
L
Linus Torvalds 已提交
1319

1320
	result = acpi_device_register(device);
L
Linus Torvalds 已提交
1321 1322

	/*
1323
	 * Bind _ADR-Based Devices when hot add
L
Linus Torvalds 已提交
1324 1325 1326 1327 1328 1329
	 */
	if (device->flags.bus_address) {
		if (device->parent && device->parent->ops.bind)
			device->parent->ops.bind(device);
	}

1330
end:
1331 1332 1333 1334 1335 1336 1337 1338
	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 已提交
1339
		*child = device;
1340
	} else
1341
		acpi_device_release(&device->dev);
L
Linus Torvalds 已提交
1342

1343
	return result;
L
Linus Torvalds 已提交
1344 1345
}

1346 1347 1348
#define ACPI_STA_DEFAULT (ACPI_STA_DEVICE_PRESENT | ACPI_STA_DEVICE_ENABLED | \
			  ACPI_STA_DEVICE_UI      | ACPI_STA_DEVICE_FUNCTIONING)

1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362
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);
}

1363 1364
static int acpi_bus_type_and_status(acpi_handle handle, int *type,
				    unsigned long long *sta)
L
Linus Torvalds 已提交
1365
{
1366 1367
	acpi_status status;
	acpi_object_type acpi_type;
L
Linus Torvalds 已提交
1368

1369
	status = acpi_get_type(handle, &acpi_type);
1370
	if (ACPI_FAILURE(status))
1371
		return -ENODEV;
L
Len Brown 已提交
1372

1373
	switch (acpi_type) {
1374 1375
	case ACPI_TYPE_ANY:		/* for ACPI_ROOT_OBJECT */
	case ACPI_TYPE_DEVICE:
1376 1377 1378 1379
		*type = ACPI_BUS_TYPE_DEVICE;
		status = acpi_bus_get_status_handle(handle, sta);
		if (ACPI_FAILURE(status))
			return -ENODEV;
1380 1381
		break;
	case ACPI_TYPE_PROCESSOR:
1382 1383 1384 1385
		*type = ACPI_BUS_TYPE_PROCESSOR;
		status = acpi_bus_get_status_handle(handle, sta);
		if (ACPI_FAILURE(status))
			return -ENODEV;
1386 1387
		break;
	case ACPI_TYPE_THERMAL:
1388 1389
		*type = ACPI_BUS_TYPE_THERMAL;
		*sta = ACPI_STA_DEFAULT;
1390 1391
		break;
	case ACPI_TYPE_POWER:
1392 1393
		*type = ACPI_BUS_TYPE_POWER;
		*sta = ACPI_STA_DEFAULT;
1394 1395
		break;
	default:
1396
		return -ENODEV;
1397
	}
L
Linus Torvalds 已提交
1398

1399 1400 1401 1402 1403 1404 1405 1406 1407
	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;
1408 1409
	struct acpi_device *device;
	acpi_status status;
1410 1411 1412 1413 1414 1415 1416
	int result;

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

	if (!(sta & ACPI_STA_DEVICE_PRESENT) &&
1417
	    !(sta & ACPI_STA_DEVICE_FUNCTIONING)) {
1418 1419 1420 1421 1422 1423 1424
		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);
1425
		return AE_CTRL_DEPTH;
1426
	}
1427

1428 1429 1430 1431 1432 1433 1434 1435
	/*
	 * 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 已提交
1436

1437
	if (!device)
1438
		return AE_CTRL_DEPTH;
L
Linus Torvalds 已提交
1439

1440 1441
	if (ops->acpi_op_start && !(ops->acpi_op_add)) {
		status = acpi_start_single_object(device);
L
Linus Torvalds 已提交
1442
		if (ACPI_FAILURE(status))
1443 1444
			return AE_CTRL_DEPTH;
	}
L
Linus Torvalds 已提交
1445

1446 1447 1448 1449
	if (!*return_value)
		*return_value = device;
	return AE_OK;
}
1450

1451 1452 1453 1454 1455
static int acpi_bus_scan(acpi_handle handle, struct acpi_bus_ops *ops,
			 struct acpi_device **child)
{
	acpi_status status;
	void *device = NULL;
1456

1457 1458 1459
	status = acpi_bus_check_add(handle, 0, ops, &device);
	if (ACPI_SUCCESS(status))
		acpi_walk_namespace(ACPI_TYPE_ANY, handle, ACPI_UINT32_MAX,
1460
				    acpi_bus_check_add, NULL, ops, &device);
L
Linus Torvalds 已提交
1461

1462 1463
	if (child)
		*child = device;
1464 1465 1466 1467 1468

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

1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482
/*
 * 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.
 */

1483
int
L
Len Brown 已提交
1484 1485
acpi_bus_add(struct acpi_device **child,
	     struct acpi_device *parent, acpi_handle handle, int type)
1486 1487 1488
{
	struct acpi_bus_ops ops;

L
Li Shaohua 已提交
1489 1490
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
1491

1492
	return acpi_bus_scan(handle, &ops, child);
1493 1494 1495
}
EXPORT_SYMBOL(acpi_bus_add);

L
Len Brown 已提交
1496
int acpi_bus_start(struct acpi_device *device)
1497 1498
{
	struct acpi_bus_ops ops;
1499
	int result;
1500

1501 1502 1503
	if (!device)
		return -EINVAL;

1504 1505
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_start = 1;
1506

1507 1508
	result = acpi_bus_scan(device->handle, &ops, NULL);

1509
	acpi_update_all_gpes();
1510 1511

	return result;
1512 1513
}
EXPORT_SYMBOL(acpi_bus_start);
L
Linus Torvalds 已提交
1514

1515
int acpi_bus_trim(struct acpi_device *start, int rmdevice)
L
Linus Torvalds 已提交
1516
{
L
Len Brown 已提交
1517 1518 1519 1520 1521 1522 1523 1524
	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 已提交
1525 1526 1527 1528 1529
	phandle = start->handle;
	child = chandle = NULL;

	while ((level > 0) && parent && (!err)) {
		status = acpi_get_next_object(ACPI_TYPE_ANY, phandle,
L
Len Brown 已提交
1530
					      chandle, &chandle);
L
Linus Torvalds 已提交
1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567

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

1570
static int acpi_bus_scan_fixed(void)
L
Linus Torvalds 已提交
1571
{
L
Len Brown 已提交
1572 1573
	int result = 0;
	struct acpi_device *device = NULL;
L
Li Shaohua 已提交
1574
	struct acpi_bus_ops ops;
L
Linus Torvalds 已提交
1575

L
Li Shaohua 已提交
1576 1577 1578 1579
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
	ops.acpi_op_start = 1;

L
Linus Torvalds 已提交
1580 1581 1582
	/*
	 * Enumerate all fixed-feature devices.
	 */
1583
	if ((acpi_gbl_FADT.flags & ACPI_FADT_POWER_BUTTON) == 0) {
1584
		result = acpi_add_single_object(&device, NULL,
L
Li Shaohua 已提交
1585
						ACPI_BUS_TYPE_POWER_BUTTON,
1586
						ACPI_STA_DEFAULT,
L
Li Shaohua 已提交
1587
						&ops);
1588
		device_init_wakeup(&device->dev, true);
1589
	}
L
Linus Torvalds 已提交
1590

1591
	if ((acpi_gbl_FADT.flags & ACPI_FADT_SLEEP_BUTTON) == 0) {
1592
		result = acpi_add_single_object(&device, NULL,
L
Li Shaohua 已提交
1593
						ACPI_BUS_TYPE_SLEEP_BUTTON,
1594
						ACPI_STA_DEFAULT,
L
Li Shaohua 已提交
1595
						&ops);
1596
	}
L
Linus Torvalds 已提交
1597

1598
	return result;
L
Linus Torvalds 已提交
1599 1600
}

1601
int __init acpi_scan_init(void)
L
Linus Torvalds 已提交
1602 1603
{
	int result;
1604
	struct acpi_bus_ops ops;
L
Linus Torvalds 已提交
1605

L
Li Shaohua 已提交
1606 1607 1608
	memset(&ops, 0, sizeof(ops));
	ops.acpi_op_add = 1;
	ops.acpi_op_start = 1;
L
Linus Torvalds 已提交
1609

1610 1611 1612 1613 1614 1615
	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");
	}

1616 1617
	acpi_power_init();

L
Linus Torvalds 已提交
1618 1619 1620
	/*
	 * Enumerate devices in the ACPI namespace.
	 */
1621
	result = acpi_bus_scan(ACPI_ROOT_OBJECT, &ops, &acpi_root);
1622

L
Li Shaohua 已提交
1623
	if (!result)
1624
		result = acpi_bus_scan_fixed();
L
Linus Torvalds 已提交
1625 1626 1627

	if (result)
		acpi_device_unregister(acpi_root, ACPI_BUS_REMOVAL_NORMAL);
1628
	else
1629
		acpi_update_all_gpes();
L
Linus Torvalds 已提交
1630

1631
	return result;
L
Linus Torvalds 已提交
1632
}