diff options
author | Andrea Bastoni <bastoni@cs.unc.edu> | 2010-05-30 19:16:45 -0400 |
---|---|---|
committer | Andrea Bastoni <bastoni@cs.unc.edu> | 2010-05-30 19:16:45 -0400 |
commit | ada47b5fe13d89735805b566185f4885f5a3f750 (patch) | |
tree | 644b88f8a71896307d71438e9b3af49126ffb22b /drivers/spi/dw_spi_mmio.c | |
parent | 43e98717ad40a4ae64545b5ba047c7b86aa44f4f (diff) | |
parent | 3280f21d43ee541f97f8cda5792150d2dbec20d5 (diff) |
Merge branch 'wip-2.6.34' into old-private-masterarchived-private-master
Diffstat (limited to 'drivers/spi/dw_spi_mmio.c')
-rw-r--r-- | drivers/spi/dw_spi_mmio.c | 148 |
1 files changed, 148 insertions, 0 deletions
diff --git a/drivers/spi/dw_spi_mmio.c b/drivers/spi/dw_spi_mmio.c new file mode 100644 index 000000000000..db35bd9c1b24 --- /dev/null +++ b/drivers/spi/dw_spi_mmio.c | |||
@@ -0,0 +1,148 @@ | |||
1 | /* | ||
2 | * dw_spi_mmio.c - Memory-mapped interface driver for DW SPI Core | ||
3 | * | ||
4 | * Copyright (c) 2010, Octasic semiconductor. | ||
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 | |||
11 | #include <linux/clk.h> | ||
12 | #include <linux/interrupt.h> | ||
13 | #include <linux/platform_device.h> | ||
14 | #include <linux/slab.h> | ||
15 | #include <linux/spi/dw_spi.h> | ||
16 | #include <linux/spi/spi.h> | ||
17 | |||
18 | #define DRIVER_NAME "dw_spi_mmio" | ||
19 | |||
20 | struct dw_spi_mmio { | ||
21 | struct dw_spi dws; | ||
22 | struct clk *clk; | ||
23 | }; | ||
24 | |||
25 | static int __devinit dw_spi_mmio_probe(struct platform_device *pdev) | ||
26 | { | ||
27 | struct dw_spi_mmio *dwsmmio; | ||
28 | struct dw_spi *dws; | ||
29 | struct resource *mem, *ioarea; | ||
30 | int ret; | ||
31 | |||
32 | dwsmmio = kzalloc(sizeof(struct dw_spi_mmio), GFP_KERNEL); | ||
33 | if (!dwsmmio) { | ||
34 | ret = -ENOMEM; | ||
35 | goto err_end; | ||
36 | } | ||
37 | |||
38 | dws = &dwsmmio->dws; | ||
39 | |||
40 | /* Get basic io resource and map it */ | ||
41 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
42 | if (!mem) { | ||
43 | dev_err(&pdev->dev, "no mem resource?\n"); | ||
44 | ret = -EINVAL; | ||
45 | goto err_kfree; | ||
46 | } | ||
47 | |||
48 | ioarea = request_mem_region(mem->start, resource_size(mem), | ||
49 | pdev->name); | ||
50 | if (!ioarea) { | ||
51 | dev_err(&pdev->dev, "SPI region already claimed\n"); | ||
52 | ret = -EBUSY; | ||
53 | goto err_kfree; | ||
54 | } | ||
55 | |||
56 | dws->regs = ioremap_nocache(mem->start, resource_size(mem)); | ||
57 | if (!dws->regs) { | ||
58 | dev_err(&pdev->dev, "SPI region already mapped\n"); | ||
59 | ret = -ENOMEM; | ||
60 | goto err_release_reg; | ||
61 | } | ||
62 | |||
63 | dws->irq = platform_get_irq(pdev, 0); | ||
64 | if (dws->irq < 0) { | ||
65 | dev_err(&pdev->dev, "no irq resource?\n"); | ||
66 | ret = dws->irq; /* -ENXIO */ | ||
67 | goto err_unmap; | ||
68 | } | ||
69 | |||
70 | dwsmmio->clk = clk_get(&pdev->dev, NULL); | ||
71 | if (!dwsmmio->clk) { | ||
72 | ret = -ENODEV; | ||
73 | goto err_irq; | ||
74 | } | ||
75 | clk_enable(dwsmmio->clk); | ||
76 | |||
77 | dws->parent_dev = &pdev->dev; | ||
78 | dws->bus_num = 0; | ||
79 | dws->num_cs = 4; | ||
80 | dws->max_freq = clk_get_rate(dwsmmio->clk); | ||
81 | |||
82 | ret = dw_spi_add_host(dws); | ||
83 | if (ret) | ||
84 | goto err_clk; | ||
85 | |||
86 | platform_set_drvdata(pdev, dwsmmio); | ||
87 | return 0; | ||
88 | |||
89 | err_clk: | ||
90 | clk_disable(dwsmmio->clk); | ||
91 | clk_put(dwsmmio->clk); | ||
92 | dwsmmio->clk = NULL; | ||
93 | err_irq: | ||
94 | free_irq(dws->irq, dws); | ||
95 | err_unmap: | ||
96 | iounmap(dws->regs); | ||
97 | err_release_reg: | ||
98 | release_mem_region(mem->start, resource_size(mem)); | ||
99 | err_kfree: | ||
100 | kfree(dwsmmio); | ||
101 | err_end: | ||
102 | return ret; | ||
103 | } | ||
104 | |||
105 | static int __devexit dw_spi_mmio_remove(struct platform_device *pdev) | ||
106 | { | ||
107 | struct dw_spi_mmio *dwsmmio = platform_get_drvdata(pdev); | ||
108 | struct resource *mem; | ||
109 | |||
110 | platform_set_drvdata(pdev, NULL); | ||
111 | |||
112 | clk_disable(dwsmmio->clk); | ||
113 | clk_put(dwsmmio->clk); | ||
114 | dwsmmio->clk = NULL; | ||
115 | |||
116 | free_irq(dwsmmio->dws.irq, &dwsmmio->dws); | ||
117 | dw_spi_remove_host(&dwsmmio->dws); | ||
118 | iounmap(dwsmmio->dws.regs); | ||
119 | kfree(dwsmmio); | ||
120 | |||
121 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
122 | release_mem_region(mem->start, resource_size(mem)); | ||
123 | return 0; | ||
124 | } | ||
125 | |||
126 | static struct platform_driver dw_spi_mmio_driver = { | ||
127 | .remove = __devexit_p(dw_spi_mmio_remove), | ||
128 | .driver = { | ||
129 | .name = DRIVER_NAME, | ||
130 | .owner = THIS_MODULE, | ||
131 | }, | ||
132 | }; | ||
133 | |||
134 | static int __init dw_spi_mmio_init(void) | ||
135 | { | ||
136 | return platform_driver_probe(&dw_spi_mmio_driver, dw_spi_mmio_probe); | ||
137 | } | ||
138 | module_init(dw_spi_mmio_init); | ||
139 | |||
140 | static void __exit dw_spi_mmio_exit(void) | ||
141 | { | ||
142 | platform_driver_unregister(&dw_spi_mmio_driver); | ||
143 | } | ||
144 | module_exit(dw_spi_mmio_exit); | ||
145 | |||
146 | MODULE_AUTHOR("Jean-Hugues Deschenes <jean-hugues.deschenes@octasic.com>"); | ||
147 | MODULE_DESCRIPTION("Memory-mapped I/O interface driver for DW SPI Core"); | ||
148 | MODULE_LICENSE("GPL v2"); | ||