Commit | Line | Data |
---|---|---|
a0848826 IPG |
1 | /* |
2 | * Intel Wireless WiMAX Connection 2400m | |
3 | * Linux driver model glue for the SDIO device, reset & fw upload | |
4 | * | |
5 | * | |
6 | * Copyright (C) 2007-2008 Intel Corporation <linux-wimax@intel.com> | |
7 | * Dirk Brandewie <dirk.j.brandewie@intel.com> | |
8 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | |
9 | * Yanir Lubetkin <yanirx.lubetkin@intel.com> | |
10 | * | |
11 | * This program is free software; you can redistribute it and/or | |
12 | * modify it under the terms of the GNU General Public License version | |
13 | * 2 as published by the Free Software Foundation. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to the Free Software | |
22 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | |
23 | * 02110-1301, USA. | |
24 | * | |
25 | * | |
26 | * See i2400m-sdio.h for a general description of this driver. | |
27 | * | |
28 | * This file implements driver model glue, and hook ups for the | |
29 | * generic driver to implement the bus-specific functions (device | |
30 | * communication setup/tear down, firmware upload and resetting). | |
31 | * | |
32 | * ROADMAP | |
33 | * | |
34 | * i2400m_probe() | |
35 | * alloc_netdev() | |
36 | * i2400ms_netdev_setup() | |
37 | * i2400ms_init() | |
38 | * i2400m_netdev_setup() | |
39 | * i2400ms_enable_function() | |
40 | * i2400m_setup() | |
41 | * | |
42 | * i2400m_remove() | |
43 | * i2400m_release() | |
44 | * free_netdev(net_dev) | |
45 | * | |
c931ceeb | 46 | * i2400ms_bus_reset() Called by i2400m_reset |
a0848826 IPG |
47 | * __i2400ms_reset() |
48 | * __i2400ms_send_barker() | |
a0848826 IPG |
49 | */ |
50 | ||
5a0e3ad6 | 51 | #include <linux/slab.h> |
a0848826 | 52 | #include <linux/debugfs.h> |
51def0be | 53 | #include <linux/mmc/sdio_ids.h> |
a0848826 IPG |
54 | #include <linux/mmc/sdio.h> |
55 | #include <linux/mmc/sdio_func.h> | |
56 | #include "i2400m-sdio.h" | |
57 | #include <linux/wimax/i2400m.h> | |
9d9779e7 | 58 | #include <linux/module.h> |
a0848826 IPG |
59 | |
60 | #define D_SUBMODULE main | |
61 | #include "sdio-debug-levels.h" | |
62 | ||
63 | /* IOE WiMAX function timeout in seconds */ | |
64 | static int ioe_timeout = 2; | |
65 | module_param(ioe_timeout, int, 0); | |
66 | ||
4c2b1a11 IPG |
67 | static char i2400ms_debug_params[128]; |
68 | module_param_string(debug, i2400ms_debug_params, sizeof(i2400ms_debug_params), | |
69 | 0644); | |
70 | MODULE_PARM_DESC(debug, | |
71 | "String of space-separated NAME:VALUE pairs, where NAMEs " | |
72 | "are the different debug submodules and VALUE are the " | |
73 | "initial debug value to set."); | |
74 | ||
1039abbc IPG |
75 | /* Our firmware file name list */ |
76 | static const char *i2400ms_bus_fw_names[] = { | |
77 | #define I2400MS_FW_FILE_NAME "i2400m-fw-sdio-1.3.sbcf" | |
78 | I2400MS_FW_FILE_NAME, | |
79 | NULL | |
80 | }; | |
81 | ||
a0848826 | 82 | |
1c0b2dd7 DB |
83 | static const struct i2400m_poke_table i2400ms_pokes[] = { |
84 | I2400M_FW_POKE(0x6BE260, 0x00000088), | |
85 | I2400M_FW_POKE(0x080550, 0x00000005), | |
86 | I2400M_FW_POKE(0xAE0000, 0x00000000), | |
87 | I2400M_FW_POKE(0x000000, 0x00000000), /* MUST be 0 terminated or bad | |
88 | * things will happen */ | |
89 | }; | |
90 | ||
a0848826 IPG |
91 | /* |
92 | * Enable the SDIO function | |
93 | * | |
94 | * Tries to enable the SDIO function; might fail if it is still not | |
95 | * ready (in some hardware, the SDIO WiMAX function is only enabled | |
96 | * when we ask it to explicitly doing). Tries until a timeout is | |
97 | * reached. | |
98 | * | |
c77ca950 IPG |
99 | * The @maxtries argument indicates how many times (at most) it should |
100 | * be tried to enable the function. 0 means forever. This acts along | |
101 | * with the timeout (ie: it'll stop trying as soon as the maximum | |
102 | * number of tries is reached _or_ as soon as the timeout is reached). | |
103 | * | |
a0848826 IPG |
104 | * The reverse of this is...sdio_disable_function() |
105 | * | |
106 | * Returns: 0 if the SDIO function was enabled, < 0 errno code on | |
107 | * error (-ENODEV when it was unable to enable the function). | |
108 | */ | |
109 | static | |
02eb41ef | 110 | int i2400ms_enable_function(struct i2400ms *i2400ms, unsigned maxtries) |
a0848826 | 111 | { |
02eb41ef | 112 | struct sdio_func *func = i2400ms->func; |
a0848826 IPG |
113 | u64 timeout; |
114 | int err; | |
115 | struct device *dev = &func->dev; | |
c77ca950 | 116 | unsigned tries = 0; |
a0848826 IPG |
117 | |
118 | d_fnstart(3, dev, "(func %p)\n", func); | |
119 | /* Setup timeout (FIXME: This needs to read the CIS table to | |
120 | * get a real timeout) and then wait for the device to signal | |
121 | * it is ready */ | |
122 | timeout = get_jiffies_64() + ioe_timeout * HZ; | |
123 | err = -ENODEV; | |
124 | while (err != 0 && time_before64(get_jiffies_64(), timeout)) { | |
125 | sdio_claim_host(func); | |
f2696fbd CK |
126 | /* |
127 | * There is a sillicon bug on the IWMC3200, where the | |
128 | * IOE timeout will cause problems on Moorestown | |
129 | * platforms (system hang). We explicitly overwrite | |
130 | * func->enable_timeout here to work around the issue. | |
131 | */ | |
02eb41ef | 132 | if (i2400ms->iwmc3200) |
f2696fbd | 133 | func->enable_timeout = IWMC3200_IOR_TIMEOUT; |
a0848826 IPG |
134 | err = sdio_enable_func(func); |
135 | if (0 == err) { | |
136 | sdio_release_host(func); | |
137 | d_printf(2, dev, "SDIO function enabled\n"); | |
138 | goto function_enabled; | |
139 | } | |
140 | d_printf(2, dev, "SDIO function failed to enable: %d\n", err); | |
a0848826 | 141 | sdio_release_host(func); |
c77ca950 IPG |
142 | if (maxtries > 0 && ++tries >= maxtries) { |
143 | err = -ETIME; | |
144 | break; | |
145 | } | |
a0848826 IPG |
146 | msleep(I2400MS_INIT_SLEEP_INTERVAL); |
147 | } | |
148 | /* If timed out, device is not there yet -- get -ENODEV so | |
149 | * the device driver core will retry later on. */ | |
150 | if (err == -ETIME) { | |
151 | dev_err(dev, "Can't enable WiMAX function; " | |
152 | " has the function been enabled?\n"); | |
153 | err = -ENODEV; | |
154 | } | |
155 | function_enabled: | |
156 | d_fnend(3, dev, "(func %p) = %d\n", func, err); | |
157 | return err; | |
158 | } | |
159 | ||
160 | ||
0856ccf2 IPG |
161 | /* |
162 | * Setup minimal device communication infrastructure needed to at | |
163 | * least be able to update the firmware. | |
fae92216 IPG |
164 | * |
165 | * Note the ugly trick: if we are in the probe path | |
166 | * (i2400ms->debugfs_dentry == NULL), we only retry function | |
167 | * enablement one, to avoid racing with the iwmc3200 top controller. | |
0856ccf2 IPG |
168 | */ |
169 | static | |
170 | int i2400ms_bus_setup(struct i2400m *i2400m) | |
171 | { | |
172 | int result; | |
173 | struct i2400ms *i2400ms = | |
174 | container_of(i2400m, struct i2400ms, i2400m); | |
175 | struct device *dev = i2400m_dev(i2400m); | |
176 | struct sdio_func *func = i2400ms->func; | |
fae92216 | 177 | int retries; |
0856ccf2 IPG |
178 | |
179 | sdio_claim_host(func); | |
180 | result = sdio_set_block_size(func, I2400MS_BLK_SIZE); | |
181 | sdio_release_host(func); | |
182 | if (result < 0) { | |
183 | dev_err(dev, "Failed to set block size: %d\n", result); | |
184 | goto error_set_blk_size; | |
185 | } | |
186 | ||
fae92216 | 187 | if (i2400ms->iwmc3200 && i2400ms->debugfs_dentry == NULL) |
fae92216 | 188 | retries = 1; |
e7fec0bb IPG |
189 | else |
190 | retries = 0; | |
fae92216 | 191 | result = i2400ms_enable_function(i2400ms, retries); |
0856ccf2 IPG |
192 | if (result < 0) { |
193 | dev_err(dev, "Cannot enable SDIO function: %d\n", result); | |
194 | goto error_func_enable; | |
195 | } | |
196 | ||
a8ee303c IPG |
197 | result = i2400ms_tx_setup(i2400ms); |
198 | if (result < 0) | |
199 | goto error_tx_setup; | |
0856ccf2 IPG |
200 | result = i2400ms_rx_setup(i2400ms); |
201 | if (result < 0) | |
202 | goto error_rx_setup; | |
203 | return 0; | |
204 | ||
205 | error_rx_setup: | |
a8ee303c IPG |
206 | i2400ms_tx_release(i2400ms); |
207 | error_tx_setup: | |
0856ccf2 IPG |
208 | sdio_claim_host(func); |
209 | sdio_disable_func(func); | |
210 | sdio_release_host(func); | |
211 | error_func_enable: | |
212 | error_set_blk_size: | |
213 | return result; | |
214 | } | |
215 | ||
216 | ||
217 | /* | |
218 | * Tear down minimal device communication infrastructure needed to at | |
219 | * least be able to update the firmware. | |
220 | */ | |
221 | static | |
222 | void i2400ms_bus_release(struct i2400m *i2400m) | |
223 | { | |
224 | struct i2400ms *i2400ms = | |
225 | container_of(i2400m, struct i2400ms, i2400m); | |
226 | struct sdio_func *func = i2400ms->func; | |
227 | ||
228 | i2400ms_rx_release(i2400ms); | |
a8ee303c | 229 | i2400ms_tx_release(i2400ms); |
0856ccf2 IPG |
230 | sdio_claim_host(func); |
231 | sdio_disable_func(func); | |
232 | sdio_release_host(func); | |
233 | } | |
234 | ||
235 | ||
a0848826 IPG |
236 | /* |
237 | * Setup driver resources needed to communicate with the device | |
238 | * | |
239 | * The fw needs some time to settle, and it was just uploaded, | |
240 | * so give it a break first. I'd prefer to just wait for the device to | |
241 | * send something, but seems the poking we do to enable SDIO stuff | |
242 | * interferes with it, so just give it a break before starting... | |
243 | */ | |
244 | static | |
245 | int i2400ms_bus_dev_start(struct i2400m *i2400m) | |
246 | { | |
a0848826 IPG |
247 | struct i2400ms *i2400ms = container_of(i2400m, struct i2400ms, i2400m); |
248 | struct sdio_func *func = i2400ms->func; | |
249 | struct device *dev = &func->dev; | |
250 | ||
251 | d_fnstart(3, dev, "(i2400m %p)\n", i2400m); | |
252 | msleep(200); | |
a8ee303c IPG |
253 | d_fnend(3, dev, "(i2400m %p) = %d\n", i2400m, 0); |
254 | return 0; | |
a0848826 IPG |
255 | } |
256 | ||
257 | ||
258 | /* | |
259 | * Sends a barker buffer to the device | |
260 | * | |
261 | * This helper will allocate a kmalloced buffer and use it to transmit | |
262 | * (then free it). Reason for this is that the SDIO host controller | |
263 | * expects alignment (unknown exactly which) which the stack won't | |
264 | * really provide and certain arches/host-controller combinations | |
265 | * cannot use stack/vmalloc/text areas for DMA transfers. | |
266 | */ | |
267 | static | |
268 | int __i2400ms_send_barker(struct i2400ms *i2400ms, | |
269 | const __le32 *barker, size_t barker_size) | |
270 | { | |
271 | int ret; | |
272 | struct sdio_func *func = i2400ms->func; | |
273 | struct device *dev = &func->dev; | |
274 | void *buffer; | |
275 | ||
276 | ret = -ENOMEM; | |
277 | buffer = kmalloc(I2400MS_BLK_SIZE, GFP_KERNEL); | |
278 | if (buffer == NULL) | |
279 | goto error_kzalloc; | |
280 | ||
281 | memcpy(buffer, barker, barker_size); | |
282 | sdio_claim_host(func); | |
283 | ret = sdio_memcpy_toio(func, 0, buffer, I2400MS_BLK_SIZE); | |
284 | sdio_release_host(func); | |
285 | ||
286 | if (ret < 0) | |
287 | d_printf(0, dev, "E: barker error: %d\n", ret); | |
288 | ||
289 | kfree(buffer); | |
290 | error_kzalloc: | |
291 | return ret; | |
292 | } | |
293 | ||
294 | ||
295 | /* | |
296 | * Reset a device at different levels (warm, cold or bus) | |
297 | * | |
298 | * @i2400ms: device descriptor | |
299 | * @reset_type: soft, warm or bus reset (I2400M_RT_WARM/SOFT/BUS) | |
300 | * | |
301 | * FIXME: not tested -- need to confirm expected effects | |
302 | * | |
303 | * Warm and cold resets get an SDIO reset if they fail (unimplemented) | |
304 | * | |
305 | * Warm reset: | |
306 | * | |
307 | * The device will be fully reset internally, but won't be | |
81b182a7 | 308 | * disconnected from the bus (so no reenumeration will |
3ad2f3fb | 309 | * happen). Firmware upload will be necessary. |
a0848826 | 310 | * |
81b182a7 DB |
311 | * The device will send a reboot barker that will trigger the driver |
312 | * to reinitialize the state via __i2400m_dev_reset_handle. | |
a0848826 | 313 | * |
81b182a7 DB |
314 | * |
315 | * Cold and bus reset: | |
a0848826 IPG |
316 | * |
317 | * The device will be fully reset internally, disconnected from the | |
81b182a7 | 318 | * bus an a reenumeration will happen. Firmware upload will be |
3ad2f3fb | 319 | * necessary. Thus, we don't do any locking or struct |
a0848826 IPG |
320 | * reinitialization, as we are going to be fully disconnected and |
321 | * reenumerated. | |
322 | * | |
323 | * Note we need to return -ENODEV if a warm reset was requested and we | |
324 | * had to resort to a bus reset. See i2400m_op_reset(), wimax_reset() | |
325 | * and wimax_dev->op_reset. | |
326 | * | |
327 | * WARNING: no driver state saved/fixed | |
328 | */ | |
329 | static | |
330 | int i2400ms_bus_reset(struct i2400m *i2400m, enum i2400m_reset_type rt) | |
331 | { | |
10b1de6b | 332 | int result = 0; |
a0848826 IPG |
333 | struct i2400ms *i2400ms = |
334 | container_of(i2400m, struct i2400ms, i2400m); | |
335 | struct device *dev = i2400m_dev(i2400m); | |
336 | static const __le32 i2400m_WARM_BOOT_BARKER[4] = { | |
ee437770 HH |
337 | cpu_to_le32(I2400M_WARM_RESET_BARKER), |
338 | cpu_to_le32(I2400M_WARM_RESET_BARKER), | |
339 | cpu_to_le32(I2400M_WARM_RESET_BARKER), | |
340 | cpu_to_le32(I2400M_WARM_RESET_BARKER), | |
a0848826 IPG |
341 | }; |
342 | static const __le32 i2400m_COLD_BOOT_BARKER[4] = { | |
ee437770 HH |
343 | cpu_to_le32(I2400M_COLD_RESET_BARKER), |
344 | cpu_to_le32(I2400M_COLD_RESET_BARKER), | |
345 | cpu_to_le32(I2400M_COLD_RESET_BARKER), | |
346 | cpu_to_le32(I2400M_COLD_RESET_BARKER), | |
a0848826 IPG |
347 | }; |
348 | ||
349 | if (rt == I2400M_RT_WARM) | |
350 | result = __i2400ms_send_barker(i2400ms, i2400m_WARM_BOOT_BARKER, | |
351 | sizeof(i2400m_WARM_BOOT_BARKER)); | |
352 | else if (rt == I2400M_RT_COLD) | |
353 | result = __i2400ms_send_barker(i2400ms, i2400m_COLD_BOOT_BARKER, | |
354 | sizeof(i2400m_COLD_BOOT_BARKER)); | |
355 | else if (rt == I2400M_RT_BUS) { | |
356 | do_bus_reset: | |
10b1de6b | 357 | |
0856ccf2 | 358 | i2400ms_bus_release(i2400m); |
10b1de6b DB |
359 | |
360 | /* Wait for the device to settle */ | |
361 | msleep(40); | |
362 | ||
0856ccf2 | 363 | result = i2400ms_bus_setup(i2400m); |
a0848826 IPG |
364 | } else |
365 | BUG(); | |
366 | if (result < 0 && rt != I2400M_RT_BUS) { | |
367 | dev_err(dev, "%s reset failed (%d); trying SDIO reset\n", | |
368 | rt == I2400M_RT_WARM ? "warm" : "cold", result); | |
369 | rt = I2400M_RT_BUS; | |
370 | goto do_bus_reset; | |
371 | } | |
372 | return result; | |
373 | } | |
374 | ||
375 | ||
376 | static | |
377 | void i2400ms_netdev_setup(struct net_device *net_dev) | |
378 | { | |
379 | struct i2400m *i2400m = net_dev_to_i2400m(net_dev); | |
380 | struct i2400ms *i2400ms = container_of(i2400m, struct i2400ms, i2400m); | |
381 | i2400ms_init(i2400ms); | |
382 | i2400m_netdev_setup(net_dev); | |
383 | } | |
384 | ||
385 | ||
386 | /* | |
387 | * Debug levels control; see debug.h | |
388 | */ | |
389 | struct d_level D_LEVEL[] = { | |
390 | D_SUBMODULE_DEFINE(main), | |
391 | D_SUBMODULE_DEFINE(tx), | |
392 | D_SUBMODULE_DEFINE(rx), | |
393 | D_SUBMODULE_DEFINE(fw), | |
394 | }; | |
395 | size_t D_LEVEL_SIZE = ARRAY_SIZE(D_LEVEL); | |
396 | ||
397 | ||
398 | #define __debugfs_register(prefix, name, parent) \ | |
399 | do { \ | |
400 | result = d_level_register_debugfs(prefix, name, parent); \ | |
401 | if (result < 0) \ | |
402 | goto error; \ | |
403 | } while (0) | |
404 | ||
405 | ||
406 | static | |
407 | int i2400ms_debugfs_add(struct i2400ms *i2400ms) | |
408 | { | |
409 | int result; | |
410 | struct dentry *dentry = i2400ms->i2400m.wimax_dev.debugfs_dentry; | |
411 | ||
20d57f8e | 412 | dentry = debugfs_create_dir("i2400m-sdio", dentry); |
a0848826 IPG |
413 | result = PTR_ERR(dentry); |
414 | if (IS_ERR(dentry)) { | |
415 | if (result == -ENODEV) | |
416 | result = 0; /* No debugfs support */ | |
417 | goto error; | |
418 | } | |
419 | i2400ms->debugfs_dentry = dentry; | |
420 | __debugfs_register("dl_", main, dentry); | |
421 | __debugfs_register("dl_", tx, dentry); | |
422 | __debugfs_register("dl_", rx, dentry); | |
423 | __debugfs_register("dl_", fw, dentry); | |
424 | ||
425 | return 0; | |
426 | ||
427 | error: | |
428 | debugfs_remove_recursive(i2400ms->debugfs_dentry); | |
fae92216 | 429 | i2400ms->debugfs_dentry = NULL; |
a0848826 IPG |
430 | return result; |
431 | } | |
432 | ||
433 | ||
384912ed MH |
434 | static struct device_type i2400ms_type = { |
435 | .name = "wimax", | |
436 | }; | |
437 | ||
a0848826 IPG |
438 | /* |
439 | * Probe a i2400m interface and register it | |
440 | * | |
441 | * @func: SDIO function | |
442 | * @id: SDIO device ID | |
443 | * @returns: 0 if ok, < 0 errno code on error. | |
444 | * | |
445 | * Alloc a net device, initialize the bus-specific details and then | |
446 | * calls the bus-generic initialization routine. That will register | |
447 | * the wimax and netdev devices, upload the firmware [using | |
448 | * _bus_bm_*()], call _bus_dev_start() to finalize the setup of the | |
449 | * communication with the device and then will start to talk to it to | |
450 | * finnish setting it up. | |
451 | * | |
452 | * Initialization is tricky; some instances of the hw are packed with | |
453 | * others in a way that requires a third driver that enables the WiMAX | |
454 | * function. In those cases, we can't enable the SDIO function and | |
455 | * we'll return with -ENODEV. When the driver that enables the WiMAX | |
456 | * function does its thing, it has to do a bus_rescan_devices() on the | |
457 | * SDIO bus so this driver is called again to enumerate the WiMAX | |
458 | * function. | |
459 | */ | |
460 | static | |
461 | int i2400ms_probe(struct sdio_func *func, | |
462 | const struct sdio_device_id *id) | |
463 | { | |
464 | int result; | |
465 | struct net_device *net_dev; | |
466 | struct device *dev = &func->dev; | |
467 | struct i2400m *i2400m; | |
468 | struct i2400ms *i2400ms; | |
469 | ||
470 | /* Allocate instance [calls i2400m_netdev_setup() on it]. */ | |
471 | result = -ENOMEM; | |
472 | net_dev = alloc_netdev(sizeof(*i2400ms), "wmx%d", | |
473 | i2400ms_netdev_setup); | |
474 | if (net_dev == NULL) { | |
475 | dev_err(dev, "no memory for network device instance\n"); | |
476 | goto error_alloc_netdev; | |
477 | } | |
478 | SET_NETDEV_DEV(net_dev, dev); | |
384912ed | 479 | SET_NETDEV_DEVTYPE(net_dev, &i2400ms_type); |
a0848826 IPG |
480 | i2400m = net_dev_to_i2400m(net_dev); |
481 | i2400ms = container_of(i2400m, struct i2400ms, i2400m); | |
482 | i2400m->wimax_dev.net_dev = net_dev; | |
483 | i2400ms->func = func; | |
484 | sdio_set_drvdata(func, i2400ms); | |
485 | ||
486 | i2400m->bus_tx_block_size = I2400MS_BLK_SIZE; | |
8a3a1b65 PP |
487 | /* |
488 | * Room required in the TX queue for SDIO message to accommodate | |
489 | * a smallest payload while allocating header space is 224 bytes, | |
490 | * which is the smallest message size(the block size 256 bytes) | |
491 | * minus the smallest message header size(32 bytes). | |
492 | */ | |
493 | i2400m->bus_tx_room_min = I2400MS_BLK_SIZE - I2400M_PL_ALIGN * 2; | |
a0848826 | 494 | i2400m->bus_pl_size_max = I2400MS_PL_SIZE_MAX; |
0856ccf2 | 495 | i2400m->bus_setup = i2400ms_bus_setup; |
a0848826 | 496 | i2400m->bus_dev_start = i2400ms_bus_dev_start; |
a8ee303c | 497 | i2400m->bus_dev_stop = NULL; |
0856ccf2 | 498 | i2400m->bus_release = i2400ms_bus_release; |
a0848826 IPG |
499 | i2400m->bus_tx_kick = i2400ms_bus_tx_kick; |
500 | i2400m->bus_reset = i2400ms_bus_reset; | |
ecddfd5e IPG |
501 | /* The iwmc3200-wimax sometimes requires the driver to try |
502 | * hard when we paint it into a corner. */ | |
c3083658 | 503 | i2400m->bus_bm_retries = I2400M_SDIO_BOOT_RETRIES; |
a0848826 IPG |
504 | i2400m->bus_bm_cmd_send = i2400ms_bus_bm_cmd_send; |
505 | i2400m->bus_bm_wait_for_ack = i2400ms_bus_bm_wait_for_ack; | |
1039abbc | 506 | i2400m->bus_fw_names = i2400ms_bus_fw_names; |
a0848826 | 507 | i2400m->bus_bm_mac_addr_impaired = 1; |
1c0b2dd7 | 508 | i2400m->bus_bm_pokes_table = &i2400ms_pokes[0]; |
a0848826 | 509 | |
02eb41ef IPG |
510 | switch (func->device) { |
511 | case SDIO_DEVICE_ID_INTEL_IWMC3200WIMAX: | |
512 | case SDIO_DEVICE_ID_INTEL_IWMC3200WIMAX_2G5: | |
513 | i2400ms->iwmc3200 = 1; | |
514 | break; | |
515 | default: | |
516 | i2400ms->iwmc3200 = 0; | |
517 | } | |
518 | ||
a0848826 IPG |
519 | result = i2400m_setup(i2400m, I2400M_BRI_NO_REBOOT); |
520 | if (result < 0) { | |
521 | dev_err(dev, "cannot setup device: %d\n", result); | |
522 | goto error_setup; | |
523 | } | |
524 | ||
525 | result = i2400ms_debugfs_add(i2400ms); | |
526 | if (result < 0) { | |
527 | dev_err(dev, "cannot create SDIO debugfs: %d\n", | |
528 | result); | |
529 | goto error_debugfs_add; | |
530 | } | |
531 | return 0; | |
532 | ||
533 | error_debugfs_add: | |
534 | i2400m_release(i2400m); | |
535 | error_setup: | |
a0a4c4c9 | 536 | sdio_set_drvdata(func, NULL); |
a0848826 IPG |
537 | free_netdev(net_dev); |
538 | error_alloc_netdev: | |
539 | return result; | |
540 | } | |
541 | ||
542 | ||
543 | static | |
544 | void i2400ms_remove(struct sdio_func *func) | |
545 | { | |
546 | struct device *dev = &func->dev; | |
547 | struct i2400ms *i2400ms = sdio_get_drvdata(func); | |
548 | struct i2400m *i2400m = &i2400ms->i2400m; | |
549 | struct net_device *net_dev = i2400m->wimax_dev.net_dev; | |
550 | ||
551 | d_fnstart(3, dev, "SDIO func %p\n", func); | |
552 | debugfs_remove_recursive(i2400ms->debugfs_dentry); | |
fae92216 | 553 | i2400ms->debugfs_dentry = NULL; |
a0848826 IPG |
554 | i2400m_release(i2400m); |
555 | sdio_set_drvdata(func, NULL); | |
a0848826 IPG |
556 | free_netdev(net_dev); |
557 | d_fnend(3, dev, "SDIO func %p\n", func); | |
558 | } | |
559 | ||
a0848826 IPG |
560 | static |
561 | const struct sdio_device_id i2400ms_sdio_ids[] = { | |
51def0be TW |
562 | /* Intel: i2400m WiMAX (iwmc3200) over SDIO */ |
563 | { SDIO_DEVICE(SDIO_VENDOR_ID_INTEL, | |
564 | SDIO_DEVICE_ID_INTEL_IWMC3200WIMAX) }, | |
f8fc3295 CK |
565 | { SDIO_DEVICE(SDIO_VENDOR_ID_INTEL, |
566 | SDIO_DEVICE_ID_INTEL_IWMC3200WIMAX_2G5) }, | |
51def0be | 567 | { /* end: all zeroes */ }, |
a0848826 IPG |
568 | }; |
569 | MODULE_DEVICE_TABLE(sdio, i2400ms_sdio_ids); | |
570 | ||
571 | ||
572 | static | |
573 | struct sdio_driver i2400m_sdio_driver = { | |
574 | .name = KBUILD_MODNAME, | |
575 | .probe = i2400ms_probe, | |
576 | .remove = i2400ms_remove, | |
577 | .id_table = i2400ms_sdio_ids, | |
578 | }; | |
579 | ||
580 | ||
581 | static | |
582 | int __init i2400ms_driver_init(void) | |
583 | { | |
4c2b1a11 IPG |
584 | d_parse_params(D_LEVEL, D_LEVEL_SIZE, i2400ms_debug_params, |
585 | "i2400m_sdio.debug"); | |
a0848826 IPG |
586 | return sdio_register_driver(&i2400m_sdio_driver); |
587 | } | |
588 | module_init(i2400ms_driver_init); | |
589 | ||
590 | ||
591 | static | |
592 | void __exit i2400ms_driver_exit(void) | |
593 | { | |
a0848826 IPG |
594 | sdio_unregister_driver(&i2400m_sdio_driver); |
595 | } | |
596 | module_exit(i2400ms_driver_exit); | |
597 | ||
598 | ||
599 | MODULE_AUTHOR("Intel Corporation <linux-wimax@intel.com>"); | |
600 | MODULE_DESCRIPTION("Intel 2400M WiMAX networking for SDIO"); | |
601 | MODULE_LICENSE("GPL"); | |
602 | MODULE_FIRMWARE(I2400MS_FW_FILE_NAME); |