Root/drivers/xen/platform-pci.c

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
39MODULE_AUTHOR("ssmith@xensource.com and stefano.stabellini@eu.citrix.com");
40MODULE_DESCRIPTION("Xen platform PCI device");
41MODULE_LICENSE("GPL");
42
43static unsigned long platform_mmio;
44static unsigned long platform_mmio_alloc;
45static unsigned long platform_mmiolen;
46static uint64_t callback_via;
47
48unsigned 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
59static 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
78static irqreturn_t do_hvm_evtchn_intr(int irq, void *dev_id)
79{
80    xen_hvm_evtchn_do_upcall();
81    return IRQ_HANDLED;
82}
83
84static 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
91static 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
104static int __devinit platform_pci_init(struct pci_dev *pdev,
105                       const struct pci_device_id *ent)
106{
107    int i, ret;
108    long ioaddr;
109    long mmio_addr, mmio_len;
110    unsigned int max_nr_gframes;
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    xen_hvm_resume_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes);
158    ret = gnttab_init();
159    if (ret)
160        goto out;
161    xenbus_probe(NULL);
162    return 0;
163
164out:
165    pci_release_region(pdev, 0);
166mem_out:
167    pci_release_region(pdev, 1);
168pci_out:
169    pci_disable_device(pdev);
170    return ret;
171}
172
173static struct pci_device_id platform_pci_tbl[] __devinitdata = {
174    {PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM,
175        PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
176    {0,}
177};
178
179MODULE_DEVICE_TABLE(pci, platform_pci_tbl);
180
181static struct pci_driver platform_driver = {
182    .name = DRV_NAME,
183    .probe = platform_pci_init,
184    .id_table = platform_pci_tbl,
185#ifdef CONFIG_PM
186    .resume_early = platform_pci_resume,
187#endif
188};
189
190static int __init platform_pci_module_init(void)
191{
192    return pci_register_driver(&platform_driver);
193}
194
195module_init(platform_pci_module_init);
196

Archive Download this file

Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master

Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9



interactive