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