📄 acpiphp_glue.c
字号:
/* * ACPI PCI HotPlug glue functions to ACPI CA subsystem * * Copyright (C) 2002,2003 Takayoshi Kochi (t-kochi@bq.jp.nec.com) * Copyright (C) 2002 Hiroshi Aono (h-aono@ap.jp.nec.com) * Copyright (C) 2002,2003 NEC Corporation * Copyright (C) 2003-2005 Matthew Wilcox (matthew.wilcox@hp.com) * Copyright (C) 2003-2005 Hewlett Packard * Copyright (C) 2005 Rajesh Shah (rajesh.shah@intel.com) * Copyright (C) 2005 Intel Corporation * * All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or (at * your option) any later version. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or * NON INFRINGEMENT. See the GNU General Public License for more * details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. * * Send feedback to <t-kochi@bq.jp.nec.com> * *//* * Lifetime rules for pci_dev: * - The one in acpiphp_func has its refcount elevated by pci_get_slot() * when the driver is loaded or when an insertion event occurs. It loses * a refcount when its ejected or the driver unloads. * - The one in acpiphp_bridge has its refcount elevated by pci_get_slot() * when the bridge is scanned and it loses a refcount when the bridge * is removed. */#include <linux/init.h>#include <linux/module.h>#include <linux/kernel.h>#include <linux/pci.h>#include <linux/smp_lock.h>#include <asm/semaphore.h>#include "../pci.h"#include "pci_hotplug.h"#include "acpiphp.h"static LIST_HEAD(bridge_list);#define MY_NAME "acpiphp_glue"static void handle_hotplug_event_bridge (acpi_handle, u32, void *);static void handle_hotplug_event_func (acpi_handle, u32, void *);static void acpiphp_sanitize_bus(struct pci_bus *bus);static void acpiphp_set_hpp_values(acpi_handle handle, struct pci_bus *bus);/* * initialization & terminatation routines *//** * is_ejectable - determine if a slot is ejectable * @handle: handle to acpi namespace * * Ejectable slot should satisfy at least these conditions: * * 1. has _ADR method * 2. has _EJ0 method * * optionally * * 1. has _STA method * 2. has _PS0 method * 3. has _PS3 method * 4. .. * */static int is_ejectable(acpi_handle handle){ acpi_status status; acpi_handle tmp; status = acpi_get_handle(handle, "_ADR", &tmp); if (ACPI_FAILURE(status)) { return 0; } status = acpi_get_handle(handle, "_EJ0", &tmp); if (ACPI_FAILURE(status)) { return 0; } return 1;}/* callback routine to check the existence of ejectable slots */static acpi_statusis_ejectable_slot(acpi_handle handle, u32 lvl, void *context, void **rv){ int *count = (int *)context; if (is_ejectable(handle)) { (*count)++; /* only one ejectable slot is enough */ return AE_CTRL_TERMINATE; } else { return AE_OK; }}/* callback routine to register each ACPI PCI slot object */static acpi_statusregister_slot(acpi_handle handle, u32 lvl, void *context, void **rv){ struct acpiphp_bridge *bridge = (struct acpiphp_bridge *)context; struct acpiphp_slot *slot; struct acpiphp_func *newfunc; acpi_handle tmp; acpi_status status = AE_OK; unsigned long adr, sun; int device, function; static int num_slots = 0; /* XXX if we support I/O node hotplug... */ status = acpi_evaluate_integer(handle, "_ADR", NULL, &adr); if (ACPI_FAILURE(status)) return AE_OK; status = acpi_get_handle(handle, "_EJ0", &tmp); if (ACPI_FAILURE(status)) return AE_OK; device = (adr >> 16) & 0xffff; function = adr & 0xffff; newfunc = kmalloc(sizeof(struct acpiphp_func), GFP_KERNEL); if (!newfunc) return AE_NO_MEMORY; memset(newfunc, 0, sizeof(struct acpiphp_func)); INIT_LIST_HEAD(&newfunc->sibling); newfunc->handle = handle; newfunc->function = function; newfunc->flags = FUNC_HAS_EJ0; if (ACPI_SUCCESS(acpi_get_handle(handle, "_STA", &tmp))) newfunc->flags |= FUNC_HAS_STA; if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS0", &tmp))) newfunc->flags |= FUNC_HAS_PS0; if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS3", &tmp))) newfunc->flags |= FUNC_HAS_PS3; status = acpi_evaluate_integer(handle, "_SUN", NULL, &sun); if (ACPI_FAILURE(status)) sun = -1; /* search for objects that share the same slot */ for (slot = bridge->slots; slot; slot = slot->next) if (slot->device == device) { if (slot->sun != sun) warn("sibling found, but _SUN doesn't match!\n"); break; } if (!slot) { slot = kmalloc(sizeof(struct acpiphp_slot), GFP_KERNEL); if (!slot) { kfree(newfunc); return AE_NO_MEMORY; } memset(slot, 0, sizeof(struct acpiphp_slot)); slot->bridge = bridge; slot->id = num_slots++; slot->device = device; slot->sun = sun; INIT_LIST_HEAD(&slot->funcs); init_MUTEX(&slot->crit_sect); slot->next = bridge->slots; bridge->slots = slot; bridge->nr_slots++; dbg("found ACPI PCI Hotplug slot %d at PCI %04x:%02x:%02x\n", slot->sun, pci_domain_nr(bridge->pci_bus), bridge->pci_bus->number, slot->device); } newfunc->slot = slot; list_add_tail(&newfunc->sibling, &slot->funcs); /* associate corresponding pci_dev */ newfunc->pci_dev = pci_get_slot(bridge->pci_bus, PCI_DEVFN(device, function)); if (newfunc->pci_dev) { slot->flags |= (SLOT_ENABLED | SLOT_POWEREDON); } /* install notify handler */ status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, handle_hotplug_event_func, newfunc); if (ACPI_FAILURE(status)) { err("failed to register interrupt notify handler\n"); return status; } return AE_OK;}/* see if it's worth looking at this bridge */static int detect_ejectable_slots(acpi_handle *bridge_handle){ acpi_status status; int count; count = 0; /* only check slots defined directly below bridge object */ status = acpi_walk_namespace(ACPI_TYPE_DEVICE, bridge_handle, (u32)1, is_ejectable_slot, (void *)&count, NULL); return count;}/* decode ACPI 2.0 _HPP hot plug parameters */static void decode_hpp(struct acpiphp_bridge *bridge){ acpi_status status; struct acpi_buffer buffer = { .length = ACPI_ALLOCATE_BUFFER, .pointer = NULL}; union acpi_object *package; int i; /* default numbers */ bridge->hpp.cache_line_size = 0x10; bridge->hpp.latency_timer = 0x40; bridge->hpp.enable_SERR = 0; bridge->hpp.enable_PERR = 0; status = acpi_evaluate_object(bridge->handle, "_HPP", NULL, &buffer); if (ACPI_FAILURE(status)) { dbg("_HPP evaluation failed\n"); return; } package = (union acpi_object *) buffer.pointer; if (!package || package->type != ACPI_TYPE_PACKAGE || package->package.count != 4 || !package->package.elements) { err("invalid _HPP object; ignoring\n"); goto err_exit; } for (i = 0; i < 4; i++) { if (package->package.elements[i].type != ACPI_TYPE_INTEGER) { err("invalid _HPP parameter type; ignoring\n"); goto err_exit; } } bridge->hpp.cache_line_size = package->package.elements[0].integer.value; bridge->hpp.latency_timer = package->package.elements[1].integer.value; bridge->hpp.enable_SERR = package->package.elements[2].integer.value; bridge->hpp.enable_PERR = package->package.elements[3].integer.value; dbg("_HPP parameter = (%02x, %02x, %02x, %02x)\n", bridge->hpp.cache_line_size, bridge->hpp.latency_timer, bridge->hpp.enable_SERR, bridge->hpp.enable_PERR); bridge->flags |= BRIDGE_HAS_HPP; err_exit: kfree(buffer.pointer);}/* initialize miscellaneous stuff for both root and PCI-to-PCI bridge */static void init_bridge_misc(struct acpiphp_bridge *bridge){ acpi_status status; /* decode ACPI 2.0 _HPP (hot plug parameters) */ decode_hpp(bridge); /* register all slot objects under this bridge */ status = acpi_walk_namespace(ACPI_TYPE_DEVICE, bridge->handle, (u32)1, register_slot, bridge, NULL); /* install notify handler */ if (bridge->type != BRIDGE_TYPE_HOST) { status = acpi_install_notify_handler(bridge->handle, ACPI_SYSTEM_NOTIFY, handle_hotplug_event_bridge, bridge); if (ACPI_FAILURE(status)) { err("failed to register interrupt notify handler\n"); } } list_add(&bridge->list, &bridge_list);}/* allocate and initialize host bridge data structure */static void add_host_bridge(acpi_handle *handle, struct pci_bus *pci_bus){ struct acpiphp_bridge *bridge; bridge = kmalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL); if (bridge == NULL) return; memset(bridge, 0, sizeof(struct acpiphp_bridge)); bridge->type = BRIDGE_TYPE_HOST; bridge->handle = handle; bridge->pci_bus = pci_bus; spin_lock_init(&bridge->res_lock); init_bridge_misc(bridge);}/* allocate and initialize PCI-to-PCI bridge data structure */static void add_p2p_bridge(acpi_handle *handle, struct pci_dev *pci_dev){ struct acpiphp_bridge *bridge; bridge = kmalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL); if (bridge == NULL) { err("out of memory\n"); return; } memset(bridge, 0, sizeof(struct acpiphp_bridge)); bridge->type = BRIDGE_TYPE_P2P; bridge->handle = handle; bridge->pci_dev = pci_dev_get(pci_dev); bridge->pci_bus = pci_dev->subordinate; if (!bridge->pci_bus) { err("This is not a PCI-to-PCI bridge!\n"); goto err; } spin_lock_init(&bridge->res_lock); init_bridge_misc(bridge); return; err: pci_dev_put(pci_dev); kfree(bridge); return;}/* callback routine to find P2P bridges */static acpi_statusfind_p2p_bridge(acpi_handle handle, u32 lvl, void *context, void **rv){ acpi_status status; acpi_handle dummy_handle; unsigned long tmp; int device, function; struct pci_dev *dev; struct pci_bus *pci_bus = context; status = acpi_get_handle(handle, "_ADR", &dummy_handle); if (ACPI_FAILURE(status)) return AE_OK; /* continue */ status = acpi_evaluate_integer(handle, "_ADR", NULL, &tmp); if (ACPI_FAILURE(status)) { dbg("%s: _ADR evaluation failure\n", __FUNCTION__); return AE_OK; } device = (tmp >> 16) & 0xffff; function = tmp & 0xffff; dev = pci_get_slot(pci_bus, PCI_DEVFN(device, function)); if (!dev || !dev->subordinate) goto out; /* check if this bridge has ejectable slots */ if (detect_ejectable_slots(handle) > 0) { dbg("found PCI-to-PCI bridge at PCI %s\n", pci_name(dev)); add_p2p_bridge(handle, dev); } out: pci_dev_put(dev); return AE_OK;}/* find hot-pluggable slots, and then find P2P bridge */static int add_bridge(acpi_handle handle){ acpi_status status; unsigned long tmp; int seg, bus; acpi_handle dummy_handle; struct pci_bus *pci_bus; /* if the bridge doesn't have _STA, we assume it is always there */ status = acpi_get_handle(handle, "_STA", &dummy_handle); if (ACPI_SUCCESS(status)) { status = acpi_evaluate_integer(handle, "_STA", NULL, &tmp); if (ACPI_FAILURE(status)) { dbg("%s: _STA evaluation failure\n", __FUNCTION__); return 0; } if ((tmp & ACPI_STA_FUNCTIONING) == 0) /* don't register this object */ return 0; } /* get PCI segment number */ status = acpi_evaluate_integer(handle, "_SEG", NULL, &tmp); seg = ACPI_SUCCESS(status) ? tmp : 0; /* get PCI bus number */ status = acpi_evaluate_integer(handle, "_BBN", NULL, &tmp); if (ACPI_SUCCESS(status)) { bus = tmp; } else { warn("can't get bus number, assuming 0\n"); bus = 0; } pci_bus = pci_find_bus(seg, bus); if (!pci_bus) { err("Can't find bus %04x:%02x\n", seg, bus); return 0; } /* check if this bridge has ejectable slots */ if (detect_ejectable_slots(handle) > 0) { dbg("found PCI host-bus bridge with hot-pluggable slots\n"); add_host_bridge(handle, pci_bus); return 0; } /* search P2P bridges under this host bridge */ status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1, find_p2p_bridge, pci_bus, NULL); if (ACPI_FAILURE(status)) warn("find_p2p_bridge faied (error code = 0x%x)\n",status); return 0;}static struct acpiphp_bridge *acpiphp_handle_to_bridge(acpi_handle handle){ struct list_head *head; list_for_each(head, &bridge_list) { struct acpiphp_bridge *bridge = list_entry(head, struct acpiphp_bridge, list); if (bridge->handle == handle) return bridge; } return NULL;}static void cleanup_bridge(struct acpiphp_bridge *bridge){ struct list_head *list, *tmp;
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -