Commit | Line | Data |
---|---|---|
183d03cc SS |
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 | ||
c1c5413a | 30 | #include <xen/platform_pci.h> |
183d03cc SS |
31 | #include <xen/grant_table.h> |
32 | #include <xen/xenbus.h> | |
33 | #include <xen/events.h> | |
34 | #include <xen/hvm.h> | |
016b6f5f | 35 | #include <xen/xen-ops.h> |
183d03cc SS |
36 | |
37 | #define DRV_NAME "xen-platform-pci" | |
38 | ||
39 | MODULE_AUTHOR("ssmith@xensource.com and stefano.stabellini@eu.citrix.com"); | |
40 | MODULE_DESCRIPTION("Xen platform PCI device"); | |
41 | MODULE_LICENSE("GPL"); | |
42 | ||
43 | static unsigned long platform_mmio; | |
44 | static unsigned long platform_mmio_alloc; | |
45 | static unsigned long platform_mmiolen; | |
016b6f5f | 46 | static uint64_t callback_via; |
183d03cc SS |
47 | |
48 | unsigned 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 | ||
59 | static 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 | ||
78 | static irqreturn_t do_hvm_evtchn_intr(int irq, void *dev_id) | |
79 | { | |
80 | xen_hvm_evtchn_do_upcall(); | |
81 | return IRQ_HANDLED; | |
82 | } | |
83 | ||
84 | static 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 | ||
016b6f5f SS |
91 | static 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 | ||
00e37bdb OH |
104 | static void __devinit prepare_shared_info(void) |
105 | { | |
106 | #ifdef CONFIG_KEXEC | |
107 | unsigned long addr; | |
108 | struct shared_info *hvm_shared_info; | |
109 | ||
110 | addr = alloc_xen_mmio(PAGE_SIZE); | |
111 | hvm_shared_info = ioremap(addr, PAGE_SIZE); | |
112 | memset(hvm_shared_info, 0, PAGE_SIZE); | |
113 | xen_hvm_prepare_kexec(hvm_shared_info, addr >> PAGE_SHIFT); | |
114 | #endif | |
115 | } | |
116 | ||
183d03cc SS |
117 | static int __devinit platform_pci_init(struct pci_dev *pdev, |
118 | const struct pci_device_id *ent) | |
119 | { | |
120 | int i, ret; | |
00f28e40 | 121 | long ioaddr; |
183d03cc | 122 | long mmio_addr, mmio_len; |
183d03cc SS |
123 | unsigned int max_nr_gframes; |
124 | ||
38ad4f4b OH |
125 | if (!xen_domain()) |
126 | return -ENODEV; | |
127 | ||
183d03cc SS |
128 | i = pci_enable_device(pdev); |
129 | if (i) | |
130 | return i; | |
131 | ||
132 | ioaddr = pci_resource_start(pdev, 0); | |
183d03cc SS |
133 | |
134 | mmio_addr = pci_resource_start(pdev, 1); | |
135 | mmio_len = pci_resource_len(pdev, 1); | |
136 | ||
137 | if (mmio_addr == 0 || ioaddr == 0) { | |
138 | dev_err(&pdev->dev, "no resources found\n"); | |
139 | ret = -ENOENT; | |
140 | goto pci_out; | |
141 | } | |
142 | ||
00f28e40 IC |
143 | ret = pci_request_region(pdev, 1, DRV_NAME); |
144 | if (ret < 0) | |
183d03cc | 145 | goto pci_out; |
183d03cc | 146 | |
00f28e40 IC |
147 | ret = pci_request_region(pdev, 0, DRV_NAME); |
148 | if (ret < 0) | |
183d03cc | 149 | goto mem_out; |
183d03cc SS |
150 | |
151 | platform_mmio = mmio_addr; | |
152 | platform_mmiolen = mmio_len; | |
153 | ||
00e37bdb OH |
154 | prepare_shared_info(); |
155 | ||
183d03cc SS |
156 | if (!xen_have_vector_callback) { |
157 | ret = xen_allocate_irq(pdev); | |
158 | if (ret) { | |
159 | dev_warn(&pdev->dev, "request_irq failed err=%d\n", ret); | |
160 | goto out; | |
161 | } | |
162 | callback_via = get_callback_via(pdev); | |
163 | ret = xen_set_callback_via(callback_via); | |
164 | if (ret) { | |
165 | dev_warn(&pdev->dev, "Unable to set the evtchn callback " | |
166 | "err=%d\n", ret); | |
167 | goto out; | |
168 | } | |
169 | } | |
170 | ||
171 | max_nr_gframes = gnttab_max_grant_frames(); | |
172 | xen_hvm_resume_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes); | |
173 | ret = gnttab_init(); | |
174 | if (ret) | |
175 | goto out; | |
176 | xenbus_probe(NULL); | |
177 | return 0; | |
178 | ||
179 | out: | |
00f28e40 | 180 | pci_release_region(pdev, 0); |
183d03cc | 181 | mem_out: |
00f28e40 | 182 | pci_release_region(pdev, 1); |
183d03cc SS |
183 | pci_out: |
184 | pci_disable_device(pdev); | |
185 | return ret; | |
186 | } | |
187 | ||
188 | static struct pci_device_id platform_pci_tbl[] __devinitdata = { | |
189 | {PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM, | |
190 | PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, | |
191 | {0,} | |
192 | }; | |
193 | ||
194 | MODULE_DEVICE_TABLE(pci, platform_pci_tbl); | |
195 | ||
196 | static struct pci_driver platform_driver = { | |
197 | .name = DRV_NAME, | |
198 | .probe = platform_pci_init, | |
199 | .id_table = platform_pci_tbl, | |
016b6f5f SS |
200 | #ifdef CONFIG_PM |
201 | .resume_early = platform_pci_resume, | |
202 | #endif | |
183d03cc SS |
203 | }; |
204 | ||
205 | static int __init platform_pci_module_init(void) | |
206 | { | |
207 | return pci_register_driver(&platform_driver); | |
208 | } | |
209 | ||
210 | module_init(platform_pci_module_init); |