ACPI / PCI: Fix NULL pointer dereference in acpi_get_pci_dev() (rev. 2)
[linux-2.6/verdex.git] / drivers / acpi / pci_root.c
blob97fad297992094396475fed43cbb3182f886257e
1 /*
2 * pci_root.c - ACPI PCI Root Bridge Driver ($Revision: 40 $)
4 * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
5 * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
7 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or (at
12 * your option) any later version.
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * General Public License for more details.
19 * You should have received a copy of the GNU General Public License along
20 * with this program; if not, write to the Free Software Foundation, Inc.,
21 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
23 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
26 #include <linux/kernel.h>
27 #include <linux/module.h>
28 #include <linux/init.h>
29 #include <linux/types.h>
30 #include <linux/proc_fs.h>
31 #include <linux/spinlock.h>
32 #include <linux/pm.h>
33 #include <linux/pci.h>
34 #include <linux/pci-acpi.h>
35 #include <linux/acpi.h>
36 #include <acpi/acpi_bus.h>
37 #include <acpi/acpi_drivers.h>
39 #define _COMPONENT ACPI_PCI_COMPONENT
40 ACPI_MODULE_NAME("pci_root");
41 #define ACPI_PCI_ROOT_CLASS "pci_bridge"
42 #define ACPI_PCI_ROOT_DEVICE_NAME "PCI Root Bridge"
43 static int acpi_pci_root_add(struct acpi_device *device);
44 static int acpi_pci_root_remove(struct acpi_device *device, int type);
45 static int acpi_pci_root_start(struct acpi_device *device);
47 static struct acpi_device_id root_device_ids[] = {
48 {"PNP0A03", 0},
49 {"", 0},
51 MODULE_DEVICE_TABLE(acpi, root_device_ids);
53 static struct acpi_driver acpi_pci_root_driver = {
54 .name = "pci_root",
55 .class = ACPI_PCI_ROOT_CLASS,
56 .ids = root_device_ids,
57 .ops = {
58 .add = acpi_pci_root_add,
59 .remove = acpi_pci_root_remove,
60 .start = acpi_pci_root_start,
64 struct acpi_pci_root {
65 struct list_head node;
66 struct acpi_device *device;
67 struct pci_bus *bus;
68 u16 segment;
69 u8 bus_nr;
71 u32 osc_support_set; /* _OSC state of support bits */
72 u32 osc_control_set; /* _OSC state of control bits */
73 u32 osc_control_qry; /* the latest _OSC query result */
75 u32 osc_queried:1; /* has _OSC control been queried? */
78 static LIST_HEAD(acpi_pci_roots);
80 static struct acpi_pci_driver *sub_driver;
81 static DEFINE_MUTEX(osc_lock);
83 int acpi_pci_register_driver(struct acpi_pci_driver *driver)
85 int n = 0;
86 struct acpi_pci_root *root;
88 struct acpi_pci_driver **pptr = &sub_driver;
89 while (*pptr)
90 pptr = &(*pptr)->next;
91 *pptr = driver;
93 if (!driver->add)
94 return 0;
96 list_for_each_entry(root, &acpi_pci_roots, node) {
97 driver->add(root->device->handle);
98 n++;
101 return n;
104 EXPORT_SYMBOL(acpi_pci_register_driver);
106 void acpi_pci_unregister_driver(struct acpi_pci_driver *driver)
108 struct acpi_pci_root *root;
110 struct acpi_pci_driver **pptr = &sub_driver;
111 while (*pptr) {
112 if (*pptr == driver)
113 break;
114 pptr = &(*pptr)->next;
116 BUG_ON(!*pptr);
117 *pptr = (*pptr)->next;
119 if (!driver->remove)
120 return;
122 list_for_each_entry(root, &acpi_pci_roots, node)
123 driver->remove(root->device->handle);
126 EXPORT_SYMBOL(acpi_pci_unregister_driver);
128 acpi_handle acpi_get_pci_rootbridge_handle(unsigned int seg, unsigned int bus)
130 struct acpi_pci_root *root;
132 list_for_each_entry(root, &acpi_pci_roots, node)
133 if ((root->segment == (u16) seg) && (root->bus_nr == (u16) bus))
134 return root->device->handle;
135 return NULL;
138 EXPORT_SYMBOL_GPL(acpi_get_pci_rootbridge_handle);
141 * acpi_is_root_bridge - determine whether an ACPI CA node is a PCI root bridge
142 * @handle - the ACPI CA node in question.
144 * Note: we could make this API take a struct acpi_device * instead, but
145 * for now, it's more convenient to operate on an acpi_handle.
147 int acpi_is_root_bridge(acpi_handle handle)
149 int ret;
150 struct acpi_device *device;
152 ret = acpi_bus_get_device(handle, &device);
153 if (ret)
154 return 0;
156 ret = acpi_match_device_ids(device, root_device_ids);
157 if (ret)
158 return 0;
159 else
160 return 1;
162 EXPORT_SYMBOL_GPL(acpi_is_root_bridge);
164 static acpi_status
165 get_root_bridge_busnr_callback(struct acpi_resource *resource, void *data)
167 int *busnr = data;
168 struct acpi_resource_address64 address;
170 if (resource->type != ACPI_RESOURCE_TYPE_ADDRESS16 &&
171 resource->type != ACPI_RESOURCE_TYPE_ADDRESS32 &&
172 resource->type != ACPI_RESOURCE_TYPE_ADDRESS64)
173 return AE_OK;
175 acpi_resource_to_address64(resource, &address);
176 if ((address.address_length > 0) &&
177 (address.resource_type == ACPI_BUS_NUMBER_RANGE))
178 *busnr = address.minimum;
180 return AE_OK;
183 static acpi_status try_get_root_bridge_busnr(acpi_handle handle,
184 unsigned long long *bus)
186 acpi_status status;
187 int busnum;
189 busnum = -1;
190 status =
191 acpi_walk_resources(handle, METHOD_NAME__CRS,
192 get_root_bridge_busnr_callback, &busnum);
193 if (ACPI_FAILURE(status))
194 return status;
195 /* Check if we really get a bus number from _CRS */
196 if (busnum == -1)
197 return AE_ERROR;
198 *bus = busnum;
199 return AE_OK;
202 static void acpi_pci_bridge_scan(struct acpi_device *device)
204 int status;
205 struct acpi_device *child = NULL;
207 if (device->flags.bus_address)
208 if (device->parent && device->parent->ops.bind) {
209 status = device->parent->ops.bind(device);
210 if (!status) {
211 list_for_each_entry(child, &device->children, node)
212 acpi_pci_bridge_scan(child);
217 static u8 OSC_UUID[16] = {0x5B, 0x4D, 0xDB, 0x33, 0xF7, 0x1F, 0x1C, 0x40,
218 0x96, 0x57, 0x74, 0x41, 0xC0, 0x3D, 0xD7, 0x66};
220 static acpi_status acpi_pci_run_osc(acpi_handle handle,
221 const u32 *capbuf, u32 *retval)
223 acpi_status status;
224 struct acpi_object_list input;
225 union acpi_object in_params[4];
226 struct acpi_buffer output = {ACPI_ALLOCATE_BUFFER, NULL};
227 union acpi_object *out_obj;
228 u32 errors;
230 /* Setting up input parameters */
231 input.count = 4;
232 input.pointer = in_params;
233 in_params[0].type = ACPI_TYPE_BUFFER;
234 in_params[0].buffer.length = 16;
235 in_params[0].buffer.pointer = OSC_UUID;
236 in_params[1].type = ACPI_TYPE_INTEGER;
237 in_params[1].integer.value = 1;
238 in_params[2].type = ACPI_TYPE_INTEGER;
239 in_params[2].integer.value = 3;
240 in_params[3].type = ACPI_TYPE_BUFFER;
241 in_params[3].buffer.length = 12;
242 in_params[3].buffer.pointer = (u8 *)capbuf;
244 status = acpi_evaluate_object(handle, "_OSC", &input, &output);
245 if (ACPI_FAILURE(status))
246 return status;
248 if (!output.length)
249 return AE_NULL_OBJECT;
251 out_obj = output.pointer;
252 if (out_obj->type != ACPI_TYPE_BUFFER) {
253 printk(KERN_DEBUG "_OSC evaluation returned wrong type\n");
254 status = AE_TYPE;
255 goto out_kfree;
257 /* Need to ignore the bit0 in result code */
258 errors = *((u32 *)out_obj->buffer.pointer) & ~(1 << 0);
259 if (errors) {
260 if (errors & OSC_REQUEST_ERROR)
261 printk(KERN_DEBUG "_OSC request failed\n");
262 if (errors & OSC_INVALID_UUID_ERROR)
263 printk(KERN_DEBUG "_OSC invalid UUID\n");
264 if (errors & OSC_INVALID_REVISION_ERROR)
265 printk(KERN_DEBUG "_OSC invalid revision\n");
266 if (errors & OSC_CAPABILITIES_MASK_ERROR) {
267 if (capbuf[OSC_QUERY_TYPE] & OSC_QUERY_ENABLE)
268 goto out_success;
269 printk(KERN_DEBUG
270 "Firmware did not grant requested _OSC control\n");
271 status = AE_SUPPORT;
272 goto out_kfree;
274 status = AE_ERROR;
275 goto out_kfree;
277 out_success:
278 *retval = *((u32 *)(out_obj->buffer.pointer + 8));
279 status = AE_OK;
281 out_kfree:
282 kfree(output.pointer);
283 return status;
286 static acpi_status acpi_pci_query_osc(struct acpi_pci_root *root, u32 flags)
288 acpi_status status;
289 u32 support_set, result, capbuf[3];
291 /* do _OSC query for all possible controls */
292 support_set = root->osc_support_set | (flags & OSC_SUPPORT_MASKS);
293 capbuf[OSC_QUERY_TYPE] = OSC_QUERY_ENABLE;
294 capbuf[OSC_SUPPORT_TYPE] = support_set;
295 capbuf[OSC_CONTROL_TYPE] = OSC_CONTROL_MASKS;
297 status = acpi_pci_run_osc(root->device->handle, capbuf, &result);
298 if (ACPI_SUCCESS(status)) {
299 root->osc_support_set = support_set;
300 root->osc_control_qry = result;
301 root->osc_queried = 1;
303 return status;
306 static acpi_status acpi_pci_osc_support(struct acpi_pci_root *root, u32 flags)
308 acpi_status status;
309 acpi_handle tmp;
311 status = acpi_get_handle(root->device->handle, "_OSC", &tmp);
312 if (ACPI_FAILURE(status))
313 return status;
314 mutex_lock(&osc_lock);
315 status = acpi_pci_query_osc(root, flags);
316 mutex_unlock(&osc_lock);
317 return status;
320 static struct acpi_pci_root *acpi_pci_find_root(acpi_handle handle)
322 struct acpi_pci_root *root;
324 list_for_each_entry(root, &acpi_pci_roots, node) {
325 if (root->device->handle == handle)
326 return root;
328 return NULL;
331 struct acpi_handle_node {
332 struct list_head node;
333 acpi_handle handle;
337 * acpi_get_pci_dev - convert ACPI CA handle to struct pci_dev
338 * @handle: the handle in question
340 * Given an ACPI CA handle, the desired PCI device is located in the
341 * list of PCI devices.
343 * If the device is found, its reference count is increased and this
344 * function returns a pointer to its data structure. The caller must
345 * decrement the reference count by calling pci_dev_put().
346 * If no device is found, %NULL is returned.
348 struct pci_dev *acpi_get_pci_dev(acpi_handle handle)
350 int dev, fn;
351 unsigned long long adr;
352 acpi_status status;
353 acpi_handle phandle;
354 struct pci_bus *pbus;
355 struct pci_dev *pdev = NULL;
356 struct acpi_handle_node *node, *tmp;
357 struct acpi_pci_root *root;
358 LIST_HEAD(device_list);
361 * Walk up the ACPI CA namespace until we reach a PCI root bridge.
363 phandle = handle;
364 while (!acpi_is_root_bridge(phandle)) {
365 node = kzalloc(sizeof(struct acpi_handle_node), GFP_KERNEL);
366 if (!node)
367 goto out;
369 INIT_LIST_HEAD(&node->node);
370 node->handle = phandle;
371 list_add(&node->node, &device_list);
373 status = acpi_get_parent(phandle, &phandle);
374 if (ACPI_FAILURE(status))
375 goto out;
378 root = acpi_pci_find_root(phandle);
379 if (!root)
380 goto out;
382 pbus = root->bus;
385 * Now, walk back down the PCI device tree until we return to our
386 * original handle. Assumes that everything between the PCI root
387 * bridge and the device we're looking for must be a P2P bridge.
389 list_for_each_entry(node, &device_list, node) {
390 acpi_handle hnd = node->handle;
391 status = acpi_evaluate_integer(hnd, "_ADR", NULL, &adr);
392 if (ACPI_FAILURE(status))
393 goto out;
394 dev = (adr >> 16) & 0xffff;
395 fn = adr & 0xffff;
397 pdev = pci_get_slot(pbus, PCI_DEVFN(dev, fn));
398 if (!pdev || hnd == handle)
399 break;
401 pbus = pdev->subordinate;
402 pci_dev_put(pdev);
405 * This function may be called for a non-PCI device that has a
406 * PCI parent (eg. a disk under a PCI SATA controller). In that
407 * case pdev->subordinate will be NULL for the parent.
409 if (!pbus) {
410 dev_dbg(&pdev->dev, "Not a PCI-to-PCI bridge\n");
411 pdev = NULL;
412 break;
415 out:
416 list_for_each_entry_safe(node, tmp, &device_list, node)
417 kfree(node);
419 return pdev;
421 EXPORT_SYMBOL_GPL(acpi_get_pci_dev);
424 * acpi_pci_osc_control_set - commit requested control to Firmware
425 * @handle: acpi_handle for the target ACPI object
426 * @flags: driver's requested control bits
428 * Attempt to take control from Firmware on requested control bits.
430 acpi_status acpi_pci_osc_control_set(acpi_handle handle, u32 flags)
432 acpi_status status;
433 u32 control_req, result, capbuf[3];
434 acpi_handle tmp;
435 struct acpi_pci_root *root;
437 status = acpi_get_handle(handle, "_OSC", &tmp);
438 if (ACPI_FAILURE(status))
439 return status;
441 control_req = (flags & OSC_CONTROL_MASKS);
442 if (!control_req)
443 return AE_TYPE;
445 root = acpi_pci_find_root(handle);
446 if (!root)
447 return AE_NOT_EXIST;
449 mutex_lock(&osc_lock);
450 /* No need to evaluate _OSC if the control was already granted. */
451 if ((root->osc_control_set & control_req) == control_req)
452 goto out;
454 /* Need to query controls first before requesting them */
455 if (!root->osc_queried) {
456 status = acpi_pci_query_osc(root, root->osc_support_set);
457 if (ACPI_FAILURE(status))
458 goto out;
460 if ((root->osc_control_qry & control_req) != control_req) {
461 printk(KERN_DEBUG
462 "Firmware did not grant requested _OSC control\n");
463 status = AE_SUPPORT;
464 goto out;
467 capbuf[OSC_QUERY_TYPE] = 0;
468 capbuf[OSC_SUPPORT_TYPE] = root->osc_support_set;
469 capbuf[OSC_CONTROL_TYPE] = root->osc_control_set | control_req;
470 status = acpi_pci_run_osc(handle, capbuf, &result);
471 if (ACPI_SUCCESS(status))
472 root->osc_control_set = result;
473 out:
474 mutex_unlock(&osc_lock);
475 return status;
477 EXPORT_SYMBOL(acpi_pci_osc_control_set);
479 static int __devinit acpi_pci_root_add(struct acpi_device *device)
481 unsigned long long segment, bus;
482 acpi_status status;
483 int result;
484 struct acpi_pci_root *root;
485 acpi_handle handle;
486 struct acpi_device *child;
487 u32 flags, base_flags;
489 segment = 0;
490 status = acpi_evaluate_integer(device->handle, METHOD_NAME__SEG, NULL,
491 &segment);
492 if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
493 printk(KERN_ERR PREFIX "can't evaluate _SEG\n");
494 return -ENODEV;
497 /* Check _CRS first, then _BBN. If no _BBN, default to zero. */
498 bus = 0;
499 status = try_get_root_bridge_busnr(device->handle, &bus);
500 if (ACPI_FAILURE(status)) {
501 status = acpi_evaluate_integer(device->handle, METHOD_NAME__BBN, NULL, &bus);
502 if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
503 printk(KERN_ERR PREFIX
504 "no bus number in _CRS and can't evaluate _BBN\n");
505 return -ENODEV;
509 root = kzalloc(sizeof(struct acpi_pci_root), GFP_KERNEL);
510 if (!root)
511 return -ENOMEM;
513 INIT_LIST_HEAD(&root->node);
514 root->device = device;
515 root->segment = segment & 0xFFFF;
516 root->bus_nr = bus & 0xFF;
517 strcpy(acpi_device_name(device), ACPI_PCI_ROOT_DEVICE_NAME);
518 strcpy(acpi_device_class(device), ACPI_PCI_ROOT_CLASS);
519 device->driver_data = root;
522 * All supported architectures that use ACPI have support for
523 * PCI domains, so we indicate this in _OSC support capabilities.
525 flags = base_flags = OSC_PCI_SEGMENT_GROUPS_SUPPORT;
526 acpi_pci_osc_support(root, flags);
529 * TBD: Need PCI interface for enumeration/configuration of roots.
532 /* TBD: Locking */
533 list_add_tail(&root->node, &acpi_pci_roots);
535 printk(KERN_INFO PREFIX "%s [%s] (%04x:%02x)\n",
536 acpi_device_name(device), acpi_device_bid(device),
537 root->segment, root->bus_nr);
540 * Scan the Root Bridge
541 * --------------------
542 * Must do this prior to any attempt to bind the root device, as the
543 * PCI namespace does not get created until this call is made (and
544 * thus the root bridge's pci_dev does not exist).
546 root->bus = pci_acpi_scan_root(device, segment, bus);
547 if (!root->bus) {
548 printk(KERN_ERR PREFIX
549 "Bus %04x:%02x not present in PCI namespace\n",
550 root->segment, root->bus_nr);
551 result = -ENODEV;
552 goto end;
556 * Attach ACPI-PCI Context
557 * -----------------------
558 * Thus binding the ACPI and PCI devices.
560 result = acpi_pci_bind_root(device);
561 if (result)
562 goto end;
565 * PCI Routing Table
566 * -----------------
567 * Evaluate and parse _PRT, if exists.
569 status = acpi_get_handle(device->handle, METHOD_NAME__PRT, &handle);
570 if (ACPI_SUCCESS(status))
571 result = acpi_pci_irq_add_prt(device->handle, root->bus);
574 * Scan and bind all _ADR-Based Devices
576 list_for_each_entry(child, &device->children, node)
577 acpi_pci_bridge_scan(child);
579 /* Indicate support for various _OSC capabilities. */
580 if (pci_ext_cfg_avail(root->bus->self))
581 flags |= OSC_EXT_PCI_CONFIG_SUPPORT;
582 if (pcie_aspm_enabled())
583 flags |= OSC_ACTIVE_STATE_PWR_SUPPORT |
584 OSC_CLOCK_PWR_CAPABILITY_SUPPORT;
585 if (pci_msi_enabled())
586 flags |= OSC_MSI_SUPPORT;
587 if (flags != base_flags)
588 acpi_pci_osc_support(root, flags);
590 return 0;
592 end:
593 if (!list_empty(&root->node))
594 list_del(&root->node);
595 kfree(root);
596 return result;
599 static int acpi_pci_root_start(struct acpi_device *device)
601 struct acpi_pci_root *root = acpi_driver_data(device);
603 pci_bus_add_devices(root->bus);
604 return 0;
607 static int acpi_pci_root_remove(struct acpi_device *device, int type)
609 struct acpi_pci_root *root = acpi_driver_data(device);
611 kfree(root);
612 return 0;
615 static int __init acpi_pci_root_init(void)
617 if (acpi_pci_disabled)
618 return 0;
620 if (acpi_bus_register_driver(&acpi_pci_root_driver) < 0)
621 return -ENODEV;
623 return 0;
626 subsys_initcall(acpi_pci_root_init);