diff options
Diffstat (limited to 'drivers/misc/iwmc3200top/main.c')
-rw-r--r-- | drivers/misc/iwmc3200top/main.c | 662 |
1 files changed, 0 insertions, 662 deletions
diff --git a/drivers/misc/iwmc3200top/main.c b/drivers/misc/iwmc3200top/main.c deleted file mode 100644 index 701eb600b127..000000000000 --- a/drivers/misc/iwmc3200top/main.c +++ /dev/null | |||
@@ -1,662 +0,0 @@ | |||
1 | /* | ||
2 | * iwmc3200top - Intel Wireless MultiCom 3200 Top Driver | ||
3 | * drivers/misc/iwmc3200top/main.c | ||
4 | * | ||
5 | * Copyright (C) 2009 Intel Corporation. All rights reserved. | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or | ||
8 | * modify it under the terms of the GNU General Public License version | ||
9 | * 2 as published by the Free Software Foundation. | ||
10 | * | ||
11 | * This program is distributed in the hope that it will be useful, | ||
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | * GNU General Public License for more details. | ||
15 | * | ||
16 | * You should have received a copy of the GNU General Public License | ||
17 | * along with this program; if not, write to the Free Software | ||
18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
19 | * 02110-1301, USA. | ||
20 | * | ||
21 | * | ||
22 | * Author Name: Maxim Grabarnik <maxim.grabarnink@intel.com> | ||
23 | * - | ||
24 | * | ||
25 | */ | ||
26 | |||
27 | #include <linux/module.h> | ||
28 | #include <linux/slab.h> | ||
29 | #include <linux/init.h> | ||
30 | #include <linux/kernel.h> | ||
31 | #include <linux/debugfs.h> | ||
32 | #include <linux/mmc/sdio_ids.h> | ||
33 | #include <linux/mmc/sdio_func.h> | ||
34 | #include <linux/mmc/sdio.h> | ||
35 | |||
36 | #include "iwmc3200top.h" | ||
37 | #include "log.h" | ||
38 | #include "fw-msg.h" | ||
39 | #include "debugfs.h" | ||
40 | |||
41 | |||
42 | #define DRIVER_DESCRIPTION "Intel(R) IWMC 3200 Top Driver" | ||
43 | #define DRIVER_COPYRIGHT "Copyright (c) 2008 Intel Corporation." | ||
44 | |||
45 | #define DRIVER_VERSION "0.1.62" | ||
46 | |||
47 | MODULE_DESCRIPTION(DRIVER_DESCRIPTION); | ||
48 | MODULE_VERSION(DRIVER_VERSION); | ||
49 | MODULE_LICENSE("GPL"); | ||
50 | MODULE_AUTHOR(DRIVER_COPYRIGHT); | ||
51 | MODULE_FIRMWARE(FW_NAME(FW_API_VER)); | ||
52 | |||
53 | |||
54 | static inline int __iwmct_tx(struct iwmct_priv *priv, void *src, int count) | ||
55 | { | ||
56 | return sdio_memcpy_toio(priv->func, IWMC_SDIO_DATA_ADDR, src, count); | ||
57 | |||
58 | } | ||
59 | int iwmct_tx(struct iwmct_priv *priv, void *src, int count) | ||
60 | { | ||
61 | int ret; | ||
62 | sdio_claim_host(priv->func); | ||
63 | ret = __iwmct_tx(priv, src, count); | ||
64 | sdio_release_host(priv->func); | ||
65 | return ret; | ||
66 | } | ||
67 | /* | ||
68 | * This workers main task is to wait for OP_OPR_ALIVE | ||
69 | * from TOP FW until ALIVE_MSG_TIMOUT timeout is elapsed. | ||
70 | * When OP_OPR_ALIVE received it will issue | ||
71 | * a call to "bus_rescan_devices". | ||
72 | */ | ||
73 | static void iwmct_rescan_worker(struct work_struct *ws) | ||
74 | { | ||
75 | struct iwmct_priv *priv; | ||
76 | int ret; | ||
77 | |||
78 | priv = container_of(ws, struct iwmct_priv, bus_rescan_worker); | ||
79 | |||
80 | LOG_INFO(priv, FW_MSG, "Calling bus_rescan\n"); | ||
81 | |||
82 | ret = bus_rescan_devices(priv->func->dev.bus); | ||
83 | if (ret < 0) | ||
84 | LOG_INFO(priv, INIT, "bus_rescan_devices FAILED!!!\n"); | ||
85 | } | ||
86 | |||
87 | static void op_top_message(struct iwmct_priv *priv, struct top_msg *msg) | ||
88 | { | ||
89 | switch (msg->hdr.opcode) { | ||
90 | case OP_OPR_ALIVE: | ||
91 | LOG_INFO(priv, FW_MSG, "Got ALIVE from device, wake rescan\n"); | ||
92 | schedule_work(&priv->bus_rescan_worker); | ||
93 | break; | ||
94 | default: | ||
95 | LOG_INFO(priv, FW_MSG, "Received msg opcode 0x%X\n", | ||
96 | msg->hdr.opcode); | ||
97 | break; | ||
98 | } | ||
99 | } | ||
100 | |||
101 | |||
102 | static void handle_top_message(struct iwmct_priv *priv, u8 *buf, int len) | ||
103 | { | ||
104 | struct top_msg *msg; | ||
105 | |||
106 | msg = (struct top_msg *)buf; | ||
107 | |||
108 | if (msg->hdr.type != COMM_TYPE_D2H) { | ||
109 | LOG_ERROR(priv, FW_MSG, | ||
110 | "Message from TOP with invalid message type 0x%X\n", | ||
111 | msg->hdr.type); | ||
112 | return; | ||
113 | } | ||
114 | |||
115 | if (len < sizeof(msg->hdr)) { | ||
116 | LOG_ERROR(priv, FW_MSG, | ||
117 | "Message from TOP is too short for message header " | ||
118 | "received %d bytes, expected at least %zd bytes\n", | ||
119 | len, sizeof(msg->hdr)); | ||
120 | return; | ||
121 | } | ||
122 | |||
123 | if (len < le16_to_cpu(msg->hdr.length) + sizeof(msg->hdr)) { | ||
124 | LOG_ERROR(priv, FW_MSG, | ||
125 | "Message length (%d bytes) is shorter than " | ||
126 | "in header (%d bytes)\n", | ||
127 | len, le16_to_cpu(msg->hdr.length)); | ||
128 | return; | ||
129 | } | ||
130 | |||
131 | switch (msg->hdr.category) { | ||
132 | case COMM_CATEGORY_OPERATIONAL: | ||
133 | op_top_message(priv, (struct top_msg *)buf); | ||
134 | break; | ||
135 | |||
136 | case COMM_CATEGORY_DEBUG: | ||
137 | case COMM_CATEGORY_TESTABILITY: | ||
138 | case COMM_CATEGORY_DIAGNOSTICS: | ||
139 | iwmct_log_top_message(priv, buf, len); | ||
140 | break; | ||
141 | |||
142 | default: | ||
143 | LOG_ERROR(priv, FW_MSG, | ||
144 | "Message from TOP with unknown category 0x%X\n", | ||
145 | msg->hdr.category); | ||
146 | break; | ||
147 | } | ||
148 | } | ||
149 | |||
150 | int iwmct_send_hcmd(struct iwmct_priv *priv, u8 *cmd, u16 len) | ||
151 | { | ||
152 | int ret; | ||
153 | u8 *buf; | ||
154 | |||
155 | LOG_TRACE(priv, FW_MSG, "Sending hcmd:\n"); | ||
156 | |||
157 | /* add padding to 256 for IWMC */ | ||
158 | ((struct top_msg *)cmd)->hdr.flags |= CMD_FLAG_PADDING_256; | ||
159 | |||
160 | LOG_HEXDUMP(FW_MSG, cmd, len); | ||
161 | |||
162 | if (len > FW_HCMD_BLOCK_SIZE) { | ||
163 | LOG_ERROR(priv, FW_MSG, "size %d exceeded hcmd max size %d\n", | ||
164 | len, FW_HCMD_BLOCK_SIZE); | ||
165 | return -1; | ||
166 | } | ||
167 | |||
168 | buf = kzalloc(FW_HCMD_BLOCK_SIZE, GFP_KERNEL); | ||
169 | if (!buf) { | ||
170 | LOG_ERROR(priv, FW_MSG, "kzalloc error, buf size %d\n", | ||
171 | FW_HCMD_BLOCK_SIZE); | ||
172 | return -1; | ||
173 | } | ||
174 | |||
175 | memcpy(buf, cmd, len); | ||
176 | ret = iwmct_tx(priv, buf, FW_HCMD_BLOCK_SIZE); | ||
177 | |||
178 | kfree(buf); | ||
179 | return ret; | ||
180 | } | ||
181 | |||
182 | |||
183 | static void iwmct_irq_read_worker(struct work_struct *ws) | ||
184 | { | ||
185 | struct iwmct_priv *priv; | ||
186 | struct iwmct_work_struct *read_req; | ||
187 | __le32 *buf = NULL; | ||
188 | int ret; | ||
189 | int iosize; | ||
190 | u32 barker; | ||
191 | bool is_barker; | ||
192 | |||
193 | priv = container_of(ws, struct iwmct_priv, isr_worker); | ||
194 | |||
195 | LOG_TRACE(priv, IRQ, "enter iwmct_irq_read_worker %p\n", ws); | ||
196 | |||
197 | /* --------------------- Handshake with device -------------------- */ | ||
198 | sdio_claim_host(priv->func); | ||
199 | |||
200 | /* all list manipulations have to be protected by | ||
201 | * sdio_claim_host/sdio_release_host */ | ||
202 | if (list_empty(&priv->read_req_list)) { | ||
203 | LOG_ERROR(priv, IRQ, "read_req_list empty in read worker\n"); | ||
204 | goto exit_release; | ||
205 | } | ||
206 | |||
207 | read_req = list_entry(priv->read_req_list.next, | ||
208 | struct iwmct_work_struct, list); | ||
209 | |||
210 | list_del(&read_req->list); | ||
211 | iosize = read_req->iosize; | ||
212 | kfree(read_req); | ||
213 | |||
214 | buf = kzalloc(iosize, GFP_KERNEL); | ||
215 | if (!buf) { | ||
216 | LOG_ERROR(priv, IRQ, "kzalloc error, buf size %d\n", iosize); | ||
217 | goto exit_release; | ||
218 | } | ||
219 | |||
220 | LOG_INFO(priv, IRQ, "iosize=%d, buf=%p, func=%d\n", | ||
221 | iosize, buf, priv->func->num); | ||
222 | |||
223 | /* read from device */ | ||
224 | ret = sdio_memcpy_fromio(priv->func, buf, IWMC_SDIO_DATA_ADDR, iosize); | ||
225 | if (ret) { | ||
226 | LOG_ERROR(priv, IRQ, "error %d reading buffer\n", ret); | ||
227 | goto exit_release; | ||
228 | } | ||
229 | |||
230 | LOG_HEXDUMP(IRQ, (u8 *)buf, iosize); | ||
231 | |||
232 | barker = le32_to_cpu(buf[0]); | ||
233 | |||
234 | /* Verify whether it's a barker and if not - treat as regular Rx */ | ||
235 | if (barker == IWMC_BARKER_ACK || | ||
236 | (barker & BARKER_DNLOAD_BARKER_MSK) == IWMC_BARKER_REBOOT) { | ||
237 | |||
238 | /* Valid Barker is equal on first 4 dwords */ | ||
239 | is_barker = (buf[1] == buf[0]) && | ||
240 | (buf[2] == buf[0]) && | ||
241 | (buf[3] == buf[0]); | ||
242 | |||
243 | if (!is_barker) { | ||
244 | LOG_WARNING(priv, IRQ, | ||
245 | "Potentially inconsistent barker " | ||
246 | "%08X_%08X_%08X_%08X\n", | ||
247 | le32_to_cpu(buf[0]), le32_to_cpu(buf[1]), | ||
248 | le32_to_cpu(buf[2]), le32_to_cpu(buf[3])); | ||
249 | } | ||
250 | } else { | ||
251 | is_barker = false; | ||
252 | } | ||
253 | |||
254 | /* Handle Top CommHub message */ | ||
255 | if (!is_barker) { | ||
256 | sdio_release_host(priv->func); | ||
257 | handle_top_message(priv, (u8 *)buf, iosize); | ||
258 | goto exit; | ||
259 | } else if (barker == IWMC_BARKER_ACK) { /* Handle barkers */ | ||
260 | if (atomic_read(&priv->dev_sync) == 0) { | ||
261 | LOG_ERROR(priv, IRQ, | ||
262 | "ACK barker arrived out-of-sync\n"); | ||
263 | goto exit_release; | ||
264 | } | ||
265 | |||
266 | /* Continuing to FW download (after Sync is completed)*/ | ||
267 | atomic_set(&priv->dev_sync, 0); | ||
268 | LOG_INFO(priv, IRQ, "ACK barker arrived " | ||
269 | "- starting FW download\n"); | ||
270 | } else { /* REBOOT barker */ | ||
271 | LOG_INFO(priv, IRQ, "Received reboot barker: %x\n", barker); | ||
272 | priv->barker = barker; | ||
273 | |||
274 | if (barker & BARKER_DNLOAD_SYNC_MSK) { | ||
275 | /* Send the same barker back */ | ||
276 | ret = __iwmct_tx(priv, buf, iosize); | ||
277 | if (ret) { | ||
278 | LOG_ERROR(priv, IRQ, | ||
279 | "error %d echoing barker\n", ret); | ||
280 | goto exit_release; | ||
281 | } | ||
282 | LOG_INFO(priv, IRQ, "Echoing barker to device\n"); | ||
283 | atomic_set(&priv->dev_sync, 1); | ||
284 | goto exit_release; | ||
285 | } | ||
286 | |||
287 | /* Continuing to FW download (without Sync) */ | ||
288 | LOG_INFO(priv, IRQ, "No sync requested " | ||
289 | "- starting FW download\n"); | ||
290 | } | ||
291 | |||
292 | sdio_release_host(priv->func); | ||
293 | |||
294 | if (priv->dbg.fw_download) | ||
295 | iwmct_fw_load(priv); | ||
296 | else | ||
297 | LOG_ERROR(priv, IRQ, "FW download not allowed\n"); | ||
298 | |||
299 | goto exit; | ||
300 | |||
301 | exit_release: | ||
302 | sdio_release_host(priv->func); | ||
303 | exit: | ||
304 | kfree(buf); | ||
305 | LOG_TRACE(priv, IRQ, "exit iwmct_irq_read_worker\n"); | ||
306 | } | ||
307 | |||
308 | static void iwmct_irq(struct sdio_func *func) | ||
309 | { | ||
310 | struct iwmct_priv *priv; | ||
311 | int val, ret; | ||
312 | int iosize; | ||
313 | int addr = IWMC_SDIO_INTR_GET_SIZE_ADDR; | ||
314 | struct iwmct_work_struct *read_req; | ||
315 | |||
316 | priv = sdio_get_drvdata(func); | ||
317 | |||
318 | LOG_TRACE(priv, IRQ, "enter iwmct_irq\n"); | ||
319 | |||
320 | /* read the function's status register */ | ||
321 | val = sdio_readb(func, IWMC_SDIO_INTR_STATUS_ADDR, &ret); | ||
322 | |||
323 | LOG_TRACE(priv, IRQ, "iir value = %d, ret=%d\n", val, ret); | ||
324 | |||
325 | if (!val) { | ||
326 | LOG_ERROR(priv, IRQ, "iir = 0, exiting ISR\n"); | ||
327 | goto exit_clear_intr; | ||
328 | } | ||
329 | |||
330 | |||
331 | /* | ||
332 | * read 2 bytes of the transaction size | ||
333 | * IMPORTANT: sdio transaction size has to be read before clearing | ||
334 | * sdio interrupt!!! | ||
335 | */ | ||
336 | val = sdio_readb(priv->func, addr++, &ret); | ||
337 | iosize = val; | ||
338 | val = sdio_readb(priv->func, addr++, &ret); | ||
339 | iosize += val << 8; | ||
340 | |||
341 | LOG_INFO(priv, IRQ, "READ size %d\n", iosize); | ||
342 | |||
343 | if (iosize == 0) { | ||
344 | LOG_ERROR(priv, IRQ, "READ size %d, exiting ISR\n", iosize); | ||
345 | goto exit_clear_intr; | ||
346 | } | ||
347 | |||
348 | /* allocate a work structure to pass iosize to the worker */ | ||
349 | read_req = kzalloc(sizeof(struct iwmct_work_struct), GFP_KERNEL); | ||
350 | if (!read_req) { | ||
351 | LOG_ERROR(priv, IRQ, "failed to allocate read_req, exit ISR\n"); | ||
352 | goto exit_clear_intr; | ||
353 | } | ||
354 | |||
355 | INIT_LIST_HEAD(&read_req->list); | ||
356 | read_req->iosize = iosize; | ||
357 | |||
358 | list_add_tail(&priv->read_req_list, &read_req->list); | ||
359 | |||
360 | /* clear the function's interrupt request bit (write 1 to clear) */ | ||
361 | sdio_writeb(func, 1, IWMC_SDIO_INTR_CLEAR_ADDR, &ret); | ||
362 | |||
363 | schedule_work(&priv->isr_worker); | ||
364 | |||
365 | LOG_TRACE(priv, IRQ, "exit iwmct_irq\n"); | ||
366 | |||
367 | return; | ||
368 | |||
369 | exit_clear_intr: | ||
370 | /* clear the function's interrupt request bit (write 1 to clear) */ | ||
371 | sdio_writeb(func, 1, IWMC_SDIO_INTR_CLEAR_ADDR, &ret); | ||
372 | } | ||
373 | |||
374 | |||
375 | static int blocks; | ||
376 | module_param(blocks, int, 0604); | ||
377 | MODULE_PARM_DESC(blocks, "max_blocks_to_send"); | ||
378 | |||
379 | static bool dump; | ||
380 | module_param(dump, bool, 0604); | ||
381 | MODULE_PARM_DESC(dump, "dump_hex_content"); | ||
382 | |||
383 | static bool jump = 1; | ||
384 | module_param(jump, bool, 0604); | ||
385 | |||
386 | static bool direct = 1; | ||
387 | module_param(direct, bool, 0604); | ||
388 | |||
389 | static bool checksum = 1; | ||
390 | module_param(checksum, bool, 0604); | ||
391 | |||
392 | static bool fw_download = 1; | ||
393 | module_param(fw_download, bool, 0604); | ||
394 | |||
395 | static int block_size = IWMC_SDIO_BLK_SIZE; | ||
396 | module_param(block_size, int, 0404); | ||
397 | |||
398 | static int download_trans_blks = IWMC_DEFAULT_TR_BLK; | ||
399 | module_param(download_trans_blks, int, 0604); | ||
400 | |||
401 | static bool rubbish_barker; | ||
402 | module_param(rubbish_barker, bool, 0604); | ||
403 | |||
404 | #ifdef CONFIG_IWMC3200TOP_DEBUG | ||
405 | static int log_level[LOG_SRC_MAX]; | ||
406 | static unsigned int log_level_argc; | ||
407 | module_param_array(log_level, int, &log_level_argc, 0604); | ||
408 | MODULE_PARM_DESC(log_level, "log_level"); | ||
409 | |||
410 | static int log_level_fw[FW_LOG_SRC_MAX]; | ||
411 | static unsigned int log_level_fw_argc; | ||
412 | module_param_array(log_level_fw, int, &log_level_fw_argc, 0604); | ||
413 | MODULE_PARM_DESC(log_level_fw, "log_level_fw"); | ||
414 | #endif | ||
415 | |||
416 | void iwmct_dbg_init_params(struct iwmct_priv *priv) | ||
417 | { | ||
418 | #ifdef CONFIG_IWMC3200TOP_DEBUG | ||
419 | int i; | ||
420 | |||
421 | for (i = 0; i < log_level_argc; i++) { | ||
422 | dev_notice(&priv->func->dev, "log_level[%d]=0x%X\n", | ||
423 | i, log_level[i]); | ||
424 | iwmct_log_set_filter((log_level[i] >> 8) & 0xFF, | ||
425 | log_level[i] & 0xFF); | ||
426 | } | ||
427 | for (i = 0; i < log_level_fw_argc; i++) { | ||
428 | dev_notice(&priv->func->dev, "log_level_fw[%d]=0x%X\n", | ||
429 | i, log_level_fw[i]); | ||
430 | iwmct_log_set_fw_filter((log_level_fw[i] >> 8) & 0xFF, | ||
431 | log_level_fw[i] & 0xFF); | ||
432 | } | ||
433 | #endif | ||
434 | |||
435 | priv->dbg.blocks = blocks; | ||
436 | LOG_INFO(priv, INIT, "blocks=%d\n", blocks); | ||
437 | priv->dbg.dump = (bool)dump; | ||
438 | LOG_INFO(priv, INIT, "dump=%d\n", dump); | ||
439 | priv->dbg.jump = (bool)jump; | ||
440 | LOG_INFO(priv, INIT, "jump=%d\n", jump); | ||
441 | priv->dbg.direct = (bool)direct; | ||
442 | LOG_INFO(priv, INIT, "direct=%d\n", direct); | ||
443 | priv->dbg.checksum = (bool)checksum; | ||
444 | LOG_INFO(priv, INIT, "checksum=%d\n", checksum); | ||
445 | priv->dbg.fw_download = (bool)fw_download; | ||
446 | LOG_INFO(priv, INIT, "fw_download=%d\n", fw_download); | ||
447 | priv->dbg.block_size = block_size; | ||
448 | LOG_INFO(priv, INIT, "block_size=%d\n", block_size); | ||
449 | priv->dbg.download_trans_blks = download_trans_blks; | ||
450 | LOG_INFO(priv, INIT, "download_trans_blks=%d\n", download_trans_blks); | ||
451 | } | ||
452 | |||
453 | /***************************************************************************** | ||
454 | * | ||
455 | * sysfs attributes | ||
456 | * | ||
457 | *****************************************************************************/ | ||
458 | static ssize_t show_iwmct_fw_version(struct device *d, | ||
459 | struct device_attribute *attr, char *buf) | ||
460 | { | ||
461 | struct iwmct_priv *priv = dev_get_drvdata(d); | ||
462 | return sprintf(buf, "%s\n", priv->dbg.label_fw); | ||
463 | } | ||
464 | static DEVICE_ATTR(cc_label_fw, S_IRUGO, show_iwmct_fw_version, NULL); | ||
465 | |||
466 | #ifdef CONFIG_IWMC3200TOP_DEBUG | ||
467 | static DEVICE_ATTR(log_level, S_IWUSR | S_IRUGO, | ||
468 | show_iwmct_log_level, store_iwmct_log_level); | ||
469 | static DEVICE_ATTR(log_level_fw, S_IWUSR | S_IRUGO, | ||
470 | show_iwmct_log_level_fw, store_iwmct_log_level_fw); | ||
471 | #endif | ||
472 | |||
473 | static struct attribute *iwmct_sysfs_entries[] = { | ||
474 | &dev_attr_cc_label_fw.attr, | ||
475 | #ifdef CONFIG_IWMC3200TOP_DEBUG | ||
476 | &dev_attr_log_level.attr, | ||
477 | &dev_attr_log_level_fw.attr, | ||
478 | #endif | ||
479 | NULL | ||
480 | }; | ||
481 | |||
482 | static struct attribute_group iwmct_attribute_group = { | ||
483 | .name = NULL, /* put in device directory */ | ||
484 | .attrs = iwmct_sysfs_entries, | ||
485 | }; | ||
486 | |||
487 | |||
488 | static int iwmct_probe(struct sdio_func *func, | ||
489 | const struct sdio_device_id *id) | ||
490 | { | ||
491 | struct iwmct_priv *priv; | ||
492 | int ret; | ||
493 | int val = 1; | ||
494 | int addr = IWMC_SDIO_INTR_ENABLE_ADDR; | ||
495 | |||
496 | dev_dbg(&func->dev, "enter iwmct_probe\n"); | ||
497 | |||
498 | dev_dbg(&func->dev, "IRQ polling period id %u msecs, HZ is %d\n", | ||
499 | jiffies_to_msecs(2147483647), HZ); | ||
500 | |||
501 | priv = kzalloc(sizeof(struct iwmct_priv), GFP_KERNEL); | ||
502 | if (!priv) { | ||
503 | dev_err(&func->dev, "kzalloc error\n"); | ||
504 | return -ENOMEM; | ||
505 | } | ||
506 | priv->func = func; | ||
507 | sdio_set_drvdata(func, priv); | ||
508 | |||
509 | INIT_WORK(&priv->bus_rescan_worker, iwmct_rescan_worker); | ||
510 | INIT_WORK(&priv->isr_worker, iwmct_irq_read_worker); | ||
511 | |||
512 | init_waitqueue_head(&priv->wait_q); | ||
513 | |||
514 | sdio_claim_host(func); | ||
515 | /* FIXME: Remove after it is fixed in the Boot ROM upgrade */ | ||
516 | func->enable_timeout = 10; | ||
517 | |||
518 | /* In our HW, setting the block size also wakes up the boot rom. */ | ||
519 | ret = sdio_set_block_size(func, priv->dbg.block_size); | ||
520 | if (ret) { | ||
521 | LOG_ERROR(priv, INIT, | ||
522 | "sdio_set_block_size() failure: %d\n", ret); | ||
523 | goto error_sdio_enable; | ||
524 | } | ||
525 | |||
526 | ret = sdio_enable_func(func); | ||
527 | if (ret) { | ||
528 | LOG_ERROR(priv, INIT, "sdio_enable_func() failure: %d\n", ret); | ||
529 | goto error_sdio_enable; | ||
530 | } | ||
531 | |||
532 | /* init reset and dev_sync states */ | ||
533 | atomic_set(&priv->reset, 0); | ||
534 | atomic_set(&priv->dev_sync, 0); | ||
535 | |||
536 | /* init read req queue */ | ||
537 | INIT_LIST_HEAD(&priv->read_req_list); | ||
538 | |||
539 | /* process configurable parameters */ | ||
540 | iwmct_dbg_init_params(priv); | ||
541 | ret = sysfs_create_group(&func->dev.kobj, &iwmct_attribute_group); | ||
542 | if (ret) { | ||
543 | LOG_ERROR(priv, INIT, "Failed to register attributes and " | ||
544 | "initialize module_params\n"); | ||
545 | goto error_dev_attrs; | ||
546 | } | ||
547 | |||
548 | iwmct_dbgfs_register(priv, DRV_NAME); | ||
549 | |||
550 | if (!priv->dbg.direct && priv->dbg.download_trans_blks > 8) { | ||
551 | LOG_INFO(priv, INIT, | ||
552 | "Reducing transaction to 8 blocks = 2K (from %d)\n", | ||
553 | priv->dbg.download_trans_blks); | ||
554 | priv->dbg.download_trans_blks = 8; | ||
555 | } | ||
556 | priv->trans_len = priv->dbg.download_trans_blks * priv->dbg.block_size; | ||
557 | LOG_INFO(priv, INIT, "Transaction length = %d\n", priv->trans_len); | ||
558 | |||
559 | ret = sdio_claim_irq(func, iwmct_irq); | ||
560 | if (ret) { | ||
561 | LOG_ERROR(priv, INIT, "sdio_claim_irq() failure: %d\n", ret); | ||
562 | goto error_claim_irq; | ||
563 | } | ||
564 | |||
565 | |||
566 | /* Enable function's interrupt */ | ||
567 | sdio_writeb(priv->func, val, addr, &ret); | ||
568 | if (ret) { | ||
569 | LOG_ERROR(priv, INIT, "Failure writing to " | ||
570 | "Interrupt Enable Register (%d): %d\n", addr, ret); | ||
571 | goto error_enable_int; | ||
572 | } | ||
573 | |||
574 | sdio_release_host(func); | ||
575 | |||
576 | LOG_INFO(priv, INIT, "exit iwmct_probe\n"); | ||
577 | |||
578 | return ret; | ||
579 | |||
580 | error_enable_int: | ||
581 | sdio_release_irq(func); | ||
582 | error_claim_irq: | ||
583 | sdio_disable_func(func); | ||
584 | error_dev_attrs: | ||
585 | iwmct_dbgfs_unregister(priv->dbgfs); | ||
586 | sysfs_remove_group(&func->dev.kobj, &iwmct_attribute_group); | ||
587 | error_sdio_enable: | ||
588 | sdio_release_host(func); | ||
589 | return ret; | ||
590 | } | ||
591 | |||
592 | static void iwmct_remove(struct sdio_func *func) | ||
593 | { | ||
594 | struct iwmct_work_struct *read_req; | ||
595 | struct iwmct_priv *priv = sdio_get_drvdata(func); | ||
596 | |||
597 | LOG_INFO(priv, INIT, "enter\n"); | ||
598 | |||
599 | sdio_claim_host(func); | ||
600 | sdio_release_irq(func); | ||
601 | sdio_release_host(func); | ||
602 | |||
603 | /* Make sure works are finished */ | ||
604 | flush_work_sync(&priv->bus_rescan_worker); | ||
605 | flush_work_sync(&priv->isr_worker); | ||
606 | |||
607 | sdio_claim_host(func); | ||
608 | sdio_disable_func(func); | ||
609 | sysfs_remove_group(&func->dev.kobj, &iwmct_attribute_group); | ||
610 | iwmct_dbgfs_unregister(priv->dbgfs); | ||
611 | sdio_release_host(func); | ||
612 | |||
613 | /* free read requests */ | ||
614 | while (!list_empty(&priv->read_req_list)) { | ||
615 | read_req = list_entry(priv->read_req_list.next, | ||
616 | struct iwmct_work_struct, list); | ||
617 | |||
618 | list_del(&read_req->list); | ||
619 | kfree(read_req); | ||
620 | } | ||
621 | |||
622 | kfree(priv); | ||
623 | } | ||
624 | |||
625 | |||
626 | static const struct sdio_device_id iwmct_ids[] = { | ||
627 | /* Intel Wireless MultiCom 3200 Top Driver */ | ||
628 | { SDIO_DEVICE(SDIO_VENDOR_ID_INTEL, 0x1404)}, | ||
629 | { }, /* Terminating entry */ | ||
630 | }; | ||
631 | |||
632 | MODULE_DEVICE_TABLE(sdio, iwmct_ids); | ||
633 | |||
634 | static struct sdio_driver iwmct_driver = { | ||
635 | .probe = iwmct_probe, | ||
636 | .remove = iwmct_remove, | ||
637 | .name = DRV_NAME, | ||
638 | .id_table = iwmct_ids, | ||
639 | }; | ||
640 | |||
641 | static int __init iwmct_init(void) | ||
642 | { | ||
643 | int rc; | ||
644 | |||
645 | /* Default log filter settings */ | ||
646 | iwmct_log_set_filter(LOG_SRC_ALL, LOG_SEV_FILTER_RUNTIME); | ||
647 | iwmct_log_set_filter(LOG_SRC_FW_MSG, LOG_SEV_FW_FILTER_ALL); | ||
648 | iwmct_log_set_fw_filter(LOG_SRC_ALL, FW_LOG_SEV_FILTER_RUNTIME); | ||
649 | |||
650 | rc = sdio_register_driver(&iwmct_driver); | ||
651 | |||
652 | return rc; | ||
653 | } | ||
654 | |||
655 | static void __exit iwmct_exit(void) | ||
656 | { | ||
657 | sdio_unregister_driver(&iwmct_driver); | ||
658 | } | ||
659 | |||
660 | module_init(iwmct_init); | ||
661 | module_exit(iwmct_exit); | ||
662 | |||