Commit | Line | Data |
---|---|---|
8344b568 AC |
1 | /* |
2 | * pci_slot.c - ACPI PCI Slot Driver | |
3 | * | |
4 | * The code here is heavily leveraged from the acpiphp module. | |
5 | * Thanks to Matthew Wilcox <matthew@wil.cx> for much guidance. | |
6 | * Thanks to Kenji Kaneshige <kaneshige.kenji@jp.fujitsu.com> for code | |
7 | * review and fixes. | |
8 | * | |
e4268aad AC |
9 | * Copyright (C) 2007-2008 Hewlett-Packard Development Company, L.P. |
10 | * Alex Chiang <achiang@hp.com> | |
8344b568 | 11 | * |
5c0b04e3 JL |
12 | * Copyright (C) 2013 Huawei Tech. Co., Ltd. |
13 | * Jiang Liu <jiang.liu@huawei.com> | |
14 | * | |
8344b568 AC |
15 | * This program is free software; you can redistribute it and/or modify it |
16 | * under the terms and conditions of the GNU General Public License, | |
17 | * version 2, as published by the Free Software Foundation. | |
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. See the GNU | |
22 | * General Public License for more details. | |
23 | * | |
24 | * You should have received a copy of the GNU General Public License along | |
25 | * with this program; if not, write to the Free Software Foundation, Inc., | |
26 | * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. | |
27 | */ | |
28 | ||
29 | #include <linux/kernel.h> | |
30 | #include <linux/module.h> | |
31 | #include <linux/init.h> | |
5a0e3ad6 | 32 | #include <linux/slab.h> |
8344b568 | 33 | #include <linux/types.h> |
5c0b04e3 | 34 | #include <linux/list.h> |
8344b568 AC |
35 | #include <linux/pci.h> |
36 | #include <linux/acpi.h> | |
eb27cae8 | 37 | #include <linux/dmi.h> |
8344b568 | 38 | |
90ab5ee9 | 39 | static bool debug; |
8344b568 AC |
40 | static int check_sta_before_sun; |
41 | ||
42 | #define DRIVER_VERSION "0.1" | |
43 | #define DRIVER_AUTHOR "Alex Chiang <achiang@hp.com>" | |
44 | #define DRIVER_DESC "ACPI PCI Slot Detection Driver" | |
45 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
46 | MODULE_DESCRIPTION(DRIVER_DESC); | |
47 | MODULE_LICENSE("GPL"); | |
48 | MODULE_PARM_DESC(debug, "Debugging mode enabled or not"); | |
49 | module_param(debug, bool, 0644); | |
50 | ||
51 | #define _COMPONENT ACPI_PCI_COMPONENT | |
52 | ACPI_MODULE_NAME("pci_slot"); | |
53 | ||
54 | #define MY_NAME "pci_slot" | |
73ce873a JL |
55 | #define err(format, arg...) pr_err("%s: " format , MY_NAME , ## arg) |
56 | #define info(format, arg...) pr_info("%s: " format , MY_NAME , ## arg) | |
8344b568 AC |
57 | #define dbg(format, arg...) \ |
58 | do { \ | |
59 | if (debug) \ | |
73ce873a | 60 | pr_debug("%s: " format, MY_NAME , ## arg); \ |
8344b568 AC |
61 | } while (0) |
62 | ||
7e24bc1c | 63 | #define SLOT_NAME_SIZE 21 /* Inspired by #define in acpiphp.h */ |
8344b568 AC |
64 | |
65 | struct acpi_pci_slot { | |
8344b568 AC |
66 | struct pci_slot *pci_slot; /* corresponding pci_slot */ |
67 | struct list_head list; /* node in the list of slots */ | |
68 | }; | |
69 | ||
8344b568 AC |
70 | static LIST_HEAD(slot_list); |
71 | static DEFINE_MUTEX(slot_list_lock); | |
8344b568 AC |
72 | |
73 | static int | |
27663c58 | 74 | check_slot(acpi_handle handle, unsigned long long *sun) |
8344b568 | 75 | { |
362b7077 | 76 | int device = -1; |
27663c58 | 77 | unsigned long long adr, sta; |
8344b568 AC |
78 | acpi_status status; |
79 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | |
80 | ||
81 | acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer); | |
82 | dbg("Checking slot on path: %s\n", (char *)buffer.pointer); | |
83 | ||
84 | if (check_sta_before_sun) { | |
85 | /* If SxFy doesn't have _STA, we just assume it's there */ | |
86 | status = acpi_evaluate_integer(handle, "_STA", NULL, &sta); | |
362b7077 | 87 | if (ACPI_SUCCESS(status) && !(sta & ACPI_STA_DEVICE_PRESENT)) |
8344b568 | 88 | goto out; |
8344b568 AC |
89 | } |
90 | ||
91 | status = acpi_evaluate_integer(handle, "_ADR", NULL, &adr); | |
92 | if (ACPI_FAILURE(status)) { | |
93 | dbg("_ADR returned %d on %s\n", status, (char *)buffer.pointer); | |
8344b568 AC |
94 | goto out; |
95 | } | |
96 | ||
8344b568 AC |
97 | /* No _SUN == not a slot == bail */ |
98 | status = acpi_evaluate_integer(handle, "_SUN", NULL, sun); | |
99 | if (ACPI_FAILURE(status)) { | |
100 | dbg("_SUN returned %d on %s\n", status, (char *)buffer.pointer); | |
8344b568 AC |
101 | goto out; |
102 | } | |
103 | ||
362b7077 | 104 | device = (adr >> 16) & 0xffff; |
8344b568 AC |
105 | out: |
106 | kfree(buffer.pointer); | |
362b7077 | 107 | return device; |
8344b568 AC |
108 | } |
109 | ||
8344b568 | 110 | /* |
5c0b04e3 | 111 | * Check whether handle has an associated slot and create PCI slot if it has. |
8344b568 AC |
112 | */ |
113 | static acpi_status | |
114 | register_slot(acpi_handle handle, u32 lvl, void *context, void **rv) | |
115 | { | |
116 | int device; | |
27663c58 | 117 | unsigned long long sun; |
8344b568 AC |
118 | char name[SLOT_NAME_SIZE]; |
119 | struct acpi_pci_slot *slot; | |
120 | struct pci_slot *pci_slot; | |
5c0b04e3 | 121 | struct pci_bus *pci_bus = context; |
8344b568 | 122 | |
362b7077 MW |
123 | device = check_slot(handle, &sun); |
124 | if (device < 0) | |
8344b568 AC |
125 | return AE_OK; |
126 | ||
5c0b04e3 JL |
127 | /* |
128 | * There may be multiple PCI functions associated with the same slot. | |
129 | * Check whether PCI slot has already been created for this PCI device. | |
130 | */ | |
131 | list_for_each_entry(slot, &slot_list, list) { | |
132 | pci_slot = slot->pci_slot; | |
133 | if (pci_slot->bus == pci_bus && pci_slot->number == device) | |
134 | return AE_OK; | |
135 | } | |
136 | ||
8344b568 AC |
137 | slot = kmalloc(sizeof(*slot), GFP_KERNEL); |
138 | if (!slot) { | |
139 | err("%s: cannot allocate memory\n", __func__); | |
140 | return AE_OK; | |
141 | } | |
142 | ||
7e24bc1c | 143 | snprintf(name, sizeof(name), "%llu", sun); |
828f3768 | 144 | pci_slot = pci_create_slot(pci_bus, device, name, NULL); |
8344b568 AC |
145 | if (IS_ERR(pci_slot)) { |
146 | err("pci_create_slot returned %ld\n", PTR_ERR(pci_slot)); | |
147 | kfree(slot); | |
e4268aad | 148 | return AE_OK; |
8344b568 AC |
149 | } |
150 | ||
8344b568 | 151 | slot->pci_slot = pci_slot; |
8344b568 | 152 | list_add(&slot->list, &slot_list); |
8344b568 | 153 | |
72800360 AC |
154 | get_device(&pci_bus->dev); |
155 | ||
8344b568 AC |
156 | dbg("pci_slot: %p, pci_bus: %x, device: %d, name: %s\n", |
157 | pci_slot, pci_bus->number, device, name); | |
158 | ||
159 | return AE_OK; | |
160 | } | |
161 | ||
be1c9de9 | 162 | void acpi_pci_slot_enumerate(struct pci_bus *bus) |
8344b568 | 163 | { |
be1c9de9 RW |
164 | acpi_handle handle = ACPI_HANDLE(bus->bridge); |
165 | ||
166 | if (handle) { | |
167 | mutex_lock(&slot_list_lock); | |
168 | acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, 1, | |
169 | register_slot, NULL, bus, NULL); | |
170 | mutex_unlock(&slot_list_lock); | |
171 | } | |
8344b568 AC |
172 | } |
173 | ||
5c0b04e3 | 174 | void acpi_pci_slot_remove(struct pci_bus *bus) |
8344b568 AC |
175 | { |
176 | struct acpi_pci_slot *slot, *tmp; | |
177 | ||
178 | mutex_lock(&slot_list_lock); | |
179 | list_for_each_entry_safe(slot, tmp, &slot_list, list) { | |
5c0b04e3 | 180 | if (slot->pci_slot->bus == bus) { |
8344b568 AC |
181 | list_del(&slot->list); |
182 | pci_destroy_slot(slot->pci_slot); | |
5c0b04e3 | 183 | put_device(&bus->dev); |
8344b568 AC |
184 | kfree(slot); |
185 | } | |
186 | } | |
187 | mutex_unlock(&slot_list_lock); | |
188 | } | |
189 | ||
190 | static int do_sta_before_sun(const struct dmi_system_id *d) | |
191 | { | |
192 | info("%s detected: will evaluate _STA before calling _SUN\n", d->ident); | |
193 | check_sta_before_sun = 1; | |
194 | return 0; | |
195 | } | |
196 | ||
197 | static struct dmi_system_id acpi_pci_slot_dmi_table[] __initdata = { | |
198 | /* | |
199 | * Fujitsu Primequest machines will return 1023 to indicate an | |
200 | * error if the _SUN method is evaluated on SxFy objects that | |
201 | * are not present (as indicated by _STA), so for those machines, | |
202 | * we want to check _STA before evaluating _SUN. | |
203 | */ | |
204 | { | |
205 | .callback = do_sta_before_sun, | |
206 | .ident = "Fujitsu PRIMEQUEST", | |
207 | .matches = { | |
208 | DMI_MATCH(DMI_BIOS_VENDOR, "FUJITSU LIMITED"), | |
209 | DMI_MATCH(DMI_BIOS_VERSION, "PRIMEQUEST"), | |
210 | }, | |
211 | }, | |
212 | {} | |
213 | }; | |
214 | ||
ab1a2e03 | 215 | void __init acpi_pci_slot_init(void) |
8344b568 AC |
216 | { |
217 | dmi_check_system(acpi_pci_slot_dmi_table); | |
8344b568 | 218 | } |