pci_root.c 19.4 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,
68 69 70
	.hotplug = {
		.ignore = true,
	},
L
Linus Torvalds 已提交
71 72
};

73
static DEFINE_MUTEX(osc_lock);
L
Linus Torvalds 已提交
74

75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98
/**
 * 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 已提交
99
static acpi_status
L
Len Brown 已提交
100
get_root_bridge_busnr_callback(struct acpi_resource *resource, void *data)
L
Linus Torvalds 已提交
101
{
102
	struct resource *res = data;
L
Linus Torvalds 已提交
103
	struct acpi_resource_address64 address;
104
	acpi_status status;
L
Linus Torvalds 已提交
105

106 107
	status = acpi_resource_to_address64(resource, &address);
	if (ACPI_FAILURE(status))
L
Linus Torvalds 已提交
108 109
		return AE_OK;

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

	return AE_OK;
}

119
static acpi_status try_get_root_bridge_busnr(acpi_handle handle,
120
					     struct resource *res)
L
Linus Torvalds 已提交
121 122 123
{
	acpi_status status;

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

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 181 182 183
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 已提交
184
static u8 pci_osc_uuid_str[] = "33DB4D5B-1FF7-401C-9657-7441C03DD766";
185 186 187 188

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

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

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

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

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

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

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

	mutex_lock(&osc_lock);
239
	status = acpi_pci_query_osc(root, flags, NULL);
240 241 242 243
	mutex_unlock(&osc_lock);
	return status;
}

244
struct acpi_pci_root *acpi_pci_find_root(acpi_handle handle)
245 246
{
	struct acpi_pci_root *root;
247
	struct acpi_device *device;
248

249 250 251 252 253 254 255
	if (acpi_bus_get_device(handle, &device) ||
	    acpi_match_device_ids(device, root_device_ids))
		return NULL;

	root = acpi_driver_data(device);

	return root;
256
}
257
EXPORT_SYMBOL_GPL(acpi_pci_find_root);
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 323 324 325
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));
326
		if (!pdev || hnd == handle)
327 328 329 330
			break;

		pbus = pdev->subordinate;
		pci_dev_put(pdev);
331 332 333 334 335 336 337 338 339 340 341

		/*
		 * 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;
		}
342 343 344 345 346 347 348 349 350
	}
out:
	list_for_each_entry_safe(node, tmp, &device_list, node)
		kfree(node);

	return pdev;
}
EXPORT_SYMBOL_GPL(acpi_get_pci_dev);

351
/**
352 353 354 355
 * 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.
356
 *
357 358 359 360 361 362 363 364
 * 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.
365
 **/
366
acpi_status acpi_pci_osc_control_set(acpi_handle handle, u32 *mask, u32 req)
367
{
368
	struct acpi_pci_root *root;
369
	acpi_status status = AE_OK;
370
	u32 ctrl, capbuf[3];
371

372 373 374 375 376
	if (!mask)
		return AE_BAD_PARAMETER;

	ctrl = *mask & OSC_PCI_CONTROL_MASKS;
	if ((ctrl & req) != req)
377 378 379 380 381 382 383
		return AE_TYPE;

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

	mutex_lock(&osc_lock);
384 385

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

390 391 392 393 394 395 396
	/* 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;
397 398
		decode_osc_control(root, "platform does not support",
				   ctrl & ~(*mask));
399 400
		ctrl = *mask;
	}
401

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

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

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

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

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

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

455
	if ((support & ACPI_PCIE_REQ_SUPPORT) != ACPI_PCIE_REQ_SUPPORT) {
456 457
		decode_osc_support(root, "not requesting OS control; OS requires",
				   ACPI_PCIE_REQ_SUPPORT);
458 459 460 461 462 463 464 465 466
		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())
467 468
			dev_info(&device->dev,
				 "PCIe AER handled by firmware\n");
469 470 471
		else
			control |= OSC_PCI_EXPRESS_AER_CONTROL;
	}
472

473
	requested = control;
474 475 476
	status = acpi_pci_osc_control_set(handle, &control,
					  OSC_PCI_EXPRESS_CAPABILITY_CONTROL);
	if (ACPI_SUCCESS(status)) {
477
		decode_osc_control(root, "OS now controls", control);
478
		if (acpi_gbl_FADT.boot_flags & ACPI_FADT_NO_ASPM) {
479
			/*
480 481
			 * We have ASPM control, but the FADT indicates
			 * that it's unsupported. Clear it.
482
			 */
483
			*clear_aspm = 1;
484
		}
485
	} else {
486 487 488 489 490
		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));

491 492 493 494 495 496 497 498
		/*
		 * 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;
499
	}
500 501
}

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

512 513 514 515
	root = kzalloc(sizeof(struct acpi_pci_root), GFP_KERNEL);
	if (!root)
		return -ENOMEM;

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

525
	/* Check _CRS first, then _BBN.  If no _BBN, default to zero. */
526
	root->secondary.flags = IORESOURCE_BUS;
527
	status = try_get_root_bridge_busnr(handle, &root->secondary);
528
	if (ACPI_FAILURE(status)) {
529 530 531 532 533 534 535
		/*
		 * 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;
536 537
		dev_warn(&device->dev,
			 FW_BUG "no secondary bus range in _CRS\n");
538
		status = acpi_evaluate_integer(handle, METHOD_NAME__BBN,
J
Jon Mason 已提交
539
					       NULL, &bus);
540 541 542 543 544
		if (ACPI_SUCCESS(status))
			root->secondary.start = bus;
		else if (status == AE_NOT_FOUND)
			root->secondary.start = 0;
		else {
545
			dev_err(&device->dev, "can't evaluate _BBN\n");
546 547
			result = -ENODEV;
			goto end;
548 549
		}
	}
L
Linus Torvalds 已提交
550

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

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

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

563
	negotiate_os_control(root, &no_aspm, &clear_aspm);
564

565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580
	/*
	 * 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);
581
		device->driver_data = NULL;
582 583 584 585 586 587 588 589 590 591 592
		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();

593 594 595 596
	pci_acpi_add_bus_pm_notifier(device, root->bus);
	if (device->wakeup.flags.run_wake)
		device_set_run_wake(root->bus->bridge, true);

597 598
	if (system_state != SYSTEM_BOOTING) {
		pcibios_resource_survey_bus(root->bus);
599
		pci_assign_unassigned_root_bus_resources(root->bus);
600
	}
601

602
	pci_bus_add_devices(root->bus);
603
	return 1;
604 605 606 607

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

610
static void acpi_pci_root_remove(struct acpi_device *device)
L
Linus Torvalds 已提交
611
{
612
	struct acpi_pci_root *root = acpi_driver_data(device);
613

614 615
	pci_stop_root_bus(root->bus);

616 617 618
	device_set_run_wake(root->bus->bridge, false);
	pci_acpi_remove_bus_pm_notifier(device);

619 620
	pci_remove_root_bus(root->bus);

L
Linus Torvalds 已提交
621 622 623
	kfree(root);
}

624
void __init acpi_pci_root_init(void)
L
Linus Torvalds 已提交
625
{
626 627
	acpi_hest_init();

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

static void handle_root_bridge_insertion(acpi_handle handle)
{
637
	struct acpi_device *device = NULL;
638

639 640
	acpi_bus_get_device(handle, &device);
	if (acpi_device_enumerated(device)) {
641 642
		dev_printk(KERN_DEBUG, &device->dev,
			   "acpi device already exists; ignoring notify\n");
643 644 645 646
		return;
	}

	if (acpi_bus_scan(handle))
647
		acpi_handle_err(handle, "cannot add bridge to acpi list\n");
648 649
}

650
static void hotplug_event_root(void *data, u32 type)
651
{
652
	acpi_handle handle = data;
653 654
	struct acpi_pci_root *root;

655
	acpi_scan_lock_acquire();
656

657
	root = acpi_pci_find_root(handle);
658 659 660 661

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

		break;

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

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

686 687
		acpi_evaluate_hotplug_ost(handle, ACPI_NOTIFY_EJECT_REQUEST,
					  ACPI_OST_SC_EJECT_IN_PROGRESS, NULL);
688 689 690 691
		get_device(&root->device->dev);

		acpi_scan_lock_release();

692
		acpi_device_hotplug(root->device, ACPI_NOTIFY_EJECT_REQUEST);
693
		return;
694
	default:
695 696 697
		acpi_handle_warn(handle,
				 "notify_handler: unknown event type 0x%x\n",
				 type);
698 699 700
		break;
	}

701
	acpi_scan_lock_release();
702 703 704 705 706
}

static void handle_hotplug_event_root(acpi_handle handle, u32 type,
					void *context)
{
707
	acpi_hotplug_execute(hotplug_event_root, handle, type);
708 709 710 711 712
}

static acpi_status __init
find_root_bridges(acpi_handle handle, u32 lvl, void *context, void **rv)
{
713
	acpi_status status;
714 715 716 717 718 719 720
	int *count = (int *)context;

	if (!acpi_is_root_bridge(handle))
		return AE_OK;

	(*count)++;

721 722 723
	status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
					handle_hotplug_event_root, NULL);
	if (ACPI_FAILURE(status))
724 725 726
		acpi_handle_printk(KERN_DEBUG, handle,
			"notify handler is not installed, exit status: %u\n",
			 (unsigned int)status);
727
	else
728 729
		acpi_handle_printk(KERN_DEBUG, handle,
				   "notify handler is installed\n");
730 731 732 733 734 735 736 737 738 739 740 741 742

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