Commit | Line | Data |
---|---|---|
3b20eb23 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
183d03cc SS |
2 | /****************************************************************************** |
3 | * platform-pci.c | |
4 | * | |
5 | * Xen platform PCI device driver | |
e01dc539 PG |
6 | * |
7 | * Authors: ssmith@xensource.com and stefano.stabellini@eu.citrix.com | |
8 | * | |
183d03cc SS |
9 | * Copyright (c) 2005, Intel Corporation. |
10 | * Copyright (c) 2007, XenSource Inc. | |
11 | * Copyright (c) 2010, Citrix | |
183d03cc SS |
12 | */ |
13 | ||
14 | ||
15 | #include <linux/interrupt.h> | |
16 | #include <linux/io.h> | |
e01dc539 | 17 | #include <linux/init.h> |
183d03cc SS |
18 | #include <linux/pci.h> |
19 | ||
c1c5413a | 20 | #include <xen/platform_pci.h> |
183d03cc SS |
21 | #include <xen/grant_table.h> |
22 | #include <xen/xenbus.h> | |
23 | #include <xen/events.h> | |
24 | #include <xen/hvm.h> | |
016b6f5f | 25 | #include <xen/xen-ops.h> |
183d03cc SS |
26 | |
27 | #define DRV_NAME "xen-platform-pci" | |
28 | ||
183d03cc SS |
29 | static unsigned long platform_mmio; |
30 | static unsigned long platform_mmio_alloc; | |
31 | static unsigned long platform_mmiolen; | |
da72ff5b | 32 | static uint64_t callback_via; |
183d03cc | 33 | |
598ddb8c | 34 | static unsigned long alloc_xen_mmio(unsigned long len) |
183d03cc SS |
35 | { |
36 | unsigned long addr; | |
37 | ||
38 | addr = platform_mmio + platform_mmio_alloc; | |
39 | platform_mmio_alloc += len; | |
40 | BUG_ON(platform_mmio_alloc > platform_mmiolen); | |
41 | ||
42 | return addr; | |
43 | } | |
44 | ||
da72ff5b SS |
45 | static uint64_t get_callback_via(struct pci_dev *pdev) |
46 | { | |
47 | u8 pin; | |
48 | int irq; | |
49 | ||
50 | irq = pdev->irq; | |
51 | if (irq < 16) | |
52 | return irq; /* ISA IRQ */ | |
53 | ||
54 | pin = pdev->pin; | |
55 | ||
56 | /* We don't know the GSI. Specify the PCI INTx line instead. */ | |
4abb77fc JG |
57 | return ((uint64_t)HVM_PARAM_CALLBACK_TYPE_PCI_INTX << |
58 | HVM_CALLBACK_VIA_TYPE_SHIFT) | | |
da72ff5b SS |
59 | ((uint64_t)pci_domain_nr(pdev->bus) << 32) | |
60 | ((uint64_t)pdev->bus->number << 16) | | |
61 | ((uint64_t)(pdev->devfn & 0xff) << 8) | | |
62 | ((uint64_t)(pin - 1) & 3); | |
63 | } | |
64 | ||
65 | static irqreturn_t do_hvm_evtchn_intr(int irq, void *dev_id) | |
66 | { | |
3e8cd711 | 67 | return xen_hvm_evtchn_do_upcall(); |
da72ff5b SS |
68 | } |
69 | ||
70 | static int xen_allocate_irq(struct pci_dev *pdev) | |
71 | { | |
72 | return request_irq(pdev->irq, do_hvm_evtchn_intr, | |
3e8cd711 | 73 | IRQF_NOBALANCING | IRQF_SHARED, |
da72ff5b SS |
74 | "xen-platform-pci", pdev); |
75 | } | |
76 | ||
77b84bb3 | 77 | static int platform_pci_resume(struct device *dev) |
da72ff5b SS |
78 | { |
79 | int err; | |
84d582d2 BO |
80 | |
81 | if (xen_have_vector_callback) | |
da72ff5b | 82 | return 0; |
84d582d2 | 83 | |
da72ff5b SS |
84 | err = xen_set_callback_via(callback_via); |
85 | if (err) { | |
77b84bb3 | 86 | dev_err(dev, "platform_pci_resume failure!\n"); |
da72ff5b SS |
87 | return err; |
88 | } | |
89 | return 0; | |
90 | } | |
91 | ||
e01dc539 PG |
92 | static int platform_pci_probe(struct pci_dev *pdev, |
93 | const struct pci_device_id *ent) | |
183d03cc SS |
94 | { |
95 | int i, ret; | |
00f28e40 | 96 | long ioaddr; |
183d03cc | 97 | long mmio_addr, mmio_len; |
183d03cc | 98 | unsigned int max_nr_gframes; |
efaf30a3 | 99 | unsigned long grant_frames; |
183d03cc | 100 | |
38ad4f4b OH |
101 | if (!xen_domain()) |
102 | return -ENODEV; | |
103 | ||
183d03cc SS |
104 | i = pci_enable_device(pdev); |
105 | if (i) | |
106 | return i; | |
107 | ||
108 | ioaddr = pci_resource_start(pdev, 0); | |
183d03cc SS |
109 | |
110 | mmio_addr = pci_resource_start(pdev, 1); | |
111 | mmio_len = pci_resource_len(pdev, 1); | |
112 | ||
113 | if (mmio_addr == 0 || ioaddr == 0) { | |
114 | dev_err(&pdev->dev, "no resources found\n"); | |
115 | ret = -ENOENT; | |
116 | goto pci_out; | |
117 | } | |
118 | ||
00f28e40 IC |
119 | ret = pci_request_region(pdev, 1, DRV_NAME); |
120 | if (ret < 0) | |
183d03cc | 121 | goto pci_out; |
183d03cc | 122 | |
00f28e40 IC |
123 | ret = pci_request_region(pdev, 0, DRV_NAME); |
124 | if (ret < 0) | |
183d03cc | 125 | goto mem_out; |
183d03cc SS |
126 | |
127 | platform_mmio = mmio_addr; | |
128 | platform_mmiolen = mmio_len; | |
84d582d2 | 129 | if (!xen_have_vector_callback) { |
da72ff5b SS |
130 | ret = xen_allocate_irq(pdev); |
131 | if (ret) { | |
132 | dev_warn(&pdev->dev, "request_irq failed err=%d\n", ret); | |
133 | goto out; | |
134 | } | |
8f4fd86a DW |
135 | /* |
136 | * It doesn't strictly *have* to run on CPU0 but it sure | |
137 | * as hell better process the event channel ports delivered | |
138 | * to CPU0. | |
139 | */ | |
140 | irq_set_affinity(pdev->irq, cpumask_of(0)); | |
141 | ||
da72ff5b SS |
142 | callback_via = get_callback_via(pdev); |
143 | ret = xen_set_callback_via(callback_via); | |
144 | if (ret) { | |
145 | dev_warn(&pdev->dev, "Unable to set the evtchn callback " | |
146 | "err=%d\n", ret); | |
c53717e1 | 147 | goto irq_out; |
da72ff5b SS |
148 | } |
149 | } | |
150 | ||
183d03cc | 151 | max_nr_gframes = gnttab_max_grant_frames(); |
efaf30a3 | 152 | grant_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes); |
89b9e08f WY |
153 | ret = gnttab_setup_auto_xlat_frames(grant_frames); |
154 | if (ret) | |
c53717e1 | 155 | goto irq_out; |
183d03cc SS |
156 | ret = gnttab_init(); |
157 | if (ret) | |
efaf30a3 | 158 | goto grant_out; |
183d03cc | 159 | return 0; |
efaf30a3 KRW |
160 | grant_out: |
161 | gnttab_free_auto_xlat_frames(); | |
c53717e1 | 162 | irq_out: |
163 | if (!xen_have_vector_callback) | |
164 | free_irq(pdev->irq, pdev); | |
183d03cc | 165 | out: |
00f28e40 | 166 | pci_release_region(pdev, 0); |
183d03cc | 167 | mem_out: |
00f28e40 | 168 | pci_release_region(pdev, 1); |
183d03cc SS |
169 | pci_out: |
170 | pci_disable_device(pdev); | |
171 | return ret; | |
172 | } | |
173 | ||
fff219d9 | 174 | static const struct pci_device_id platform_pci_tbl[] = { |
183d03cc SS |
175 | {PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM, |
176 | PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, | |
177 | {0,} | |
178 | }; | |
179 | ||
c17db640 | 180 | static const struct dev_pm_ops platform_pm_ops = { |
77b84bb3 BH |
181 | .resume_noirq = platform_pci_resume, |
182 | }; | |
183 | ||
183d03cc SS |
184 | static struct pci_driver platform_driver = { |
185 | .name = DRV_NAME, | |
e01dc539 | 186 | .probe = platform_pci_probe, |
183d03cc | 187 | .id_table = platform_pci_tbl, |
77b84bb3 BH |
188 | .driver = { |
189 | .pm = &platform_pm_ops, | |
190 | }, | |
183d03cc SS |
191 | }; |
192 | ||
1ea55e80 | 193 | builtin_pci_driver(platform_driver); |