pci_root.c 19.2 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29
/*
 *  pci_root.c - ACPI PCI Root Bridge Driver ($Revision: 40 $)
 *
 *  Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
 *  Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or (at
 *  your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful, but
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *  General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
30
#include <linux/mutex.h>
L
Linus Torvalds 已提交
31
#include <linux/pm.h>
32
#include <linux/pm_runtime.h>
L
Linus Torvalds 已提交
33
#include <linux/pci.h>
34
#include <linux/pci-acpi.h>
35
#include <linux/pci-aspm.h>
L
Linus Torvalds 已提交
36
#include <linux/acpi.h>
37
#include <linux/slab.h>
L
Linus Torvalds 已提交
38 39
#include <acpi/acpi_bus.h>
#include <acpi/acpi_drivers.h>
40
#include <acpi/apei.h>
L
Linus Torvalds 已提交
41

42 43
#include "internal.h"

44 45
#define PREFIX "ACPI: "

L
Linus Torvalds 已提交
46
#define _COMPONENT		ACPI_PCI_COMPONENT
47
ACPI_MODULE_NAME("pci_root");
L
Linus Torvalds 已提交
48 49
#define ACPI_PCI_ROOT_CLASS		"pci_bridge"
#define ACPI_PCI_ROOT_DEVICE_NAME	"PCI Root Bridge"
50 51 52
static int acpi_pci_root_add(struct acpi_device *device,
			     const struct acpi_device_id *not_used);
static void acpi_pci_root_remove(struct acpi_device *device);
L
Linus Torvalds 已提交
53

54 55 56 57
#define ACPI_PCIE_REQ_SUPPORT (OSC_PCI_EXT_CONFIG_SUPPORT \
				| OSC_PCI_ASPM_SUPPORT \
				| OSC_PCI_CLOCK_PM_SUPPORT \
				| OSC_PCI_MSI_SUPPORT)
58

59
static const struct acpi_device_id root_device_ids[] = {
60 61 62 63
	{"PNP0A03", 0},
	{"", 0},
};

64
static struct acpi_scan_handler pci_root_handler = {
65
	.ids = root_device_ids,
66 67
	.attach = acpi_pci_root_add,
	.detach = acpi_pci_root_remove,
L
Linus Torvalds 已提交
68 69
};

70
static DEFINE_MUTEX(osc_lock);
L
Linus Torvalds 已提交
71

72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95
/**
 * acpi_is_root_bridge - determine whether an ACPI CA node is a PCI root bridge
 * @handle - the ACPI CA node in question.
 *
 * Note: we could make this API take a struct acpi_device * instead, but
 * for now, it's more convenient to operate on an acpi_handle.
 */
int acpi_is_root_bridge(acpi_handle handle)
{
	int ret;
	struct acpi_device *device;

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

	ret = acpi_match_device_ids(device, root_device_ids);
	if (ret)
		return 0;
	else
		return 1;
}
EXPORT_SYMBOL_GPL(acpi_is_root_bridge);

L
Linus Torvalds 已提交
96
static acpi_status
L
Len Brown 已提交
97
get_root_bridge_busnr_callback(struct acpi_resource *resource, void *data)
L
Linus Torvalds 已提交
98
{
99
	struct resource *res = data;
L
Linus Torvalds 已提交
100
	struct acpi_resource_address64 address;
101
	acpi_status status;
L
Linus Torvalds 已提交
102

103 104
	status = acpi_resource_to_address64(resource, &address);
	if (ACPI_FAILURE(status))
L
Linus Torvalds 已提交
105 106
		return AE_OK;

L
Len Brown 已提交
107
	if ((address.address_length > 0) &&
108 109 110 111
	    (address.resource_type == ACPI_BUS_NUMBER_RANGE)) {
		res->start = address.minimum;
		res->end = address.minimum + address.address_length - 1;
	}
L
Linus Torvalds 已提交
112 113 114 115

	return AE_OK;
}

116
static acpi_status try_get_root_bridge_busnr(acpi_handle handle,
117
					     struct resource *res)
L
Linus Torvalds 已提交
118 119 120
{
	acpi_status status;

121
	res->start = -1;
L
Len Brown 已提交
122 123
	status =
	    acpi_walk_resources(handle, METHOD_NAME__CRS,
124
				get_root_bridge_busnr_callback, res);
L
Linus Torvalds 已提交
125 126
	if (ACPI_FAILURE(status))
		return status;
127
	if (res->start == -1)
L
Linus Torvalds 已提交
128 129 130 131
		return AE_ERROR;
	return AE_OK;
}

132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180
struct pci_osc_bit_struct {
	u32 bit;
	char *desc;
};

static struct pci_osc_bit_struct pci_osc_support_bit[] = {
	{ OSC_PCI_EXT_CONFIG_SUPPORT, "ExtendedConfig" },
	{ OSC_PCI_ASPM_SUPPORT, "ASPM" },
	{ OSC_PCI_CLOCK_PM_SUPPORT, "ClockPM" },
	{ OSC_PCI_SEGMENT_GROUPS_SUPPORT, "Segments" },
	{ OSC_PCI_MSI_SUPPORT, "MSI" },
};

static struct pci_osc_bit_struct pci_osc_control_bit[] = {
	{ OSC_PCI_EXPRESS_NATIVE_HP_CONTROL, "PCIeHotplug" },
	{ OSC_PCI_SHPC_NATIVE_HP_CONTROL, "SHPCHotplug" },
	{ OSC_PCI_EXPRESS_PME_CONTROL, "PME" },
	{ OSC_PCI_EXPRESS_AER_CONTROL, "AER" },
	{ OSC_PCI_EXPRESS_CAPABILITY_CONTROL, "PCIeCapability" },
};

static void decode_osc_bits(struct acpi_pci_root *root, char *msg, u32 word,
			    struct pci_osc_bit_struct *table, int size)
{
	char buf[80];
	int i, len = 0;
	struct pci_osc_bit_struct *entry;

	buf[0] = '\0';
	for (i = 0, entry = table; i < size; i++, entry++)
		if (word & entry->bit)
			len += snprintf(buf + len, sizeof(buf) - len, "%s%s",
					len ? " " : "", entry->desc);

	dev_info(&root->device->dev, "_OSC: %s [%s]\n", msg, buf);
}

static void decode_osc_support(struct acpi_pci_root *root, char *msg, u32 word)
{
	decode_osc_bits(root, msg, word, pci_osc_support_bit,
			ARRAY_SIZE(pci_osc_support_bit));
}

static void decode_osc_control(struct acpi_pci_root *root, char *msg, u32 word)
{
	decode_osc_bits(root, msg, word, pci_osc_control_bit,
			ARRAY_SIZE(pci_osc_control_bit));
}

S
Shaohua Li 已提交
181
static u8 pci_osc_uuid_str[] = "33DB4D5B-1FF7-401C-9657-7441C03DD766";
182 183 184 185

static acpi_status acpi_pci_run_osc(acpi_handle handle,
				    const u32 *capbuf, u32 *retval)
{
S
Shaohua Li 已提交
186 187 188 189 190 191
	struct acpi_osc_context context = {
		.uuid_str = pci_osc_uuid_str,
		.rev = 1,
		.cap.length = 12,
		.cap.pointer = (void *)capbuf,
	};
192 193
	acpi_status status;

S
Shaohua Li 已提交
194 195 196 197
	status = acpi_run_osc(handle, &context);
	if (ACPI_SUCCESS(status)) {
		*retval = *((u32 *)(context.ret.pointer + 8));
		kfree(context.ret.pointer);
198 199 200 201
	}
	return status;
}

202 203 204
static acpi_status acpi_pci_query_osc(struct acpi_pci_root *root,
					u32 support,
					u32 *control)
205 206
{
	acpi_status status;
207 208 209 210
	u32 result, capbuf[3];

	support &= OSC_PCI_SUPPORT_MASKS;
	support |= root->osc_support_set;
211

212 213
	capbuf[OSC_QUERY_DWORD] = OSC_QUERY_ENABLE;
	capbuf[OSC_SUPPORT_DWORD] = support;
214 215
	if (control) {
		*control &= OSC_PCI_CONTROL_MASKS;
216
		capbuf[OSC_CONTROL_DWORD] = *control | root->osc_control_set;
217
	} else {
218
		/* Run _OSC query only with existing controls. */
219
		capbuf[OSC_CONTROL_DWORD] = root->osc_control_set;
220
	}
221 222 223

	status = acpi_pci_run_osc(root->device->handle, capbuf, &result);
	if (ACPI_SUCCESS(status)) {
224
		root->osc_support_set = support;
225
		if (control)
226
			*control = result;
227 228 229 230 231 232 233 234 235
	}
	return status;
}

static acpi_status acpi_pci_osc_support(struct acpi_pci_root *root, u32 flags)
{
	acpi_status status;

	mutex_lock(&osc_lock);
236
	status = acpi_pci_query_osc(root, flags, NULL);
237 238 239 240
	mutex_unlock(&osc_lock);
	return status;
}

241
struct acpi_pci_root *acpi_pci_find_root(acpi_handle handle)
242 243
{
	struct acpi_pci_root *root;
244
	struct acpi_device *device;
245

246 247 248 249 250 251 252
	if (acpi_bus_get_device(handle, &device) ||
	    acpi_match_device_ids(device, root_device_ids))
		return NULL;

	root = acpi_driver_data(device);

	return root;
253
}
254
EXPORT_SYMBOL_GPL(acpi_pci_find_root);
255

256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 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 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322
struct acpi_handle_node {
	struct list_head node;
	acpi_handle handle;
};

/**
 * acpi_get_pci_dev - convert ACPI CA handle to struct pci_dev
 * @handle: the handle in question
 *
 * Given an ACPI CA handle, the desired PCI device is located in the
 * list of PCI devices.
 *
 * If the device is found, its reference count is increased and this
 * function returns a pointer to its data structure.  The caller must
 * decrement the reference count by calling pci_dev_put().
 * If no device is found, %NULL is returned.
 */
struct pci_dev *acpi_get_pci_dev(acpi_handle handle)
{
	int dev, fn;
	unsigned long long adr;
	acpi_status status;
	acpi_handle phandle;
	struct pci_bus *pbus;
	struct pci_dev *pdev = NULL;
	struct acpi_handle_node *node, *tmp;
	struct acpi_pci_root *root;
	LIST_HEAD(device_list);

	/*
	 * Walk up the ACPI CA namespace until we reach a PCI root bridge.
	 */
	phandle = handle;
	while (!acpi_is_root_bridge(phandle)) {
		node = kzalloc(sizeof(struct acpi_handle_node), GFP_KERNEL);
		if (!node)
			goto out;

		INIT_LIST_HEAD(&node->node);
		node->handle = phandle;
		list_add(&node->node, &device_list);

		status = acpi_get_parent(phandle, &phandle);
		if (ACPI_FAILURE(status))
			goto out;
	}

	root = acpi_pci_find_root(phandle);
	if (!root)
		goto out;

	pbus = root->bus;

	/*
	 * Now, walk back down the PCI device tree until we return to our
	 * original handle. Assumes that everything between the PCI root
	 * bridge and the device we're looking for must be a P2P bridge.
	 */
	list_for_each_entry(node, &device_list, node) {
		acpi_handle hnd = node->handle;
		status = acpi_evaluate_integer(hnd, "_ADR", NULL, &adr);
		if (ACPI_FAILURE(status))
			goto out;
		dev = (adr >> 16) & 0xffff;
		fn  = adr & 0xffff;

		pdev = pci_get_slot(pbus, PCI_DEVFN(dev, fn));
323
		if (!pdev || hnd == handle)
324 325 326 327
			break;

		pbus = pdev->subordinate;
		pci_dev_put(pdev);
328 329 330 331 332 333 334 335 336 337 338

		/*
		 * This function may be called for a non-PCI device that has a
		 * PCI parent (eg. a disk under a PCI SATA controller).  In that
		 * case pdev->subordinate will be NULL for the parent.
		 */
		if (!pbus) {
			dev_dbg(&pdev->dev, "Not a PCI-to-PCI bridge\n");
			pdev = NULL;
			break;
		}
339 340 341 342 343 344 345 346 347
	}
out:
	list_for_each_entry_safe(node, tmp, &device_list, node)
		kfree(node);

	return pdev;
}
EXPORT_SYMBOL_GPL(acpi_get_pci_dev);

348
/**
349 350 351 352
 * acpi_pci_osc_control_set - Request control of PCI root _OSC features.
 * @handle: ACPI handle of a PCI root bridge (or PCIe Root Complex).
 * @mask: Mask of _OSC bits to request control of, place to store control mask.
 * @req: Mask of _OSC bits the control of is essential to the caller.
353
 *
354 355 356 357 358 359 360 361
 * Run _OSC query for @mask and if that is successful, compare the returned
 * mask of control bits with @req.  If all of the @req bits are set in the
 * returned mask, run _OSC request for it.
 *
 * The variable at the @mask address may be modified regardless of whether or
 * not the function returns success.  On success it will contain the mask of
 * _OSC bits the BIOS has granted control of, but its contents are meaningless
 * on failure.
362
 **/
363
acpi_status acpi_pci_osc_control_set(acpi_handle handle, u32 *mask, u32 req)
364
{
365
	struct acpi_pci_root *root;
366
	acpi_status status = AE_OK;
367
	u32 ctrl, capbuf[3];
368

369 370 371 372 373
	if (!mask)
		return AE_BAD_PARAMETER;

	ctrl = *mask & OSC_PCI_CONTROL_MASKS;
	if ((ctrl & req) != req)
374 375 376 377 378 379 380
		return AE_TYPE;

	root = acpi_pci_find_root(handle);
	if (!root)
		return AE_NOT_EXIST;

	mutex_lock(&osc_lock);
381 382

	*mask = ctrl | root->osc_control_set;
383
	/* No need to evaluate _OSC if the control was already granted. */
384
	if ((root->osc_control_set & ctrl) == ctrl)
385 386
		goto out;

387 388 389 390 391 392 393
	/* Need to check the available controls bits before requesting them. */
	while (*mask) {
		status = acpi_pci_query_osc(root, root->osc_support_set, mask);
		if (ACPI_FAILURE(status))
			goto out;
		if (ctrl == *mask)
			break;
394 395
		decode_osc_control(root, "platform does not support",
				   ctrl & ~(*mask));
396 397
		ctrl = *mask;
	}
398

399
	if ((ctrl & req) != req) {
400 401
		decode_osc_control(root, "not requesting control; platform does not support",
				   req & ~(ctrl));
402 403 404 405
		status = AE_SUPPORT;
		goto out;
	}

406 407 408
	capbuf[OSC_QUERY_DWORD] = 0;
	capbuf[OSC_SUPPORT_DWORD] = root->osc_support_set;
	capbuf[OSC_CONTROL_DWORD] = ctrl;
409
	status = acpi_pci_run_osc(handle, capbuf, mask);
410
	if (ACPI_SUCCESS(status))
411
		root->osc_control_set = *mask;
412 413 414 415
out:
	mutex_unlock(&osc_lock);
	return status;
}
416
EXPORT_SYMBOL(acpi_pci_osc_control_set);
417

418 419
static void negotiate_os_control(struct acpi_pci_root *root, int *no_aspm,
				 int *clear_aspm)
L
Linus Torvalds 已提交
420
{
421
	u32 support, control, requested;
422 423
	acpi_status status;
	struct acpi_device *device = root->device;
424
	acpi_handle handle = device->handle;
L
Linus Torvalds 已提交
425

426
	/*
427 428
	 * All supported architectures that use ACPI have support for
	 * PCI domains, so we indicate this in _OSC support capabilities.
429
	 */
430
	support = OSC_PCI_SEGMENT_GROUPS_SUPPORT;
431
	if (pci_ext_cfg_avail())
432
		support |= OSC_PCI_EXT_CONFIG_SUPPORT;
433
	if (pcie_aspm_support_enabled())
434
		support |= OSC_PCI_ASPM_SUPPORT | OSC_PCI_CLOCK_PM_SUPPORT;
435
	if (pci_msi_enabled())
436
		support |= OSC_PCI_MSI_SUPPORT;
437 438

	decode_osc_support(root, "OS supports", support);
439 440
	status = acpi_pci_osc_support(root, support);
	if (ACPI_FAILURE(status)) {
441 442
		dev_info(&device->dev, "_OSC failed (%s); disabling ASPM\n",
			 acpi_format_exception(status));
443
		*no_aspm = 1;
444
		return;
445
	}
446

447 448 449 450 451
	if (pcie_ports_disabled) {
		dev_info(&device->dev, "PCIe port services disabled; not requesting _OSC control\n");
		return;
	}

452
	if ((support & ACPI_PCIE_REQ_SUPPORT) != ACPI_PCIE_REQ_SUPPORT) {
453 454
		decode_osc_support(root, "not requesting OS control; OS requires",
				   ACPI_PCIE_REQ_SUPPORT);
455 456 457 458 459 460 461 462 463
		return;
	}

	control = OSC_PCI_EXPRESS_CAPABILITY_CONTROL
		| OSC_PCI_EXPRESS_NATIVE_HP_CONTROL
		| OSC_PCI_EXPRESS_PME_CONTROL;

	if (pci_aer_available()) {
		if (aer_acpi_firmware_first())
464 465
			dev_info(&device->dev,
				 "PCIe AER handled by firmware\n");
466 467 468
		else
			control |= OSC_PCI_EXPRESS_AER_CONTROL;
	}
469

470
	requested = control;
471 472 473
	status = acpi_pci_osc_control_set(handle, &control,
					  OSC_PCI_EXPRESS_CAPABILITY_CONTROL);
	if (ACPI_SUCCESS(status)) {
474
		decode_osc_control(root, "OS now controls", control);
475
		if (acpi_gbl_FADT.boot_flags & ACPI_FADT_NO_ASPM) {
476
			/*
477 478
			 * We have ASPM control, but the FADT indicates
			 * that it's unsupported. Clear it.
479
			 */
480
			*clear_aspm = 1;
481
		}
482
	} else {
483 484 485 486 487
		decode_osc_control(root, "OS requested", requested);
		decode_osc_control(root, "platform willing to grant", control);
		dev_info(&device->dev, "_OSC failed (%s); disabling ASPM\n",
			acpi_format_exception(status));

488 489 490 491 492 493 494 495
		/*
		 * We want to disable ASPM here, but aspm_disabled
		 * needs to remain in its state from boot so that we
		 * properly handle PCIe 1.1 devices.  So we set this
		 * flag here, to defer the action until after the ACPI
		 * root scan.
		 */
		*no_aspm = 1;
496
	}
497 498
}

499 500
static int acpi_pci_root_add(struct acpi_device *device,
			     const struct acpi_device_id *not_used)
L
Linus Torvalds 已提交
501
{
502 503 504 505
	unsigned long long segment, bus;
	acpi_status status;
	int result;
	struct acpi_pci_root *root;
506
	acpi_handle handle = device->handle;
507
	int no_aspm = 0, clear_aspm = 0;
L
Linus Torvalds 已提交
508

509 510 511 512
	root = kzalloc(sizeof(struct acpi_pci_root), GFP_KERNEL);
	if (!root)
		return -ENOMEM;

513
	segment = 0;
514
	status = acpi_evaluate_integer(handle, METHOD_NAME__SEG, NULL,
515 516
				       &segment);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
517
		dev_err(&device->dev,  "can't evaluate _SEG\n");
518 519
		result = -ENODEV;
		goto end;
520
	}
L
Linus Torvalds 已提交
521

522
	/* Check _CRS first, then _BBN.  If no _BBN, default to zero. */
523
	root->secondary.flags = IORESOURCE_BUS;
524
	status = try_get_root_bridge_busnr(handle, &root->secondary);
525
	if (ACPI_FAILURE(status)) {
526 527 528 529 530 531 532
		/*
		 * We need both the start and end of the downstream bus range
		 * to interpret _CBA (MMCONFIG base address), so it really is
		 * supposed to be in _CRS.  If we don't find it there, all we
		 * can do is assume [_BBN-0xFF] or [0-0xFF].
		 */
		root->secondary.end = 0xFF;
533 534
		dev_warn(&device->dev,
			 FW_BUG "no secondary bus range in _CRS\n");
535
		status = acpi_evaluate_integer(handle, METHOD_NAME__BBN,
J
Jon Mason 已提交
536
					       NULL, &bus);
537 538 539 540 541
		if (ACPI_SUCCESS(status))
			root->secondary.start = bus;
		else if (status == AE_NOT_FOUND)
			root->secondary.start = 0;
		else {
542
			dev_err(&device->dev, "can't evaluate _BBN\n");
543 544
			result = -ENODEV;
			goto end;
545 546
		}
	}
L
Linus Torvalds 已提交
547

548
	root->device = device;
549
	root->segment = segment & 0xFFFF;
L
Linus Torvalds 已提交
550 551
	strcpy(acpi_device_name(device), ACPI_PCI_ROOT_DEVICE_NAME);
	strcpy(acpi_device_class(device), ACPI_PCI_ROOT_CLASS);
552
	device->driver_data = root;
L
Linus Torvalds 已提交
553

554
	pr_info(PREFIX "%s [%s] (domain %04x %pR)\n",
L
Len Brown 已提交
555
	       acpi_device_name(device), acpi_device_bid(device),
556
	       root->segment, &root->secondary);
L
Linus Torvalds 已提交
557

558
	root->mcfg_addr = acpi_pci_root_get_mcfg_addr(handle);
L
Linus Torvalds 已提交
559

560
	negotiate_os_control(root, &no_aspm, &clear_aspm);
561

562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577
	/*
	 * TBD: Need PCI interface for enumeration/configuration of roots.
	 */

	/*
	 * Scan the Root Bridge
	 * --------------------
	 * Must do this prior to any attempt to bind the root device, as the
	 * PCI namespace does not get created until this call is made (and
	 * thus the root bridge's pci_dev does not exist).
	 */
	root->bus = pci_acpi_scan_root(root);
	if (!root->bus) {
		dev_err(&device->dev,
			"Bus %04x:%02x not present in PCI namespace\n",
			root->segment, (unsigned int)root->secondary.start);
578
		device->driver_data = NULL;
579 580 581 582 583 584 585 586 587 588 589
		result = -ENODEV;
		goto end;
	}

	if (clear_aspm) {
		dev_info(&device->dev, "Disabling ASPM (FADT indicates it is unsupported)\n");
		pcie_clear_aspm(root->bus);
	}
	if (no_aspm)
		pcie_no_aspm();

590 591 592 593
	pci_acpi_add_bus_pm_notifier(device, root->bus);
	if (device->wakeup.flags.run_wake)
		device_set_run_wake(root->bus->bridge, true);

594 595
	if (system_state != SYSTEM_BOOTING) {
		pcibios_resource_survey_bus(root->bus);
596
		pci_assign_unassigned_root_bus_resources(root->bus);
597
	}
598

599
	pci_bus_add_devices(root->bus);
600
	return 1;
601 602 603 604

end:
	kfree(root);
	return result;
605
}
L
Linus Torvalds 已提交
606

607
static void acpi_pci_root_remove(struct acpi_device *device)
L
Linus Torvalds 已提交
608
{
609
	struct acpi_pci_root *root = acpi_driver_data(device);
610

611 612
	pci_stop_root_bus(root->bus);

613 614 615
	device_set_run_wake(root->bus->bridge, false);
	pci_acpi_remove_bus_pm_notifier(device);

616 617
	pci_remove_root_bus(root->bus);

L
Linus Torvalds 已提交
618 619 620
	kfree(root);
}

621
void __init acpi_pci_root_init(void)
L
Linus Torvalds 已提交
622
{
623 624
	acpi_hest_init();

625 626 627 628
	if (!acpi_pci_disabled) {
		pci_acpi_crs_quirks();
		acpi_scan_add_handler(&pci_root_handler);
	}
L
Linus Torvalds 已提交
629
}
630 631 632 633 634 635 636
/* Support root bridge hotplug */

static void handle_root_bridge_insertion(acpi_handle handle)
{
	struct acpi_device *device;

	if (!acpi_bus_get_device(handle, &device)) {
637 638
		dev_printk(KERN_DEBUG, &device->dev,
			   "acpi device already exists; ignoring notify\n");
639 640 641 642
		return;
	}

	if (acpi_bus_scan(handle))
643
		acpi_handle_err(handle, "cannot add bridge to acpi list\n");
644 645
}

646
static void hotplug_event_root(void *data, u32 type)
647
{
648
	acpi_handle handle = data;
649 650
	struct acpi_pci_root *root;

651
	acpi_scan_lock_acquire();
652

653
	root = acpi_pci_find_root(handle);
654 655 656 657

	switch (type) {
	case ACPI_NOTIFY_BUS_CHECK:
		/* bus enumerate */
658 659
		acpi_handle_printk(KERN_DEBUG, handle,
				   "Bus check notify on %s\n", __func__);
660 661 662
		if (root)
			acpiphp_check_host_bridge(handle);
		else
663 664 665 666 667 668
			handle_root_bridge_insertion(handle);

		break;

	case ACPI_NOTIFY_DEVICE_CHECK:
		/* device check */
669 670
		acpi_handle_printk(KERN_DEBUG, handle,
				   "Device check notify on %s\n", __func__);
671 672 673 674 675 676
		if (!root)
			handle_root_bridge_insertion(handle);
		break;

	case ACPI_NOTIFY_EJECT_REQUEST:
		/* request device eject */
677 678
		acpi_handle_printk(KERN_DEBUG, handle,
				   "Device eject notify on %s\n", __func__);
679 680 681 682 683 684 685 686 687
		if (!root)
			break;

		get_device(&root->device->dev);

		acpi_scan_lock_release();

		acpi_bus_device_eject(root->device, ACPI_NOTIFY_EJECT_REQUEST);
		return;
688
	default:
689 690 691
		acpi_handle_warn(handle,
				 "notify_handler: unknown event type 0x%x\n",
				 type);
692 693 694
		break;
	}

695
	acpi_scan_lock_release();
696 697 698 699 700
}

static void handle_hotplug_event_root(acpi_handle handle, u32 type,
					void *context)
{
701
	acpi_hotplug_execute(hotplug_event_root, handle, type);
702 703 704 705 706
}

static acpi_status __init
find_root_bridges(acpi_handle handle, u32 lvl, void *context, void **rv)
{
707
	acpi_status status;
708 709 710 711 712 713 714
	int *count = (int *)context;

	if (!acpi_is_root_bridge(handle))
		return AE_OK;

	(*count)++;

715 716 717
	status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
					handle_hotplug_event_root, NULL);
	if (ACPI_FAILURE(status))
718 719 720
		acpi_handle_printk(KERN_DEBUG, handle,
			"notify handler is not installed, exit status: %u\n",
			 (unsigned int)status);
721
	else
722 723
		acpi_handle_printk(KERN_DEBUG, handle,
				   "notify handler is installed\n");
724 725 726 727 728 729 730 731 732 733 734 735 736

	return AE_OK;
}

void __init acpi_pci_root_hp_init(void)
{
	int num = 0;

	acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT,
		ACPI_UINT32_MAX, find_root_bridges, NULL, &num, NULL);

	printk(KERN_DEBUG "Found %d acpi root devices\n", num);
}