spi/dw_spi: add a missed dw_spi_remove_host() in exit sequence
[safe/jmp/linux-2.6] / drivers / spi / dw_spi_pci.c
1 /*
2  * mrst_spi_pci.c - PCI interface driver for DW SPI Core
3  *
4  * Copyright (c) 2009, 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
16  * with this program; if not, write to the Free Software Foundation,
17  * Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
18  */
19
20 #include <linux/interrupt.h>
21 #include <linux/pci.h>
22 #include <linux/spi/dw_spi.h>
23 #include <linux/spi/spi.h>
24
25 #define DRIVER_NAME "dw_spi_pci"
26
27 struct dw_spi_pci {
28         struct pci_dev          *pdev;
29         struct dw_spi           dws;
30 };
31
32 static int __devinit spi_pci_probe(struct pci_dev *pdev,
33         const struct pci_device_id *ent)
34 {
35         struct dw_spi_pci *dwpci;
36         struct dw_spi *dws;
37         int pci_bar = 0;
38         int ret;
39
40         printk(KERN_INFO "DW: found PCI SPI controller(ID: %04x:%04x)\n",
41                 pdev->vendor, pdev->device);
42
43         ret = pci_enable_device(pdev);
44         if (ret)
45                 return ret;
46
47         dwpci = kzalloc(sizeof(struct dw_spi_pci), GFP_KERNEL);
48         if (!dwpci) {
49                 ret = -ENOMEM;
50                 goto err_disable;
51         }
52
53         dwpci->pdev = pdev;
54         dws = &dwpci->dws;
55
56         /* Get basic io resource and map it */
57         dws->paddr = pci_resource_start(pdev, pci_bar);
58         dws->iolen = pci_resource_len(pdev, pci_bar);
59
60         ret = pci_request_region(pdev, pci_bar, dev_name(&pdev->dev));
61         if (ret)
62                 goto err_kfree;
63
64         dws->regs = ioremap_nocache((unsigned long)dws->paddr,
65                                 pci_resource_len(pdev, pci_bar));
66         if (!dws->regs) {
67                 ret = -ENOMEM;
68                 goto err_release_reg;
69         }
70
71         dws->parent_dev = &pdev->dev;
72         dws->bus_num = 0;
73         dws->num_cs = 4;
74         dws->max_freq = 25000000;       /* for Moorestwon */
75         dws->irq = pdev->irq;
76
77         ret = dw_spi_add_host(dws);
78         if (ret)
79                 goto err_unmap;
80
81         /* PCI hook and SPI hook use the same drv data */
82         pci_set_drvdata(pdev, dwpci);
83         return 0;
84
85 err_unmap:
86         iounmap(dws->regs);
87 err_release_reg:
88         pci_release_region(pdev, pci_bar);
89 err_kfree:
90         kfree(dwpci);
91 err_disable:
92         pci_disable_device(pdev);
93         return ret;
94 }
95
96 static void __devexit spi_pci_remove(struct pci_dev *pdev)
97 {
98         struct dw_spi_pci *dwpci = pci_get_drvdata(pdev);
99
100         pci_set_drvdata(pdev, NULL);
101         dw_spi_remove_host(&dwpci->dws);
102         iounmap(dwpci->dws.regs);
103         pci_release_region(pdev, 0);
104         kfree(dwpci);
105         pci_disable_device(pdev);
106 }
107
108 #ifdef CONFIG_PM
109 static int spi_suspend(struct pci_dev *pdev, pm_message_t state)
110 {
111         struct dw_spi_pci *dwpci = pci_get_drvdata(pdev);
112         int ret;
113
114         ret = dw_spi_suspend_host(&dwpci->dws);
115         if (ret)
116                 return ret;
117         pci_save_state(pdev);
118         pci_disable_device(pdev);
119         pci_set_power_state(pdev, pci_choose_state(pdev, state));
120         return ret;
121 }
122
123 static int spi_resume(struct pci_dev *pdev)
124 {
125         struct dw_spi_pci *dwpci = pci_get_drvdata(pdev);
126         int ret;
127
128         pci_set_power_state(pdev, PCI_D0);
129         pci_restore_state(pdev);
130         ret = pci_enable_device(pdev);
131         if (ret)
132                 return ret;
133         return dw_spi_resume_host(&dwpci->dws);
134 }
135 #else
136 #define spi_suspend     NULL
137 #define spi_resume      NULL
138 #endif
139
140 static const struct pci_device_id pci_ids[] __devinitdata = {
141         /* Intel Moorestown platform SPI controller 0 */
142         { PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x0800) },
143         {},
144 };
145
146 static struct pci_driver dw_spi_driver = {
147         .name =         DRIVER_NAME,
148         .id_table =     pci_ids,
149         .probe =        spi_pci_probe,
150         .remove =       __devexit_p(spi_pci_remove),
151         .suspend =      spi_suspend,
152         .resume =       spi_resume,
153 };
154
155 static int __init mrst_spi_init(void)
156 {
157         return pci_register_driver(&dw_spi_driver);
158 }
159
160 static void __exit mrst_spi_exit(void)
161 {
162         pci_unregister_driver(&dw_spi_driver);
163 }
164
165 module_init(mrst_spi_init);
166 module_exit(mrst_spi_exit);
167
168 MODULE_AUTHOR("Feng Tang <feng.tang@intel.com>");
169 MODULE_DESCRIPTION("PCI interface driver for DW SPI Core");
170 MODULE_LICENSE("GPL v2");