ia64/xen-unstable

view unmodified_drivers/linux-2.6/platform-pci/platform-pci.c @ 13842:311b27546cf6

[IA64] Follow to allow PV-on-HVM callback irq to be identified by PCI device.

Also delete IA64 specific spec concerned with IA64_CALLBACK_IRQ_RID.

Signed-off-by: Tsunehisa Doi <Doi.Tsunehisa@jp.fujitsu.com>
author awilliam@xenbuild2.aw
date Tue Feb 06 09:26:25 2007 -0700 (2007-02-06)
parents d1710eb35385
children a68a3c6cac5f
line source
1 /******************************************************************************
2 * evtchn-pci.c
3 * xen event channel fake PCI device driver
4 * Copyright (C) 2005, Intel Corporation.
5 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms and conditions of the GNU General Public License,
8 * version 2, as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope it will be useful, but WITHOUT
11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
13 * more details.
14 *
15 * You should have received a copy of the GNU General Public License along with
16 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
17 * Place - Suite 330, Boston, MA 02111-1307 USA.
18 *
19 */
21 #include <linux/module.h>
22 #include <linux/kernel.h>
23 #include <linux/sched.h>
24 #include <linux/errno.h>
25 #include <linux/pci.h>
26 #include <linux/init.h>
27 #include <linux/version.h>
28 #include <linux/interrupt.h>
29 #include <linux/vmalloc.h>
30 #include <linux/mm.h>
31 #include <asm/system.h>
32 #include <asm/io.h>
33 #include <asm/irq.h>
34 #include <asm/uaccess.h>
35 #include <asm/hypervisor.h>
36 #include <asm/pgtable.h>
37 #include <xen/interface/memory.h>
38 #include <xen/features.h>
39 #ifdef __ia64__
40 #include <asm/xen/xencomm.h>
41 #endif
43 #include "platform-pci.h"
45 #ifdef HAVE_XEN_PLATFORM_COMPAT_H
46 #include <xen/platform-compat.h>
47 #endif
49 #define DRV_NAME "xen-platform-pci"
50 #define DRV_VERSION "0.10"
51 #define DRV_RELDATE "03/03/2005"
53 char *hypercall_stubs;
54 EXPORT_SYMBOL(hypercall_stubs);
56 // Used to be xiaofeng.ling@intel.com
57 MODULE_AUTHOR("ssmith@xensource.com");
58 MODULE_DESCRIPTION("Xen platform PCI device");
59 MODULE_LICENSE("GPL");
61 unsigned long *phys_to_machine_mapping;
62 EXPORT_SYMBOL(phys_to_machine_mapping);
64 static int __devinit init_xen_info(void)
65 {
66 unsigned long shared_info_frame;
67 struct xen_add_to_physmap xatp;
68 extern void *shared_info_area;
70 #ifdef __ia64__
71 xencomm_init();
72 #endif
74 setup_xen_features();
76 shared_info_frame = alloc_xen_mmio(PAGE_SIZE) >> PAGE_SHIFT;
77 xatp.domid = DOMID_SELF;
78 xatp.idx = 0;
79 xatp.space = XENMAPSPACE_shared_info;
80 xatp.gpfn = shared_info_frame;
81 if (HYPERVISOR_memory_op(XENMEM_add_to_physmap, &xatp))
82 BUG();
84 shared_info_area =
85 ioremap(shared_info_frame << PAGE_SHIFT, PAGE_SIZE);
86 if (shared_info_area == NULL)
87 panic("can't map shared info\n");
89 phys_to_machine_mapping = NULL;
91 gnttab_init();
93 return 0;
94 }
96 static void __devexit platform_pci_remove(struct pci_dev *pdev)
97 {
98 long ioaddr, iolen;
99 long mmio_addr, mmio_len;
101 ioaddr = pci_resource_start(pdev, 0);
102 iolen = pci_resource_len(pdev, 0);
103 mmio_addr = pci_resource_start(pdev, 1);
104 mmio_len = pci_resource_len(pdev, 1);
106 release_region(ioaddr, iolen);
107 release_mem_region(mmio_addr, mmio_len);
109 pci_set_drvdata(pdev, NULL);
110 free_irq(pdev->irq, pdev);
111 }
113 static unsigned long platform_mmio;
114 static unsigned long platform_mmio_alloc;
115 static unsigned long platform_mmiolen;
117 unsigned long alloc_xen_mmio(unsigned long len)
118 {
119 unsigned long addr;
121 addr = 0;
122 if (platform_mmio_alloc + len <= platform_mmiolen)
123 {
124 addr = platform_mmio + platform_mmio_alloc;
125 platform_mmio_alloc += len;
126 } else {
127 panic("ran out of xen mmio space");
128 }
129 return addr;
130 }
132 #ifndef __ia64__
133 /* Lifted from hvmloader.c */
134 static int get_hypercall_stubs(void)
135 {
136 uint32_t eax, ebx, ecx, edx, pages, msr, i;
137 char signature[13];
139 cpuid(0x40000000, &eax, &ebx, &ecx, &edx);
140 *(uint32_t*)(signature + 0) = ebx;
141 *(uint32_t*)(signature + 4) = ecx;
142 *(uint32_t*)(signature + 8) = edx;
143 signature[12] = 0;
145 if (strcmp("XenVMMXenVMM", signature) || (eax < 0x40000002)) {
146 printk(KERN_WARNING
147 "Detected Xen platform device but not Xen VMM?"
148 " (sig %s, eax %x)\n",
149 signature, eax);
150 return -EINVAL;
151 }
153 cpuid(0x40000001, &eax, &ebx, &ecx, &edx);
155 printk(KERN_INFO "Xen version %d.%d.\n", eax >> 16, eax & 0xffff);
157 cpuid(0x40000002, &pages, &msr, &ecx, &edx);
159 printk(KERN_INFO "Hypercall area is %u pages.\n", pages);
161 /* Use __vmalloc() because vmalloc_exec() is not an exported symbol. */
162 /* PAGE_KERNEL_EXEC also is not exported, hence we use PAGE_KERNEL. */
163 /* hypercall_stubs = vmalloc_exec(pages * PAGE_SIZE); */
164 hypercall_stubs = __vmalloc(pages * PAGE_SIZE,
165 GFP_KERNEL | __GFP_HIGHMEM,
166 __pgprot(__PAGE_KERNEL & ~_PAGE_NX));
167 if (hypercall_stubs == NULL)
168 return -ENOMEM;
170 for (i = 0; i < pages; i++) {
171 unsigned long pfn;
172 pfn = vmalloc_to_pfn((char *)hypercall_stubs + i*PAGE_SIZE);
173 wrmsrl(msr, ((u64)pfn << PAGE_SHIFT) + i);
174 }
176 return 0;
177 }
178 #else /* __ia64__ */
179 #define get_hypercall_stubs() (0)
180 #endif
182 static uint64_t get_callback_via(struct pci_dev *pdev)
183 {
184 u8 pin;
185 #ifdef __ia64__
186 int irq, rid;
187 for (irq = 0; irq < 16; irq++) {
188 if (isa_irq_to_vector(irq) == pdev->irq)
189 return irq; /* ISA IRQ */
190 }
191 #else /* !__ia64__ */
193 if (pdev->irq < 16)
194 return pdev->irq; /* ISA IRQ */
195 #endif
197 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,16)
198 pin = pdev->pin;
199 #else
200 pci_read_config_byte(pdev, PCI_INTERRUPT_PIN, &pin);
201 #endif
203 /* We don't know the GSI. Specify the PCI INTx line instead. */
204 return (((uint64_t)0x01 << 56) | /* PCI INTx identifier */
205 ((uint64_t)pci_domain_nr(pdev->bus) << 32) |
206 ((uint64_t)pdev->bus->number << 16) |
207 ((uint64_t)(pdev->devfn & 0xff) << 8) |
208 ((uint64_t)(pin - 1) & 3));
209 }
211 /* Invalidate foreign mappings (e.g., in qemu-based device model). */
212 static uint16_t invlmap_port;
213 void xen_invalidate_foreign_mappings(void)
214 {
215 outb(0, invlmap_port);
216 }
217 EXPORT_SYMBOL(xen_invalidate_foreign_mappings);
219 static int __devinit platform_pci_init(struct pci_dev *pdev,
220 const struct pci_device_id *ent)
221 {
222 int i, ret;
223 long ioaddr, iolen;
224 long mmio_addr, mmio_len;
225 uint64_t callback_via;
227 i = pci_enable_device(pdev);
228 if (i)
229 return i;
231 ioaddr = pci_resource_start(pdev, 0);
232 iolen = pci_resource_len(pdev, 0);
234 mmio_addr = pci_resource_start(pdev, 1);
235 mmio_len = pci_resource_len(pdev, 1);
237 callback_via = get_callback_via(pdev);
239 if (mmio_addr == 0 || ioaddr == 0 || callback_via == 0) {
240 printk(KERN_WARNING DRV_NAME ":no resources found\n");
241 return -ENOENT;
242 }
244 invlmap_port = ioaddr;
246 if (request_mem_region(mmio_addr, mmio_len, DRV_NAME) == NULL)
247 {
248 printk(KERN_ERR ":MEM I/O resource 0x%lx @ 0x%lx busy\n",
249 mmio_addr, mmio_len);
250 return -EBUSY;
251 }
253 if (request_region(ioaddr, iolen, DRV_NAME) == NULL)
254 {
255 printk(KERN_ERR DRV_NAME ":I/O resource 0x%lx @ 0x%lx busy\n",
256 iolen, ioaddr);
257 release_mem_region(mmio_addr, mmio_len);
258 return -EBUSY;
259 }
261 platform_mmio = mmio_addr;
262 platform_mmiolen = mmio_len;
264 ret = get_hypercall_stubs();
265 if (ret < 0)
266 goto out;
268 if ((ret = init_xen_info()))
269 goto out;
271 if ((ret = request_irq(pdev->irq, evtchn_interrupt,
272 SA_SHIRQ | SA_SAMPLE_RANDOM,
273 "xen-platform-pci", pdev)))
274 goto out;
276 if ((ret = set_callback_via(callback_via)))
277 goto out;
279 out:
280 if (ret) {
281 release_mem_region(mmio_addr, mmio_len);
282 release_region(ioaddr, iolen);
283 }
285 return ret;
286 }
288 #define XEN_PLATFORM_VENDOR_ID 0x5853
289 #define XEN_PLATFORM_DEVICE_ID 0x0001
290 static struct pci_device_id platform_pci_tbl[] __devinitdata = {
291 {XEN_PLATFORM_VENDOR_ID, XEN_PLATFORM_DEVICE_ID,
292 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
293 /* Continue to recognise the old ID for now */
294 {0xfffd, 0x0101, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
295 {0,}
296 };
298 MODULE_DEVICE_TABLE(pci, platform_pci_tbl);
300 static struct pci_driver platform_driver = {
301 name: DRV_NAME,
302 probe: platform_pci_init,
303 remove: __devexit_p(platform_pci_remove),
304 id_table: platform_pci_tbl,
305 };
307 static int pci_device_registered;
309 static int __init platform_pci_module_init(void)
310 {
311 int rc;
313 rc = pci_module_init(&platform_driver);
314 if (rc)
315 printk(KERN_INFO DRV_NAME ":No platform pci device model found\n");
316 else
317 pci_device_registered = 1;
319 return rc;
320 }
322 static void __exit platform_pci_module_cleanup(void)
323 {
324 printk(KERN_INFO DRV_NAME ":Do platform module cleanup\n");
325 /* disable hypervisor for callback irq */
326 set_callback_via(0);
327 if (pci_device_registered)
328 pci_unregister_driver(&platform_driver);
329 }
331 module_init(platform_pci_module_init);
332 module_exit(platform_pci_module_cleanup);