Loading...
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 <weidong.han@intel.com>
18 */
19
20#include <linux/pci.h>
21#include <xen/xen.h>
22#include <xen/interface/physdev.h>
23#include <xen/interface/xen.h>
24
25#include <asm/xen/hypervisor.h>
26#include <asm/xen/hypercall.h>
27#include "../pci/pci.h"
28
29static int xen_add_device(struct device *dev)
30{
31 int r;
32 struct pci_dev *pci_dev = to_pci_dev(dev);
33
34#ifdef CONFIG_PCI_IOV
35 if (pci_dev->is_virtfn) {
36 struct physdev_manage_pci_ext manage_pci_ext = {
37 .bus = pci_dev->bus->number,
38 .devfn = pci_dev->devfn,
39 .is_virtfn = 1,
40 .physfn.bus = pci_dev->physfn->bus->number,
41 .physfn.devfn = pci_dev->physfn->devfn,
42 };
43
44 r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
45 &manage_pci_ext);
46 } else
47#endif
48 if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn)) {
49 struct physdev_manage_pci_ext manage_pci_ext = {
50 .bus = pci_dev->bus->number,
51 .devfn = pci_dev->devfn,
52 .is_extfn = 1,
53 };
54
55 r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
56 &manage_pci_ext);
57 } else {
58 struct physdev_manage_pci manage_pci = {
59 .bus = pci_dev->bus->number,
60 .devfn = pci_dev->devfn,
61 };
62
63 r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add,
64 &manage_pci);
65 }
66
67 return r;
68}
69
70static int xen_remove_device(struct device *dev)
71{
72 int r;
73 struct pci_dev *pci_dev = to_pci_dev(dev);
74 struct physdev_manage_pci manage_pci;
75
76 manage_pci.bus = pci_dev->bus->number;
77 manage_pci.devfn = pci_dev->devfn;
78
79 r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_remove,
80 &manage_pci);
81
82 return r;
83}
84
85static int xen_pci_notifier(struct notifier_block *nb,
86 unsigned long action, void *data)
87{
88 struct device *dev = data;
89 int r = 0;
90
91 switch (action) {
92 case BUS_NOTIFY_ADD_DEVICE:
93 r = xen_add_device(dev);
94 break;
95 case BUS_NOTIFY_DEL_DEVICE:
96 r = xen_remove_device(dev);
97 break;
98 default:
99 break;
100 }
101
102 return r;
103}
104
105struct notifier_block device_nb = {
106 .notifier_call = xen_pci_notifier,
107};
108
109static int __init register_xen_pci_notifier(void)
110{
111 if (!xen_initial_domain())
112 return 0;
113
114 return bus_register_notifier(&pci_bus_type, &device_nb);
115}
116
117arch_initcall(register_xen_pci_notifier);
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 <weidong.han@intel.com>
18 */
19
20#include <linux/pci.h>
21#include <linux/acpi.h>
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"
29#ifdef CONFIG_PCI_MMCONFIG
30#include <asm/pci_x86.h>
31#endif
32
33static bool __read_mostly pci_seg_supported = true;
34
35static int xen_add_device(struct device *dev)
36{
37 int r;
38 struct pci_dev *pci_dev = to_pci_dev(dev);
39#ifdef CONFIG_PCI_IOV
40 struct pci_dev *physfn = pci_dev->physfn;
41#endif
42
43 if (pci_seg_supported) {
44 struct physdev_pci_device_add add = {
45 .seg = pci_domain_nr(pci_dev->bus),
46 .bus = pci_dev->bus->number,
47 .devfn = pci_dev->devfn
48 };
49#ifdef CONFIG_ACPI
50 acpi_handle handle;
51#endif
52
53#ifdef CONFIG_PCI_IOV
54 if (pci_dev->is_virtfn) {
55 add.flags = XEN_PCI_DEV_VIRTFN;
56 add.physfn.bus = physfn->bus->number;
57 add.physfn.devfn = physfn->devfn;
58 } else
59#endif
60 if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn))
61 add.flags = XEN_PCI_DEV_EXTFN;
62
63#ifdef CONFIG_ACPI
64 handle = ACPI_HANDLE(&pci_dev->dev);
65 if (!handle && pci_dev->bus->bridge)
66 handle = ACPI_HANDLE(pci_dev->bus->bridge);
67#ifdef CONFIG_PCI_IOV
68 if (!handle && pci_dev->is_virtfn)
69 handle = ACPI_HANDLE(physfn->bus->bridge);
70#endif
71 if (handle) {
72 acpi_status status;
73
74 do {
75 unsigned long long pxm;
76
77 status = acpi_evaluate_integer(handle, "_PXM",
78 NULL, &pxm);
79 if (ACPI_SUCCESS(status)) {
80 add.optarr[0] = pxm;
81 add.flags |= XEN_PCI_DEV_PXM;
82 break;
83 }
84 status = acpi_get_parent(handle, &handle);
85 } while (ACPI_SUCCESS(status));
86 }
87#endif /* CONFIG_ACPI */
88
89 r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_add, &add);
90 if (r != -ENOSYS)
91 return r;
92 pci_seg_supported = false;
93 }
94
95 if (pci_domain_nr(pci_dev->bus))
96 r = -ENOSYS;
97#ifdef CONFIG_PCI_IOV
98 else if (pci_dev->is_virtfn) {
99 struct physdev_manage_pci_ext manage_pci_ext = {
100 .bus = pci_dev->bus->number,
101 .devfn = pci_dev->devfn,
102 .is_virtfn = 1,
103 .physfn.bus = physfn->bus->number,
104 .physfn.devfn = physfn->devfn,
105 };
106
107 r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
108 &manage_pci_ext);
109 }
110#endif
111 else if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn)) {
112 struct physdev_manage_pci_ext manage_pci_ext = {
113 .bus = pci_dev->bus->number,
114 .devfn = pci_dev->devfn,
115 .is_extfn = 1,
116 };
117
118 r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
119 &manage_pci_ext);
120 } else {
121 struct physdev_manage_pci manage_pci = {
122 .bus = pci_dev->bus->number,
123 .devfn = pci_dev->devfn,
124 };
125
126 r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add,
127 &manage_pci);
128 }
129
130 return r;
131}
132
133static int xen_remove_device(struct device *dev)
134{
135 int r;
136 struct pci_dev *pci_dev = to_pci_dev(dev);
137
138 if (pci_seg_supported) {
139 struct physdev_pci_device device = {
140 .seg = pci_domain_nr(pci_dev->bus),
141 .bus = pci_dev->bus->number,
142 .devfn = pci_dev->devfn
143 };
144
145 r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_remove,
146 &device);
147 } else if (pci_domain_nr(pci_dev->bus))
148 r = -ENOSYS;
149 else {
150 struct physdev_manage_pci manage_pci = {
151 .bus = pci_dev->bus->number,
152 .devfn = pci_dev->devfn
153 };
154
155 r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_remove,
156 &manage_pci);
157 }
158
159 return r;
160}
161
162static int xen_pci_notifier(struct notifier_block *nb,
163 unsigned long action, void *data)
164{
165 struct device *dev = data;
166 int r = 0;
167
168 switch (action) {
169 case BUS_NOTIFY_ADD_DEVICE:
170 r = xen_add_device(dev);
171 break;
172 case BUS_NOTIFY_DEL_DEVICE:
173 r = xen_remove_device(dev);
174 break;
175 default:
176 return NOTIFY_DONE;
177 }
178 if (r)
179 dev_err(dev, "Failed to %s - passthrough or MSI/MSI-X might fail!\n",
180 action == BUS_NOTIFY_ADD_DEVICE ? "add" :
181 (action == BUS_NOTIFY_DEL_DEVICE ? "delete" : "?"));
182 return NOTIFY_OK;
183}
184
185static struct notifier_block device_nb = {
186 .notifier_call = xen_pci_notifier,
187};
188
189static int __init register_xen_pci_notifier(void)
190{
191 if (!xen_initial_domain())
192 return 0;
193
194 return bus_register_notifier(&pci_bus_type, &device_nb);
195}
196
197arch_initcall(register_xen_pci_notifier);
198
199#ifdef CONFIG_PCI_MMCONFIG
200static int __init xen_mcfg_late(void)
201{
202 struct pci_mmcfg_region *cfg;
203 int rc;
204
205 if (!xen_initial_domain())
206 return 0;
207
208 if ((pci_probe & PCI_PROBE_MMCONF) == 0)
209 return 0;
210
211 if (list_empty(&pci_mmcfg_list))
212 return 0;
213
214 /* Check whether they are in the right area. */
215 list_for_each_entry(cfg, &pci_mmcfg_list, list) {
216 struct physdev_pci_mmcfg_reserved r;
217
218 r.address = cfg->address;
219 r.segment = cfg->segment;
220 r.start_bus = cfg->start_bus;
221 r.end_bus = cfg->end_bus;
222 r.flags = XEN_PCI_MMCFG_RESERVED;
223
224 rc = HYPERVISOR_physdev_op(PHYSDEVOP_pci_mmcfg_reserved, &r);
225 switch (rc) {
226 case 0:
227 case -ENOSYS:
228 continue;
229
230 default:
231 pr_warn("Failed to report MMCONFIG reservation"
232 " state for %s to hypervisor"
233 " (%d)\n",
234 cfg->name, rc);
235 }
236 }
237 return 0;
238}
239/*
240 * Needs to be done after acpi_init which are subsys_initcall.
241 */
242subsys_initcall_sync(xen_mcfg_late);
243#endif