]>
Commit | Line | Data |
---|---|---|
e28c31a9 WH |
1 | /* |
2 | * Copyright (c) 2009, Intel Corporation. | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify it | |
5 | * under the terms and conditions of the GNU General Public License, | |
6 | * version 2, as published by the Free Software Foundation. | |
7 | * | |
8 | * This program is distributed in the hope it will be useful, but WITHOUT | |
9 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
10 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
11 | * more details. | |
12 | * | |
13 | * You should have received a copy of the GNU General Public License along with | |
14 | * this program; if not, write to the Free Software Foundation, Inc., 59 Temple | |
15 | * Place - Suite 330, Boston, MA 02111-1307 USA. | |
16 | * | |
17 | * Author: Weidong Han <[email protected]> | |
18 | */ | |
19 | ||
20 | #include <linux/pci.h> | |
55e901fc | 21 | #include <linux/acpi.h> |
e28c31a9 WH |
22 | #include <xen/xen.h> |
23 | #include <xen/interface/physdev.h> | |
24 | #include <xen/interface/xen.h> | |
25 | ||
26 | #include <asm/xen/hypervisor.h> | |
27 | #include <asm/xen/hypercall.h> | |
28 | #include "../pci/pci.h" | |
b7ef4a6d | 29 | #ifdef CONFIG_PCI_MMCONFIG |
8deb3eb1 | 30 | #include <asm/pci_x86.h> |
b7ef4a6d | 31 | #endif |
e28c31a9 | 32 | |
55e901fc JB |
33 | static bool __read_mostly pci_seg_supported = true; |
34 | ||
e28c31a9 WH |
35 | static int xen_add_device(struct device *dev) |
36 | { | |
37 | int r; | |
38 | struct pci_dev *pci_dev = to_pci_dev(dev); | |
55e901fc JB |
39 | #ifdef CONFIG_PCI_IOV |
40 | struct pci_dev *physfn = pci_dev->physfn; | |
41 | #endif | |
42 | ||
43 | if (pci_seg_supported) { | |
486edb24 BO |
44 | struct { |
45 | struct physdev_pci_device_add add; | |
46 | uint32_t pxm; | |
47 | } add_ext = { | |
48 | .add.seg = pci_domain_nr(pci_dev->bus), | |
49 | .add.bus = pci_dev->bus->number, | |
50 | .add.devfn = pci_dev->devfn | |
55e901fc | 51 | }; |
486edb24 BO |
52 | struct physdev_pci_device_add *add = &add_ext.add; |
53 | ||
55e901fc JB |
54 | #ifdef CONFIG_ACPI |
55 | acpi_handle handle; | |
56 | #endif | |
e28c31a9 WH |
57 | |
58 | #ifdef CONFIG_PCI_IOV | |
55e901fc | 59 | if (pci_dev->is_virtfn) { |
486edb24 BO |
60 | add->flags = XEN_PCI_DEV_VIRTFN; |
61 | add->physfn.bus = physfn->bus->number; | |
62 | add->physfn.devfn = physfn->devfn; | |
55e901fc JB |
63 | } else |
64 | #endif | |
65 | if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn)) | |
486edb24 | 66 | add->flags = XEN_PCI_DEV_EXTFN; |
55e901fc JB |
67 | |
68 | #ifdef CONFIG_ACPI | |
3a83f992 | 69 | handle = ACPI_HANDLE(&pci_dev->dev); |
780dbcd0 | 70 | if (!handle && pci_dev->bus->bridge) |
3a83f992 | 71 | handle = ACPI_HANDLE(pci_dev->bus->bridge); |
55e901fc JB |
72 | #ifdef CONFIG_PCI_IOV |
73 | if (!handle && pci_dev->is_virtfn) | |
3a83f992 | 74 | handle = ACPI_HANDLE(physfn->bus->bridge); |
55e901fc JB |
75 | #endif |
76 | if (handle) { | |
77 | acpi_status status; | |
78 | ||
79 | do { | |
80 | unsigned long long pxm; | |
81 | ||
82 | status = acpi_evaluate_integer(handle, "_PXM", | |
83 | NULL, &pxm); | |
84 | if (ACPI_SUCCESS(status)) { | |
486edb24 BO |
85 | add->optarr[0] = pxm; |
86 | add->flags |= XEN_PCI_DEV_PXM; | |
55e901fc JB |
87 | break; |
88 | } | |
89 | status = acpi_get_parent(handle, &handle); | |
90 | } while (ACPI_SUCCESS(status)); | |
91 | } | |
92 | #endif /* CONFIG_ACPI */ | |
93 | ||
486edb24 | 94 | r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_add, add); |
55e901fc JB |
95 | if (r != -ENOSYS) |
96 | return r; | |
97 | pci_seg_supported = false; | |
98 | } | |
99 | ||
100 | if (pci_domain_nr(pci_dev->bus)) | |
101 | r = -ENOSYS; | |
102 | #ifdef CONFIG_PCI_IOV | |
103 | else if (pci_dev->is_virtfn) { | |
e28c31a9 WH |
104 | struct physdev_manage_pci_ext manage_pci_ext = { |
105 | .bus = pci_dev->bus->number, | |
106 | .devfn = pci_dev->devfn, | |
107 | .is_virtfn = 1, | |
55e901fc JB |
108 | .physfn.bus = physfn->bus->number, |
109 | .physfn.devfn = physfn->devfn, | |
e28c31a9 WH |
110 | }; |
111 | ||
112 | r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext, | |
113 | &manage_pci_ext); | |
55e901fc | 114 | } |
e28c31a9 | 115 | #endif |
55e901fc | 116 | else if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn)) { |
e28c31a9 WH |
117 | struct physdev_manage_pci_ext manage_pci_ext = { |
118 | .bus = pci_dev->bus->number, | |
119 | .devfn = pci_dev->devfn, | |
120 | .is_extfn = 1, | |
121 | }; | |
122 | ||
123 | r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext, | |
124 | &manage_pci_ext); | |
125 | } else { | |
126 | struct physdev_manage_pci manage_pci = { | |
4b010983 | 127 | .bus = pci_dev->bus->number, |
e28c31a9 WH |
128 | .devfn = pci_dev->devfn, |
129 | }; | |
130 | ||
131 | r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add, | |
132 | &manage_pci); | |
133 | } | |
134 | ||
135 | return r; | |
136 | } | |
137 | ||
138 | static int xen_remove_device(struct device *dev) | |
139 | { | |
140 | int r; | |
141 | struct pci_dev *pci_dev = to_pci_dev(dev); | |
e28c31a9 | 142 | |
55e901fc JB |
143 | if (pci_seg_supported) { |
144 | struct physdev_pci_device device = { | |
145 | .seg = pci_domain_nr(pci_dev->bus), | |
146 | .bus = pci_dev->bus->number, | |
147 | .devfn = pci_dev->devfn | |
148 | }; | |
e28c31a9 | 149 | |
55e901fc JB |
150 | r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_remove, |
151 | &device); | |
152 | } else if (pci_domain_nr(pci_dev->bus)) | |
153 | r = -ENOSYS; | |
154 | else { | |
155 | struct physdev_manage_pci manage_pci = { | |
156 | .bus = pci_dev->bus->number, | |
157 | .devfn = pci_dev->devfn | |
158 | }; | |
159 | ||
160 | r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_remove, | |
161 | &manage_pci); | |
162 | } | |
e28c31a9 WH |
163 | |
164 | return r; | |
165 | } | |
166 | ||
167 | static int xen_pci_notifier(struct notifier_block *nb, | |
168 | unsigned long action, void *data) | |
169 | { | |
170 | struct device *dev = data; | |
171 | int r = 0; | |
172 | ||
173 | switch (action) { | |
174 | case BUS_NOTIFY_ADD_DEVICE: | |
175 | r = xen_add_device(dev); | |
176 | break; | |
177 | case BUS_NOTIFY_DEL_DEVICE: | |
178 | r = xen_remove_device(dev); | |
179 | break; | |
180 | default: | |
12e13ac8 | 181 | return NOTIFY_DONE; |
e28c31a9 | 182 | } |
12e13ac8 JB |
183 | if (r) |
184 | dev_err(dev, "Failed to %s - passthrough or MSI/MSI-X might fail!\n", | |
185 | action == BUS_NOTIFY_ADD_DEVICE ? "add" : | |
186 | (action == BUS_NOTIFY_DEL_DEVICE ? "delete" : "?")); | |
187 | return NOTIFY_OK; | |
e28c31a9 WH |
188 | } |
189 | ||
12e13ac8 | 190 | static struct notifier_block device_nb = { |
e28c31a9 WH |
191 | .notifier_call = xen_pci_notifier, |
192 | }; | |
193 | ||
194 | static int __init register_xen_pci_notifier(void) | |
195 | { | |
196 | if (!xen_initial_domain()) | |
197 | return 0; | |
198 | ||
199 | return bus_register_notifier(&pci_bus_type, &device_nb); | |
200 | } | |
201 | ||
202 | arch_initcall(register_xen_pci_notifier); | |
8deb3eb1 KRW |
203 | |
204 | #ifdef CONFIG_PCI_MMCONFIG | |
205 | static int __init xen_mcfg_late(void) | |
206 | { | |
207 | struct pci_mmcfg_region *cfg; | |
208 | int rc; | |
209 | ||
210 | if (!xen_initial_domain()) | |
211 | return 0; | |
212 | ||
213 | if ((pci_probe & PCI_PROBE_MMCONF) == 0) | |
214 | return 0; | |
215 | ||
216 | if (list_empty(&pci_mmcfg_list)) | |
217 | return 0; | |
218 | ||
219 | /* Check whether they are in the right area. */ | |
220 | list_for_each_entry(cfg, &pci_mmcfg_list, list) { | |
221 | struct physdev_pci_mmcfg_reserved r; | |
222 | ||
223 | r.address = cfg->address; | |
224 | r.segment = cfg->segment; | |
225 | r.start_bus = cfg->start_bus; | |
226 | r.end_bus = cfg->end_bus; | |
227 | r.flags = XEN_PCI_MMCFG_RESERVED; | |
228 | ||
229 | rc = HYPERVISOR_physdev_op(PHYSDEVOP_pci_mmcfg_reserved, &r); | |
230 | switch (rc) { | |
231 | case 0: | |
232 | case -ENOSYS: | |
233 | continue; | |
234 | ||
235 | default: | |
236 | pr_warn("Failed to report MMCONFIG reservation" | |
237 | " state for %s to hypervisor" | |
238 | " (%d)\n", | |
239 | cfg->name, rc); | |
240 | } | |
241 | } | |
242 | return 0; | |
243 | } | |
244 | /* | |
245 | * Needs to be done after acpi_init which are subsys_initcall. | |
246 | */ | |
247 | subsys_initcall_sync(xen_mcfg_late); | |
248 | #endif |