| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 7 |  * Copyright (C) 2003-2005 Matthew Wilcox (matthew.wilcox@hp.com) | 
 | 8 |  * Copyright (C) 2003-2005 Hewlett Packard | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 9 |  * Copyright (C) 2005 Rajesh Shah (rajesh.shah@intel.com) | 
 | 10 |  * Copyright (C) 2005 Intel Corporation | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |  * | 
| Kristen Carlson Accardi | 998be20 | 2006-07-26 10:52:33 -0700 | [diff] [blame] | 29 |  * Send feedback to <kristen.c.accardi@intel.com> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 |  * | 
 | 31 |  */ | 
 | 32 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 33 | /* | 
 | 34 |  * Lifetime rules for pci_dev: | 
 | 35 |  *  - The one in acpiphp_func has its refcount elevated by pci_get_slot() | 
 | 36 |  *    when the driver is loaded or when an insertion event occurs.  It loses | 
 | 37 |  *    a refcount when its ejected or the driver unloads. | 
 | 38 |  *  - The one in acpiphp_bridge has its refcount elevated by pci_get_slot() | 
 | 39 |  *    when the bridge is scanned and it loses a refcount when the bridge | 
 | 40 |  *    is removed. | 
 | 41 |  */ | 
 | 42 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | #include <linux/init.h> | 
 | 44 | #include <linux/module.h> | 
 | 45 |  | 
 | 46 | #include <linux/kernel.h> | 
 | 47 | #include <linux/pci.h> | 
 | 48 | #include <linux/smp_lock.h> | 
| Ingo Molnar | 6aa4cdd | 2006-01-13 16:02:15 +0100 | [diff] [blame] | 49 | #include <linux/mutex.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 |  | 
 | 51 | #include "../pci.h" | 
 | 52 | #include "pci_hotplug.h" | 
 | 53 | #include "acpiphp.h" | 
 | 54 |  | 
 | 55 | static LIST_HEAD(bridge_list); | 
 | 56 |  | 
 | 57 | #define MY_NAME "acpiphp_glue" | 
 | 58 |  | 
 | 59 | static void handle_hotplug_event_bridge (acpi_handle, u32, void *); | 
| Kristen Accardi | 8e5dce3 | 2005-10-18 17:21:40 -0700 | [diff] [blame] | 60 | static void acpiphp_sanitize_bus(struct pci_bus *bus); | 
 | 61 | static void acpiphp_set_hpp_values(acpi_handle handle, struct pci_bus *bus); | 
| Len Brown | 2b85e13 | 2006-06-27 01:50:14 -0400 | [diff] [blame] | 62 | static void handle_hotplug_event_func(acpi_handle handle, u32 type, void *context); | 
| Kristen Accardi | 8e5dce3 | 2005-10-18 17:21:40 -0700 | [diff] [blame] | 63 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 |  | 
 | 65 | /* | 
 | 66 |  * initialization & terminatation routines | 
 | 67 |  */ | 
 | 68 |  | 
 | 69 | /** | 
 | 70 |  * is_ejectable - determine if a slot is ejectable | 
 | 71 |  * @handle: handle to acpi namespace | 
 | 72 |  * | 
 | 73 |  * Ejectable slot should satisfy at least these conditions: | 
 | 74 |  * | 
 | 75 |  *  1. has _ADR method | 
 | 76 |  *  2. has _EJ0 method | 
 | 77 |  * | 
 | 78 |  * optionally | 
 | 79 |  * | 
 | 80 |  *  1. has _STA method | 
 | 81 |  *  2. has _PS0 method | 
 | 82 |  *  3. has _PS3 method | 
 | 83 |  *  4. .. | 
 | 84 |  * | 
 | 85 |  */ | 
 | 86 | static int is_ejectable(acpi_handle handle) | 
 | 87 | { | 
 | 88 | 	acpi_status status; | 
 | 89 | 	acpi_handle tmp; | 
 | 90 |  | 
 | 91 | 	status = acpi_get_handle(handle, "_ADR", &tmp); | 
 | 92 | 	if (ACPI_FAILURE(status)) { | 
 | 93 | 		return 0; | 
 | 94 | 	} | 
 | 95 |  | 
 | 96 | 	status = acpi_get_handle(handle, "_EJ0", &tmp); | 
 | 97 | 	if (ACPI_FAILURE(status)) { | 
 | 98 | 		return 0; | 
 | 99 | 	} | 
 | 100 |  | 
 | 101 | 	return 1; | 
 | 102 | } | 
 | 103 |  | 
 | 104 |  | 
 | 105 | /* callback routine to check the existence of ejectable slots */ | 
 | 106 | static acpi_status | 
 | 107 | is_ejectable_slot(acpi_handle handle, u32 lvl, void *context, void **rv) | 
 | 108 | { | 
 | 109 | 	int *count = (int *)context; | 
 | 110 |  | 
 | 111 | 	if (is_ejectable(handle)) { | 
 | 112 | 		(*count)++; | 
 | 113 | 		/* only one ejectable slot is enough */ | 
 | 114 | 		return AE_CTRL_TERMINATE; | 
 | 115 | 	} else { | 
 | 116 | 		return AE_OK; | 
 | 117 | 	} | 
 | 118 | } | 
 | 119 |  | 
| Kristen Accardi | 4e8662b | 2006-06-28 03:08:06 -0400 | [diff] [blame] | 120 | /* callback routine to check for the existance of a pci dock device */ | 
 | 121 | static acpi_status | 
 | 122 | is_pci_dock_device(acpi_handle handle, u32 lvl, void *context, void **rv) | 
 | 123 | { | 
 | 124 | 	int *count = (int *)context; | 
 | 125 |  | 
 | 126 | 	if (is_dock_device(handle)) { | 
 | 127 | 		(*count)++; | 
 | 128 | 		return AE_CTRL_TERMINATE; | 
 | 129 | 	} else { | 
 | 130 | 		return AE_OK; | 
 | 131 | 	} | 
 | 132 | } | 
 | 133 |  | 
 | 134 |  | 
 | 135 |  | 
 | 136 |  | 
 | 137 | /* | 
 | 138 |  * the _DCK method can do funny things... and sometimes not | 
 | 139 |  * hah-hah funny. | 
 | 140 |  * | 
 | 141 |  * TBD - figure out a way to only call fixups for | 
 | 142 |  * systems that require them. | 
 | 143 |  */ | 
 | 144 | static int post_dock_fixups(struct notifier_block *nb, unsigned long val, | 
 | 145 | 	void *v) | 
 | 146 | { | 
 | 147 | 	struct acpiphp_func *func = container_of(nb, struct acpiphp_func, nb); | 
 | 148 | 	struct pci_bus *bus = func->slot->bridge->pci_bus; | 
 | 149 | 	u32 buses; | 
 | 150 |  | 
 | 151 | 	if (!bus->self) | 
 | 152 | 		return  NOTIFY_OK; | 
 | 153 |  | 
 | 154 | 	/* fixup bad _DCK function that rewrites | 
 | 155 | 	 * secondary bridge on slot | 
 | 156 | 	 */ | 
 | 157 | 	pci_read_config_dword(bus->self, | 
 | 158 | 			PCI_PRIMARY_BUS, | 
 | 159 | 			&buses); | 
 | 160 |  | 
 | 161 | 	if (((buses >> 8) & 0xff) != bus->secondary) { | 
 | 162 | 		buses = (buses & 0xff000000) | 
 | 163 | 	     		| ((unsigned int)(bus->primary)     <<  0) | 
 | 164 | 	     		| ((unsigned int)(bus->secondary)   <<  8) | 
 | 165 | 	     		| ((unsigned int)(bus->subordinate) << 16); | 
 | 166 | 		pci_write_config_dword(bus->self, PCI_PRIMARY_BUS, buses); | 
 | 167 | 	} | 
 | 168 | 	return NOTIFY_OK; | 
 | 169 | } | 
 | 170 |  | 
 | 171 |  | 
 | 172 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 173 |  | 
 | 174 | /* callback routine to register each ACPI PCI slot object */ | 
 | 175 | static acpi_status | 
 | 176 | register_slot(acpi_handle handle, u32 lvl, void *context, void **rv) | 
 | 177 | { | 
 | 178 | 	struct acpiphp_bridge *bridge = (struct acpiphp_bridge *)context; | 
 | 179 | 	struct acpiphp_slot *slot; | 
 | 180 | 	struct acpiphp_func *newfunc; | 
 | 181 | 	acpi_handle tmp; | 
 | 182 | 	acpi_status status = AE_OK; | 
 | 183 | 	unsigned long adr, sun; | 
| MUNEDA Takahiro | e27da38 | 2006-02-23 17:56:08 -0800 | [diff] [blame] | 184 | 	int device, function, retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 |  | 
 | 186 | 	status = acpi_evaluate_integer(handle, "_ADR", NULL, &adr); | 
 | 187 |  | 
 | 188 | 	if (ACPI_FAILURE(status)) | 
 | 189 | 		return AE_OK; | 
 | 190 |  | 
 | 191 | 	status = acpi_get_handle(handle, "_EJ0", &tmp); | 
 | 192 |  | 
| Kristen Accardi | 4e8662b | 2006-06-28 03:08:06 -0400 | [diff] [blame] | 193 | 	if (ACPI_FAILURE(status) && !(is_dock_device(handle))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | 		return AE_OK; | 
 | 195 |  | 
 | 196 | 	device = (adr >> 16) & 0xffff; | 
 | 197 | 	function = adr & 0xffff; | 
 | 198 |  | 
| Eric Sesterhenn | f5afe80 | 2006-02-28 15:34:49 +0100 | [diff] [blame] | 199 | 	newfunc = kzalloc(sizeof(struct acpiphp_func), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 | 	if (!newfunc) | 
 | 201 | 		return AE_NO_MEMORY; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 |  | 
 | 203 | 	INIT_LIST_HEAD(&newfunc->sibling); | 
 | 204 | 	newfunc->handle = handle; | 
 | 205 | 	newfunc->function = function; | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 206 | 	if (ACPI_SUCCESS(status)) | 
 | 207 | 		newfunc->flags = FUNC_HAS_EJ0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 208 |  | 
 | 209 | 	if (ACPI_SUCCESS(acpi_get_handle(handle, "_STA", &tmp))) | 
 | 210 | 		newfunc->flags |= FUNC_HAS_STA; | 
 | 211 |  | 
 | 212 | 	if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS0", &tmp))) | 
 | 213 | 		newfunc->flags |= FUNC_HAS_PS0; | 
 | 214 |  | 
 | 215 | 	if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS3", &tmp))) | 
 | 216 | 		newfunc->flags |= FUNC_HAS_PS3; | 
 | 217 |  | 
| Kristen Accardi | 4e8662b | 2006-06-28 03:08:06 -0400 | [diff] [blame] | 218 | 	if (ACPI_SUCCESS(acpi_get_handle(handle, "_DCK", &tmp))) | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 219 | 		newfunc->flags |= FUNC_HAS_DCK; | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 220 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | 	status = acpi_evaluate_integer(handle, "_SUN", NULL, &sun); | 
| Kristen Accardi | 95b38b3 | 2006-06-28 03:09:54 -0400 | [diff] [blame] | 222 | 	if (ACPI_FAILURE(status)) { | 
 | 223 | 		/* | 
 | 224 | 		 * use the count of the number of slots we've found | 
 | 225 | 		 * for the number of the slot | 
 | 226 | 		 */ | 
 | 227 | 		sun = bridge->nr_slots+1; | 
 | 228 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 229 |  | 
 | 230 | 	/* search for objects that share the same slot */ | 
 | 231 | 	for (slot = bridge->slots; slot; slot = slot->next) | 
 | 232 | 		if (slot->device == device) { | 
 | 233 | 			if (slot->sun != sun) | 
 | 234 | 				warn("sibling found, but _SUN doesn't match!\n"); | 
 | 235 | 			break; | 
 | 236 | 		} | 
 | 237 |  | 
 | 238 | 	if (!slot) { | 
| Eric Sesterhenn | f5afe80 | 2006-02-28 15:34:49 +0100 | [diff] [blame] | 239 | 		slot = kzalloc(sizeof(struct acpiphp_slot), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 240 | 		if (!slot) { | 
 | 241 | 			kfree(newfunc); | 
 | 242 | 			return AE_NO_MEMORY; | 
 | 243 | 		} | 
 | 244 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 245 | 		slot->bridge = bridge; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 246 | 		slot->device = device; | 
 | 247 | 		slot->sun = sun; | 
 | 248 | 		INIT_LIST_HEAD(&slot->funcs); | 
| Ingo Molnar | 6aa4cdd | 2006-01-13 16:02:15 +0100 | [diff] [blame] | 249 | 		mutex_init(&slot->crit_sect); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 250 |  | 
 | 251 | 		slot->next = bridge->slots; | 
 | 252 | 		bridge->slots = slot; | 
 | 253 |  | 
 | 254 | 		bridge->nr_slots++; | 
 | 255 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 256 | 		dbg("found ACPI PCI Hotplug slot %d at PCI %04x:%02x:%02x\n", | 
 | 257 | 				slot->sun, pci_domain_nr(bridge->pci_bus), | 
 | 258 | 				bridge->pci_bus->number, slot->device); | 
| MUNEDA Takahiro | e27da38 | 2006-02-23 17:56:08 -0800 | [diff] [blame] | 259 | 		retval = acpiphp_register_hotplug_slot(slot); | 
 | 260 | 		if (retval) { | 
 | 261 | 			warn("acpiphp_register_hotplug_slot failed(err code = 0x%x)\n", retval); | 
 | 262 | 			goto err_exit; | 
 | 263 | 		} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 264 | 	} | 
 | 265 |  | 
 | 266 | 	newfunc->slot = slot; | 
 | 267 | 	list_add_tail(&newfunc->sibling, &slot->funcs); | 
 | 268 |  | 
 | 269 | 	/* associate corresponding pci_dev */ | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 270 | 	newfunc->pci_dev = pci_get_slot(bridge->pci_bus, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 271 | 					 PCI_DEVFN(device, function)); | 
 | 272 | 	if (newfunc->pci_dev) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 273 | 		slot->flags |= (SLOT_ENABLED | SLOT_POWEREDON); | 
 | 274 | 	} | 
 | 275 |  | 
| Kristen Accardi | 4e8662b | 2006-06-28 03:08:06 -0400 | [diff] [blame] | 276 | 	if (is_dock_device(handle)) { | 
 | 277 | 		/* we don't want to call this device's _EJ0 | 
 | 278 | 		 * because we want the dock notify handler | 
 | 279 | 		 * to call it after it calls _DCK | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 280 | 		 */ | 
 | 281 | 		newfunc->flags &= ~FUNC_HAS_EJ0; | 
| Kristen Accardi | 4e8662b | 2006-06-28 03:08:06 -0400 | [diff] [blame] | 282 | 		if (register_hotplug_dock_device(handle, | 
 | 283 | 			handle_hotplug_event_func, newfunc)) | 
 | 284 | 			dbg("failed to register dock device\n"); | 
 | 285 |  | 
 | 286 | 		/* we need to be notified when dock events happen | 
 | 287 | 		 * outside of the hotplug operation, since we may | 
 | 288 | 		 * need to do fixups before we can hotplug. | 
 | 289 | 		 */ | 
 | 290 | 		newfunc->nb.notifier_call = post_dock_fixups; | 
 | 291 | 		if (register_dock_notifier(&newfunc->nb)) | 
 | 292 | 			dbg("failed to register a dock notifier"); | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 293 | 	} | 
 | 294 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 295 | 	/* install notify handler */ | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 296 | 	if (!(newfunc->flags & FUNC_HAS_DCK)) { | 
 | 297 | 		status = acpi_install_notify_handler(handle, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 298 | 					     ACPI_SYSTEM_NOTIFY, | 
 | 299 | 					     handle_hotplug_event_func, | 
 | 300 | 					     newfunc); | 
 | 301 |  | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 302 | 		if (ACPI_FAILURE(status)) | 
 | 303 | 			err("failed to register interrupt notify handler\n"); | 
 | 304 | 	} else | 
 | 305 | 		status = AE_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 306 |  | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 307 | 	return status; | 
| MUNEDA Takahiro | e27da38 | 2006-02-23 17:56:08 -0800 | [diff] [blame] | 308 |  | 
 | 309 |  err_exit: | 
 | 310 | 	bridge->nr_slots--; | 
 | 311 | 	bridge->slots = slot->next; | 
 | 312 | 	kfree(slot); | 
 | 313 | 	kfree(newfunc); | 
 | 314 |  | 
 | 315 | 	return AE_OK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | } | 
 | 317 |  | 
 | 318 |  | 
 | 319 | /* see if it's worth looking at this bridge */ | 
 | 320 | static int detect_ejectable_slots(acpi_handle *bridge_handle) | 
 | 321 | { | 
 | 322 | 	acpi_status status; | 
 | 323 | 	int count; | 
 | 324 |  | 
 | 325 | 	count = 0; | 
 | 326 |  | 
 | 327 | 	/* only check slots defined directly below bridge object */ | 
 | 328 | 	status = acpi_walk_namespace(ACPI_TYPE_DEVICE, bridge_handle, (u32)1, | 
 | 329 | 				     is_ejectable_slot, (void *)&count, NULL); | 
 | 330 |  | 
| Kristen Accardi | 4e8662b | 2006-06-28 03:08:06 -0400 | [diff] [blame] | 331 | 	/* | 
 | 332 | 	 * we also need to add this bridge if there is a dock bridge or | 
 | 333 | 	 * other pci device on a dock station (removable) | 
 | 334 | 	 */ | 
 | 335 | 	if (!count) | 
 | 336 | 		status = acpi_walk_namespace(ACPI_TYPE_DEVICE, bridge_handle, | 
 | 337 | 				(u32)1, is_pci_dock_device, (void *)&count, | 
 | 338 | 				NULL); | 
 | 339 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 340 | 	return count; | 
 | 341 | } | 
 | 342 |  | 
 | 343 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 344 | /* decode ACPI 2.0 _HPP hot plug parameters */ | 
 | 345 | static void decode_hpp(struct acpiphp_bridge *bridge) | 
 | 346 | { | 
 | 347 | 	acpi_status status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 |  | 
| Kenji Kaneshige | 7430e34 | 2006-05-02 10:54:50 +0900 | [diff] [blame] | 349 | 	status = acpi_get_hp_params_from_firmware(bridge->pci_bus, &bridge->hpp); | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 350 | 	if (ACPI_FAILURE(status) || | 
 | 351 | 	    !bridge->hpp.t0 || (bridge->hpp.t0->revision > 1)) { | 
| Kristen Accardi | 783c49f | 2006-03-03 10:16:05 -0800 | [diff] [blame] | 352 | 		/* use default numbers */ | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 353 | 		printk(KERN_WARNING | 
 | 354 | 		       "%s: Could not get hotplug parameters. Use defaults\n", | 
 | 355 | 		       __FUNCTION__); | 
 | 356 | 		bridge->hpp.t0 = &bridge->hpp.type0_data; | 
 | 357 | 		bridge->hpp.t0->revision = 0; | 
 | 358 | 		bridge->hpp.t0->cache_line_size = 0x10; | 
 | 359 | 		bridge->hpp.t0->latency_timer = 0x40; | 
 | 360 | 		bridge->hpp.t0->enable_serr = 0; | 
 | 361 | 		bridge->hpp.t0->enable_perr = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | } | 
 | 364 |  | 
 | 365 |  | 
| Kristen Accardi | 783c49f | 2006-03-03 10:16:05 -0800 | [diff] [blame] | 366 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 367 | /* initialize miscellaneous stuff for both root and PCI-to-PCI bridge */ | 
 | 368 | static void init_bridge_misc(struct acpiphp_bridge *bridge) | 
 | 369 | { | 
 | 370 | 	acpi_status status; | 
 | 371 |  | 
 | 372 | 	/* decode ACPI 2.0 _HPP (hot plug parameters) */ | 
 | 373 | 	decode_hpp(bridge); | 
 | 374 |  | 
| MUNEDA Takahiro | e27da38 | 2006-02-23 17:56:08 -0800 | [diff] [blame] | 375 | 	/* must be added to the list prior to calling register_slot */ | 
 | 376 | 	list_add(&bridge->list, &bridge_list); | 
 | 377 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 378 | 	/* register all slot objects under this bridge */ | 
 | 379 | 	status = acpi_walk_namespace(ACPI_TYPE_DEVICE, bridge->handle, (u32)1, | 
 | 380 | 				     register_slot, bridge, NULL); | 
| MUNEDA Takahiro | e27da38 | 2006-02-23 17:56:08 -0800 | [diff] [blame] | 381 | 	if (ACPI_FAILURE(status)) { | 
 | 382 | 		list_del(&bridge->list); | 
 | 383 | 		return; | 
 | 384 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 385 |  | 
 | 386 | 	/* install notify handler */ | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 387 | 	if (bridge->type != BRIDGE_TYPE_HOST) { | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 388 | 		if ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func) { | 
 | 389 | 			status = acpi_remove_notify_handler(bridge->func->handle, | 
 | 390 | 						ACPI_SYSTEM_NOTIFY, | 
 | 391 | 						handle_hotplug_event_func); | 
 | 392 | 			if (ACPI_FAILURE(status)) | 
 | 393 | 				err("failed to remove notify handler\n"); | 
 | 394 | 		} | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 395 | 		status = acpi_install_notify_handler(bridge->handle, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 396 | 					     ACPI_SYSTEM_NOTIFY, | 
 | 397 | 					     handle_hotplug_event_bridge, | 
 | 398 | 					     bridge); | 
 | 399 |  | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 400 | 		if (ACPI_FAILURE(status)) { | 
 | 401 | 			err("failed to register interrupt notify handler\n"); | 
 | 402 | 		} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 403 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 404 | } | 
 | 405 |  | 
 | 406 |  | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 407 | /* find acpiphp_func from acpiphp_bridge */ | 
 | 408 | static struct acpiphp_func *acpiphp_bridge_handle_to_function(acpi_handle handle) | 
 | 409 | { | 
 | 410 | 	struct list_head *node, *l; | 
 | 411 | 	struct acpiphp_bridge *bridge; | 
 | 412 | 	struct acpiphp_slot *slot; | 
 | 413 | 	struct acpiphp_func *func; | 
 | 414 |  | 
 | 415 | 	list_for_each(node, &bridge_list) { | 
 | 416 | 		bridge = list_entry(node, struct acpiphp_bridge, list); | 
 | 417 | 		for (slot = bridge->slots; slot; slot = slot->next) { | 
 | 418 | 			list_for_each(l, &slot->funcs) { | 
 | 419 | 				func = list_entry(l, struct acpiphp_func, | 
 | 420 | 							sibling); | 
 | 421 | 				if (func->handle == handle) | 
 | 422 | 					return func; | 
 | 423 | 			} | 
 | 424 | 		} | 
 | 425 | 	} | 
 | 426 |  | 
 | 427 | 	return NULL; | 
 | 428 | } | 
 | 429 |  | 
 | 430 |  | 
 | 431 | static inline void config_p2p_bridge_flags(struct acpiphp_bridge *bridge) | 
 | 432 | { | 
 | 433 | 	acpi_handle dummy_handle; | 
 | 434 |  | 
 | 435 | 	if (ACPI_SUCCESS(acpi_get_handle(bridge->handle, | 
 | 436 | 					"_STA", &dummy_handle))) | 
 | 437 | 		bridge->flags |= BRIDGE_HAS_STA; | 
 | 438 |  | 
 | 439 | 	if (ACPI_SUCCESS(acpi_get_handle(bridge->handle, | 
 | 440 | 					"_EJ0", &dummy_handle))) | 
 | 441 | 		bridge->flags |= BRIDGE_HAS_EJ0; | 
 | 442 |  | 
 | 443 | 	if (ACPI_SUCCESS(acpi_get_handle(bridge->handle, | 
 | 444 | 					"_PS0", &dummy_handle))) | 
 | 445 | 		bridge->flags |= BRIDGE_HAS_PS0; | 
 | 446 |  | 
 | 447 | 	if (ACPI_SUCCESS(acpi_get_handle(bridge->handle, | 
 | 448 | 					"_PS3", &dummy_handle))) | 
 | 449 | 		bridge->flags |= BRIDGE_HAS_PS3; | 
 | 450 |  | 
 | 451 | 	/* is this ejectable p2p bridge? */ | 
 | 452 | 	if (bridge->flags & BRIDGE_HAS_EJ0) { | 
 | 453 | 		struct acpiphp_func *func; | 
 | 454 |  | 
 | 455 | 		dbg("found ejectable p2p bridge\n"); | 
 | 456 |  | 
 | 457 | 		/* make link between PCI bridge and PCI function */ | 
 | 458 | 		func = acpiphp_bridge_handle_to_function(bridge->handle); | 
 | 459 | 		if (!func) | 
 | 460 | 			return; | 
 | 461 | 		bridge->func = func; | 
 | 462 | 		func->bridge = bridge; | 
 | 463 | 	} | 
 | 464 | } | 
 | 465 |  | 
 | 466 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 467 | /* allocate and initialize host bridge data structure */ | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 468 | static void add_host_bridge(acpi_handle *handle, struct pci_bus *pci_bus) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 469 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 470 | 	struct acpiphp_bridge *bridge; | 
 | 471 |  | 
| Eric Sesterhenn | f5afe80 | 2006-02-28 15:34:49 +0100 | [diff] [blame] | 472 | 	bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 473 | 	if (bridge == NULL) | 
 | 474 | 		return; | 
 | 475 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 476 | 	bridge->type = BRIDGE_TYPE_HOST; | 
 | 477 | 	bridge->handle = handle; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 478 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 479 | 	bridge->pci_bus = pci_bus; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 480 |  | 
 | 481 | 	spin_lock_init(&bridge->res_lock); | 
 | 482 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 483 | 	init_bridge_misc(bridge); | 
 | 484 | } | 
 | 485 |  | 
 | 486 |  | 
 | 487 | /* allocate and initialize PCI-to-PCI bridge data structure */ | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 488 | static void add_p2p_bridge(acpi_handle *handle, struct pci_dev *pci_dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 489 | { | 
 | 490 | 	struct acpiphp_bridge *bridge; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 491 |  | 
| Eric Sesterhenn | f5afe80 | 2006-02-28 15:34:49 +0100 | [diff] [blame] | 492 | 	bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 493 | 	if (bridge == NULL) { | 
 | 494 | 		err("out of memory\n"); | 
 | 495 | 		return; | 
 | 496 | 	} | 
 | 497 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 498 | 	bridge->type = BRIDGE_TYPE_P2P; | 
 | 499 | 	bridge->handle = handle; | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 500 | 	config_p2p_bridge_flags(bridge); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 501 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 502 | 	bridge->pci_dev = pci_dev_get(pci_dev); | 
 | 503 | 	bridge->pci_bus = pci_dev->subordinate; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 504 | 	if (!bridge->pci_bus) { | 
 | 505 | 		err("This is not a PCI-to-PCI bridge!\n"); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 506 | 		goto err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 507 | 	} | 
 | 508 |  | 
 | 509 | 	spin_lock_init(&bridge->res_lock); | 
 | 510 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 511 | 	init_bridge_misc(bridge); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 512 | 	return; | 
 | 513 |  err: | 
 | 514 | 	pci_dev_put(pci_dev); | 
 | 515 | 	kfree(bridge); | 
 | 516 | 	return; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 517 | } | 
 | 518 |  | 
 | 519 |  | 
 | 520 | /* callback routine to find P2P bridges */ | 
 | 521 | static acpi_status | 
 | 522 | find_p2p_bridge(acpi_handle handle, u32 lvl, void *context, void **rv) | 
 | 523 | { | 
 | 524 | 	acpi_status status; | 
 | 525 | 	acpi_handle dummy_handle; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 526 | 	unsigned long tmp; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 527 | 	int device, function; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 528 | 	struct pci_dev *dev; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 529 | 	struct pci_bus *pci_bus = context; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 530 |  | 
 | 531 | 	status = acpi_get_handle(handle, "_ADR", &dummy_handle); | 
 | 532 | 	if (ACPI_FAILURE(status)) | 
 | 533 | 		return AE_OK;		/* continue */ | 
 | 534 |  | 
 | 535 | 	status = acpi_evaluate_integer(handle, "_ADR", NULL, &tmp); | 
 | 536 | 	if (ACPI_FAILURE(status)) { | 
 | 537 | 		dbg("%s: _ADR evaluation failure\n", __FUNCTION__); | 
 | 538 | 		return AE_OK; | 
 | 539 | 	} | 
 | 540 |  | 
 | 541 | 	device = (tmp >> 16) & 0xffff; | 
 | 542 | 	function = tmp & 0xffff; | 
 | 543 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 544 | 	dev = pci_get_slot(pci_bus, PCI_DEVFN(device, function)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 545 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 546 | 	if (!dev || !dev->subordinate) | 
 | 547 | 		goto out; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 548 |  | 
 | 549 | 	/* check if this bridge has ejectable slots */ | 
| Kristen Accardi | 4e8662b | 2006-06-28 03:08:06 -0400 | [diff] [blame] | 550 | 	if ((detect_ejectable_slots(handle) > 0)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 551 | 		dbg("found PCI-to-PCI bridge at PCI %s\n", pci_name(dev)); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 552 | 		add_p2p_bridge(handle, dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 553 | 	} | 
 | 554 |  | 
| Kenji Kaneshige | 7c8f25d | 2006-02-27 22:15:49 +0900 | [diff] [blame] | 555 | 	/* search P2P bridges under this p2p bridge */ | 
 | 556 | 	status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1, | 
 | 557 | 				     find_p2p_bridge, dev->subordinate, NULL); | 
 | 558 | 	if (ACPI_FAILURE(status)) | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 559 | 		warn("find_p2p_bridge failed (error code = 0x%x)\n", status); | 
| Kenji Kaneshige | 7c8f25d | 2006-02-27 22:15:49 +0900 | [diff] [blame] | 560 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 561 |  out: | 
 | 562 | 	pci_dev_put(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 563 | 	return AE_OK; | 
 | 564 | } | 
 | 565 |  | 
 | 566 |  | 
 | 567 | /* find hot-pluggable slots, and then find P2P bridge */ | 
 | 568 | static int add_bridge(acpi_handle handle) | 
 | 569 | { | 
 | 570 | 	acpi_status status; | 
 | 571 | 	unsigned long tmp; | 
 | 572 | 	int seg, bus; | 
 | 573 | 	acpi_handle dummy_handle; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 574 | 	struct pci_bus *pci_bus; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 575 |  | 
 | 576 | 	/* if the bridge doesn't have _STA, we assume it is always there */ | 
 | 577 | 	status = acpi_get_handle(handle, "_STA", &dummy_handle); | 
 | 578 | 	if (ACPI_SUCCESS(status)) { | 
 | 579 | 		status = acpi_evaluate_integer(handle, "_STA", NULL, &tmp); | 
 | 580 | 		if (ACPI_FAILURE(status)) { | 
 | 581 | 			dbg("%s: _STA evaluation failure\n", __FUNCTION__); | 
 | 582 | 			return 0; | 
 | 583 | 		} | 
 | 584 | 		if ((tmp & ACPI_STA_FUNCTIONING) == 0) | 
 | 585 | 			/* don't register this object */ | 
 | 586 | 			return 0; | 
 | 587 | 	} | 
 | 588 |  | 
 | 589 | 	/* get PCI segment number */ | 
 | 590 | 	status = acpi_evaluate_integer(handle, "_SEG", NULL, &tmp); | 
 | 591 |  | 
 | 592 | 	seg = ACPI_SUCCESS(status) ? tmp : 0; | 
 | 593 |  | 
 | 594 | 	/* get PCI bus number */ | 
 | 595 | 	status = acpi_evaluate_integer(handle, "_BBN", NULL, &tmp); | 
 | 596 |  | 
 | 597 | 	if (ACPI_SUCCESS(status)) { | 
 | 598 | 		bus = tmp; | 
 | 599 | 	} else { | 
 | 600 | 		warn("can't get bus number, assuming 0\n"); | 
 | 601 | 		bus = 0; | 
 | 602 | 	} | 
 | 603 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 604 | 	pci_bus = pci_find_bus(seg, bus); | 
 | 605 | 	if (!pci_bus) { | 
 | 606 | 		err("Can't find bus %04x:%02x\n", seg, bus); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 607 | 		return 0; | 
 | 608 | 	} | 
 | 609 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 610 | 	/* check if this bridge has ejectable slots */ | 
 | 611 | 	if (detect_ejectable_slots(handle) > 0) { | 
 | 612 | 		dbg("found PCI host-bus bridge with hot-pluggable slots\n"); | 
 | 613 | 		add_host_bridge(handle, pci_bus); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 614 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 615 |  | 
 | 616 | 	/* search P2P bridges under this host bridge */ | 
 | 617 | 	status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1, | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 618 | 				     find_p2p_bridge, pci_bus, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 619 |  | 
 | 620 | 	if (ACPI_FAILURE(status)) | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 621 | 		warn("find_p2p_bridge failed (error code = 0x%x)\n", status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 622 |  | 
 | 623 | 	return 0; | 
 | 624 | } | 
 | 625 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 626 | static struct acpiphp_bridge *acpiphp_handle_to_bridge(acpi_handle handle) | 
 | 627 | { | 
 | 628 | 	struct list_head *head; | 
 | 629 | 	list_for_each(head, &bridge_list) { | 
 | 630 | 		struct acpiphp_bridge *bridge = list_entry(head, | 
 | 631 | 						struct acpiphp_bridge, list); | 
 | 632 | 		if (bridge->handle == handle) | 
 | 633 | 			return bridge; | 
 | 634 | 	} | 
 | 635 |  | 
 | 636 | 	return NULL; | 
 | 637 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 638 |  | 
| Rajesh Shah | 364d509 | 2005-04-28 00:25:54 -0700 | [diff] [blame] | 639 | static void cleanup_bridge(struct acpiphp_bridge *bridge) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 640 | { | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 641 | 	struct list_head *list, *tmp; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 642 | 	struct acpiphp_slot *slot; | 
 | 643 | 	acpi_status status; | 
| Rajesh Shah | 364d509 | 2005-04-28 00:25:54 -0700 | [diff] [blame] | 644 | 	acpi_handle handle = bridge->handle; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 645 |  | 
 | 646 | 	status = acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY, | 
 | 647 | 					    handle_hotplug_event_bridge); | 
 | 648 | 	if (ACPI_FAILURE(status)) | 
 | 649 | 		err("failed to remove notify handler\n"); | 
 | 650 |  | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 651 | 	if ((bridge->type != BRIDGE_TYPE_HOST) && | 
 | 652 | 	    ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func)) { | 
 | 653 | 		status = acpi_install_notify_handler(bridge->func->handle, | 
 | 654 | 						ACPI_SYSTEM_NOTIFY, | 
 | 655 | 						handle_hotplug_event_func, | 
 | 656 | 						bridge->func); | 
 | 657 | 		if (ACPI_FAILURE(status)) | 
 | 658 | 			err("failed to install interrupt notify handler\n"); | 
 | 659 | 	} | 
 | 660 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 661 | 	slot = bridge->slots; | 
 | 662 | 	while (slot) { | 
 | 663 | 		struct acpiphp_slot *next = slot->next; | 
 | 664 | 		list_for_each_safe (list, tmp, &slot->funcs) { | 
 | 665 | 			struct acpiphp_func *func; | 
 | 666 | 			func = list_entry(list, struct acpiphp_func, sibling); | 
| Kristen Accardi | 4e8662b | 2006-06-28 03:08:06 -0400 | [diff] [blame] | 667 | 			if (is_dock_device(func->handle)) { | 
 | 668 | 				unregister_hotplug_dock_device(func->handle); | 
 | 669 | 				unregister_dock_notifier(&func->nb); | 
 | 670 | 			} | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 671 | 			if (!(func->flags & FUNC_HAS_DCK)) { | 
 | 672 | 				status = acpi_remove_notify_handler(func->handle, | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 673 | 						ACPI_SYSTEM_NOTIFY, | 
 | 674 | 						handle_hotplug_event_func); | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 675 | 				if (ACPI_FAILURE(status)) | 
 | 676 | 					err("failed to remove notify handler\n"); | 
 | 677 | 			} | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 678 | 			pci_dev_put(func->pci_dev); | 
 | 679 | 			list_del(list); | 
 | 680 | 			kfree(func); | 
 | 681 | 		} | 
| MUNEDA Takahiro | e27da38 | 2006-02-23 17:56:08 -0800 | [diff] [blame] | 682 | 		acpiphp_unregister_hotplug_slot(slot); | 
 | 683 | 		list_del(&slot->funcs); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 684 | 		kfree(slot); | 
 | 685 | 		slot = next; | 
 | 686 | 	} | 
 | 687 |  | 
 | 688 | 	pci_dev_put(bridge->pci_dev); | 
 | 689 | 	list_del(&bridge->list); | 
 | 690 | 	kfree(bridge); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 691 | } | 
 | 692 |  | 
| Rajesh Shah | 364d509 | 2005-04-28 00:25:54 -0700 | [diff] [blame] | 693 | static acpi_status | 
 | 694 | cleanup_p2p_bridge(acpi_handle handle, u32 lvl, void *context, void **rv) | 
 | 695 | { | 
 | 696 | 	struct acpiphp_bridge *bridge; | 
 | 697 |  | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 698 | 	/* cleanup p2p bridges under this P2P bridge | 
 | 699 | 	   in a depth-first manner */ | 
 | 700 | 	acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1, | 
 | 701 | 				cleanup_p2p_bridge, NULL, NULL); | 
 | 702 |  | 
| Rajesh Shah | 364d509 | 2005-04-28 00:25:54 -0700 | [diff] [blame] | 703 | 	if (!(bridge = acpiphp_handle_to_bridge(handle))) | 
 | 704 | 		return AE_OK; | 
 | 705 | 	cleanup_bridge(bridge); | 
 | 706 | 	return AE_OK; | 
 | 707 | } | 
 | 708 |  | 
 | 709 | static void remove_bridge(acpi_handle handle) | 
 | 710 | { | 
 | 711 | 	struct acpiphp_bridge *bridge; | 
 | 712 |  | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 713 | 	/* cleanup p2p bridges under this host bridge | 
 | 714 | 	   in a depth-first manner */ | 
 | 715 | 	acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, | 
 | 716 | 				(u32)1, cleanup_p2p_bridge, NULL, NULL); | 
 | 717 |  | 
| Rajesh Shah | 364d509 | 2005-04-28 00:25:54 -0700 | [diff] [blame] | 718 | 	bridge = acpiphp_handle_to_bridge(handle); | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 719 | 	if (bridge) | 
| Rajesh Shah | 364d509 | 2005-04-28 00:25:54 -0700 | [diff] [blame] | 720 | 		cleanup_bridge(bridge); | 
| Rajesh Shah | 364d509 | 2005-04-28 00:25:54 -0700 | [diff] [blame] | 721 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 722 |  | 
| Kenji Kaneshige | a0d399a | 2005-04-28 00:25:59 -0700 | [diff] [blame] | 723 | static struct pci_dev * get_apic_pci_info(acpi_handle handle) | 
 | 724 | { | 
 | 725 | 	struct acpi_pci_id id; | 
 | 726 | 	struct pci_bus *bus; | 
 | 727 | 	struct pci_dev *dev; | 
 | 728 |  | 
 | 729 | 	if (ACPI_FAILURE(acpi_get_pci_id(handle, &id))) | 
 | 730 | 		return NULL; | 
 | 731 |  | 
 | 732 | 	bus = pci_find_bus(id.segment, id.bus); | 
 | 733 | 	if (!bus) | 
 | 734 | 		return NULL; | 
 | 735 |  | 
 | 736 | 	dev = pci_get_slot(bus, PCI_DEVFN(id.device, id.function)); | 
 | 737 | 	if (!dev) | 
 | 738 | 		return NULL; | 
 | 739 |  | 
 | 740 | 	if ((dev->class != PCI_CLASS_SYSTEM_PIC_IOAPIC) && | 
 | 741 | 	    (dev->class != PCI_CLASS_SYSTEM_PIC_IOXAPIC)) | 
 | 742 | 	{ | 
 | 743 | 		pci_dev_put(dev); | 
 | 744 | 		return NULL; | 
 | 745 | 	} | 
 | 746 |  | 
 | 747 | 	return dev; | 
 | 748 | } | 
 | 749 |  | 
 | 750 | static int get_gsi_base(acpi_handle handle, u32 *gsi_base) | 
 | 751 | { | 
 | 752 | 	acpi_status status; | 
 | 753 | 	int result = -1; | 
 | 754 | 	unsigned long gsb; | 
 | 755 | 	struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; | 
 | 756 | 	union acpi_object *obj; | 
 | 757 | 	void *table; | 
 | 758 |  | 
 | 759 | 	status = acpi_evaluate_integer(handle, "_GSB", NULL, &gsb); | 
 | 760 | 	if (ACPI_SUCCESS(status)) { | 
 | 761 | 		*gsi_base = (u32)gsb; | 
 | 762 | 		return 0; | 
 | 763 | 	} | 
 | 764 |  | 
 | 765 | 	status = acpi_evaluate_object(handle, "_MAT", NULL, &buffer); | 
 | 766 | 	if (ACPI_FAILURE(status) || !buffer.length || !buffer.pointer) | 
 | 767 | 		return -1; | 
 | 768 |  | 
 | 769 | 	obj = buffer.pointer; | 
 | 770 | 	if (obj->type != ACPI_TYPE_BUFFER) | 
 | 771 | 		goto out; | 
 | 772 |  | 
 | 773 | 	table = obj->buffer.pointer; | 
 | 774 | 	switch (((acpi_table_entry_header *)table)->type) { | 
 | 775 | 	case ACPI_MADT_IOSAPIC: | 
 | 776 | 		*gsi_base = ((struct acpi_table_iosapic *)table)->global_irq_base; | 
 | 777 | 		result = 0; | 
 | 778 | 		break; | 
 | 779 | 	case ACPI_MADT_IOAPIC: | 
 | 780 | 		*gsi_base = ((struct acpi_table_ioapic *)table)->global_irq_base; | 
 | 781 | 		result = 0; | 
 | 782 | 		break; | 
 | 783 | 	default: | 
 | 784 | 		break; | 
 | 785 | 	} | 
 | 786 |  out: | 
| Kristen Accardi | 81b26bc | 2006-04-18 14:36:43 -0700 | [diff] [blame] | 787 | 	kfree(buffer.pointer); | 
| Kenji Kaneshige | a0d399a | 2005-04-28 00:25:59 -0700 | [diff] [blame] | 788 | 	return result; | 
 | 789 | } | 
 | 790 |  | 
 | 791 | static acpi_status | 
 | 792 | ioapic_add(acpi_handle handle, u32 lvl, void *context, void **rv) | 
 | 793 | { | 
 | 794 | 	acpi_status status; | 
 | 795 | 	unsigned long sta; | 
 | 796 | 	acpi_handle tmp; | 
 | 797 | 	struct pci_dev *pdev; | 
 | 798 | 	u32 gsi_base; | 
 | 799 | 	u64 phys_addr; | 
 | 800 |  | 
 | 801 | 	/* Evaluate _STA if present */ | 
 | 802 | 	status = acpi_evaluate_integer(handle, "_STA", NULL, &sta); | 
 | 803 | 	if (ACPI_SUCCESS(status) && sta != ACPI_STA_ALL) | 
 | 804 | 		return AE_CTRL_DEPTH; | 
 | 805 |  | 
 | 806 | 	/* Scan only PCI bus scope */ | 
 | 807 | 	status = acpi_get_handle(handle, "_HID", &tmp); | 
 | 808 | 	if (ACPI_SUCCESS(status)) | 
 | 809 | 		return AE_CTRL_DEPTH; | 
 | 810 |  | 
 | 811 | 	if (get_gsi_base(handle, &gsi_base)) | 
 | 812 | 		return AE_OK; | 
 | 813 |  | 
 | 814 | 	pdev = get_apic_pci_info(handle); | 
 | 815 | 	if (!pdev) | 
 | 816 | 		return AE_OK; | 
 | 817 |  | 
 | 818 | 	if (pci_enable_device(pdev)) { | 
 | 819 | 		pci_dev_put(pdev); | 
 | 820 | 		return AE_OK; | 
 | 821 | 	} | 
 | 822 |  | 
 | 823 | 	pci_set_master(pdev); | 
 | 824 |  | 
 | 825 | 	if (pci_request_region(pdev, 0, "I/O APIC(acpiphp)")) { | 
 | 826 | 		pci_disable_device(pdev); | 
 | 827 | 		pci_dev_put(pdev); | 
 | 828 | 		return AE_OK; | 
 | 829 | 	} | 
 | 830 |  | 
 | 831 | 	phys_addr = pci_resource_start(pdev, 0); | 
 | 832 | 	if (acpi_register_ioapic(handle, phys_addr, gsi_base)) { | 
 | 833 | 		pci_release_region(pdev, 0); | 
 | 834 | 		pci_disable_device(pdev); | 
 | 835 | 		pci_dev_put(pdev); | 
 | 836 | 		return AE_OK; | 
 | 837 | 	} | 
 | 838 |  | 
 | 839 | 	return AE_OK; | 
 | 840 | } | 
 | 841 |  | 
 | 842 | static int acpiphp_configure_ioapics(acpi_handle handle) | 
 | 843 | { | 
 | 844 | 	acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, | 
 | 845 | 			    ACPI_UINT32_MAX, ioapic_add, NULL, NULL); | 
 | 846 | 	return 0; | 
 | 847 | } | 
 | 848 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 849 | static int power_on_slot(struct acpiphp_slot *slot) | 
 | 850 | { | 
 | 851 | 	acpi_status status; | 
 | 852 | 	struct acpiphp_func *func; | 
 | 853 | 	struct list_head *l; | 
 | 854 | 	int retval = 0; | 
 | 855 |  | 
 | 856 | 	/* if already enabled, just skip */ | 
 | 857 | 	if (slot->flags & SLOT_POWEREDON) | 
 | 858 | 		goto err_exit; | 
 | 859 |  | 
 | 860 | 	list_for_each (l, &slot->funcs) { | 
 | 861 | 		func = list_entry(l, struct acpiphp_func, sibling); | 
 | 862 |  | 
 | 863 | 		if (func->flags & FUNC_HAS_PS0) { | 
 | 864 | 			dbg("%s: executing _PS0\n", __FUNCTION__); | 
 | 865 | 			status = acpi_evaluate_object(func->handle, "_PS0", NULL, NULL); | 
 | 866 | 			if (ACPI_FAILURE(status)) { | 
 | 867 | 				warn("%s: _PS0 failed\n", __FUNCTION__); | 
 | 868 | 				retval = -1; | 
 | 869 | 				goto err_exit; | 
 | 870 | 			} else | 
 | 871 | 				break; | 
 | 872 | 		} | 
 | 873 | 	} | 
 | 874 |  | 
 | 875 | 	/* TBD: evaluate _STA to check if the slot is enabled */ | 
 | 876 |  | 
 | 877 | 	slot->flags |= SLOT_POWEREDON; | 
 | 878 |  | 
 | 879 |  err_exit: | 
 | 880 | 	return retval; | 
 | 881 | } | 
 | 882 |  | 
 | 883 |  | 
 | 884 | static int power_off_slot(struct acpiphp_slot *slot) | 
 | 885 | { | 
 | 886 | 	acpi_status status; | 
 | 887 | 	struct acpiphp_func *func; | 
 | 888 | 	struct list_head *l; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 889 |  | 
 | 890 | 	int retval = 0; | 
 | 891 |  | 
 | 892 | 	/* if already disabled, just skip */ | 
 | 893 | 	if ((slot->flags & SLOT_POWEREDON) == 0) | 
 | 894 | 		goto err_exit; | 
 | 895 |  | 
 | 896 | 	list_for_each (l, &slot->funcs) { | 
 | 897 | 		func = list_entry(l, struct acpiphp_func, sibling); | 
 | 898 |  | 
| Rajesh Shah | 2f523b1 | 2005-04-28 00:25:55 -0700 | [diff] [blame] | 899 | 		if (func->flags & FUNC_HAS_PS3) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 900 | 			status = acpi_evaluate_object(func->handle, "_PS3", NULL, NULL); | 
 | 901 | 			if (ACPI_FAILURE(status)) { | 
 | 902 | 				warn("%s: _PS3 failed\n", __FUNCTION__); | 
 | 903 | 				retval = -1; | 
 | 904 | 				goto err_exit; | 
 | 905 | 			} else | 
 | 906 | 				break; | 
 | 907 | 		} | 
 | 908 | 	} | 
 | 909 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 910 | 	/* TBD: evaluate _STA to check if the slot is disabled */ | 
 | 911 |  | 
 | 912 | 	slot->flags &= (~SLOT_POWEREDON); | 
 | 913 |  | 
 | 914 |  err_exit: | 
 | 915 | 	return retval; | 
 | 916 | } | 
 | 917 |  | 
 | 918 |  | 
| Kristen Accardi | 15a1ae7 | 2006-02-23 17:55:58 -0800 | [diff] [blame] | 919 |  | 
 | 920 | /** | 
 | 921 |  * acpiphp_max_busnr - return the highest reserved bus number under | 
 | 922 |  * the given bus. | 
 | 923 |  * @bus: bus to start search with | 
 | 924 |  * | 
 | 925 |  */ | 
 | 926 | static unsigned char acpiphp_max_busnr(struct pci_bus *bus) | 
 | 927 | { | 
 | 928 | 	struct list_head *tmp; | 
 | 929 | 	unsigned char max, n; | 
 | 930 |  | 
 | 931 | 	/* | 
 | 932 | 	 * pci_bus_max_busnr will return the highest | 
 | 933 | 	 * reserved busnr for all these children. | 
 | 934 | 	 * that is equivalent to the bus->subordinate | 
 | 935 | 	 * value.  We don't want to use the parent's | 
 | 936 | 	 * bus->subordinate value because it could have | 
 | 937 | 	 * padding in it. | 
 | 938 | 	 */ | 
 | 939 | 	max = bus->secondary; | 
 | 940 |  | 
 | 941 | 	list_for_each(tmp, &bus->children) { | 
 | 942 | 		n = pci_bus_max_busnr(pci_bus_b(tmp)); | 
 | 943 | 		if (n > max) | 
 | 944 | 			max = n; | 
 | 945 | 	} | 
 | 946 | 	return max; | 
 | 947 | } | 
 | 948 |  | 
 | 949 |  | 
| Kristen Accardi | 15a1ae7 | 2006-02-23 17:55:58 -0800 | [diff] [blame] | 950 | /** | 
 | 951 |  * acpiphp_bus_add - add a new bus to acpi subsystem | 
 | 952 |  * @func: acpiphp_func of the bridge | 
 | 953 |  * | 
 | 954 |  */ | 
 | 955 | static int acpiphp_bus_add(struct acpiphp_func *func) | 
 | 956 | { | 
 | 957 | 	acpi_handle phandle; | 
 | 958 | 	struct acpi_device *device, *pdevice; | 
 | 959 | 	int ret_val; | 
 | 960 |  | 
 | 961 | 	acpi_get_parent(func->handle, &phandle); | 
 | 962 | 	if (acpi_bus_get_device(phandle, &pdevice)) { | 
 | 963 | 		dbg("no parent device, assuming NULL\n"); | 
 | 964 | 		pdevice = NULL; | 
 | 965 | 	} | 
| Kristen Accardi | 20416ea | 2006-02-23 17:56:03 -0800 | [diff] [blame] | 966 | 	if (!acpi_bus_get_device(func->handle, &device)) { | 
 | 967 | 		dbg("bus exists... trim\n"); | 
 | 968 | 		/* this shouldn't be in here, so remove | 
 | 969 | 		 * the bus then re-add it... | 
 | 970 | 		 */ | 
 | 971 | 		ret_val = acpi_bus_trim(device, 1); | 
 | 972 | 		dbg("acpi_bus_trim return %x\n", ret_val); | 
 | 973 | 	} | 
 | 974 |  | 
 | 975 | 	ret_val = acpi_bus_add(&device, pdevice, func->handle, | 
 | 976 | 		ACPI_BUS_TYPE_DEVICE); | 
 | 977 | 	if (ret_val) { | 
 | 978 | 		dbg("error adding bus, %x\n", | 
 | 979 | 			-ret_val); | 
 | 980 | 		goto acpiphp_bus_add_out; | 
| Kristen Accardi | 15a1ae7 | 2006-02-23 17:55:58 -0800 | [diff] [blame] | 981 | 	} | 
 | 982 | 	/* | 
 | 983 | 	 * try to start anyway.  We could have failed to add | 
 | 984 | 	 * simply because this bus had previously been added | 
 | 985 | 	 * on another add.  Don't bother with the return value | 
 | 986 | 	 * we just keep going. | 
 | 987 | 	 */ | 
 | 988 | 	ret_val = acpi_bus_start(device); | 
 | 989 |  | 
 | 990 | acpiphp_bus_add_out: | 
 | 991 | 	return ret_val; | 
 | 992 | } | 
 | 993 |  | 
 | 994 |  | 
| MUNEDA Takahiro | 92c9be9 | 2006-03-22 14:49:09 +0900 | [diff] [blame] | 995 | /** | 
 | 996 |  * acpiphp_bus_trim - trim a bus from acpi subsystem | 
 | 997 |  * @handle: handle to acpi namespace | 
 | 998 |  * | 
 | 999 |  */ | 
 | 1000 | int acpiphp_bus_trim(acpi_handle handle) | 
 | 1001 | { | 
 | 1002 | 	struct acpi_device *device; | 
 | 1003 | 	int retval; | 
 | 1004 |  | 
 | 1005 | 	retval = acpi_bus_get_device(handle, &device); | 
 | 1006 | 	if (retval) { | 
 | 1007 | 		dbg("acpi_device not found\n"); | 
 | 1008 | 		return retval; | 
 | 1009 | 	} | 
 | 1010 |  | 
 | 1011 | 	retval = acpi_bus_trim(device, 1); | 
 | 1012 | 	if (retval) | 
 | 1013 | 		err("cannot remove from acpi list\n"); | 
 | 1014 |  | 
 | 1015 | 	return retval; | 
 | 1016 | } | 
| Kristen Accardi | 15a1ae7 | 2006-02-23 17:55:58 -0800 | [diff] [blame] | 1017 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1018 | /** | 
 | 1019 |  * enable_device - enable, configure a slot | 
 | 1020 |  * @slot: slot to be enabled | 
 | 1021 |  * | 
 | 1022 |  * This function should be called per *physical slot*, | 
 | 1023 |  * not per each slot object in ACPI namespace. | 
 | 1024 |  * | 
 | 1025 |  */ | 
 | 1026 | static int enable_device(struct acpiphp_slot *slot) | 
 | 1027 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1028 | 	struct pci_dev *dev; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1029 | 	struct pci_bus *bus = slot->bridge->pci_bus; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1030 | 	struct list_head *l; | 
 | 1031 | 	struct acpiphp_func *func; | 
 | 1032 | 	int retval = 0; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1033 | 	int num, max, pass; | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 1034 | 	acpi_status status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1035 |  | 
 | 1036 | 	if (slot->flags & SLOT_ENABLED) | 
 | 1037 | 		goto err_exit; | 
 | 1038 |  | 
 | 1039 | 	/* sanity check: dev should be NULL when hot-plugged in */ | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1040 | 	dev = pci_get_slot(bus, PCI_DEVFN(slot->device, 0)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1041 | 	if (dev) { | 
 | 1042 | 		/* This case shouldn't happen */ | 
 | 1043 | 		err("pci_dev structure already exists.\n"); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1044 | 		pci_dev_put(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1045 | 		retval = -1; | 
 | 1046 | 		goto err_exit; | 
 | 1047 | 	} | 
 | 1048 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1049 | 	num = pci_scan_slot(bus, PCI_DEVFN(slot->device, 0)); | 
 | 1050 | 	if (num == 0) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1051 | 		err("No new device found\n"); | 
 | 1052 | 		retval = -1; | 
 | 1053 | 		goto err_exit; | 
 | 1054 | 	} | 
 | 1055 |  | 
| Kristen Accardi | 15a1ae7 | 2006-02-23 17:55:58 -0800 | [diff] [blame] | 1056 | 	max = acpiphp_max_busnr(bus); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1057 | 	for (pass = 0; pass < 2; pass++) { | 
 | 1058 | 		list_for_each_entry(dev, &bus->devices, bus_list) { | 
 | 1059 | 			if (PCI_SLOT(dev->devfn) != slot->device) | 
 | 1060 | 				continue; | 
 | 1061 | 			if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE || | 
| Kristen Accardi | c64b5ee | 2005-12-14 09:37:26 -0800 | [diff] [blame] | 1062 | 			    dev->hdr_type == PCI_HEADER_TYPE_CARDBUS) { | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1063 | 				max = pci_scan_bridge(bus, dev, max, pass); | 
| MUNEDA Takahiro | 92c9be9 | 2006-03-22 14:49:09 +0900 | [diff] [blame] | 1064 | 				if (pass && dev->subordinate) | 
| Kristen Accardi | c64b5ee | 2005-12-14 09:37:26 -0800 | [diff] [blame] | 1065 | 					pci_bus_size_bridges(dev->subordinate); | 
 | 1066 | 			} | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1067 | 		} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1068 | 	} | 
 | 1069 |  | 
| MUNEDA Takahiro | 92c9be9 | 2006-03-22 14:49:09 +0900 | [diff] [blame] | 1070 | 	list_for_each (l, &slot->funcs) { | 
 | 1071 | 		func = list_entry(l, struct acpiphp_func, sibling); | 
 | 1072 | 		acpiphp_bus_add(func); | 
 | 1073 | 	} | 
 | 1074 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1075 | 	pci_bus_assign_resources(bus); | 
| Kristen Accardi | 8e5dce3 | 2005-10-18 17:21:40 -0700 | [diff] [blame] | 1076 | 	acpiphp_sanitize_bus(bus); | 
 | 1077 | 	pci_enable_bridges(bus); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1078 | 	pci_bus_add_devices(bus); | 
| MUNEDA Takahiro | 0cccd0c | 2006-02-24 17:46:04 +0900 | [diff] [blame] | 1079 | 	acpiphp_set_hpp_values(slot->bridge->handle, bus); | 
 | 1080 | 	acpiphp_configure_ioapics(slot->bridge->handle); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1081 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1082 | 	/* associate pci_dev to our representation */ | 
 | 1083 | 	list_for_each (l, &slot->funcs) { | 
 | 1084 | 		func = list_entry(l, struct acpiphp_func, sibling); | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1085 | 		func->pci_dev = pci_get_slot(bus, PCI_DEVFN(slot->device, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1086 | 							func->function)); | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 1087 | 		if (!func->pci_dev) | 
 | 1088 | 			continue; | 
 | 1089 |  | 
 | 1090 | 		if (func->pci_dev->hdr_type != PCI_HEADER_TYPE_BRIDGE && | 
 | 1091 | 		    func->pci_dev->hdr_type != PCI_HEADER_TYPE_CARDBUS) | 
 | 1092 | 			continue; | 
 | 1093 |  | 
 | 1094 | 		status = find_p2p_bridge(func->handle, (u32)1, bus, NULL); | 
 | 1095 | 		if (ACPI_FAILURE(status)) | 
 | 1096 | 			warn("find_p2p_bridge failed (error code = 0x%x)\n", | 
 | 1097 | 				status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1098 | 	} | 
 | 1099 |  | 
 | 1100 | 	slot->flags |= SLOT_ENABLED; | 
 | 1101 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1102 |  err_exit: | 
 | 1103 | 	return retval; | 
 | 1104 | } | 
 | 1105 |  | 
 | 1106 |  | 
 | 1107 | /** | 
 | 1108 |  * disable_device - disable a slot | 
 | 1109 |  */ | 
 | 1110 | static int disable_device(struct acpiphp_slot *slot) | 
 | 1111 | { | 
 | 1112 | 	int retval = 0; | 
 | 1113 | 	struct acpiphp_func *func; | 
 | 1114 | 	struct list_head *l; | 
 | 1115 |  | 
 | 1116 | 	/* is this slot already disabled? */ | 
 | 1117 | 	if (!(slot->flags & SLOT_ENABLED)) | 
 | 1118 | 		goto err_exit; | 
 | 1119 |  | 
 | 1120 | 	list_for_each (l, &slot->funcs) { | 
 | 1121 | 		func = list_entry(l, struct acpiphp_func, sibling); | 
| MUNEDA Takahiro | 92c9be9 | 2006-03-22 14:49:09 +0900 | [diff] [blame] | 1122 |  | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 1123 | 		if (func->bridge) { | 
 | 1124 | 			/* cleanup p2p bridges under this P2P bridge */ | 
 | 1125 | 			cleanup_p2p_bridge(func->bridge->handle, | 
 | 1126 | 						(u32)1, NULL, NULL); | 
 | 1127 | 			func->bridge = NULL; | 
 | 1128 | 		} | 
 | 1129 |  | 
| MUNEDA Takahiro | 92c9be9 | 2006-03-22 14:49:09 +0900 | [diff] [blame] | 1130 | 		acpiphp_bus_trim(func->handle); | 
 | 1131 | 		/* try to remove anyway. | 
 | 1132 | 		 * acpiphp_bus_add might have been failed */ | 
 | 1133 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1134 | 		if (!func->pci_dev) | 
 | 1135 | 			continue; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1136 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1137 | 		pci_remove_bus_device(func->pci_dev); | 
 | 1138 | 		pci_dev_put(func->pci_dev); | 
 | 1139 | 		func->pci_dev = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1140 | 	} | 
 | 1141 |  | 
 | 1142 | 	slot->flags &= (~SLOT_ENABLED); | 
 | 1143 |  | 
 | 1144 |  err_exit: | 
 | 1145 | 	return retval; | 
 | 1146 | } | 
 | 1147 |  | 
 | 1148 |  | 
 | 1149 | /** | 
 | 1150 |  * get_slot_status - get ACPI slot status | 
 | 1151 |  * | 
 | 1152 |  * if a slot has _STA for each function and if any one of them | 
 | 1153 |  * returned non-zero status, return it | 
 | 1154 |  * | 
 | 1155 |  * if a slot doesn't have _STA and if any one of its functions' | 
 | 1156 |  * configuration space is configured, return 0x0f as a _STA | 
 | 1157 |  * | 
 | 1158 |  * otherwise return 0 | 
 | 1159 |  */ | 
 | 1160 | static unsigned int get_slot_status(struct acpiphp_slot *slot) | 
 | 1161 | { | 
 | 1162 | 	acpi_status status; | 
 | 1163 | 	unsigned long sta = 0; | 
 | 1164 | 	u32 dvid; | 
 | 1165 | 	struct list_head *l; | 
 | 1166 | 	struct acpiphp_func *func; | 
 | 1167 |  | 
 | 1168 | 	list_for_each (l, &slot->funcs) { | 
 | 1169 | 		func = list_entry(l, struct acpiphp_func, sibling); | 
 | 1170 |  | 
 | 1171 | 		if (func->flags & FUNC_HAS_STA) { | 
 | 1172 | 			status = acpi_evaluate_integer(func->handle, "_STA", NULL, &sta); | 
 | 1173 | 			if (ACPI_SUCCESS(status) && sta) | 
 | 1174 | 				break; | 
 | 1175 | 		} else { | 
 | 1176 | 			pci_bus_read_config_dword(slot->bridge->pci_bus, | 
 | 1177 | 						  PCI_DEVFN(slot->device, | 
 | 1178 | 							    func->function), | 
 | 1179 | 						  PCI_VENDOR_ID, &dvid); | 
 | 1180 | 			if (dvid != 0xffffffff) { | 
 | 1181 | 				sta = ACPI_STA_ALL; | 
 | 1182 | 				break; | 
 | 1183 | 			} | 
 | 1184 | 		} | 
 | 1185 | 	} | 
 | 1186 |  | 
 | 1187 | 	return (unsigned int)sta; | 
 | 1188 | } | 
 | 1189 |  | 
 | 1190 | /** | 
| Rajesh Shah | 8d50e33 | 2005-04-28 00:25:57 -0700 | [diff] [blame] | 1191 |  * acpiphp_eject_slot - physically eject the slot | 
 | 1192 |  */ | 
 | 1193 | static int acpiphp_eject_slot(struct acpiphp_slot *slot) | 
 | 1194 | { | 
 | 1195 | 	acpi_status status; | 
 | 1196 | 	struct acpiphp_func *func; | 
 | 1197 | 	struct list_head *l; | 
 | 1198 | 	struct acpi_object_list arg_list; | 
 | 1199 | 	union acpi_object arg; | 
 | 1200 |  | 
 | 1201 | 	list_for_each (l, &slot->funcs) { | 
 | 1202 | 		func = list_entry(l, struct acpiphp_func, sibling); | 
 | 1203 |  | 
 | 1204 | 		/* We don't want to call _EJ0 on non-existing functions. */ | 
 | 1205 | 		if ((func->flags & FUNC_HAS_EJ0)) { | 
 | 1206 | 			/* _EJ0 method take one argument */ | 
 | 1207 | 			arg_list.count = 1; | 
 | 1208 | 			arg_list.pointer = &arg; | 
 | 1209 | 			arg.type = ACPI_TYPE_INTEGER; | 
 | 1210 | 			arg.integer.value = 1; | 
 | 1211 |  | 
 | 1212 | 			status = acpi_evaluate_object(func->handle, "_EJ0", &arg_list, NULL); | 
 | 1213 | 			if (ACPI_FAILURE(status)) { | 
 | 1214 | 				warn("%s: _EJ0 failed\n", __FUNCTION__); | 
 | 1215 | 				return -1; | 
 | 1216 | 			} else | 
 | 1217 | 				break; | 
 | 1218 | 		} | 
 | 1219 | 	} | 
 | 1220 | 	return 0; | 
 | 1221 | } | 
 | 1222 |  | 
 | 1223 | /** | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1224 |  * acpiphp_check_bridge - re-enumerate devices | 
 | 1225 |  * | 
 | 1226 |  * Iterate over all slots under this bridge and make sure that if a | 
 | 1227 |  * card is present they are enabled, and if not they are disabled. | 
 | 1228 |  */ | 
 | 1229 | static int acpiphp_check_bridge(struct acpiphp_bridge *bridge) | 
 | 1230 | { | 
 | 1231 | 	struct acpiphp_slot *slot; | 
 | 1232 | 	int retval = 0; | 
 | 1233 | 	int enabled, disabled; | 
 | 1234 |  | 
 | 1235 | 	enabled = disabled = 0; | 
 | 1236 |  | 
 | 1237 | 	for (slot = bridge->slots; slot; slot = slot->next) { | 
 | 1238 | 		unsigned int status = get_slot_status(slot); | 
 | 1239 | 		if (slot->flags & SLOT_ENABLED) { | 
 | 1240 | 			if (status == ACPI_STA_ALL) | 
 | 1241 | 				continue; | 
 | 1242 | 			retval = acpiphp_disable_slot(slot); | 
 | 1243 | 			if (retval) { | 
 | 1244 | 				err("Error occurred in disabling\n"); | 
 | 1245 | 				goto err_exit; | 
| Rajesh Shah | 8d50e33 | 2005-04-28 00:25:57 -0700 | [diff] [blame] | 1246 | 			} else { | 
 | 1247 | 				acpiphp_eject_slot(slot); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1248 | 			} | 
 | 1249 | 			disabled++; | 
 | 1250 | 		} else { | 
 | 1251 | 			if (status != ACPI_STA_ALL) | 
 | 1252 | 				continue; | 
 | 1253 | 			retval = acpiphp_enable_slot(slot); | 
 | 1254 | 			if (retval) { | 
 | 1255 | 				err("Error occurred in enabling\n"); | 
 | 1256 | 				goto err_exit; | 
 | 1257 | 			} | 
 | 1258 | 			enabled++; | 
 | 1259 | 		} | 
 | 1260 | 	} | 
 | 1261 |  | 
 | 1262 | 	dbg("%s: %d enabled, %d disabled\n", __FUNCTION__, enabled, disabled); | 
 | 1263 |  | 
 | 1264 |  err_exit: | 
 | 1265 | 	return retval; | 
 | 1266 | } | 
 | 1267 |  | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1268 | static void program_hpp(struct pci_dev *dev, struct acpiphp_bridge *bridge) | 
 | 1269 | { | 
 | 1270 | 	u16 pci_cmd, pci_bctl; | 
 | 1271 | 	struct pci_dev *cdev; | 
 | 1272 |  | 
 | 1273 | 	/* Program hpp values for this device */ | 
 | 1274 | 	if (!(dev->hdr_type == PCI_HEADER_TYPE_NORMAL || | 
 | 1275 | 			(dev->hdr_type == PCI_HEADER_TYPE_BRIDGE && | 
 | 1276 | 			(dev->class >> 8) == PCI_CLASS_BRIDGE_PCI))) | 
 | 1277 | 		return; | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 1278 |  | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1279 | 	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 1280 | 			bridge->hpp.t0->cache_line_size); | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1281 | 	pci_write_config_byte(dev, PCI_LATENCY_TIMER, | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 1282 | 			bridge->hpp.t0->latency_timer); | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1283 | 	pci_read_config_word(dev, PCI_COMMAND, &pci_cmd); | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 1284 | 	if (bridge->hpp.t0->enable_serr) | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1285 | 		pci_cmd |= PCI_COMMAND_SERR; | 
 | 1286 | 	else | 
 | 1287 | 		pci_cmd &= ~PCI_COMMAND_SERR; | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 1288 | 	if (bridge->hpp.t0->enable_perr) | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1289 | 		pci_cmd |= PCI_COMMAND_PARITY; | 
 | 1290 | 	else | 
 | 1291 | 		pci_cmd &= ~PCI_COMMAND_PARITY; | 
 | 1292 | 	pci_write_config_word(dev, PCI_COMMAND, pci_cmd); | 
 | 1293 |  | 
 | 1294 | 	/* Program bridge control value and child devices */ | 
 | 1295 | 	if ((dev->class >> 8) == PCI_CLASS_BRIDGE_PCI) { | 
 | 1296 | 		pci_write_config_byte(dev, PCI_SEC_LATENCY_TIMER, | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 1297 | 				bridge->hpp.t0->latency_timer); | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1298 | 		pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &pci_bctl); | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 1299 | 		if (bridge->hpp.t0->enable_serr) | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1300 | 			pci_bctl |= PCI_BRIDGE_CTL_SERR; | 
 | 1301 | 		else | 
 | 1302 | 			pci_bctl &= ~PCI_BRIDGE_CTL_SERR; | 
| Kenji Kaneshige | e22b7350 | 2006-05-02 10:57:14 +0900 | [diff] [blame] | 1303 | 		if (bridge->hpp.t0->enable_perr) | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1304 | 			pci_bctl |= PCI_BRIDGE_CTL_PARITY; | 
 | 1305 | 		else | 
 | 1306 | 			pci_bctl &= ~PCI_BRIDGE_CTL_PARITY; | 
 | 1307 | 		pci_write_config_word(dev, PCI_BRIDGE_CONTROL, pci_bctl); | 
 | 1308 | 		if (dev->subordinate) { | 
 | 1309 | 			list_for_each_entry(cdev, &dev->subordinate->devices, | 
 | 1310 | 					bus_list) | 
 | 1311 | 				program_hpp(cdev, bridge); | 
 | 1312 | 		} | 
 | 1313 | 	} | 
 | 1314 | } | 
 | 1315 |  | 
 | 1316 | static void acpiphp_set_hpp_values(acpi_handle handle, struct pci_bus *bus) | 
 | 1317 | { | 
 | 1318 | 	struct acpiphp_bridge bridge; | 
 | 1319 | 	struct pci_dev *dev; | 
 | 1320 |  | 
 | 1321 | 	memset(&bridge, 0, sizeof(bridge)); | 
 | 1322 | 	bridge.handle = handle; | 
| Kenji Kaneshige | 7430e34 | 2006-05-02 10:54:50 +0900 | [diff] [blame] | 1323 | 	bridge.pci_bus = bus; | 
| Kristen Accardi | 783c49f | 2006-03-03 10:16:05 -0800 | [diff] [blame] | 1324 | 	bridge.pci_dev = bus->self; | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1325 | 	decode_hpp(&bridge); | 
 | 1326 | 	list_for_each_entry(dev, &bus->devices, bus_list) | 
 | 1327 | 		program_hpp(dev, &bridge); | 
 | 1328 |  | 
 | 1329 | } | 
 | 1330 |  | 
 | 1331 | /* | 
 | 1332 |  * Remove devices for which we could not assign resources, call | 
 | 1333 |  * arch specific code to fix-up the bus | 
 | 1334 |  */ | 
 | 1335 | static void acpiphp_sanitize_bus(struct pci_bus *bus) | 
 | 1336 | { | 
 | 1337 | 	struct pci_dev *dev; | 
 | 1338 | 	int i; | 
 | 1339 | 	unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM; | 
 | 1340 |  | 
 | 1341 | 	list_for_each_entry(dev, &bus->devices, bus_list) { | 
 | 1342 | 		for (i=0; i<PCI_BRIDGE_RESOURCES; i++) { | 
 | 1343 | 			struct resource *res = &dev->resource[i]; | 
 | 1344 | 			if ((res->flags & type_mask) && !res->start && | 
 | 1345 | 					res->end) { | 
 | 1346 | 				/* Could not assign a required resources | 
 | 1347 | 				 * for this device, remove it */ | 
 | 1348 | 				pci_remove_bus_device(dev); | 
 | 1349 | 				break; | 
 | 1350 | 			} | 
 | 1351 | 		} | 
 | 1352 | 	} | 
 | 1353 | } | 
 | 1354 |  | 
 | 1355 | /* Program resources in newly inserted bridge */ | 
 | 1356 | static int acpiphp_configure_bridge (acpi_handle handle) | 
 | 1357 | { | 
 | 1358 | 	struct acpi_pci_id pci_id; | 
 | 1359 | 	struct pci_bus *bus; | 
 | 1360 |  | 
 | 1361 | 	if (ACPI_FAILURE(acpi_get_pci_id(handle, &pci_id))) { | 
 | 1362 | 		err("cannot get PCI domain and bus number for bridge\n"); | 
 | 1363 | 		return -EINVAL; | 
 | 1364 | 	} | 
 | 1365 | 	bus = pci_find_bus(pci_id.segment, pci_id.bus); | 
 | 1366 | 	if (!bus) { | 
 | 1367 | 		err("cannot find bus %d:%d\n", | 
 | 1368 | 				pci_id.segment, pci_id.bus); | 
 | 1369 | 		return -EINVAL; | 
 | 1370 | 	} | 
 | 1371 |  | 
 | 1372 | 	pci_bus_size_bridges(bus); | 
 | 1373 | 	pci_bus_assign_resources(bus); | 
 | 1374 | 	acpiphp_sanitize_bus(bus); | 
 | 1375 | 	acpiphp_set_hpp_values(handle, bus); | 
 | 1376 | 	pci_enable_bridges(bus); | 
| Kenji Kaneshige | a0d399a | 2005-04-28 00:25:59 -0700 | [diff] [blame] | 1377 | 	acpiphp_configure_ioapics(handle); | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1378 | 	return 0; | 
 | 1379 | } | 
 | 1380 |  | 
 | 1381 | static void handle_bridge_insertion(acpi_handle handle, u32 type) | 
 | 1382 | { | 
 | 1383 | 	struct acpi_device *device, *pdevice; | 
 | 1384 | 	acpi_handle phandle; | 
 | 1385 |  | 
 | 1386 | 	if ((type != ACPI_NOTIFY_BUS_CHECK) && | 
 | 1387 | 			(type != ACPI_NOTIFY_DEVICE_CHECK)) { | 
 | 1388 | 		err("unexpected notification type %d\n", type); | 
 | 1389 | 		return; | 
 | 1390 | 	} | 
 | 1391 |  | 
 | 1392 | 	acpi_get_parent(handle, &phandle); | 
 | 1393 | 	if (acpi_bus_get_device(phandle, &pdevice)) { | 
 | 1394 | 		dbg("no parent device, assuming NULL\n"); | 
 | 1395 | 		pdevice = NULL; | 
 | 1396 | 	} | 
 | 1397 | 	if (acpi_bus_add(&device, pdevice, handle, ACPI_BUS_TYPE_DEVICE)) { | 
 | 1398 | 		err("cannot add bridge to acpi list\n"); | 
 | 1399 | 		return; | 
 | 1400 | 	} | 
 | 1401 | 	if (!acpiphp_configure_bridge(handle) && | 
 | 1402 | 		!acpi_bus_start(device)) | 
 | 1403 | 		add_bridge(handle); | 
 | 1404 | 	else | 
 | 1405 | 		err("cannot configure and start bridge\n"); | 
 | 1406 |  | 
 | 1407 | } | 
 | 1408 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1409 | /* | 
 | 1410 |  * ACPI event handlers | 
 | 1411 |  */ | 
 | 1412 |  | 
 | 1413 | /** | 
 | 1414 |  * handle_hotplug_event_bridge - handle ACPI event on bridges | 
 | 1415 |  * | 
 | 1416 |  * @handle: Notify()'ed acpi_handle | 
 | 1417 |  * @type: Notify code | 
 | 1418 |  * @context: pointer to acpiphp_bridge structure | 
 | 1419 |  * | 
 | 1420 |  * handles ACPI event notification on {host,p2p} bridges | 
 | 1421 |  * | 
 | 1422 |  */ | 
 | 1423 | static void handle_hotplug_event_bridge(acpi_handle handle, u32 type, void *context) | 
 | 1424 | { | 
 | 1425 | 	struct acpiphp_bridge *bridge; | 
 | 1426 | 	char objname[64]; | 
 | 1427 | 	struct acpi_buffer buffer = { .length = sizeof(objname), | 
 | 1428 | 				      .pointer = objname }; | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1429 | 	struct acpi_device *device; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1430 |  | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1431 | 	if (acpi_bus_get_device(handle, &device)) { | 
 | 1432 | 		/* This bridge must have just been physically inserted */ | 
 | 1433 | 		handle_bridge_insertion(handle, type); | 
 | 1434 | 		return; | 
 | 1435 | 	} | 
 | 1436 |  | 
 | 1437 | 	bridge = acpiphp_handle_to_bridge(handle); | 
 | 1438 | 	if (!bridge) { | 
 | 1439 | 		err("cannot get bridge info\n"); | 
 | 1440 | 		return; | 
 | 1441 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1442 |  | 
 | 1443 | 	acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer); | 
 | 1444 |  | 
 | 1445 | 	switch (type) { | 
 | 1446 | 	case ACPI_NOTIFY_BUS_CHECK: | 
 | 1447 | 		/* bus re-enumerate */ | 
 | 1448 | 		dbg("%s: Bus check notify on %s\n", __FUNCTION__, objname); | 
 | 1449 | 		acpiphp_check_bridge(bridge); | 
 | 1450 | 		break; | 
 | 1451 |  | 
 | 1452 | 	case ACPI_NOTIFY_DEVICE_CHECK: | 
 | 1453 | 		/* device check */ | 
 | 1454 | 		dbg("%s: Device check notify on %s\n", __FUNCTION__, objname); | 
 | 1455 | 		acpiphp_check_bridge(bridge); | 
 | 1456 | 		break; | 
 | 1457 |  | 
 | 1458 | 	case ACPI_NOTIFY_DEVICE_WAKE: | 
 | 1459 | 		/* wake event */ | 
 | 1460 | 		dbg("%s: Device wake notify on %s\n", __FUNCTION__, objname); | 
 | 1461 | 		break; | 
 | 1462 |  | 
 | 1463 | 	case ACPI_NOTIFY_EJECT_REQUEST: | 
 | 1464 | 		/* request device eject */ | 
 | 1465 | 		dbg("%s: Device eject notify on %s\n", __FUNCTION__, objname); | 
| MUNEDA Takahiro | 551bcb7 | 2006-03-22 14:49:20 +0900 | [diff] [blame] | 1466 | 		if ((bridge->type != BRIDGE_TYPE_HOST) && | 
 | 1467 | 		    (bridge->flags & BRIDGE_HAS_EJ0)) { | 
 | 1468 | 			struct acpiphp_slot *slot; | 
 | 1469 | 			slot = bridge->func->slot; | 
 | 1470 | 			if (!acpiphp_disable_slot(slot)) | 
 | 1471 | 				acpiphp_eject_slot(slot); | 
 | 1472 | 		} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1473 | 		break; | 
 | 1474 |  | 
 | 1475 | 	case ACPI_NOTIFY_FREQUENCY_MISMATCH: | 
 | 1476 | 		printk(KERN_ERR "Device %s cannot be configured due" | 
 | 1477 | 				" to a frequency mismatch\n", objname); | 
 | 1478 | 		break; | 
 | 1479 |  | 
 | 1480 | 	case ACPI_NOTIFY_BUS_MODE_MISMATCH: | 
 | 1481 | 		printk(KERN_ERR "Device %s cannot be configured due" | 
 | 1482 | 				" to a bus mode mismatch\n", objname); | 
 | 1483 | 		break; | 
 | 1484 |  | 
 | 1485 | 	case ACPI_NOTIFY_POWER_FAULT: | 
 | 1486 | 		printk(KERN_ERR "Device %s has suffered a power fault\n", | 
 | 1487 | 				objname); | 
 | 1488 | 		break; | 
 | 1489 |  | 
 | 1490 | 	default: | 
 | 1491 | 		warn("notify_handler: unknown event type 0x%x for %s\n", type, objname); | 
 | 1492 | 		break; | 
 | 1493 | 	} | 
 | 1494 | } | 
 | 1495 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1496 | /** | 
 | 1497 |  * handle_hotplug_event_func - handle ACPI event on functions (i.e. slots) | 
 | 1498 |  * | 
 | 1499 |  * @handle: Notify()'ed acpi_handle | 
 | 1500 |  * @type: Notify code | 
 | 1501 |  * @context: pointer to acpiphp_func structure | 
 | 1502 |  * | 
 | 1503 |  * handles ACPI event notification on slots | 
 | 1504 |  * | 
 | 1505 |  */ | 
| Len Brown | 2b85e13 | 2006-06-27 01:50:14 -0400 | [diff] [blame] | 1506 | static void handle_hotplug_event_func(acpi_handle handle, u32 type, void *context) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1507 | { | 
 | 1508 | 	struct acpiphp_func *func; | 
 | 1509 | 	char objname[64]; | 
 | 1510 | 	struct acpi_buffer buffer = { .length = sizeof(objname), | 
 | 1511 | 				      .pointer = objname }; | 
 | 1512 |  | 
 | 1513 | 	acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer); | 
 | 1514 |  | 
 | 1515 | 	func = (struct acpiphp_func *)context; | 
 | 1516 |  | 
 | 1517 | 	switch (type) { | 
 | 1518 | 	case ACPI_NOTIFY_BUS_CHECK: | 
 | 1519 | 		/* bus re-enumerate */ | 
 | 1520 | 		dbg("%s: Bus check notify on %s\n", __FUNCTION__, objname); | 
 | 1521 | 		acpiphp_enable_slot(func->slot); | 
 | 1522 | 		break; | 
 | 1523 |  | 
 | 1524 | 	case ACPI_NOTIFY_DEVICE_CHECK: | 
 | 1525 | 		/* device check : re-enumerate from parent bus */ | 
 | 1526 | 		dbg("%s: Device check notify on %s\n", __FUNCTION__, objname); | 
 | 1527 | 		acpiphp_check_bridge(func->slot->bridge); | 
 | 1528 | 		break; | 
 | 1529 |  | 
 | 1530 | 	case ACPI_NOTIFY_DEVICE_WAKE: | 
 | 1531 | 		/* wake event */ | 
 | 1532 | 		dbg("%s: Device wake notify on %s\n", __FUNCTION__, objname); | 
 | 1533 | 		break; | 
 | 1534 |  | 
 | 1535 | 	case ACPI_NOTIFY_EJECT_REQUEST: | 
 | 1536 | 		/* request device eject */ | 
 | 1537 | 		dbg("%s: Device eject notify on %s\n", __FUNCTION__, objname); | 
| Rajesh Shah | 8d50e33 | 2005-04-28 00:25:57 -0700 | [diff] [blame] | 1538 | 		if (!(acpiphp_disable_slot(func->slot))) | 
 | 1539 | 			acpiphp_eject_slot(func->slot); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1540 | 		break; | 
 | 1541 |  | 
 | 1542 | 	default: | 
 | 1543 | 		warn("notify_handler: unknown event type 0x%x for %s\n", type, objname); | 
 | 1544 | 		break; | 
 | 1545 | 	} | 
 | 1546 | } | 
 | 1547 |  | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1548 |  | 
 | 1549 | static acpi_status | 
 | 1550 | find_root_bridges(acpi_handle handle, u32 lvl, void *context, void **rv) | 
 | 1551 | { | 
 | 1552 | 	int *count = (int *)context; | 
 | 1553 |  | 
| Kristen Accardi | 783c49f | 2006-03-03 10:16:05 -0800 | [diff] [blame] | 1554 | 	if (acpi_root_bridge(handle)) { | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1555 | 		acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, | 
 | 1556 | 				handle_hotplug_event_bridge, NULL); | 
 | 1557 | 			(*count)++; | 
 | 1558 | 	} | 
 | 1559 | 	return AE_OK ; | 
 | 1560 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1561 |  | 
 | 1562 | static struct acpi_pci_driver acpi_pci_hp_driver = { | 
 | 1563 | 	.add =		add_bridge, | 
 | 1564 | 	.remove =	remove_bridge, | 
 | 1565 | }; | 
 | 1566 |  | 
 | 1567 | /** | 
 | 1568 |  * acpiphp_glue_init - initializes all PCI hotplug - ACPI glue data structures | 
 | 1569 |  * | 
 | 1570 |  */ | 
 | 1571 | int __init acpiphp_glue_init(void) | 
 | 1572 | { | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1573 | 	int num = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1574 |  | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1575 | 	acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT, | 
 | 1576 | 			ACPI_UINT32_MAX, find_root_bridges, &num, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1577 |  | 
 | 1578 | 	if (num <= 0) | 
 | 1579 | 		return -1; | 
| Rajesh Shah | 8e7561c | 2005-04-28 00:25:56 -0700 | [diff] [blame] | 1580 | 	else | 
 | 1581 | 		acpi_pci_register_driver(&acpi_pci_hp_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1582 |  | 
 | 1583 | 	return 0; | 
 | 1584 | } | 
 | 1585 |  | 
 | 1586 |  | 
 | 1587 | /** | 
 | 1588 |  * acpiphp_glue_exit - terminates all PCI hotplug - ACPI glue data structures | 
 | 1589 |  * | 
 | 1590 |  * This function frees all data allocated in acpiphp_glue_init() | 
 | 1591 |  */ | 
 | 1592 | void __exit acpiphp_glue_exit(void) | 
 | 1593 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1594 | 	acpi_pci_unregister_driver(&acpi_pci_hp_driver); | 
 | 1595 | } | 
 | 1596 |  | 
 | 1597 |  | 
 | 1598 | /** | 
 | 1599 |  * acpiphp_get_num_slots - count number of slots in a system | 
 | 1600 |  */ | 
 | 1601 | int __init acpiphp_get_num_slots(void) | 
 | 1602 | { | 
 | 1603 | 	struct list_head *node; | 
 | 1604 | 	struct acpiphp_bridge *bridge; | 
 | 1605 | 	int num_slots; | 
 | 1606 |  | 
 | 1607 | 	num_slots = 0; | 
 | 1608 |  | 
 | 1609 | 	list_for_each (node, &bridge_list) { | 
 | 1610 | 		bridge = (struct acpiphp_bridge *)node; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1611 | 		dbg("Bus %04x:%02x has %d slot%s\n", | 
 | 1612 | 				pci_domain_nr(bridge->pci_bus), | 
 | 1613 | 				bridge->pci_bus->number, bridge->nr_slots, | 
 | 1614 | 				bridge->nr_slots == 1 ? "" : "s"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1615 | 		num_slots += bridge->nr_slots; | 
 | 1616 | 	} | 
 | 1617 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1618 | 	dbg("Total %d slots\n", num_slots); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1619 | 	return num_slots; | 
 | 1620 | } | 
 | 1621 |  | 
 | 1622 |  | 
 | 1623 | #if 0 | 
 | 1624 | /** | 
 | 1625 |  * acpiphp_for_each_slot - call function for each slot | 
 | 1626 |  * @fn: callback function | 
 | 1627 |  * @data: context to be passed to callback function | 
 | 1628 |  * | 
 | 1629 |  */ | 
 | 1630 | static int acpiphp_for_each_slot(acpiphp_callback fn, void *data) | 
 | 1631 | { | 
 | 1632 | 	struct list_head *node; | 
 | 1633 | 	struct acpiphp_bridge *bridge; | 
 | 1634 | 	struct acpiphp_slot *slot; | 
 | 1635 | 	int retval = 0; | 
 | 1636 |  | 
 | 1637 | 	list_for_each (node, &bridge_list) { | 
 | 1638 | 		bridge = (struct acpiphp_bridge *)node; | 
 | 1639 | 		for (slot = bridge->slots; slot; slot = slot->next) { | 
 | 1640 | 			retval = fn(slot, data); | 
 | 1641 | 			if (!retval) | 
 | 1642 | 				goto err_exit; | 
 | 1643 | 		} | 
 | 1644 | 	} | 
 | 1645 |  | 
 | 1646 |  err_exit: | 
 | 1647 | 	return retval; | 
 | 1648 | } | 
 | 1649 | #endif | 
 | 1650 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1651 |  | 
 | 1652 | /** | 
 | 1653 |  * acpiphp_enable_slot - power on slot | 
 | 1654 |  */ | 
 | 1655 | int acpiphp_enable_slot(struct acpiphp_slot *slot) | 
 | 1656 | { | 
 | 1657 | 	int retval; | 
 | 1658 |  | 
| Ingo Molnar | 6aa4cdd | 2006-01-13 16:02:15 +0100 | [diff] [blame] | 1659 | 	mutex_lock(&slot->crit_sect); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1660 |  | 
 | 1661 | 	/* wake up all functions */ | 
 | 1662 | 	retval = power_on_slot(slot); | 
 | 1663 | 	if (retval) | 
 | 1664 | 		goto err_exit; | 
 | 1665 |  | 
| MUNEDA Takahiro | cde0e5d | 2006-03-22 14:49:33 +0900 | [diff] [blame] | 1666 | 	if (get_slot_status(slot) == ACPI_STA_ALL) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1667 | 		/* configure all functions */ | 
 | 1668 | 		retval = enable_device(slot); | 
| MUNEDA Takahiro | cde0e5d | 2006-03-22 14:49:33 +0900 | [diff] [blame] | 1669 | 		if (retval) | 
 | 1670 | 			power_off_slot(slot); | 
 | 1671 | 	} else { | 
 | 1672 | 		dbg("%s: Slot status is not ACPI_STA_ALL\n", __FUNCTION__); | 
 | 1673 | 		power_off_slot(slot); | 
 | 1674 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1675 |  | 
 | 1676 |  err_exit: | 
| Ingo Molnar | 6aa4cdd | 2006-01-13 16:02:15 +0100 | [diff] [blame] | 1677 | 	mutex_unlock(&slot->crit_sect); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1678 | 	return retval; | 
 | 1679 | } | 
 | 1680 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1681 | /** | 
 | 1682 |  * acpiphp_disable_slot - power off slot | 
 | 1683 |  */ | 
 | 1684 | int acpiphp_disable_slot(struct acpiphp_slot *slot) | 
 | 1685 | { | 
 | 1686 | 	int retval = 0; | 
 | 1687 |  | 
| Ingo Molnar | 6aa4cdd | 2006-01-13 16:02:15 +0100 | [diff] [blame] | 1688 | 	mutex_lock(&slot->crit_sect); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1689 |  | 
 | 1690 | 	/* unconfigure all functions */ | 
 | 1691 | 	retval = disable_device(slot); | 
 | 1692 | 	if (retval) | 
 | 1693 | 		goto err_exit; | 
 | 1694 |  | 
 | 1695 | 	/* power off all functions */ | 
 | 1696 | 	retval = power_off_slot(slot); | 
 | 1697 | 	if (retval) | 
 | 1698 | 		goto err_exit; | 
 | 1699 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1700 |  err_exit: | 
| Ingo Molnar | 6aa4cdd | 2006-01-13 16:02:15 +0100 | [diff] [blame] | 1701 | 	mutex_unlock(&slot->crit_sect); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1702 | 	return retval; | 
 | 1703 | } | 
 | 1704 |  | 
 | 1705 |  | 
 | 1706 | /* | 
 | 1707 |  * slot enabled:  1 | 
 | 1708 |  * slot disabled: 0 | 
 | 1709 |  */ | 
 | 1710 | u8 acpiphp_get_power_status(struct acpiphp_slot *slot) | 
 | 1711 | { | 
| Rajesh Shah | 8d50e33 | 2005-04-28 00:25:57 -0700 | [diff] [blame] | 1712 | 	return (slot->flags & SLOT_POWEREDON); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1713 | } | 
 | 1714 |  | 
 | 1715 |  | 
 | 1716 | /* | 
 | 1717 |  * latch closed:  1 | 
 | 1718 |  * latch   open:  0 | 
 | 1719 |  */ | 
 | 1720 | u8 acpiphp_get_latch_status(struct acpiphp_slot *slot) | 
 | 1721 | { | 
 | 1722 | 	unsigned int sta; | 
 | 1723 |  | 
 | 1724 | 	sta = get_slot_status(slot); | 
 | 1725 |  | 
 | 1726 | 	return (sta & ACPI_STA_SHOW_IN_UI) ? 1 : 0; | 
 | 1727 | } | 
 | 1728 |  | 
 | 1729 |  | 
 | 1730 | /* | 
 | 1731 |  * adapter presence : 1 | 
 | 1732 |  *          absence : 0 | 
 | 1733 |  */ | 
 | 1734 | u8 acpiphp_get_adapter_status(struct acpiphp_slot *slot) | 
 | 1735 | { | 
 | 1736 | 	unsigned int sta; | 
 | 1737 |  | 
 | 1738 | 	sta = get_slot_status(slot); | 
 | 1739 |  | 
 | 1740 | 	return (sta == 0) ? 0 : 1; | 
 | 1741 | } | 
 | 1742 |  | 
 | 1743 |  | 
 | 1744 | /* | 
 | 1745 |  * pci address (seg/bus/dev) | 
 | 1746 |  */ | 
 | 1747 | u32 acpiphp_get_address(struct acpiphp_slot *slot) | 
 | 1748 | { | 
 | 1749 | 	u32 address; | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1750 | 	struct pci_bus *pci_bus = slot->bridge->pci_bus; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1751 |  | 
| Rajesh Shah | 42f49a6 | 2005-04-28 00:25:53 -0700 | [diff] [blame] | 1752 | 	address = (pci_domain_nr(pci_bus) << 16) | | 
 | 1753 | 		  (pci_bus->number << 8) | | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1754 | 		  slot->device; | 
 | 1755 |  | 
 | 1756 | 	return address; | 
 | 1757 | } |