Loading...
1/******************************************************************************
2 * platform-pci.c
3 *
4 * Xen platform PCI device driver
5 * Copyright (c) 2005, Intel Corporation.
6 * Copyright (c) 2007, XenSource Inc.
7 * Copyright (c) 2010, Citrix
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms and conditions of the GNU General Public License,
11 * version 2, as published by the Free Software Foundation.
12 *
13 * This program is distributed in the hope it will be useful, but WITHOUT
14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * more details.
17 *
18 * You should have received a copy of the GNU General Public License along with
19 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
20 * Place - Suite 330, Boston, MA 02111-1307 USA.
21 *
22 */
23
24
25#include <linux/interrupt.h>
26#include <linux/io.h>
27#include <linux/module.h>
28#include <linux/pci.h>
29
30#include <xen/platform_pci.h>
31#include <xen/grant_table.h>
32#include <xen/xenbus.h>
33#include <xen/events.h>
34#include <xen/hvm.h>
35#include <xen/xen-ops.h>
36
37#define DRV_NAME "xen-platform-pci"
38
39MODULE_AUTHOR("ssmith@xensource.com and stefano.stabellini@eu.citrix.com");
40MODULE_DESCRIPTION("Xen platform PCI device");
41MODULE_LICENSE("GPL");
42
43static unsigned long platform_mmio;
44static unsigned long platform_mmio_alloc;
45static unsigned long platform_mmiolen;
46static uint64_t callback_via;
47
48unsigned long alloc_xen_mmio(unsigned long len)
49{
50 unsigned long addr;
51
52 addr = platform_mmio + platform_mmio_alloc;
53 platform_mmio_alloc += len;
54 BUG_ON(platform_mmio_alloc > platform_mmiolen);
55
56 return addr;
57}
58
59static uint64_t get_callback_via(struct pci_dev *pdev)
60{
61 u8 pin;
62 int irq;
63
64 irq = pdev->irq;
65 if (irq < 16)
66 return irq; /* ISA IRQ */
67
68 pin = pdev->pin;
69
70 /* We don't know the GSI. Specify the PCI INTx line instead. */
71 return ((uint64_t)0x01 << 56) | /* PCI INTx identifier */
72 ((uint64_t)pci_domain_nr(pdev->bus) << 32) |
73 ((uint64_t)pdev->bus->number << 16) |
74 ((uint64_t)(pdev->devfn & 0xff) << 8) |
75 ((uint64_t)(pin - 1) & 3);
76}
77
78static irqreturn_t do_hvm_evtchn_intr(int irq, void *dev_id)
79{
80 xen_hvm_evtchn_do_upcall();
81 return IRQ_HANDLED;
82}
83
84static int xen_allocate_irq(struct pci_dev *pdev)
85{
86 return request_irq(pdev->irq, do_hvm_evtchn_intr,
87 IRQF_DISABLED | IRQF_NOBALANCING | IRQF_TRIGGER_RISING,
88 "xen-platform-pci", pdev);
89}
90
91static int platform_pci_resume(struct pci_dev *pdev)
92{
93 int err;
94 if (xen_have_vector_callback)
95 return 0;
96 err = xen_set_callback_via(callback_via);
97 if (err) {
98 dev_err(&pdev->dev, "platform_pci_resume failure!\n");
99 return err;
100 }
101 return 0;
102}
103
104static int __devinit platform_pci_init(struct pci_dev *pdev,
105 const struct pci_device_id *ent)
106{
107 int i, ret;
108 long ioaddr;
109 long mmio_addr, mmio_len;
110 unsigned int max_nr_gframes;
111
112 i = pci_enable_device(pdev);
113 if (i)
114 return i;
115
116 ioaddr = pci_resource_start(pdev, 0);
117
118 mmio_addr = pci_resource_start(pdev, 1);
119 mmio_len = pci_resource_len(pdev, 1);
120
121 if (mmio_addr == 0 || ioaddr == 0) {
122 dev_err(&pdev->dev, "no resources found\n");
123 ret = -ENOENT;
124 goto pci_out;
125 }
126
127 ret = pci_request_region(pdev, 1, DRV_NAME);
128 if (ret < 0)
129 goto pci_out;
130
131 ret = pci_request_region(pdev, 0, DRV_NAME);
132 if (ret < 0)
133 goto mem_out;
134
135 platform_mmio = mmio_addr;
136 platform_mmiolen = mmio_len;
137
138 if (!xen_have_vector_callback) {
139 ret = xen_allocate_irq(pdev);
140 if (ret) {
141 dev_warn(&pdev->dev, "request_irq failed err=%d\n", ret);
142 goto out;
143 }
144 callback_via = get_callback_via(pdev);
145 ret = xen_set_callback_via(callback_via);
146 if (ret) {
147 dev_warn(&pdev->dev, "Unable to set the evtchn callback "
148 "err=%d\n", ret);
149 goto out;
150 }
151 }
152
153 max_nr_gframes = gnttab_max_grant_frames();
154 xen_hvm_resume_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes);
155 ret = gnttab_init();
156 if (ret)
157 goto out;
158 xenbus_probe(NULL);
159 return 0;
160
161out:
162 pci_release_region(pdev, 0);
163mem_out:
164 pci_release_region(pdev, 1);
165pci_out:
166 pci_disable_device(pdev);
167 return ret;
168}
169
170static struct pci_device_id platform_pci_tbl[] __devinitdata = {
171 {PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM,
172 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
173 {0,}
174};
175
176MODULE_DEVICE_TABLE(pci, platform_pci_tbl);
177
178static struct pci_driver platform_driver = {
179 .name = DRV_NAME,
180 .probe = platform_pci_init,
181 .id_table = platform_pci_tbl,
182#ifdef CONFIG_PM
183 .resume_early = platform_pci_resume,
184#endif
185};
186
187static int __init platform_pci_module_init(void)
188{
189 /* no unplug has been done, IGNORE hasn't been specified: just
190 * return now */
191 if (!xen_platform_pci_unplug)
192 return -ENODEV;
193
194 return pci_register_driver(&platform_driver);
195}
196
197module_init(platform_pci_module_init);
1// SPDX-License-Identifier: GPL-2.0-only
2/******************************************************************************
3 * platform-pci.c
4 *
5 * Xen platform PCI device driver
6 *
7 * Authors: ssmith@xensource.com and stefano.stabellini@eu.citrix.com
8 *
9 * Copyright (c) 2005, Intel Corporation.
10 * Copyright (c) 2007, XenSource Inc.
11 * Copyright (c) 2010, Citrix
12 */
13
14
15#include <linux/interrupt.h>
16#include <linux/io.h>
17#include <linux/init.h>
18#include <linux/pci.h>
19
20#include <xen/platform_pci.h>
21#include <xen/grant_table.h>
22#include <xen/xenbus.h>
23#include <xen/events.h>
24#include <xen/hvm.h>
25#include <xen/xen-ops.h>
26
27#define DRV_NAME "xen-platform-pci"
28
29static unsigned long platform_mmio;
30static unsigned long platform_mmio_alloc;
31static unsigned long platform_mmiolen;
32static uint64_t callback_via;
33
34static unsigned long alloc_xen_mmio(unsigned long len)
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
45static 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. */
57 return ((uint64_t)HVM_PARAM_CALLBACK_TYPE_PCI_INTX <<
58 HVM_CALLBACK_VIA_TYPE_SHIFT) |
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
65static irqreturn_t do_hvm_evtchn_intr(int irq, void *dev_id)
66{
67 xen_hvm_evtchn_do_upcall();
68 return IRQ_HANDLED;
69}
70
71static int xen_allocate_irq(struct pci_dev *pdev)
72{
73 return request_irq(pdev->irq, do_hvm_evtchn_intr,
74 IRQF_NOBALANCING | IRQF_TRIGGER_RISING,
75 "xen-platform-pci", pdev);
76}
77
78static int platform_pci_resume(struct device *dev)
79{
80 int err;
81
82 if (xen_have_vector_callback)
83 return 0;
84
85 err = xen_set_callback_via(callback_via);
86 if (err) {
87 dev_err(dev, "platform_pci_resume failure!\n");
88 return err;
89 }
90 return 0;
91}
92
93static int platform_pci_probe(struct pci_dev *pdev,
94 const struct pci_device_id *ent)
95{
96 int i, ret;
97 long ioaddr;
98 long mmio_addr, mmio_len;
99 unsigned int max_nr_gframes;
100 unsigned long grant_frames;
101
102 if (!xen_domain())
103 return -ENODEV;
104
105 i = pci_enable_device(pdev);
106 if (i)
107 return i;
108
109 ioaddr = pci_resource_start(pdev, 0);
110
111 mmio_addr = pci_resource_start(pdev, 1);
112 mmio_len = pci_resource_len(pdev, 1);
113
114 if (mmio_addr == 0 || ioaddr == 0) {
115 dev_err(&pdev->dev, "no resources found\n");
116 ret = -ENOENT;
117 goto pci_out;
118 }
119
120 ret = pci_request_region(pdev, 1, DRV_NAME);
121 if (ret < 0)
122 goto pci_out;
123
124 ret = pci_request_region(pdev, 0, DRV_NAME);
125 if (ret < 0)
126 goto mem_out;
127
128 platform_mmio = mmio_addr;
129 platform_mmiolen = mmio_len;
130 if (!xen_have_vector_callback) {
131 ret = xen_allocate_irq(pdev);
132 if (ret) {
133 dev_warn(&pdev->dev, "request_irq failed err=%d\n", ret);
134 goto out;
135 }
136 /*
137 * It doesn't strictly *have* to run on CPU0 but it sure
138 * as hell better process the event channel ports delivered
139 * to CPU0.
140 */
141 irq_set_affinity(pdev->irq, cpumask_of(0));
142
143 callback_via = get_callback_via(pdev);
144 ret = xen_set_callback_via(callback_via);
145 if (ret) {
146 dev_warn(&pdev->dev, "Unable to set the evtchn callback "
147 "err=%d\n", ret);
148 goto irq_out;
149 }
150 }
151
152 max_nr_gframes = gnttab_max_grant_frames();
153 grant_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes);
154 ret = gnttab_setup_auto_xlat_frames(grant_frames);
155 if (ret)
156 goto irq_out;
157 ret = gnttab_init();
158 if (ret)
159 goto grant_out;
160 return 0;
161grant_out:
162 gnttab_free_auto_xlat_frames();
163irq_out:
164 if (!xen_have_vector_callback)
165 free_irq(pdev->irq, pdev);
166out:
167 pci_release_region(pdev, 0);
168mem_out:
169 pci_release_region(pdev, 1);
170pci_out:
171 pci_disable_device(pdev);
172 return ret;
173}
174
175static const struct pci_device_id platform_pci_tbl[] = {
176 {PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM,
177 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
178 {0,}
179};
180
181static const struct dev_pm_ops platform_pm_ops = {
182 .resume_noirq = platform_pci_resume,
183};
184
185static struct pci_driver platform_driver = {
186 .name = DRV_NAME,
187 .probe = platform_pci_probe,
188 .id_table = platform_pci_tbl,
189 .driver = {
190 .pm = &platform_pm_ops,
191 },
192};
193
194builtin_pci_driver(platform_driver);