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 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; 46 static uint64_t callback_via; 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 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 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 117 static int __devinit platform_pci_init(struct pci_dev *pdev, 118 const struct pci_device_id *ent) 119 { 120 int i, ret; 121 long ioaddr; 122 long mmio_addr, mmio_len; 123 unsigned int max_nr_gframes; 124 125 if (!xen_domain()) 126 return -ENODEV; 127 128 i = pci_enable_device(pdev); 129 if (i) 130 return i; 131 132 ioaddr = pci_resource_start(pdev, 0); 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 143 ret = pci_request_region(pdev, 1, DRV_NAME); 144 if (ret < 0) 145 goto pci_out; 146 147 ret = pci_request_region(pdev, 0, DRV_NAME); 148 if (ret < 0) 149 goto mem_out; 150 151 platform_mmio = mmio_addr; 152 platform_mmiolen = mmio_len; 153 154 prepare_shared_info(); 155 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: 180 pci_release_region(pdev, 0); 181 mem_out: 182 pci_release_region(pdev, 1); 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, 200 #ifdef CONFIG_PM 201 .resume_early = platform_pci_resume, 202 #endif 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); 211