1 /*
2 * This file is part of wl1271
3 *
4 * Copyright (C) 2009-2010 Nokia Corporation
5 *
6 * Contact: Luciano Coelho <luciano.coelho@nokia.com>
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * version 2 as published by the Free Software Foundation.
11 *
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
20 * 02110-1301 USA
21 *
22 */
23
24 #include <linux/irq.h>
25 #include <linux/module.h>
26 #include <linux/vmalloc.h>
27 #include <linux/platform_device.h>
28 #include <linux/mmc/sdio_func.h>
29 #include <linux/mmc/sdio_ids.h>
30 #include <linux/mmc/card.h>
31 #include <linux/mmc/host.h>
32 #include <linux/gpio.h>
33 #include <linux/wl12xx.h>
34 #include <linux/pm_runtime.h>
35
36 #include "wl12xx.h"
37 #include "wl12xx_80211.h"
38 #include "io.h"
39
40 #ifndef SDIO_VENDOR_ID_TI
41 #define SDIO_VENDOR_ID_TI 0x0097
42 #endif
43
44 #ifndef SDIO_DEVICE_ID_TI_WL1271
45 #define SDIO_DEVICE_ID_TI_WL1271 0x4076
46 #endif
47
48 struct wl12xx_sdio_glue {
49 struct device *dev;
50 struct platform_device *core;
51 };
52
53 static const struct sdio_device_id wl1271_devices[] __devinitconst = {
54 { SDIO_DEVICE(SDIO_VENDOR_ID_TI, SDIO_DEVICE_ID_TI_WL1271) },
55 {}
56 };
57 MODULE_DEVICE_TABLE(sdio, wl1271_devices);
58
wl1271_sdio_set_block_size(struct device * child,unsigned int blksz)59 static void wl1271_sdio_set_block_size(struct device *child,
60 unsigned int blksz)
61 {
62 struct wl12xx_sdio_glue *glue = dev_get_drvdata(child->parent);
63 struct sdio_func *func = dev_to_sdio_func(glue->dev);
64
65 sdio_claim_host(func);
66 sdio_set_block_size(func, blksz);
67 sdio_release_host(func);
68 }
69
wl12xx_sdio_raw_read(struct device * child,int addr,void * buf,size_t len,bool fixed)70 static void wl12xx_sdio_raw_read(struct device *child, int addr, void *buf,
71 size_t len, bool fixed)
72 {
73 int ret;
74 struct wl12xx_sdio_glue *glue = dev_get_drvdata(child->parent);
75 struct sdio_func *func = dev_to_sdio_func(glue->dev);
76
77 if (unlikely(addr == HW_ACCESS_ELP_CTRL_REG_ADDR)) {
78 ((u8 *)buf)[0] = sdio_f0_readb(func, addr, &ret);
79 dev_dbg(child->parent, "sdio read 52 addr 0x%x, byte 0x%02x\n",
80 addr, ((u8 *)buf)[0]);
81 } else {
82 if (fixed)
83 ret = sdio_readsb(func, buf, addr, len);
84 else
85 ret = sdio_memcpy_fromio(func, buf, addr, len);
86
87 dev_dbg(child->parent, "sdio read 53 addr 0x%x, %zu bytes\n",
88 addr, len);
89 }
90
91 if (ret)
92 dev_err(child->parent, "sdio read failed (%d)\n", ret);
93 }
94
wl12xx_sdio_raw_write(struct device * child,int addr,void * buf,size_t len,bool fixed)95 static void wl12xx_sdio_raw_write(struct device *child, int addr, void *buf,
96 size_t len, bool fixed)
97 {
98 int ret;
99 struct wl12xx_sdio_glue *glue = dev_get_drvdata(child->parent);
100 struct sdio_func *func = dev_to_sdio_func(glue->dev);
101
102 if (unlikely(addr == HW_ACCESS_ELP_CTRL_REG_ADDR)) {
103 sdio_f0_writeb(func, ((u8 *)buf)[0], addr, &ret);
104 dev_dbg(child->parent, "sdio write 52 addr 0x%x, byte 0x%02x\n",
105 addr, ((u8 *)buf)[0]);
106 } else {
107 dev_dbg(child->parent, "sdio write 53 addr 0x%x, %zu bytes\n",
108 addr, len);
109
110 if (fixed)
111 ret = sdio_writesb(func, addr, buf, len);
112 else
113 ret = sdio_memcpy_toio(func, addr, buf, len);
114 }
115
116 if (ret)
117 dev_err(child->parent, "sdio write failed (%d)\n", ret);
118 }
119
wl12xx_sdio_power_on(struct wl12xx_sdio_glue * glue)120 static int wl12xx_sdio_power_on(struct wl12xx_sdio_glue *glue)
121 {
122 int ret;
123 struct sdio_func *func = dev_to_sdio_func(glue->dev);
124
125 /* If enabled, tell runtime PM not to power off the card */
126 if (pm_runtime_enabled(&func->dev)) {
127 ret = pm_runtime_get_sync(&func->dev);
128 if (ret < 0)
129 goto out;
130 } else {
131 /* Runtime PM is disabled: power up the card manually */
132 ret = mmc_power_restore_host(func->card->host);
133 if (ret < 0)
134 goto out;
135 }
136
137 sdio_claim_host(func);
138 sdio_enable_func(func);
139
140 out:
141 return ret;
142 }
143
wl12xx_sdio_power_off(struct wl12xx_sdio_glue * glue)144 static int wl12xx_sdio_power_off(struct wl12xx_sdio_glue *glue)
145 {
146 int ret;
147 struct sdio_func *func = dev_to_sdio_func(glue->dev);
148
149 sdio_disable_func(func);
150 sdio_release_host(func);
151
152 /* Power off the card manually, even if runtime PM is enabled. */
153 ret = mmc_power_save_host(func->card->host);
154 if (ret < 0)
155 return ret;
156
157 /* If enabled, let runtime PM know the card is powered off */
158 if (pm_runtime_enabled(&func->dev))
159 ret = pm_runtime_put_sync(&func->dev);
160
161 return ret;
162 }
163
wl12xx_sdio_set_power(struct device * child,bool enable)164 static int wl12xx_sdio_set_power(struct device *child, bool enable)
165 {
166 struct wl12xx_sdio_glue *glue = dev_get_drvdata(child->parent);
167
168 if (enable)
169 return wl12xx_sdio_power_on(glue);
170 else
171 return wl12xx_sdio_power_off(glue);
172 }
173
174 static struct wl1271_if_operations sdio_ops = {
175 .read = wl12xx_sdio_raw_read,
176 .write = wl12xx_sdio_raw_write,
177 .power = wl12xx_sdio_set_power,
178 .set_block_size = wl1271_sdio_set_block_size,
179 };
180
wl1271_probe(struct sdio_func * func,const struct sdio_device_id * id)181 static int __devinit wl1271_probe(struct sdio_func *func,
182 const struct sdio_device_id *id)
183 {
184 struct wl12xx_platform_data *wlan_data;
185 struct wl12xx_sdio_glue *glue;
186 struct resource res[1];
187 mmc_pm_flag_t mmcflags;
188 int ret = -ENOMEM;
189
190 /* We are only able to handle the wlan function */
191 if (func->num != 0x02)
192 return -ENODEV;
193
194 glue = kzalloc(sizeof(*glue), GFP_KERNEL);
195 if (!glue) {
196 dev_err(&func->dev, "can't allocate glue\n");
197 goto out;
198 }
199
200 glue->dev = &func->dev;
201
202 /* Grab access to FN0 for ELP reg. */
203 func->card->quirks |= MMC_QUIRK_LENIENT_FN0;
204
205 /* Use block mode for transferring over one block size of data */
206 func->card->quirks |= MMC_QUIRK_BLKSZ_FOR_BYTE_MODE;
207
208 wlan_data = wl12xx_get_platform_data();
209 if (IS_ERR(wlan_data)) {
210 ret = PTR_ERR(wlan_data);
211 dev_err(glue->dev, "missing wlan platform data: %d\n", ret);
212 goto out_free_glue;
213 }
214
215 /* if sdio can keep power while host is suspended, enable wow */
216 mmcflags = sdio_get_host_pm_caps(func);
217 dev_dbg(glue->dev, "sdio PM caps = 0x%x\n", mmcflags);
218
219 if (mmcflags & MMC_PM_KEEP_POWER)
220 wlan_data->pwr_in_suspend = true;
221
222 wlan_data->ops = &sdio_ops;
223
224 sdio_set_drvdata(func, glue);
225
226 /* Tell PM core that we don't need the card to be powered now */
227 pm_runtime_put_noidle(&func->dev);
228
229 glue->core = platform_device_alloc("wl12xx", -1);
230 if (!glue->core) {
231 dev_err(glue->dev, "can't allocate platform_device");
232 ret = -ENOMEM;
233 goto out_free_glue;
234 }
235
236 glue->core->dev.parent = &func->dev;
237
238 memset(res, 0x00, sizeof(res));
239
240 res[0].start = wlan_data->irq;
241 res[0].flags = IORESOURCE_IRQ;
242 res[0].name = "irq";
243
244 ret = platform_device_add_resources(glue->core, res, ARRAY_SIZE(res));
245 if (ret) {
246 dev_err(glue->dev, "can't add resources\n");
247 goto out_dev_put;
248 }
249
250 ret = platform_device_add_data(glue->core, wlan_data,
251 sizeof(*wlan_data));
252 if (ret) {
253 dev_err(glue->dev, "can't add platform data\n");
254 goto out_dev_put;
255 }
256
257 ret = platform_device_add(glue->core);
258 if (ret) {
259 dev_err(glue->dev, "can't add platform device\n");
260 goto out_dev_put;
261 }
262 return 0;
263
264 out_dev_put:
265 platform_device_put(glue->core);
266
267 out_free_glue:
268 kfree(glue);
269
270 out:
271 return ret;
272 }
273
wl1271_remove(struct sdio_func * func)274 static void __devexit wl1271_remove(struct sdio_func *func)
275 {
276 struct wl12xx_sdio_glue *glue = sdio_get_drvdata(func);
277
278 /* Undo decrement done above in wl1271_probe */
279 pm_runtime_get_noresume(&func->dev);
280
281 platform_device_del(glue->core);
282 platform_device_put(glue->core);
283 kfree(glue);
284 }
285
286 #ifdef CONFIG_PM
wl1271_suspend(struct device * dev)287 static int wl1271_suspend(struct device *dev)
288 {
289 /* Tell MMC/SDIO core it's OK to power down the card
290 * (if it isn't already), but not to remove it completely */
291 struct sdio_func *func = dev_to_sdio_func(dev);
292 struct wl12xx_sdio_glue *glue = sdio_get_drvdata(func);
293 struct wl1271 *wl = platform_get_drvdata(glue->core);
294 mmc_pm_flag_t sdio_flags;
295 int ret = 0;
296
297 dev_dbg(dev, "wl1271 suspend. wow_enabled: %d\n",
298 wl->wow_enabled);
299
300 /* check whether sdio should keep power */
301 if (wl->wow_enabled) {
302 sdio_flags = sdio_get_host_pm_caps(func);
303
304 if (!(sdio_flags & MMC_PM_KEEP_POWER)) {
305 dev_err(dev, "can't keep power while host "
306 "is suspended\n");
307 ret = -EINVAL;
308 goto out;
309 }
310
311 /* keep power while host suspended */
312 ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
313 if (ret) {
314 dev_err(dev, "error while trying to keep power\n");
315 goto out;
316 }
317
318 /* release host */
319 sdio_release_host(func);
320 }
321 out:
322 return ret;
323 }
324
wl1271_resume(struct device * dev)325 static int wl1271_resume(struct device *dev)
326 {
327 struct sdio_func *func = dev_to_sdio_func(dev);
328 struct wl12xx_sdio_glue *glue = sdio_get_drvdata(func);
329 struct wl1271 *wl = platform_get_drvdata(glue->core);
330
331 dev_dbg(dev, "wl1271 resume\n");
332 if (wl->wow_enabled) {
333 /* claim back host */
334 sdio_claim_host(func);
335 }
336
337 return 0;
338 }
339
340 static const struct dev_pm_ops wl1271_sdio_pm_ops = {
341 .suspend = wl1271_suspend,
342 .resume = wl1271_resume,
343 };
344 #endif
345
346 static struct sdio_driver wl1271_sdio_driver = {
347 .name = "wl1271_sdio",
348 .id_table = wl1271_devices,
349 .probe = wl1271_probe,
350 .remove = __devexit_p(wl1271_remove),
351 #ifdef CONFIG_PM
352 .drv = {
353 .pm = &wl1271_sdio_pm_ops,
354 },
355 #endif
356 };
357
wl1271_init(void)358 static int __init wl1271_init(void)
359 {
360 return sdio_register_driver(&wl1271_sdio_driver);
361 }
362
wl1271_exit(void)363 static void __exit wl1271_exit(void)
364 {
365 sdio_unregister_driver(&wl1271_sdio_driver);
366 }
367
368 module_init(wl1271_init);
369 module_exit(wl1271_exit);
370
371 MODULE_LICENSE("GPL");
372 MODULE_AUTHOR("Luciano Coelho <coelho@ti.com>");
373 MODULE_AUTHOR("Juuso Oikarinen <juuso.oikarinen@nokia.com>");
374 MODULE_FIRMWARE(WL127X_FW_NAME);
375 MODULE_FIRMWARE(WL128X_FW_NAME);
376