wl1251: Fix memory leak in data path command handling
[pandora-wifi.git] / drivers / net / wireless / wl12xx / wl1251_sdio.c
1 /*
2  * wl12xx SDIO routines
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License version 2 as
6  * published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License
14  * along with this program; if not, write to the Free Software
15  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
16  * 02110-1301 USA
17  *
18  * Copyright (C) 2005 Texas Instruments Incorporated
19  * Copyright (C) 2008 Google Inc
20  * Copyright (C) 2009 Bob Copeland (me@bobcopeland.com)
21  */
22 #include <linux/module.h>
23 #include <linux/mod_devicetable.h>
24 #include <linux/mmc/sdio_func.h>
25 #include <linux/mmc/sdio_ids.h>
26 #include <linux/platform_device.h>
27 #include <linux/spi/wl12xx.h>
28 #include <linux/irq.h>
29
30 #include "wl1251.h"
31
32 #ifndef SDIO_VENDOR_ID_TI
33 #define SDIO_VENDOR_ID_TI               0x104c
34 #endif
35
36 #ifndef SDIO_DEVICE_ID_TI_WL1251
37 #define SDIO_DEVICE_ID_TI_WL1251        0x9066
38 #endif
39
40 struct wl1251_sdio {
41         struct sdio_func *func;
42         u32 elp_val;
43 };
44
45 static struct wl12xx_platform_data *wl12xx_board_data;
46
47 static struct sdio_func *wl_to_func(struct wl1251 *wl)
48 {
49         struct wl1251_sdio *wl_sdio = wl->if_priv;
50         return wl_sdio->func;
51 }
52
53 static void wl1251_sdio_interrupt(struct sdio_func *func)
54 {
55         struct wl1251 *wl = sdio_get_drvdata(func);
56
57         /* FIXME should be synchronous for sdio */
58         wl1251_irq(wl);
59 }
60
61 static const struct sdio_device_id wl1251_devices[] = {
62         { SDIO_DEVICE(SDIO_VENDOR_ID_TI, SDIO_DEVICE_ID_TI_WL1251) },
63         {}
64 };
65 MODULE_DEVICE_TABLE(sdio, wl1251_devices);
66
67
68 static void wl1251_sdio_read(struct wl1251 *wl, int addr,
69                              void *buf, size_t len)
70 {
71         int ret;
72         struct sdio_func *func = wl_to_func(wl);
73
74         sdio_claim_host(func);
75         ret = sdio_memcpy_fromio(func, buf, addr, len);
76         if (ret)
77                 wl1251_error("sdio read failed (%d)", ret);
78         sdio_release_host(func);
79 }
80
81 static void wl1251_sdio_write(struct wl1251 *wl, int addr,
82                               void *buf, size_t len)
83 {
84         int ret;
85         struct sdio_func *func = wl_to_func(wl);
86
87         sdio_claim_host(func);
88         ret = sdio_memcpy_toio(func, addr, buf, len);
89         if (ret)
90                 wl1251_error("sdio write failed (%d)", ret);
91         sdio_release_host(func);
92 }
93
94 static void wl1251_sdio_read_elp(struct wl1251 *wl, int addr, u32 *val)
95 {
96         int ret = 0;
97         struct wl1251_sdio *wl_sdio = wl->if_priv;
98         struct sdio_func *func = wl_sdio->func;
99
100         /*
101          * The hardware only supports RAW (read after write) access for
102          * reading, regular sdio_readb won't work here (it interprets
103          * the unused bits of CMD52 as write data even if we send read
104          * request).
105          */
106         sdio_claim_host(func);
107         *val = sdio_readb_ext(func, addr, &ret, wl_sdio->elp_val);
108         sdio_release_host(func);
109
110         if (ret)
111                 wl1251_error("sdio_readb failed (%d)", ret);
112 }
113
114 static void wl1251_sdio_write_elp(struct wl1251 *wl, int addr, u32 val)
115 {
116         int ret = 0;
117         struct wl1251_sdio *wl_sdio = wl->if_priv;
118         struct sdio_func *func = wl_sdio->func;
119
120         sdio_claim_host(func);
121         sdio_writeb(func, val, addr, &ret);
122         sdio_release_host(func);
123
124         if (ret)
125                 wl1251_error("sdio_writeb failed (%d)", ret);
126         else
127                 wl_sdio->elp_val = val;
128 }
129
130 static void wl1251_sdio_reset(struct wl1251 *wl)
131 {
132         extern int sdio_reset_comm(struct mmc_card *card);
133         struct sdio_func *func = wl_to_func(wl);
134         int ret;
135
136         sdio_claim_host(func);
137         sdio_reset_comm(func->card);
138         ret = sdio_enable_func(func);
139         if (ret)
140                 goto release;
141
142         sdio_set_block_size(func, 512);
143
144 release:
145         sdio_release_host(func);
146 }
147
148 static void wl1251_sdio_enable_irq(struct wl1251 *wl)
149 {
150         struct sdio_func *func = wl_to_func(wl);
151
152         sdio_claim_host(func);
153         sdio_claim_irq(func, wl1251_sdio_interrupt);
154         sdio_release_host(func);
155 }
156
157 static void wl1251_sdio_disable_irq(struct wl1251 *wl)
158 {
159         struct sdio_func *func = wl_to_func(wl);
160
161         sdio_claim_host(func);
162         sdio_release_irq(func);
163         sdio_release_host(func);
164 }
165
166 /* Interrupts when using dedicated WLAN_IRQ pin */
167 static irqreturn_t wl1251_line_irq(int irq, void *cookie)
168 {
169         struct wl1251 *wl = cookie;
170
171         wl1251_irq(wl);
172
173         return IRQ_HANDLED;
174 }
175
176 static void wl1251_enable_line_irq(struct wl1251 *wl)
177 {
178         return enable_irq(wl->irq);
179 }
180
181 static void wl1251_disable_line_irq(struct wl1251 *wl)
182 {
183         return disable_irq(wl->irq);
184 }
185
186 static void wl1251_sdio_set_power(bool enable)
187 {
188 }
189
190 static struct wl1251_if_operations wl1251_sdio_ops = {
191         .read = wl1251_sdio_read,
192         .write = wl1251_sdio_write,
193         .write_elp = wl1251_sdio_write_elp,
194         .read_elp = wl1251_sdio_read_elp,
195         .reset = wl1251_sdio_reset,
196 };
197
198 static int wl1251_platform_probe(struct platform_device *pdev)
199 {
200         if (pdev->id != -1) {
201                 wl1251_error("can only handle single device");
202                 return -ENODEV;
203         }
204
205         wl12xx_board_data = pdev->dev.platform_data;
206         return 0;
207 }
208
209 /*
210  * Dummy platform_driver for passing platform_data to this driver,
211  * until we have a way to pass this through SDIO subsystem or
212  * some other way.
213  */
214 static struct platform_driver wl1251_platform_driver = {
215         .driver = {
216                 .name   = "wl1251_data",
217                 .owner  = THIS_MODULE,
218         },
219         .probe  = wl1251_platform_probe,
220 };
221
222 static int wl1251_sdio_probe(struct sdio_func *func,
223                              const struct sdio_device_id *id)
224 {
225         int ret;
226         struct wl1251 *wl;
227         struct ieee80211_hw *hw;
228         struct wl1251_sdio *wl_sdio;
229
230         hw = wl1251_alloc_hw();
231         if (IS_ERR(hw))
232                 return PTR_ERR(hw);
233
234         wl = hw->priv;
235
236         wl_sdio = kzalloc(sizeof(*wl_sdio), GFP_KERNEL);
237         if (wl_sdio == NULL) {
238                 ret = -ENOMEM;
239                 goto out_free_hw;
240         }
241
242         sdio_claim_host(func);
243         ret = sdio_enable_func(func);
244         if (ret)
245                 goto release;
246
247         sdio_set_block_size(func, 512);
248         sdio_release_host(func);
249
250         SET_IEEE80211_DEV(hw, &func->dev);
251         wl_sdio->func = func;
252         wl->if_priv = wl_sdio;
253         wl->if_ops = &wl1251_sdio_ops;
254         wl->set_power = wl1251_sdio_set_power;
255
256         if (wl12xx_board_data != NULL) {
257                 wl->set_power = wl12xx_board_data->set_power;
258                 wl->irq = wl12xx_board_data->irq;
259                 wl->use_eeprom = wl12xx_board_data->use_eeprom;
260         }
261
262         if (wl->irq) {
263                 ret = request_irq(wl->irq, wl1251_line_irq, 0, "wl1251", wl);
264                 if (ret < 0) {
265                         wl1251_error("request_irq() failed: %d", ret);
266                         goto disable;
267                 }
268
269                 set_irq_type(wl->irq, IRQ_TYPE_EDGE_RISING);
270                 disable_irq(wl->irq);
271
272                 wl1251_sdio_ops.enable_irq = wl1251_enable_line_irq;
273                 wl1251_sdio_ops.disable_irq = wl1251_disable_line_irq;
274
275                 wl1251_info("using dedicated interrupt line");
276         } else {
277                 wl1251_sdio_ops.enable_irq = wl1251_sdio_enable_irq;
278                 wl1251_sdio_ops.disable_irq = wl1251_sdio_disable_irq;
279
280                 wl1251_info("using SDIO interrupt");
281         }
282
283         ret = wl1251_init_ieee80211(wl);
284         if (ret)
285                 goto out_free_irq;
286
287         /* we can power it down now until it's started */
288         wl->set_power(0);
289
290         sdio_set_drvdata(func, wl);
291         return ret;
292
293 out_free_irq:
294         if (wl->irq)
295                 free_irq(wl->irq, wl);
296 disable:
297         sdio_claim_host(func);
298         sdio_disable_func(func);
299 release:
300         sdio_release_host(func);
301         kfree(wl_sdio);
302 out_free_hw:
303         wl1251_free_hw(wl);
304         return ret;
305 }
306
307 static void __devexit wl1251_sdio_remove(struct sdio_func *func)
308 {
309         struct wl1251 *wl = sdio_get_drvdata(func);
310         struct wl1251_sdio *wl_sdio = wl->if_priv;
311
312         if (wl->irq)
313                 free_irq(wl->irq, wl);
314         kfree(wl_sdio);
315         wl1251_free_hw(wl);
316
317         sdio_claim_host(func);
318         sdio_release_irq(func);
319         sdio_disable_func(func);
320         sdio_release_host(func);
321 }
322
323 static struct sdio_driver wl1251_sdio_driver = {
324         .name           = "wl1251_sdio",
325         .id_table       = wl1251_devices,
326         .probe          = wl1251_sdio_probe,
327         .remove         = __devexit_p(wl1251_sdio_remove),
328 };
329
330 static int __init wl1251_sdio_init(void)
331 {
332         int err;
333
334         err = platform_driver_register(&wl1251_platform_driver);
335         if (err) {
336                 wl1251_error("failed to register platform driver: %d", err);
337                 return err;
338         }
339
340         err = sdio_register_driver(&wl1251_sdio_driver);
341         if (err)
342                 wl1251_error("failed to register sdio driver: %d", err);
343         return err;
344 }
345
346 static void __exit wl1251_sdio_exit(void)
347 {
348         sdio_unregister_driver(&wl1251_sdio_driver);
349         platform_driver_unregister(&wl1251_platform_driver);
350         wl1251_notice("unloaded");
351 }
352
353 module_init(wl1251_sdio_init);
354 module_exit(wl1251_sdio_exit);
355
356 MODULE_LICENSE("GPL");
357 MODULE_AUTHOR("Kalle Valo <kalle.valo@nokia.com>");