Version:  2.0.40 2.2.26 2.4.37 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17 3.18 3.19 4.0 4.1 4.2 4.3 4.4 4.5 4.6 4.7

Linux/drivers/xen/platform-pci.c

  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 
 42 static unsigned long platform_mmio;
 43 static unsigned long platform_mmio_alloc;
 44 static unsigned long platform_mmiolen;
 45 static uint64_t callback_via;
 46 
 47 static 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 
 58 static 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 
 77 static irqreturn_t do_hvm_evtchn_intr(int irq, void *dev_id)
 78 {
 79         xen_hvm_evtchn_do_upcall();
 80         return IRQ_HANDLED;
 81 }
 82 
 83 static 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 
 90 static 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 
103 static 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;
166 grant_out:
167         gnttab_free_auto_xlat_frames();
168 out:
169         pci_release_region(pdev, 0);
170 mem_out:
171         pci_release_region(pdev, 1);
172 pci_out:
173         pci_disable_device(pdev);
174         return ret;
175 }
176 
177 static 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 
183 static 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 
192 static int __init platform_pci_init(void)
193 {
194         return pci_register_driver(&platform_driver);
195 }
196 device_initcall(platform_pci_init);
197 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us