1 /*
2  * ACPI PCI HotPlug glue functions to ACPI CA subsystem
3  *
4  * Copyright (C) 2002,2003 Takayoshi Kochi (t-kochi@bq.jp.nec.com)
5  * Copyright (C) 2002 Hiroshi Aono (h-aono@ap.jp.nec.com)
6  * Copyright (C) 2002,2003 NEC Corporation
7  * Copyright (C) 2003-2005 Matthew Wilcox (matthew.wilcox@hp.com)
8  * Copyright (C) 2003-2005 Hewlett Packard
9  * Copyright (C) 2005 Rajesh Shah (rajesh.shah@intel.com)
10  * Copyright (C) 2005 Intel Corporation
11  *
12  * All rights reserved.
13  *
14  * This program is free software; you can redistribute it and/or modify
15  * it under the terms of the GNU General Public License as published by
16  * the Free Software Foundation; either version 2 of the License, or (at
17  * your option) any later version.
18  *
19  * This program is distributed in the hope that it will be useful, but
20  * WITHOUT ANY WARRANTY; without even the implied warranty of
21  * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
22  * NON INFRINGEMENT.  See the GNU General Public License for more
23  * details.
24  *
25  * You should have received a copy of the GNU General Public License
26  * along with this program; if not, write to the Free Software
27  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
28  *
29  * Send feedback to <kristen.c.accardi@intel.com>
30  *
31  */
32 
33 /*
34  * Lifetime rules for pci_dev:
35  *  - The one in acpiphp_bridge has its refcount elevated by pci_get_slot()
36  *    when the bridge is scanned and it loses a refcount when the bridge
37  *    is removed.
38  *  - When a P2P bridge is present, we elevate the refcount on the subordinate
39  *    bus. It loses the refcount when the the driver unloads.
40  */
41 
42 #include <linux/init.h>
43 #include <linux/module.h>
44 
45 #include <linux/kernel.h>
46 #include <linux/pci.h>
47 #include <linux/pci_hotplug.h>
48 #include <linux/pci-acpi.h>
49 #include <linux/mutex.h>
50 #include <linux/slab.h>
51 #include <linux/acpi.h>
52 
53 #include "../pci.h"
54 #include "acpiphp.h"
55 
56 static LIST_HEAD(bridge_list);
57 static DEFINE_MUTEX(bridge_mutex);
58 static DEFINE_MUTEX(acpiphp_context_lock);
59 
60 #define MY_NAME "acpiphp_glue"
61 
62 static void handle_hotplug_event(acpi_handle handle, u32 type, void *data);
63 static void acpiphp_sanitize_bus(struct pci_bus *bus);
64 static void acpiphp_set_hpp_values(struct pci_bus *bus);
65 static void hotplug_event(acpi_handle handle, u32 type, void *data);
66 static void free_bridge(struct kref *kref);
67 
68 static void acpiphp_context_handler(acpi_handle handle, void *context)
69 {
70 	/* Intentionally empty. */
71 }
72 
73 /**
74  * acpiphp_init_context - Create hotplug context and grab a reference to it.
75  * @handle: ACPI object handle to create the context for.
76  *
77  * Call under acpiphp_context_lock.
78  */
79 static struct acpiphp_context *acpiphp_init_context(acpi_handle handle)
80 {
81 	struct acpiphp_context *context;
82 	acpi_status status;
83 
84 	context = kzalloc(sizeof(*context), GFP_KERNEL);
85 	if (!context)
86 		return NULL;
87 
88 	context->handle = handle;
89 	context->refcount = 1;
90 	status = acpi_attach_data(handle, acpiphp_context_handler, context);
91 	if (ACPI_FAILURE(status)) {
92 		kfree(context);
93 		return NULL;
94 	}
95 	return context;
96 }
97 
98 /**
99  * acpiphp_get_context - Get hotplug context and grab a reference to it.
100  * @handle: ACPI object handle to get the context for.
101  *
102  * Call under acpiphp_context_lock.
103  */
104 static struct acpiphp_context *acpiphp_get_context(acpi_handle handle)
105 {
106 	struct acpiphp_context *context = NULL;
107 	acpi_status status;
108 	void *data;
109 
110 	status = acpi_get_data(handle, acpiphp_context_handler, &data);
111 	if (ACPI_SUCCESS(status)) {
112 		context = data;
113 		context->refcount++;
114 	}
115 	return context;
116 }
117 
118 /**
119  * acpiphp_put_context - Drop a reference to ACPI hotplug context.
120  * @handle: ACPI object handle to put the context for.
121  *
122  * The context object is removed if there are no more references to it.
123  *
124  * Call under acpiphp_context_lock.
125  */
126 static void acpiphp_put_context(struct acpiphp_context *context)
127 {
128 	if (--context->refcount)
129 		return;
130 
131 	WARN_ON(context->bridge);
132 	acpi_detach_data(context->handle, acpiphp_context_handler);
133 	kfree(context);
134 }
135 
136 static inline void get_bridge(struct acpiphp_bridge *bridge)
137 {
138 	kref_get(&bridge->ref);
139 }
140 
141 static inline void put_bridge(struct acpiphp_bridge *bridge)
142 {
143 	kref_put(&bridge->ref, free_bridge);
144 }
145 
146 static void free_bridge(struct kref *kref)
147 {
148 	struct acpiphp_context *context;
149 	struct acpiphp_bridge *bridge;
150 	struct acpiphp_slot *slot, *next;
151 	struct acpiphp_func *func, *tmp;
152 
153 	mutex_lock(&acpiphp_context_lock);
154 
155 	bridge = container_of(kref, struct acpiphp_bridge, ref);
156 
157 	list_for_each_entry_safe(slot, next, &bridge->slots, node) {
158 		list_for_each_entry_safe(func, tmp, &slot->funcs, sibling)
159 			acpiphp_put_context(func_to_context(func));
160 
161 		kfree(slot);
162 	}
163 
164 	context = bridge->context;
165 	/* Root bridges will not have hotplug context. */
166 	if (context) {
167 		/* Release the reference taken by acpiphp_enumerate_slots(). */
168 		put_bridge(context->func.parent);
169 		context->bridge = NULL;
170 		acpiphp_put_context(context);
171 	}
172 
173 	put_device(&bridge->pci_bus->dev);
174 	pci_dev_put(bridge->pci_dev);
175 	kfree(bridge);
176 
177 	mutex_unlock(&acpiphp_context_lock);
178 }
179 
180 /*
181  * the _DCK method can do funny things... and sometimes not
182  * hah-hah funny.
183  *
184  * TBD - figure out a way to only call fixups for
185  * systems that require them.
186  */
187 static void post_dock_fixups(acpi_handle not_used, u32 event, void *data)
188 {
189 	struct acpiphp_context *context = data;
190 	struct pci_bus *bus = context->func.slot->bus;
191 	u32 buses;
192 
193 	if (!bus->self)
194 		return;
195 
196 	/* fixup bad _DCK function that rewrites
197 	 * secondary bridge on slot
198 	 */
199 	pci_read_config_dword(bus->self,
200 			PCI_PRIMARY_BUS,
201 			&buses);
202 
203 	if (((buses >> 8) & 0xff) != bus->busn_res.start) {
204 		buses = (buses & 0xff000000)
205 			| ((unsigned int)(bus->primary)     <<  0)
206 			| ((unsigned int)(bus->busn_res.start)   <<  8)
207 			| ((unsigned int)(bus->busn_res.end) << 16);
208 		pci_write_config_dword(bus->self, PCI_PRIMARY_BUS, buses);
209 	}
210 }
211 
212 
213 static const struct acpi_dock_ops acpiphp_dock_ops = {
214 	.fixup = post_dock_fixups,
215 	.handler = hotplug_event,
216 };
217 
218 /* Check whether the PCI device is managed by native PCIe hotplug driver */
219 static bool device_is_managed_by_native_pciehp(struct pci_dev *pdev)
220 {
221 	u32 reg32;
222 	acpi_handle tmp;
223 	struct acpi_pci_root *root;
224 
225 	/* Check whether the PCIe port supports native PCIe hotplug */
226 	if (pcie_capability_read_dword(pdev, PCI_EXP_SLTCAP, &reg32))
227 		return false;
228 	if (!(reg32 & PCI_EXP_SLTCAP_HPC))
229 		return false;
230 
231 	/*
232 	 * Check whether native PCIe hotplug has been enabled for
233 	 * this PCIe hierarchy.
234 	 */
235 	tmp = acpi_find_root_bridge_handle(pdev);
236 	if (!tmp)
237 		return false;
238 	root = acpi_pci_find_root(tmp);
239 	if (!root)
240 		return false;
241 	if (!(root->osc_control_set & OSC_PCI_EXPRESS_NATIVE_HP_CONTROL))
242 		return false;
243 
244 	return true;
245 }
246 
247 static void acpiphp_dock_init(void *data)
248 {
249 	struct acpiphp_context *context = data;
250 
251 	get_bridge(context->func.parent);
252 }
253 
254 static void acpiphp_dock_release(void *data)
255 {
256 	struct acpiphp_context *context = data;
257 
258 	put_bridge(context->func.parent);
259 }
260 
261 /* callback routine to register each ACPI PCI slot object */
262 static acpi_status register_slot(acpi_handle handle, u32 lvl, void *data,
263 				 void **rv)
264 {
265 	struct acpiphp_bridge *bridge = data;
266 	struct acpiphp_context *context;
267 	struct acpiphp_slot *slot;
268 	struct acpiphp_func *newfunc;
269 	acpi_status status = AE_OK;
270 	unsigned long long adr;
271 	int device, function;
272 	struct pci_bus *pbus = bridge->pci_bus;
273 	struct pci_dev *pdev = bridge->pci_dev;
274 	u32 val;
275 
276 	if (pdev && device_is_managed_by_native_pciehp(pdev))
277 		return AE_OK;
278 
279 	status = acpi_evaluate_integer(handle, "_ADR", NULL, &adr);
280 	if (ACPI_FAILURE(status)) {
281 		acpi_handle_warn(handle, "can't evaluate _ADR (%#x)\n", status);
282 		return AE_OK;
283 	}
284 
285 	device = (adr >> 16) & 0xffff;
286 	function = adr & 0xffff;
287 
288 	mutex_lock(&acpiphp_context_lock);
289 	context = acpiphp_init_context(handle);
290 	if (!context) {
291 		mutex_unlock(&acpiphp_context_lock);
292 		acpi_handle_err(handle, "No hotplug context\n");
293 		return AE_NOT_EXIST;
294 	}
295 	newfunc = &context->func;
296 	newfunc->function = function;
297 	newfunc->parent = bridge;
298 	mutex_unlock(&acpiphp_context_lock);
299 
300 	if (acpi_has_method(handle, "_EJ0"))
301 		newfunc->flags = FUNC_HAS_EJ0;
302 
303 	if (acpi_has_method(handle, "_STA"))
304 		newfunc->flags |= FUNC_HAS_STA;
305 
306 	if (acpi_has_method(handle, "_PS0"))
307 		newfunc->flags |= FUNC_HAS_PS0;
308 
309 	if (acpi_has_method(handle, "_PS3"))
310 		newfunc->flags |= FUNC_HAS_PS3;
311 
312 	if (acpi_has_method(handle, "_DCK"))
313 		newfunc->flags |= FUNC_HAS_DCK;
314 
315 	/* search for objects that share the same slot */
316 	list_for_each_entry(slot, &bridge->slots, node)
317 		if (slot->device == device)
318 			goto slot_found;
319 
320 	slot = kzalloc(sizeof(struct acpiphp_slot), GFP_KERNEL);
321 	if (!slot) {
322 		status = AE_NO_MEMORY;
323 		goto err;
324 	}
325 
326 	slot->bus = bridge->pci_bus;
327 	slot->device = device;
328 	INIT_LIST_HEAD(&slot->funcs);
329 	mutex_init(&slot->crit_sect);
330 
331 	mutex_lock(&bridge_mutex);
332 	list_add_tail(&slot->node, &bridge->slots);
333 	mutex_unlock(&bridge_mutex);
334 
335 	/* Register slots for ejectable funtions only. */
336 	if (acpi_pci_check_ejectable(pbus, handle)  || is_dock_device(handle)) {
337 		unsigned long long sun;
338 		int retval;
339 
340 		bridge->nr_slots++;
341 		status = acpi_evaluate_integer(handle, "_SUN", NULL, &sun);
342 		if (ACPI_FAILURE(status))
343 			sun = bridge->nr_slots;
344 
345 		dbg("found ACPI PCI Hotplug slot %llu at PCI %04x:%02x:%02x\n",
346 		    sun, pci_domain_nr(pbus), pbus->number, device);
347 
348 		retval = acpiphp_register_hotplug_slot(slot, sun);
349 		if (retval) {
350 			bridge->nr_slots--;
351 			if (retval == -EBUSY)
352 				warn("Slot %llu already registered by another "
353 					"hotplug driver\n", sun);
354 			else
355 				warn("acpiphp_register_hotplug_slot failed "
356 					"(err code = 0x%x)\n", retval);
357 		}
358 		/* Even if the slot registration fails, we can still use it. */
359 	}
360 
361  slot_found:
362 	newfunc->slot = slot;
363 	mutex_lock(&bridge_mutex);
364 	list_add_tail(&newfunc->sibling, &slot->funcs);
365 	mutex_unlock(&bridge_mutex);
366 
367 	if (pci_bus_read_dev_vendor_id(pbus, PCI_DEVFN(device, function),
368 				       &val, 60*1000))
369 		slot->flags |= (SLOT_ENABLED | SLOT_POWEREDON);
370 
371 	if (is_dock_device(handle)) {
372 		/* we don't want to call this device's _EJ0
373 		 * because we want the dock notify handler
374 		 * to call it after it calls _DCK
375 		 */
376 		newfunc->flags &= ~FUNC_HAS_EJ0;
377 		if (register_hotplug_dock_device(handle,
378 			&acpiphp_dock_ops, context,
379 			acpiphp_dock_init, acpiphp_dock_release))
380 			dbg("failed to register dock device\n");
381 	}
382 
383 	/* install notify handler */
384 	if (!(newfunc->flags & FUNC_HAS_DCK)) {
385 		status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
386 						     handle_hotplug_event,
387 						     context);
388 		if (ACPI_FAILURE(status))
389 			acpi_handle_err(handle,
390 					"failed to install notify handler\n");
391 	}
392 
393 	return AE_OK;
394 
395  err:
396 	mutex_lock(&acpiphp_context_lock);
397 	acpiphp_put_context(context);
398 	mutex_unlock(&acpiphp_context_lock);
399 	return status;
400 }
401 
402 static struct acpiphp_bridge *acpiphp_handle_to_bridge(acpi_handle handle)
403 {
404 	struct acpiphp_context *context;
405 	struct acpiphp_bridge *bridge = NULL;
406 
407 	mutex_lock(&acpiphp_context_lock);
408 	context = acpiphp_get_context(handle);
409 	if (context) {
410 		bridge = context->bridge;
411 		if (bridge)
412 			get_bridge(bridge);
413 
414 		acpiphp_put_context(context);
415 	}
416 	mutex_unlock(&acpiphp_context_lock);
417 	return bridge;
418 }
419 
420 static void cleanup_bridge(struct acpiphp_bridge *bridge)
421 {
422 	struct acpiphp_slot *slot;
423 	struct acpiphp_func *func;
424 	acpi_status status;
425 
426 	list_for_each_entry(slot, &bridge->slots, node) {
427 		list_for_each_entry(func, &slot->funcs, sibling) {
428 			acpi_handle handle = func_to_handle(func);
429 
430 			if (is_dock_device(handle))
431 				unregister_hotplug_dock_device(handle);
432 
433 			if (!(func->flags & FUNC_HAS_DCK)) {
434 				status = acpi_remove_notify_handler(handle,
435 							ACPI_SYSTEM_NOTIFY,
436 							handle_hotplug_event);
437 				if (ACPI_FAILURE(status))
438 					err("failed to remove notify handler\n");
439 			}
440 		}
441 		acpiphp_unregister_hotplug_slot(slot);
442 	}
443 
444 	mutex_lock(&bridge_mutex);
445 	list_del(&bridge->list);
446 	mutex_unlock(&bridge_mutex);
447 }
448 
449 static int power_on_slot(struct acpiphp_slot *slot)
450 {
451 	acpi_status status;
452 	struct acpiphp_func *func;
453 	int retval = 0;
454 
455 	/* if already enabled, just skip */
456 	if (slot->flags & SLOT_POWEREDON)
457 		goto err_exit;
458 
459 	list_for_each_entry(func, &slot->funcs, sibling) {
460 		if (func->flags & FUNC_HAS_PS0) {
461 			dbg("%s: executing _PS0\n", __func__);
462 			status = acpi_evaluate_object(func_to_handle(func),
463 						      "_PS0", NULL, NULL);
464 			if (ACPI_FAILURE(status)) {
465 				warn("%s: _PS0 failed\n", __func__);
466 				retval = -1;
467 				goto err_exit;
468 			} else
469 				break;
470 		}
471 	}
472 
473 	/* TBD: evaluate _STA to check if the slot is enabled */
474 
475 	slot->flags |= SLOT_POWEREDON;
476 
477  err_exit:
478 	return retval;
479 }
480 
481 
482 static int power_off_slot(struct acpiphp_slot *slot)
483 {
484 	acpi_status status;
485 	struct acpiphp_func *func;
486 
487 	int retval = 0;
488 
489 	/* if already disabled, just skip */
490 	if ((slot->flags & SLOT_POWEREDON) == 0)
491 		goto err_exit;
492 
493 	list_for_each_entry(func, &slot->funcs, sibling) {
494 		if (func->flags & FUNC_HAS_PS3) {
495 			status = acpi_evaluate_object(func_to_handle(func),
496 						      "_PS3", NULL, NULL);
497 			if (ACPI_FAILURE(status)) {
498 				warn("%s: _PS3 failed\n", __func__);
499 				retval = -1;
500 				goto err_exit;
501 			} else
502 				break;
503 		}
504 	}
505 
506 	/* TBD: evaluate _STA to check if the slot is disabled */
507 
508 	slot->flags &= (~SLOT_POWEREDON);
509 
510  err_exit:
511 	return retval;
512 }
513 
514 
515 
516 /**
517  * acpiphp_max_busnr - return the highest reserved bus number under the given bus.
518  * @bus: bus to start search with
519  */
520 static unsigned char acpiphp_max_busnr(struct pci_bus *bus)
521 {
522 	struct list_head *tmp;
523 	unsigned char max, n;
524 
525 	/*
526 	 * pci_bus_max_busnr will return the highest
527 	 * reserved busnr for all these children.
528 	 * that is equivalent to the bus->subordinate
529 	 * value.  We don't want to use the parent's
530 	 * bus->subordinate value because it could have
531 	 * padding in it.
532 	 */
533 	max = bus->busn_res.start;
534 
535 	list_for_each(tmp, &bus->children) {
536 		n = pci_bus_max_busnr(pci_bus_b(tmp));
537 		if (n > max)
538 			max = n;
539 	}
540 	return max;
541 }
542 
543 /**
544  * acpiphp_bus_trim - Trim device objects in an ACPI namespace subtree.
545  * @handle: ACPI device object handle to start from.
546  */
547 static void acpiphp_bus_trim(acpi_handle handle)
548 {
549 	struct acpi_device *adev = NULL;
550 
551 	acpi_bus_get_device(handle, &adev);
552 	if (adev)
553 		acpi_bus_trim(adev);
554 }
555 
556 /**
557  * acpiphp_bus_add - Scan ACPI namespace subtree.
558  * @handle: ACPI object handle to start the scan from.
559  */
560 static void acpiphp_bus_add(acpi_handle handle)
561 {
562 	acpiphp_bus_trim(handle);
563 	acpi_bus_scan(handle);
564 }
565 
566 static void acpiphp_set_acpi_region(struct acpiphp_slot *slot)
567 {
568 	struct acpiphp_func *func;
569 	union acpi_object params[2];
570 	struct acpi_object_list arg_list;
571 
572 	list_for_each_entry(func, &slot->funcs, sibling) {
573 		arg_list.count = 2;
574 		arg_list.pointer = params;
575 		params[0].type = ACPI_TYPE_INTEGER;
576 		params[0].integer.value = ACPI_ADR_SPACE_PCI_CONFIG;
577 		params[1].type = ACPI_TYPE_INTEGER;
578 		params[1].integer.value = 1;
579 		/* _REG is optional, we don't care about if there is failure */
580 		acpi_evaluate_object(func_to_handle(func), "_REG", &arg_list,
581 				     NULL);
582 	}
583 }
584 
585 static void check_hotplug_bridge(struct acpiphp_slot *slot, struct pci_dev *dev)
586 {
587 	struct acpiphp_func *func;
588 
589 	/* quirk, or pcie could set it already */
590 	if (dev->is_hotplug_bridge)
591 		return;
592 
593 	list_for_each_entry(func, &slot->funcs, sibling) {
594 		if (PCI_FUNC(dev->devfn) == func->function) {
595 			dev->is_hotplug_bridge = 1;
596 			break;
597 		}
598 	}
599 }
600 
601 /**
602  * enable_device - enable, configure a slot
603  * @slot: slot to be enabled
604  *
605  * This function should be called per *physical slot*,
606  * not per each slot object in ACPI namespace.
607  */
608 static int __ref enable_device(struct acpiphp_slot *slot)
609 {
610 	struct pci_dev *dev;
611 	struct pci_bus *bus = slot->bus;
612 	struct acpiphp_func *func;
613 	int num, max, pass;
614 	LIST_HEAD(add_list);
615 
616 	if (slot->flags & SLOT_ENABLED)
617 		goto err_exit;
618 
619 	list_for_each_entry(func, &slot->funcs, sibling)
620 		acpiphp_bus_add(func_to_handle(func));
621 
622 	num = pci_scan_slot(bus, PCI_DEVFN(slot->device, 0));
623 	if (num == 0) {
624 		/* Maybe only part of funcs are added. */
625 		dbg("No new device found\n");
626 		goto err_exit;
627 	}
628 
629 	max = acpiphp_max_busnr(bus);
630 	for (pass = 0; pass < 2; pass++) {
631 		list_for_each_entry(dev, &bus->devices, bus_list) {
632 			if (PCI_SLOT(dev->devfn) != slot->device)
633 				continue;
634 			if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
635 			    dev->hdr_type == PCI_HEADER_TYPE_CARDBUS) {
636 				max = pci_scan_bridge(bus, dev, max, pass);
637 				if (pass && dev->subordinate) {
638 					check_hotplug_bridge(slot, dev);
639 					pcibios_resource_survey_bus(dev->subordinate);
640 					__pci_bus_size_bridges(dev->subordinate,
641 							       &add_list);
642 				}
643 			}
644 		}
645 	}
646 
647 	__pci_bus_assign_resources(bus, &add_list, NULL);
648 	acpiphp_sanitize_bus(bus);
649 	acpiphp_set_hpp_values(bus);
650 	acpiphp_set_acpi_region(slot);
651 	pci_enable_bridges(bus);
652 
653 	list_for_each_entry(dev, &bus->devices, bus_list) {
654 		/* Assume that newly added devices are powered on already. */
655 		if (!dev->is_added)
656 			dev->current_state = PCI_D0;
657 	}
658 
659 	pci_bus_add_devices(bus);
660 
661 	slot->flags |= SLOT_ENABLED;
662 	list_for_each_entry(func, &slot->funcs, sibling) {
663 		dev = pci_get_slot(bus, PCI_DEVFN(slot->device,
664 						  func->function));
665 		if (!dev) {
666 			/* Do not set SLOT_ENABLED flag if some funcs
667 			   are not added. */
668 			slot->flags &= (~SLOT_ENABLED);
669 			continue;
670 		}
671 	}
672 
673 
674  err_exit:
675 	return 0;
676 }
677 
678 /* return first device in slot, acquiring a reference on it */
679 static struct pci_dev *dev_in_slot(struct acpiphp_slot *slot)
680 {
681 	struct pci_bus *bus = slot->bus;
682 	struct pci_dev *dev;
683 	struct pci_dev *ret = NULL;
684 
685 	down_read(&pci_bus_sem);
686 	list_for_each_entry(dev, &bus->devices, bus_list)
687 		if (PCI_SLOT(dev->devfn) == slot->device) {
688 			ret = pci_dev_get(dev);
689 			break;
690 		}
691 	up_read(&pci_bus_sem);
692 
693 	return ret;
694 }
695 
696 /**
697  * disable_device - disable a slot
698  * @slot: ACPI PHP slot
699  */
700 static int disable_device(struct acpiphp_slot *slot)
701 {
702 	struct acpiphp_func *func;
703 	struct pci_dev *pdev;
704 
705 	/*
706 	 * enable_device() enumerates all functions in this device via
707 	 * pci_scan_slot(), whether they have associated ACPI hotplug
708 	 * methods (_EJ0, etc.) or not.  Therefore, we remove all functions
709 	 * here.
710 	 */
711 	while ((pdev = dev_in_slot(slot))) {
712 		pci_stop_and_remove_bus_device(pdev);
713 		pci_dev_put(pdev);
714 	}
715 
716 	list_for_each_entry(func, &slot->funcs, sibling)
717 		acpiphp_bus_trim(func_to_handle(func));
718 
719 	slot->flags &= (~SLOT_ENABLED);
720 
721 	return 0;
722 }
723 
724 
725 /**
726  * get_slot_status - get ACPI slot status
727  * @slot: ACPI PHP slot
728  *
729  * If a slot has _STA for each function and if any one of them
730  * returned non-zero status, return it.
731  *
732  * If a slot doesn't have _STA and if any one of its functions'
733  * configuration space is configured, return 0x0f as a _STA.
734  *
735  * Otherwise return 0.
736  */
737 static unsigned int get_slot_status(struct acpiphp_slot *slot)
738 {
739 	unsigned long long sta = 0;
740 	struct acpiphp_func *func;
741 
742 	list_for_each_entry(func, &slot->funcs, sibling) {
743 		if (func->flags & FUNC_HAS_STA) {
744 			acpi_status status;
745 
746 			status = acpi_evaluate_integer(func_to_handle(func),
747 						       "_STA", NULL, &sta);
748 			if (ACPI_SUCCESS(status) && sta)
749 				break;
750 		} else {
751 			u32 dvid;
752 
753 			pci_bus_read_config_dword(slot->bus,
754 						  PCI_DEVFN(slot->device,
755 							    func->function),
756 						  PCI_VENDOR_ID, &dvid);
757 			if (dvid != 0xffffffff) {
758 				sta = ACPI_STA_ALL;
759 				break;
760 			}
761 		}
762 	}
763 
764 	return (unsigned int)sta;
765 }
766 
767 /**
768  * acpiphp_check_bridge - re-enumerate devices
769  * @bridge: where to begin re-enumeration
770  *
771  * Iterate over all slots under this bridge and make sure that if a
772  * card is present they are enabled, and if not they are disabled.
773  */
774 static int acpiphp_check_bridge(struct acpiphp_bridge *bridge)
775 {
776 	struct acpiphp_slot *slot;
777 	int retval = 0;
778 	int enabled, disabled;
779 
780 	enabled = disabled = 0;
781 
782 	list_for_each_entry(slot, &bridge->slots, node) {
783 		unsigned int status = get_slot_status(slot);
784 		if (slot->flags & SLOT_ENABLED) {
785 			if (status == ACPI_STA_ALL)
786 				continue;
787 
788 			retval = acpiphp_disable_and_eject_slot(slot);
789 			if (retval)
790 				goto err_exit;
791 
792 			disabled++;
793 		} else {
794 			if (status != ACPI_STA_ALL)
795 				continue;
796 			retval = acpiphp_enable_slot(slot);
797 			if (retval) {
798 				err("Error occurred in enabling\n");
799 				goto err_exit;
800 			}
801 			enabled++;
802 		}
803 	}
804 
805 	dbg("%s: %d enabled, %d disabled\n", __func__, enabled, disabled);
806 
807  err_exit:
808 	return retval;
809 }
810 
811 static void acpiphp_set_hpp_values(struct pci_bus *bus)
812 {
813 	struct pci_dev *dev;
814 
815 	list_for_each_entry(dev, &bus->devices, bus_list)
816 		pci_configure_slot(dev);
817 }
818 
819 /*
820  * Remove devices for which we could not assign resources, call
821  * arch specific code to fix-up the bus
822  */
823 static void acpiphp_sanitize_bus(struct pci_bus *bus)
824 {
825 	struct pci_dev *dev, *tmp;
826 	int i;
827 	unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM;
828 
829 	list_for_each_entry_safe(dev, tmp, &bus->devices, bus_list) {
830 		for (i=0; i<PCI_BRIDGE_RESOURCES; i++) {
831 			struct resource *res = &dev->resource[i];
832 			if ((res->flags & type_mask) && !res->start &&
833 					res->end) {
834 				/* Could not assign a required resources
835 				 * for this device, remove it */
836 				pci_stop_and_remove_bus_device(dev);
837 				break;
838 			}
839 		}
840 	}
841 }
842 
843 /*
844  * ACPI event handlers
845  */
846 
847 static acpi_status
848 check_sub_bridges(acpi_handle handle, u32 lvl, void *context, void **rv)
849 {
850 	struct acpiphp_bridge *bridge;
851 	char objname[64];
852 	struct acpi_buffer buffer = { .length = sizeof(objname),
853 				      .pointer = objname };
854 
855 	bridge = acpiphp_handle_to_bridge(handle);
856 	if (bridge) {
857 		acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
858 		dbg("%s: re-enumerating slots under %s\n",
859 			__func__, objname);
860 		acpiphp_check_bridge(bridge);
861 		put_bridge(bridge);
862 	}
863 	return AE_OK ;
864 }
865 
866 void acpiphp_check_host_bridge(acpi_handle handle)
867 {
868 	struct acpiphp_bridge *bridge;
869 
870 	bridge = acpiphp_handle_to_bridge(handle);
871 	if (bridge) {
872 		acpiphp_check_bridge(bridge);
873 		put_bridge(bridge);
874 	}
875 
876 	acpi_walk_namespace(ACPI_TYPE_DEVICE, handle,
877 		ACPI_UINT32_MAX, check_sub_bridges, NULL, NULL, NULL);
878 }
879 
880 static void hotplug_event(acpi_handle handle, u32 type, void *data)
881 {
882 	struct acpiphp_context *context = data;
883 	struct acpiphp_func *func = &context->func;
884 	struct acpiphp_bridge *bridge;
885 	char objname[64];
886 	struct acpi_buffer buffer = { .length = sizeof(objname),
887 				      .pointer = objname };
888 
889 	mutex_lock(&acpiphp_context_lock);
890 	bridge = context->bridge;
891 	if (bridge)
892 		get_bridge(bridge);
893 
894 	mutex_unlock(&acpiphp_context_lock);
895 
896 	acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
897 
898 	switch (type) {
899 	case ACPI_NOTIFY_BUS_CHECK:
900 		/* bus re-enumerate */
901 		dbg("%s: Bus check notify on %s\n", __func__, objname);
902 		dbg("%s: re-enumerating slots under %s\n", __func__, objname);
903 		if (bridge) {
904 			acpiphp_check_bridge(bridge);
905 			acpi_walk_namespace(ACPI_TYPE_DEVICE, handle,
906 					    ACPI_UINT32_MAX, check_sub_bridges,
907 					    NULL, NULL, NULL);
908 		} else {
909 			acpiphp_enable_slot(func->slot);
910 		}
911 		break;
912 
913 	case ACPI_NOTIFY_DEVICE_CHECK:
914 		/* device check */
915 		dbg("%s: Device check notify on %s\n", __func__, objname);
916 		if (bridge)
917 			acpiphp_check_bridge(bridge);
918 		else
919 			acpiphp_check_bridge(func->parent);
920 
921 		break;
922 
923 	case ACPI_NOTIFY_EJECT_REQUEST:
924 		/* request device eject */
925 		dbg("%s: Device eject notify on %s\n", __func__, objname);
926 		acpiphp_disable_and_eject_slot(func->slot);
927 		break;
928 	}
929 
930 	if (bridge)
931 		put_bridge(bridge);
932 }
933 
934 static void hotplug_event_work(struct work_struct *work)
935 {
936 	struct acpiphp_context *context;
937 	struct acpi_hp_work *hp_work;
938 
939 	hp_work = container_of(work, struct acpi_hp_work, work);
940 	context = hp_work->context;
941 	acpi_scan_lock_acquire();
942 
943 	hotplug_event(hp_work->handle, hp_work->type, context);
944 
945 	acpi_scan_lock_release();
946 	kfree(hp_work); /* allocated in handle_hotplug_event() */
947 	put_bridge(context->func.parent);
948 }
949 
950 /**
951  * handle_hotplug_event - handle ACPI hotplug event
952  * @handle: Notify()'ed acpi_handle
953  * @type: Notify code
954  * @data: pointer to acpiphp_context structure
955  *
956  * Handles ACPI event notification on slots.
957  */
958 static void handle_hotplug_event(acpi_handle handle, u32 type, void *data)
959 {
960 	struct acpiphp_context *context;
961 
962 	switch (type) {
963 	case ACPI_NOTIFY_BUS_CHECK:
964 	case ACPI_NOTIFY_DEVICE_CHECK:
965 	case ACPI_NOTIFY_EJECT_REQUEST:
966 		break;
967 
968 	case ACPI_NOTIFY_DEVICE_WAKE:
969 		return;
970 
971 	case ACPI_NOTIFY_FREQUENCY_MISMATCH:
972 		acpi_handle_err(handle, "Device cannot be configured due "
973 				"to a frequency mismatch\n");
974 		return;
975 
976 	case ACPI_NOTIFY_BUS_MODE_MISMATCH:
977 		acpi_handle_err(handle, "Device cannot be configured due "
978 				"to a bus mode mismatch\n");
979 		return;
980 
981 	case ACPI_NOTIFY_POWER_FAULT:
982 		acpi_handle_err(handle, "Device has suffered a power fault\n");
983 		return;
984 
985 	default:
986 		acpi_handle_warn(handle, "Unsupported event type 0x%x\n", type);
987 		return;
988 	}
989 
990 	mutex_lock(&acpiphp_context_lock);
991 	context = acpiphp_get_context(handle);
992 	if (context) {
993 		get_bridge(context->func.parent);
994 		acpiphp_put_context(context);
995 		alloc_acpi_hp_work(handle, type, context, hotplug_event_work);
996 	}
997 	mutex_unlock(&acpiphp_context_lock);
998 }
999 
1000 /*
1001  * Create hotplug slots for the PCI bus.
1002  * It should always return 0 to avoid skipping following notifiers.
1003  */
1004 void acpiphp_enumerate_slots(struct pci_bus *bus)
1005 {
1006 	struct acpiphp_bridge *bridge;
1007 	acpi_handle handle;
1008 	acpi_status status;
1009 
1010 	if (acpiphp_disabled)
1011 		return;
1012 
1013 	handle = ACPI_HANDLE(bus->bridge);
1014 	if (!handle)
1015 		return;
1016 
1017 	bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL);
1018 	if (!bridge) {
1019 		acpi_handle_err(handle, "No memory for bridge object\n");
1020 		return;
1021 	}
1022 
1023 	INIT_LIST_HEAD(&bridge->slots);
1024 	kref_init(&bridge->ref);
1025 	bridge->pci_dev = pci_dev_get(bus->self);
1026 	bridge->pci_bus = bus;
1027 
1028 	/*
1029 	 * Grab a ref to the subordinate PCI bus in case the bus is
1030 	 * removed via PCI core logical hotplug. The ref pins the bus
1031 	 * (which we access during module unload).
1032 	 */
1033 	get_device(&bus->dev);
1034 
1035 	if (!pci_is_root_bus(bridge->pci_bus)) {
1036 		struct acpiphp_context *context;
1037 
1038 		/*
1039 		 * This bridge should have been registered as a hotplug function
1040 		 * under its parent, so the context has to be there.  If not, we
1041 		 * are in deep goo.
1042 		 */
1043 		mutex_lock(&acpiphp_context_lock);
1044 		context = acpiphp_get_context(handle);
1045 		if (WARN_ON(!context)) {
1046 			mutex_unlock(&acpiphp_context_lock);
1047 			put_device(&bus->dev);
1048 			kfree(bridge);
1049 			return;
1050 		}
1051 		bridge->context = context;
1052 		context->bridge = bridge;
1053 		/* Get a reference to the parent bridge. */
1054 		get_bridge(context->func.parent);
1055 		mutex_unlock(&acpiphp_context_lock);
1056 	}
1057 
1058 	/* must be added to the list prior to calling register_slot */
1059 	mutex_lock(&bridge_mutex);
1060 	list_add(&bridge->list, &bridge_list);
1061 	mutex_unlock(&bridge_mutex);
1062 
1063 	/* register all slot objects under this bridge */
1064 	status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, 1,
1065 				     register_slot, NULL, bridge, NULL);
1066 	if (ACPI_FAILURE(status)) {
1067 		acpi_handle_err(handle, "failed to register slots\n");
1068 		cleanup_bridge(bridge);
1069 		put_bridge(bridge);
1070 	}
1071 }
1072 
1073 /* Destroy hotplug slots associated with the PCI bus */
1074 void acpiphp_remove_slots(struct pci_bus *bus)
1075 {
1076 	struct acpiphp_bridge *bridge, *tmp;
1077 
1078 	if (acpiphp_disabled)
1079 		return;
1080 
1081 	list_for_each_entry_safe(bridge, tmp, &bridge_list, list)
1082 		if (bridge->pci_bus == bus) {
1083 			cleanup_bridge(bridge);
1084 			put_bridge(bridge);
1085 			break;
1086 		}
1087 }
1088 
1089 /**
1090  * acpiphp_enable_slot - power on slot
1091  * @slot: ACPI PHP slot
1092  */
1093 int acpiphp_enable_slot(struct acpiphp_slot *slot)
1094 {
1095 	int retval;
1096 
1097 	mutex_lock(&slot->crit_sect);
1098 
1099 	/* wake up all functions */
1100 	retval = power_on_slot(slot);
1101 	if (retval)
1102 		goto err_exit;
1103 
1104 	if (get_slot_status(slot) == ACPI_STA_ALL) {
1105 		/* configure all functions */
1106 		retval = enable_device(slot);
1107 		if (retval)
1108 			power_off_slot(slot);
1109 	} else {
1110 		dbg("%s: Slot status is not ACPI_STA_ALL\n", __func__);
1111 		power_off_slot(slot);
1112 	}
1113 
1114  err_exit:
1115 	mutex_unlock(&slot->crit_sect);
1116 	return retval;
1117 }
1118 
1119 /**
1120  * acpiphp_disable_and_eject_slot - power off and eject slot
1121  * @slot: ACPI PHP slot
1122  */
1123 int acpiphp_disable_and_eject_slot(struct acpiphp_slot *slot)
1124 {
1125 	struct acpiphp_func *func;
1126 	int retval = 0;
1127 
1128 	mutex_lock(&slot->crit_sect);
1129 
1130 	/* unconfigure all functions */
1131 	retval = disable_device(slot);
1132 	if (retval)
1133 		goto err_exit;
1134 
1135 	/* power off all functions */
1136 	retval = power_off_slot(slot);
1137 	if (retval)
1138 		goto err_exit;
1139 
1140 	list_for_each_entry(func, &slot->funcs, sibling)
1141 		if (func->flags & FUNC_HAS_EJ0) {
1142 			acpi_handle handle = func_to_handle(func);
1143 
1144 			if (ACPI_FAILURE(acpi_evaluate_ej0(handle)))
1145 				acpi_handle_err(handle, "_EJ0 failed\n");
1146 
1147 			break;
1148 		}
1149 
1150  err_exit:
1151 	mutex_unlock(&slot->crit_sect);
1152 	return retval;
1153 }
1154 
1155 
1156 /*
1157  * slot enabled:  1
1158  * slot disabled: 0
1159  */
1160 u8 acpiphp_get_power_status(struct acpiphp_slot *slot)
1161 {
1162 	return (slot->flags & SLOT_POWEREDON);
1163 }
1164 
1165 
1166 /*
1167  * latch   open:  1
1168  * latch closed:  0
1169  */
1170 u8 acpiphp_get_latch_status(struct acpiphp_slot *slot)
1171 {
1172 	unsigned int sta;
1173 
1174 	sta = get_slot_status(slot);
1175 
1176 	return (sta & ACPI_STA_DEVICE_UI) ? 0 : 1;
1177 }
1178 
1179 
1180 /*
1181  * adapter presence : 1
1182  *          absence : 0
1183  */
1184 u8 acpiphp_get_adapter_status(struct acpiphp_slot *slot)
1185 {
1186 	unsigned int sta;
1187 
1188 	sta = get_slot_status(slot);
1189 
1190 	return (sta == 0) ? 0 : 1;
1191 }
1192