Commit | Line | Data |
---|---|---|
d2b21f19 CM |
1 | /* |
2 | * linux/drivers/net/wireless/libertas/if_spi.c | |
3 | * | |
4 | * Driver for Marvell SPI WLAN cards. | |
5 | * | |
6 | * Copyright 2008 Analog Devices Inc. | |
7 | * | |
8 | * Authors: | |
9 | * Andrey Yurovsky <andrey@cozybit.com> | |
10 | * Colin McCabe <colin@cozybit.com> | |
11 | * | |
12 | * Inspired by if_sdio.c, Copyright 2007-2008 Pierre Ossman | |
13 | * | |
14 | * This program is free software; you can redistribute it and/or modify | |
15 | * it under the terms of the GNU General Public License as published by | |
16 | * the Free Software Foundation; either version 2 of the License, or | |
17 | * (at your option) any later version. | |
18 | */ | |
19 | ||
0e4e06ae JP |
20 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
21 | ||
a6b7a407 AD |
22 | #include <linux/hardirq.h> |
23 | #include <linux/interrupt.h> | |
d2b21f19 CM |
24 | #include <linux/moduleparam.h> |
25 | #include <linux/firmware.h> | |
d2b21f19 | 26 | #include <linux/jiffies.h> |
d2b21f19 CM |
27 | #include <linux/list.h> |
28 | #include <linux/netdevice.h> | |
5a0e3ad6 | 29 | #include <linux/slab.h> |
d2b21f19 CM |
30 | #include <linux/spi/libertas_spi.h> |
31 | #include <linux/spi/spi.h> | |
32 | ||
33 | #include "host.h" | |
34 | #include "decl.h" | |
35 | #include "defs.h" | |
36 | #include "dev.h" | |
37 | #include "if_spi.h" | |
38 | ||
16f775be VK |
39 | struct if_spi_packet { |
40 | struct list_head list; | |
41 | u16 blen; | |
42 | u8 buffer[0] __attribute__((aligned(4))); | |
43 | }; | |
44 | ||
d2b21f19 CM |
45 | struct if_spi_card { |
46 | struct spi_device *spi; | |
47 | struct lbs_private *priv; | |
0c2bec96 | 48 | struct libertas_spi_platform_data *pdata; |
d2b21f19 | 49 | |
d2b21f19 CM |
50 | /* The card ID and card revision, as reported by the hardware. */ |
51 | u16 card_id; | |
52 | u8 card_rev; | |
53 | ||
d2b21f19 CM |
54 | /* The last time that we initiated an SPU operation */ |
55 | unsigned long prev_xfer_time; | |
56 | ||
57 | int use_dummy_writes; | |
58 | unsigned long spu_port_delay; | |
59 | unsigned long spu_reg_delay; | |
60 | ||
61 | /* Handles all SPI communication (except for FW load) */ | |
16f775be VK |
62 | struct workqueue_struct *workqueue; |
63 | struct work_struct packet_work; | |
f39de992 | 64 | struct work_struct resume_work; |
d2b21f19 CM |
65 | |
66 | u8 cmd_buffer[IF_SPI_CMD_BUF_SIZE]; | |
16f775be VK |
67 | |
68 | /* A buffer of incoming packets from libertas core. | |
69 | * Since we can't sleep in hw_host_to_card, we have to buffer | |
70 | * them. */ | |
71 | struct list_head cmd_packet_list; | |
72 | struct list_head data_packet_list; | |
73 | ||
74 | /* Protects cmd_packet_list and data_packet_list */ | |
75 | spinlock_t buffer_lock; | |
f39de992 VK |
76 | |
77 | /* True is card suspended */ | |
78 | u8 suspended; | |
d2b21f19 CM |
79 | }; |
80 | ||
81 | static void free_if_spi_card(struct if_spi_card *card) | |
82 | { | |
16f775be VK |
83 | struct list_head *cursor, *next; |
84 | struct if_spi_packet *packet; | |
85 | ||
86 | list_for_each_safe(cursor, next, &card->cmd_packet_list) { | |
87 | packet = container_of(cursor, struct if_spi_packet, list); | |
88 | list_del(&packet->list); | |
89 | kfree(packet); | |
90 | } | |
91 | list_for_each_safe(cursor, next, &card->data_packet_list) { | |
92 | packet = container_of(cursor, struct if_spi_packet, list); | |
93 | list_del(&packet->list); | |
94 | kfree(packet); | |
95 | } | |
d2b21f19 CM |
96 | spi_set_drvdata(card->spi, NULL); |
97 | kfree(card); | |
98 | } | |
99 | ||
915a824e DW |
100 | #define MODEL_8385 0x04 |
101 | #define MODEL_8686 0x0b | |
102 | #define MODEL_8688 0x10 | |
103 | ||
104 | static const struct lbs_fw_table fw_table[] = { | |
105 | { MODEL_8385, "libertas/gspi8385_helper.bin", "libertas/gspi8385.bin" }, | |
106 | { MODEL_8385, "libertas/gspi8385_hlp.bin", "libertas/gspi8385.bin" }, | |
107 | { MODEL_8686, "libertas/gspi8686_v9_helper.bin", "libertas/gspi8686_v9.bin" }, | |
108 | { MODEL_8686, "libertas/gspi8686_hlp.bin", "libertas/gspi8686.bin" }, | |
109 | { MODEL_8688, "libertas/gspi8688_helper.bin", "libertas/gspi8688.bin" }, | |
110 | { 0, NULL, NULL } | |
d2b21f19 | 111 | }; |
915a824e DW |
112 | MODULE_FIRMWARE("libertas/gspi8385_helper.bin"); |
113 | MODULE_FIRMWARE("libertas/gspi8385_hlp.bin"); | |
114 | MODULE_FIRMWARE("libertas/gspi8385.bin"); | |
115 | MODULE_FIRMWARE("libertas/gspi8686_v9_helper.bin"); | |
116 | MODULE_FIRMWARE("libertas/gspi8686_v9.bin"); | |
117 | MODULE_FIRMWARE("libertas/gspi8686_hlp.bin"); | |
118 | MODULE_FIRMWARE("libertas/gspi8686.bin"); | |
119 | MODULE_FIRMWARE("libertas/gspi8688_helper.bin"); | |
120 | MODULE_FIRMWARE("libertas/gspi8688.bin"); | |
121 | ||
d2b21f19 CM |
122 | |
123 | /* | |
124 | * SPI Interface Unit Routines | |
125 | * | |
126 | * The SPU sits between the host and the WLAN module. | |
127 | * All communication with the firmware is through SPU transactions. | |
128 | * | |
129 | * First we have to put a SPU register name on the bus. Then we can | |
130 | * either read from or write to that register. | |
131 | * | |
d2b21f19 CM |
132 | */ |
133 | ||
134 | static void spu_transaction_init(struct if_spi_card *card) | |
135 | { | |
136 | if (!time_after(jiffies, card->prev_xfer_time + 1)) { | |
137 | /* Unfortunately, the SPU requires a delay between successive | |
138 | * transactions. If our last transaction was more than a jiffy | |
139 | * ago, we have obviously already delayed enough. | |
140 | * If not, we have to busy-wait to be on the safe side. */ | |
141 | ndelay(400); | |
142 | } | |
d2b21f19 CM |
143 | } |
144 | ||
145 | static void spu_transaction_finish(struct if_spi_card *card) | |
146 | { | |
d2b21f19 CM |
147 | card->prev_xfer_time = jiffies; |
148 | } | |
149 | ||
8973a6e7 RD |
150 | /* |
151 | * Write out a byte buffer to an SPI register, | |
152 | * using a series of 16-bit transfers. | |
153 | */ | |
d2b21f19 CM |
154 | static int spu_write(struct if_spi_card *card, u16 reg, const u8 *buf, int len) |
155 | { | |
156 | int err = 0; | |
d18ba452 | 157 | __le16 reg_out = cpu_to_le16(reg | IF_SPI_WRITE_OPERATION_MASK); |
4d1d4985 SAS |
158 | struct spi_message m; |
159 | struct spi_transfer reg_trans; | |
160 | struct spi_transfer data_trans; | |
161 | ||
162 | spi_message_init(&m); | |
163 | memset(®_trans, 0, sizeof(reg_trans)); | |
164 | memset(&data_trans, 0, sizeof(data_trans)); | |
d2b21f19 CM |
165 | |
166 | /* You must give an even number of bytes to the SPU, even if it | |
167 | * doesn't care about the last one. */ | |
168 | BUG_ON(len & 0x1); | |
169 | ||
170 | spu_transaction_init(card); | |
171 | ||
172 | /* write SPU register index */ | |
4d1d4985 SAS |
173 | reg_trans.tx_buf = ®_out; |
174 | reg_trans.len = sizeof(reg_out); | |
d2b21f19 | 175 | |
4d1d4985 SAS |
176 | data_trans.tx_buf = buf; |
177 | data_trans.len = len; | |
d2b21f19 | 178 | |
4d1d4985 SAS |
179 | spi_message_add_tail(®_trans, &m); |
180 | spi_message_add_tail(&data_trans, &m); | |
181 | ||
182 | err = spi_sync(card->spi, &m); | |
d2b21f19 CM |
183 | spu_transaction_finish(card); |
184 | return err; | |
185 | } | |
186 | ||
187 | static inline int spu_write_u16(struct if_spi_card *card, u16 reg, u16 val) | |
188 | { | |
d18ba452 | 189 | __le16 buff; |
d2b21f19 | 190 | |
f488b72d SAS |
191 | buff = cpu_to_le16(val); |
192 | return spu_write(card, reg, (u8 *)&buff, sizeof(u16)); | |
d2b21f19 CM |
193 | } |
194 | ||
195 | static inline int spu_reg_is_port_reg(u16 reg) | |
196 | { | |
197 | switch (reg) { | |
198 | case IF_SPI_IO_RDWRPORT_REG: | |
199 | case IF_SPI_CMD_RDWRPORT_REG: | |
200 | case IF_SPI_DATA_RDWRPORT_REG: | |
201 | return 1; | |
202 | default: | |
203 | return 0; | |
204 | } | |
205 | } | |
206 | ||
207 | static int spu_read(struct if_spi_card *card, u16 reg, u8 *buf, int len) | |
208 | { | |
4d1d4985 | 209 | unsigned int delay; |
d2b21f19 | 210 | int err = 0; |
d18ba452 | 211 | __le16 reg_out = cpu_to_le16(reg | IF_SPI_READ_OPERATION_MASK); |
4d1d4985 SAS |
212 | struct spi_message m; |
213 | struct spi_transfer reg_trans; | |
214 | struct spi_transfer dummy_trans; | |
215 | struct spi_transfer data_trans; | |
d2b21f19 | 216 | |
8973a6e7 RD |
217 | /* |
218 | * You must take an even number of bytes from the SPU, even if you | |
219 | * don't care about the last one. | |
220 | */ | |
d2b21f19 CM |
221 | BUG_ON(len & 0x1); |
222 | ||
223 | spu_transaction_init(card); | |
224 | ||
4d1d4985 SAS |
225 | spi_message_init(&m); |
226 | memset(®_trans, 0, sizeof(reg_trans)); | |
227 | memset(&dummy_trans, 0, sizeof(dummy_trans)); | |
228 | memset(&data_trans, 0, sizeof(data_trans)); | |
229 | ||
d2b21f19 | 230 | /* write SPU register index */ |
4d1d4985 SAS |
231 | reg_trans.tx_buf = ®_out; |
232 | reg_trans.len = sizeof(reg_out); | |
233 | spi_message_add_tail(®_trans, &m); | |
d2b21f19 CM |
234 | |
235 | delay = spu_reg_is_port_reg(reg) ? card->spu_port_delay : | |
236 | card->spu_reg_delay; | |
237 | if (card->use_dummy_writes) { | |
238 | /* Clock in dummy cycles while the SPU fills the FIFO */ | |
4d1d4985 SAS |
239 | dummy_trans.len = delay / 8; |
240 | spi_message_add_tail(&dummy_trans, &m); | |
d2b21f19 CM |
241 | } else { |
242 | /* Busy-wait while the SPU fills the FIFO */ | |
4d1d4985 SAS |
243 | reg_trans.delay_usecs = |
244 | DIV_ROUND_UP((100 + (delay * 10)), 1000); | |
d2b21f19 CM |
245 | } |
246 | ||
247 | /* read in data */ | |
4d1d4985 SAS |
248 | data_trans.rx_buf = buf; |
249 | data_trans.len = len; | |
250 | spi_message_add_tail(&data_trans, &m); | |
d2b21f19 | 251 | |
4d1d4985 | 252 | err = spi_sync(card->spi, &m); |
d2b21f19 CM |
253 | spu_transaction_finish(card); |
254 | return err; | |
255 | } | |
256 | ||
257 | /* Read 16 bits from an SPI register */ | |
258 | static inline int spu_read_u16(struct if_spi_card *card, u16 reg, u16 *val) | |
259 | { | |
d18ba452 | 260 | __le16 buf; |
f488b72d SAS |
261 | int ret; |
262 | ||
263 | ret = spu_read(card, reg, (u8 *)&buf, sizeof(buf)); | |
264 | if (ret == 0) | |
265 | *val = le16_to_cpup(&buf); | |
266 | return ret; | |
d2b21f19 CM |
267 | } |
268 | ||
8973a6e7 RD |
269 | /* |
270 | * Read 32 bits from an SPI register. | |
271 | * The low 16 bits are read first. | |
272 | */ | |
d2b21f19 CM |
273 | static int spu_read_u32(struct if_spi_card *card, u16 reg, u32 *val) |
274 | { | |
d18ba452 | 275 | __le32 buf; |
d2b21f19 | 276 | int err; |
f488b72d SAS |
277 | |
278 | err = spu_read(card, reg, (u8 *)&buf, sizeof(buf)); | |
d2b21f19 | 279 | if (!err) |
f488b72d | 280 | *val = le32_to_cpup(&buf); |
d2b21f19 CM |
281 | return err; |
282 | } | |
283 | ||
8973a6e7 RD |
284 | /* |
285 | * Keep reading 16 bits from an SPI register until you get the correct result. | |
d2b21f19 CM |
286 | * |
287 | * If mask = 0, the correct result is any non-zero number. | |
288 | * If mask != 0, the correct result is any number where | |
289 | * number & target_mask == target | |
290 | * | |
8973a6e7 RD |
291 | * Returns -ETIMEDOUT if a second passes without the correct result. |
292 | */ | |
d2b21f19 CM |
293 | static int spu_wait_for_u16(struct if_spi_card *card, u16 reg, |
294 | u16 target_mask, u16 target) | |
295 | { | |
296 | int err; | |
297 | unsigned long timeout = jiffies + 5*HZ; | |
298 | while (1) { | |
299 | u16 val; | |
300 | err = spu_read_u16(card, reg, &val); | |
301 | if (err) | |
302 | return err; | |
303 | if (target_mask) { | |
304 | if ((val & target_mask) == target) | |
305 | return 0; | |
306 | } else { | |
307 | if (val) | |
308 | return 0; | |
309 | } | |
310 | udelay(100); | |
311 | if (time_after(jiffies, timeout)) { | |
0e4e06ae | 312 | pr_err("%s: timeout with val=%02x, target_mask=%02x, target=%02x\n", |
d2b21f19 CM |
313 | __func__, val, target_mask, target); |
314 | return -ETIMEDOUT; | |
315 | } | |
316 | } | |
317 | } | |
318 | ||
8973a6e7 RD |
319 | /* |
320 | * Read 16 bits from an SPI register until you receive a specific value. | |
321 | * Returns -ETIMEDOUT if a 4 tries pass without success. | |
322 | */ | |
d2b21f19 CM |
323 | static int spu_wait_for_u32(struct if_spi_card *card, u32 reg, u32 target) |
324 | { | |
325 | int err, try; | |
326 | for (try = 0; try < 4; ++try) { | |
327 | u32 val = 0; | |
328 | err = spu_read_u32(card, reg, &val); | |
329 | if (err) | |
330 | return err; | |
331 | if (val == target) | |
332 | return 0; | |
333 | mdelay(100); | |
334 | } | |
335 | return -ETIMEDOUT; | |
336 | } | |
337 | ||
338 | static int spu_set_interrupt_mode(struct if_spi_card *card, | |
339 | int suppress_host_int, | |
340 | int auto_int) | |
341 | { | |
342 | int err = 0; | |
343 | ||
8973a6e7 RD |
344 | /* |
345 | * We can suppress a host interrupt by clearing the appropriate | |
346 | * bit in the "host interrupt status mask" register | |
347 | */ | |
d2b21f19 CM |
348 | if (suppress_host_int) { |
349 | err = spu_write_u16(card, IF_SPI_HOST_INT_STATUS_MASK_REG, 0); | |
350 | if (err) | |
351 | return err; | |
352 | } else { | |
353 | err = spu_write_u16(card, IF_SPI_HOST_INT_STATUS_MASK_REG, | |
354 | IF_SPI_HISM_TX_DOWNLOAD_RDY | | |
355 | IF_SPI_HISM_RX_UPLOAD_RDY | | |
356 | IF_SPI_HISM_CMD_DOWNLOAD_RDY | | |
357 | IF_SPI_HISM_CARDEVENT | | |
358 | IF_SPI_HISM_CMD_UPLOAD_RDY); | |
359 | if (err) | |
360 | return err; | |
361 | } | |
362 | ||
8973a6e7 RD |
363 | /* |
364 | * If auto-interrupts are on, the completion of certain transactions | |
d2b21f19 CM |
365 | * will trigger an interrupt automatically. If auto-interrupts |
366 | * are off, we need to set the "Card Interrupt Cause" register to | |
8973a6e7 RD |
367 | * trigger a card interrupt. |
368 | */ | |
d2b21f19 CM |
369 | if (auto_int) { |
370 | err = spu_write_u16(card, IF_SPI_HOST_INT_CTRL_REG, | |
371 | IF_SPI_HICT_TX_DOWNLOAD_OVER_AUTO | | |
372 | IF_SPI_HICT_RX_UPLOAD_OVER_AUTO | | |
373 | IF_SPI_HICT_CMD_DOWNLOAD_OVER_AUTO | | |
374 | IF_SPI_HICT_CMD_UPLOAD_OVER_AUTO); | |
375 | if (err) | |
376 | return err; | |
377 | } else { | |
378 | err = spu_write_u16(card, IF_SPI_HOST_INT_STATUS_MASK_REG, 0); | |
379 | if (err) | |
380 | return err; | |
381 | } | |
382 | return err; | |
383 | } | |
384 | ||
385 | static int spu_get_chip_revision(struct if_spi_card *card, | |
386 | u16 *card_id, u8 *card_rev) | |
387 | { | |
388 | int err = 0; | |
389 | u32 dev_ctrl; | |
390 | err = spu_read_u32(card, IF_SPI_DEVICEID_CTRL_REG, &dev_ctrl); | |
391 | if (err) | |
392 | return err; | |
393 | *card_id = IF_SPI_DEVICEID_CTRL_REG_TO_CARD_ID(dev_ctrl); | |
394 | *card_rev = IF_SPI_DEVICEID_CTRL_REG_TO_CARD_REV(dev_ctrl); | |
395 | return err; | |
396 | } | |
397 | ||
398 | static int spu_set_bus_mode(struct if_spi_card *card, u16 mode) | |
399 | { | |
400 | int err = 0; | |
401 | u16 rval; | |
402 | /* set bus mode */ | |
403 | err = spu_write_u16(card, IF_SPI_SPU_BUS_MODE_REG, mode); | |
404 | if (err) | |
405 | return err; | |
406 | /* Check that we were able to read back what we just wrote. */ | |
407 | err = spu_read_u16(card, IF_SPI_SPU_BUS_MODE_REG, &rval); | |
408 | if (err) | |
409 | return err; | |
88d89526 | 410 | if ((rval & 0xF) != mode) { |
0e4e06ae | 411 | pr_err("Can't read bus mode register\n"); |
d2b21f19 CM |
412 | return -EIO; |
413 | } | |
414 | return 0; | |
415 | } | |
416 | ||
417 | static int spu_init(struct if_spi_card *card, int use_dummy_writes) | |
418 | { | |
419 | int err = 0; | |
420 | u32 delay; | |
421 | ||
8973a6e7 RD |
422 | /* |
423 | * We have to start up in timed delay mode so that we can safely | |
424 | * read the Delay Read Register. | |
425 | */ | |
d2b21f19 CM |
426 | card->use_dummy_writes = 0; |
427 | err = spu_set_bus_mode(card, | |
428 | IF_SPI_BUS_MODE_SPI_CLOCK_PHASE_RISING | | |
429 | IF_SPI_BUS_MODE_DELAY_METHOD_TIMED | | |
430 | IF_SPI_BUS_MODE_16_BIT_ADDRESS_16_BIT_DATA); | |
431 | if (err) | |
432 | return err; | |
433 | card->spu_port_delay = 1000; | |
434 | card->spu_reg_delay = 1000; | |
435 | err = spu_read_u32(card, IF_SPI_DELAY_READ_REG, &delay); | |
436 | if (err) | |
437 | return err; | |
438 | card->spu_port_delay = delay & 0x0000ffff; | |
439 | card->spu_reg_delay = (delay & 0xffff0000) >> 16; | |
440 | ||
441 | /* If dummy clock delay mode has been requested, switch to it now */ | |
442 | if (use_dummy_writes) { | |
443 | card->use_dummy_writes = 1; | |
444 | err = spu_set_bus_mode(card, | |
445 | IF_SPI_BUS_MODE_SPI_CLOCK_PHASE_RISING | | |
446 | IF_SPI_BUS_MODE_DELAY_METHOD_DUMMY_CLOCK | | |
447 | IF_SPI_BUS_MODE_16_BIT_ADDRESS_16_BIT_DATA); | |
448 | if (err) | |
449 | return err; | |
450 | } | |
451 | ||
452 | lbs_deb_spi("Initialized SPU unit. " | |
453 | "spu_port_delay=0x%04lx, spu_reg_delay=0x%04lx\n", | |
454 | card->spu_port_delay, card->spu_reg_delay); | |
455 | return err; | |
456 | } | |
457 | ||
458 | /* | |
459 | * Firmware Loading | |
460 | */ | |
461 | ||
915a824e DW |
462 | static int if_spi_prog_helper_firmware(struct if_spi_card *card, |
463 | const struct firmware *firmware) | |
d2b21f19 CM |
464 | { |
465 | int err = 0; | |
d2b21f19 CM |
466 | int bytes_remaining; |
467 | const u8 *fw; | |
468 | u8 temp[HELPER_FW_LOAD_CHUNK_SZ]; | |
d2b21f19 CM |
469 | |
470 | lbs_deb_enter(LBS_DEB_SPI); | |
471 | ||
472 | err = spu_set_interrupt_mode(card, 1, 0); | |
473 | if (err) | |
474 | goto out; | |
915a824e | 475 | |
d2b21f19 CM |
476 | bytes_remaining = firmware->size; |
477 | fw = firmware->data; | |
478 | ||
479 | /* Load helper firmware image */ | |
480 | while (bytes_remaining > 0) { | |
8973a6e7 RD |
481 | /* |
482 | * Scratch pad 1 should contain the number of bytes we | |
483 | * want to download to the firmware | |
484 | */ | |
d2b21f19 CM |
485 | err = spu_write_u16(card, IF_SPI_SCRATCH_1_REG, |
486 | HELPER_FW_LOAD_CHUNK_SZ); | |
487 | if (err) | |
915a824e | 488 | goto out; |
d2b21f19 CM |
489 | |
490 | err = spu_wait_for_u16(card, IF_SPI_HOST_INT_STATUS_REG, | |
491 | IF_SPI_HIST_CMD_DOWNLOAD_RDY, | |
492 | IF_SPI_HIST_CMD_DOWNLOAD_RDY); | |
493 | if (err) | |
915a824e | 494 | goto out; |
d2b21f19 | 495 | |
8973a6e7 RD |
496 | /* |
497 | * Feed the data into the command read/write port reg | |
498 | * in chunks of 64 bytes | |
499 | */ | |
d2b21f19 CM |
500 | memset(temp, 0, sizeof(temp)); |
501 | memcpy(temp, fw, | |
502 | min(bytes_remaining, HELPER_FW_LOAD_CHUNK_SZ)); | |
503 | mdelay(10); | |
504 | err = spu_write(card, IF_SPI_CMD_RDWRPORT_REG, | |
505 | temp, HELPER_FW_LOAD_CHUNK_SZ); | |
506 | if (err) | |
915a824e | 507 | goto out; |
d2b21f19 CM |
508 | |
509 | /* Interrupt the boot code */ | |
510 | err = spu_write_u16(card, IF_SPI_HOST_INT_STATUS_REG, 0); | |
511 | if (err) | |
915a824e | 512 | goto out; |
d2b21f19 CM |
513 | err = spu_write_u16(card, IF_SPI_CARD_INT_CAUSE_REG, |
514 | IF_SPI_CIC_CMD_DOWNLOAD_OVER); | |
515 | if (err) | |
915a824e | 516 | goto out; |
d2b21f19 CM |
517 | bytes_remaining -= HELPER_FW_LOAD_CHUNK_SZ; |
518 | fw += HELPER_FW_LOAD_CHUNK_SZ; | |
519 | } | |
520 | ||
8973a6e7 RD |
521 | /* |
522 | * Once the helper / single stage firmware download is complete, | |
d2b21f19 | 523 | * write 0 to scratch pad 1 and interrupt the |
8973a6e7 RD |
524 | * bootloader. This completes the helper download. |
525 | */ | |
d2b21f19 CM |
526 | err = spu_write_u16(card, IF_SPI_SCRATCH_1_REG, FIRMWARE_DNLD_OK); |
527 | if (err) | |
915a824e | 528 | goto out; |
d2b21f19 CM |
529 | err = spu_write_u16(card, IF_SPI_HOST_INT_STATUS_REG, 0); |
530 | if (err) | |
915a824e | 531 | goto out; |
d2b21f19 CM |
532 | err = spu_write_u16(card, IF_SPI_CARD_INT_CAUSE_REG, |
533 | IF_SPI_CIC_CMD_DOWNLOAD_OVER); | |
915a824e | 534 | goto out; |
d2b21f19 CM |
535 | |
536 | lbs_deb_spi("waiting for helper to boot...\n"); | |
537 | ||
d2b21f19 CM |
538 | out: |
539 | if (err) | |
0e4e06ae | 540 | pr_err("failed to load helper firmware (err=%d)\n", err); |
d2b21f19 CM |
541 | lbs_deb_leave_args(LBS_DEB_SPI, "err %d", err); |
542 | return err; | |
543 | } | |
544 | ||
8973a6e7 RD |
545 | /* |
546 | * Returns the length of the next packet the firmware expects us to send. | |
547 | * Sets crc_err if the previous transfer had a CRC error. | |
548 | */ | |
d2b21f19 CM |
549 | static int if_spi_prog_main_firmware_check_len(struct if_spi_card *card, |
550 | int *crc_err) | |
551 | { | |
552 | u16 len; | |
553 | int err = 0; | |
554 | ||
8973a6e7 RD |
555 | /* |
556 | * wait until the host interrupt status register indicates | |
557 | * that we are ready to download | |
558 | */ | |
d2b21f19 CM |
559 | err = spu_wait_for_u16(card, IF_SPI_HOST_INT_STATUS_REG, |
560 | IF_SPI_HIST_CMD_DOWNLOAD_RDY, | |
561 | IF_SPI_HIST_CMD_DOWNLOAD_RDY); | |
562 | if (err) { | |
0e4e06ae | 563 | pr_err("timed out waiting for host_int_status\n"); |
d2b21f19 CM |
564 | return err; |
565 | } | |
566 | ||
567 | /* Ask the device how many bytes of firmware it wants. */ | |
568 | err = spu_read_u16(card, IF_SPI_SCRATCH_1_REG, &len); | |
569 | if (err) | |
570 | return err; | |
571 | ||
572 | if (len > IF_SPI_CMD_BUF_SIZE) { | |
0e4e06ae JP |
573 | pr_err("firmware load device requested a larger transfer than we are prepared to handle (len = %d)\n", |
574 | len); | |
d2b21f19 CM |
575 | return -EIO; |
576 | } | |
577 | if (len & 0x1) { | |
578 | lbs_deb_spi("%s: crc error\n", __func__); | |
579 | len &= ~0x1; | |
580 | *crc_err = 1; | |
581 | } else | |
582 | *crc_err = 0; | |
583 | ||
584 | return len; | |
585 | } | |
586 | ||
915a824e DW |
587 | static int if_spi_prog_main_firmware(struct if_spi_card *card, |
588 | const struct firmware *firmware) | |
d2b21f19 | 589 | { |
f3a57fd1 | 590 | struct lbs_private *priv = card->priv; |
d2b21f19 CM |
591 | int len, prev_len; |
592 | int bytes, crc_err = 0, err = 0; | |
d2b21f19 | 593 | const u8 *fw; |
d2b21f19 CM |
594 | u16 num_crc_errs; |
595 | ||
596 | lbs_deb_enter(LBS_DEB_SPI); | |
597 | ||
598 | err = spu_set_interrupt_mode(card, 1, 0); | |
599 | if (err) | |
600 | goto out; | |
601 | ||
d2b21f19 CM |
602 | err = spu_wait_for_u16(card, IF_SPI_SCRATCH_1_REG, 0, 0); |
603 | if (err) { | |
f3a57fd1 JP |
604 | netdev_err(priv->dev, |
605 | "%s: timed out waiting for initial scratch reg = 0\n", | |
606 | __func__); | |
915a824e | 607 | goto out; |
d2b21f19 CM |
608 | } |
609 | ||
610 | num_crc_errs = 0; | |
611 | prev_len = 0; | |
612 | bytes = firmware->size; | |
613 | fw = firmware->data; | |
614 | while ((len = if_spi_prog_main_firmware_check_len(card, &crc_err))) { | |
615 | if (len < 0) { | |
616 | err = len; | |
915a824e | 617 | goto out; |
d2b21f19 CM |
618 | } |
619 | if (bytes < 0) { | |
8973a6e7 RD |
620 | /* |
621 | * If there are no more bytes left, we would normally | |
622 | * expect to have terminated with len = 0 | |
623 | */ | |
f3a57fd1 JP |
624 | netdev_err(priv->dev, |
625 | "Firmware load wants more bytes than we have to offer.\n"); | |
d2b21f19 CM |
626 | break; |
627 | } | |
628 | if (crc_err) { | |
629 | /* Previous transfer failed. */ | |
630 | if (++num_crc_errs > MAX_MAIN_FW_LOAD_CRC_ERR) { | |
0e4e06ae | 631 | pr_err("Too many CRC errors encountered in firmware load.\n"); |
d2b21f19 | 632 | err = -EIO; |
915a824e | 633 | goto out; |
d2b21f19 CM |
634 | } |
635 | } else { | |
636 | /* Previous transfer succeeded. Advance counters. */ | |
637 | bytes -= prev_len; | |
638 | fw += prev_len; | |
639 | } | |
640 | if (bytes < len) { | |
641 | memset(card->cmd_buffer, 0, len); | |
642 | memcpy(card->cmd_buffer, fw, bytes); | |
643 | } else | |
644 | memcpy(card->cmd_buffer, fw, len); | |
645 | ||
646 | err = spu_write_u16(card, IF_SPI_HOST_INT_STATUS_REG, 0); | |
647 | if (err) | |
915a824e | 648 | goto out; |
d2b21f19 CM |
649 | err = spu_write(card, IF_SPI_CMD_RDWRPORT_REG, |
650 | card->cmd_buffer, len); | |
651 | if (err) | |
915a824e | 652 | goto out; |
d2b21f19 CM |
653 | err = spu_write_u16(card, IF_SPI_CARD_INT_CAUSE_REG , |
654 | IF_SPI_CIC_CMD_DOWNLOAD_OVER); | |
655 | if (err) | |
915a824e | 656 | goto out; |
d2b21f19 CM |
657 | prev_len = len; |
658 | } | |
659 | if (bytes > prev_len) { | |
0e4e06ae | 660 | pr_err("firmware load wants fewer bytes than we have to offer\n"); |
d2b21f19 CM |
661 | } |
662 | ||
663 | /* Confirm firmware download */ | |
664 | err = spu_wait_for_u32(card, IF_SPI_SCRATCH_4_REG, | |
665 | SUCCESSFUL_FW_DOWNLOAD_MAGIC); | |
666 | if (err) { | |
0e4e06ae | 667 | pr_err("failed to confirm the firmware download\n"); |
915a824e | 668 | goto out; |
d2b21f19 CM |
669 | } |
670 | ||
d2b21f19 CM |
671 | out: |
672 | if (err) | |
0e4e06ae | 673 | pr_err("failed to load firmware (err=%d)\n", err); |
d2b21f19 CM |
674 | lbs_deb_leave_args(LBS_DEB_SPI, "err %d", err); |
675 | return err; | |
676 | } | |
677 | ||
678 | /* | |
679 | * SPI Transfer Thread | |
680 | * | |
16f775be | 681 | * The SPI worker handles all SPI transfers, so there is no need for a lock. |
d2b21f19 CM |
682 | */ |
683 | ||
684 | /* Move a command from the card to the host */ | |
685 | static int if_spi_c2h_cmd(struct if_spi_card *card) | |
686 | { | |
687 | struct lbs_private *priv = card->priv; | |
688 | unsigned long flags; | |
689 | int err = 0; | |
690 | u16 len; | |
691 | u8 i; | |
692 | ||
8973a6e7 RD |
693 | /* |
694 | * We need a buffer big enough to handle whatever people send to | |
695 | * hw_host_to_card | |
696 | */ | |
d2b21f19 CM |
697 | BUILD_BUG_ON(IF_SPI_CMD_BUF_SIZE < LBS_CMD_BUFFER_SIZE); |
698 | BUILD_BUG_ON(IF_SPI_CMD_BUF_SIZE < LBS_UPLD_SIZE); | |
699 | ||
8973a6e7 RD |
700 | /* |
701 | * It's just annoying if the buffer size isn't a multiple of 4, because | |
702 | * then we might have len < IF_SPI_CMD_BUF_SIZE but | |
703 | * ALIGN(len, 4) > IF_SPI_CMD_BUF_SIZE | |
704 | */ | |
d2b21f19 CM |
705 | BUILD_BUG_ON(IF_SPI_CMD_BUF_SIZE % 4 != 0); |
706 | ||
707 | lbs_deb_enter(LBS_DEB_SPI); | |
708 | ||
709 | /* How many bytes are there to read? */ | |
710 | err = spu_read_u16(card, IF_SPI_SCRATCH_2_REG, &len); | |
711 | if (err) | |
712 | goto out; | |
713 | if (!len) { | |
f3a57fd1 JP |
714 | netdev_err(priv->dev, "%s: error: card has no data for host\n", |
715 | __func__); | |
d2b21f19 CM |
716 | err = -EINVAL; |
717 | goto out; | |
718 | } else if (len > IF_SPI_CMD_BUF_SIZE) { | |
f3a57fd1 JP |
719 | netdev_err(priv->dev, |
720 | "%s: error: response packet too large: %d bytes, but maximum is %d\n", | |
721 | __func__, len, IF_SPI_CMD_BUF_SIZE); | |
d2b21f19 CM |
722 | err = -EINVAL; |
723 | goto out; | |
724 | } | |
725 | ||
726 | /* Read the data from the WLAN module into our command buffer */ | |
727 | err = spu_read(card, IF_SPI_CMD_RDWRPORT_REG, | |
728 | card->cmd_buffer, ALIGN(len, 4)); | |
729 | if (err) | |
730 | goto out; | |
731 | ||
732 | spin_lock_irqsave(&priv->driver_lock, flags); | |
733 | i = (priv->resp_idx == 0) ? 1 : 0; | |
734 | BUG_ON(priv->resp_len[i]); | |
735 | priv->resp_len[i] = len; | |
736 | memcpy(priv->resp_buf[i], card->cmd_buffer, len); | |
737 | lbs_notify_command_response(priv, i); | |
738 | spin_unlock_irqrestore(&priv->driver_lock, flags); | |
739 | ||
740 | out: | |
741 | if (err) | |
f3a57fd1 | 742 | netdev_err(priv->dev, "%s: err=%d\n", __func__, err); |
d2b21f19 CM |
743 | lbs_deb_leave(LBS_DEB_SPI); |
744 | return err; | |
745 | } | |
746 | ||
747 | /* Move data from the card to the host */ | |
748 | static int if_spi_c2h_data(struct if_spi_card *card) | |
749 | { | |
f3a57fd1 | 750 | struct lbs_private *priv = card->priv; |
d2b21f19 CM |
751 | struct sk_buff *skb; |
752 | char *data; | |
753 | u16 len; | |
754 | int err = 0; | |
755 | ||
756 | lbs_deb_enter(LBS_DEB_SPI); | |
757 | ||
758 | /* How many bytes are there to read? */ | |
759 | err = spu_read_u16(card, IF_SPI_SCRATCH_1_REG, &len); | |
760 | if (err) | |
761 | goto out; | |
762 | if (!len) { | |
f3a57fd1 JP |
763 | netdev_err(priv->dev, "%s: error: card has no data for host\n", |
764 | __func__); | |
d2b21f19 CM |
765 | err = -EINVAL; |
766 | goto out; | |
767 | } else if (len > MRVDRV_ETH_RX_PACKET_BUFFER_SIZE) { | |
f3a57fd1 JP |
768 | netdev_err(priv->dev, |
769 | "%s: error: card has %d bytes of data, but our maximum skb size is %zu\n", | |
770 | __func__, len, MRVDRV_ETH_RX_PACKET_BUFFER_SIZE); | |
d2b21f19 CM |
771 | err = -EINVAL; |
772 | goto out; | |
773 | } | |
774 | ||
775 | /* TODO: should we allocate a smaller skb if we have less data? */ | |
776 | skb = dev_alloc_skb(MRVDRV_ETH_RX_PACKET_BUFFER_SIZE); | |
777 | if (!skb) { | |
778 | err = -ENOBUFS; | |
779 | goto out; | |
780 | } | |
781 | skb_reserve(skb, IPFIELD_ALIGN_OFFSET); | |
782 | data = skb_put(skb, len); | |
783 | ||
784 | /* Read the data from the WLAN module into our skb... */ | |
785 | err = spu_read(card, IF_SPI_DATA_RDWRPORT_REG, data, ALIGN(len, 4)); | |
786 | if (err) | |
787 | goto free_skb; | |
788 | ||
789 | /* pass the SKB to libertas */ | |
790 | err = lbs_process_rxed_packet(card->priv, skb); | |
791 | if (err) | |
792 | goto free_skb; | |
793 | ||
794 | /* success */ | |
795 | goto out; | |
796 | ||
797 | free_skb: | |
798 | dev_kfree_skb(skb); | |
799 | out: | |
800 | if (err) | |
f3a57fd1 | 801 | netdev_err(priv->dev, "%s: err=%d\n", __func__, err); |
d2b21f19 CM |
802 | lbs_deb_leave(LBS_DEB_SPI); |
803 | return err; | |
804 | } | |
805 | ||
16f775be VK |
806 | /* Move data or a command from the host to the card. */ |
807 | static void if_spi_h2c(struct if_spi_card *card, | |
808 | struct if_spi_packet *packet, int type) | |
809 | { | |
f3a57fd1 | 810 | struct lbs_private *priv = card->priv; |
16f775be VK |
811 | int err = 0; |
812 | u16 int_type, port_reg; | |
813 | ||
814 | switch (type) { | |
815 | case MVMS_DAT: | |
816 | int_type = IF_SPI_CIC_TX_DOWNLOAD_OVER; | |
817 | port_reg = IF_SPI_DATA_RDWRPORT_REG; | |
818 | break; | |
819 | case MVMS_CMD: | |
820 | int_type = IF_SPI_CIC_CMD_DOWNLOAD_OVER; | |
821 | port_reg = IF_SPI_CMD_RDWRPORT_REG; | |
822 | break; | |
823 | default: | |
f3a57fd1 JP |
824 | netdev_err(priv->dev, "can't transfer buffer of type %d\n", |
825 | type); | |
16f775be VK |
826 | err = -EINVAL; |
827 | goto out; | |
828 | } | |
829 | ||
830 | /* Write the data to the card */ | |
831 | err = spu_write(card, port_reg, packet->buffer, packet->blen); | |
832 | if (err) | |
833 | goto out; | |
834 | ||
835 | out: | |
836 | kfree(packet); | |
837 | ||
838 | if (err) | |
f3a57fd1 | 839 | netdev_err(priv->dev, "%s: error %d\n", __func__, err); |
16f775be VK |
840 | } |
841 | ||
d2b21f19 CM |
842 | /* Inform the host about a card event */ |
843 | static void if_spi_e2h(struct if_spi_card *card) | |
844 | { | |
845 | int err = 0; | |
d2b21f19 CM |
846 | u32 cause; |
847 | struct lbs_private *priv = card->priv; | |
848 | ||
849 | err = spu_read_u32(card, IF_SPI_SCRATCH_3_REG, &cause); | |
850 | if (err) | |
851 | goto out; | |
852 | ||
ea2d0639 | 853 | /* re-enable the card event interrupt */ |
854 | spu_write_u16(card, IF_SPI_HOST_INT_STATUS_REG, | |
855 | ~IF_SPI_HICU_CARD_EVENT); | |
856 | ||
857 | /* generate a card interrupt */ | |
858 | spu_write_u16(card, IF_SPI_CARD_INT_CAUSE_REG, IF_SPI_CIC_HOST_EVENT); | |
859 | ||
d2b21f19 | 860 | lbs_queue_event(priv, cause & 0xff); |
d2b21f19 CM |
861 | out: |
862 | if (err) | |
f3a57fd1 | 863 | netdev_err(priv->dev, "%s: error %d\n", __func__, err); |
d2b21f19 CM |
864 | } |
865 | ||
16f775be | 866 | static void if_spi_host_to_card_worker(struct work_struct *work) |
d2b21f19 CM |
867 | { |
868 | int err; | |
16f775be | 869 | struct if_spi_card *card; |
d2b21f19 | 870 | u16 hiStatus; |
16f775be VK |
871 | unsigned long flags; |
872 | struct if_spi_packet *packet; | |
f3a57fd1 | 873 | struct lbs_private *priv; |
d2b21f19 | 874 | |
16f775be | 875 | card = container_of(work, struct if_spi_card, packet_work); |
f3a57fd1 | 876 | priv = card->priv; |
d2b21f19 | 877 | |
16f775be VK |
878 | lbs_deb_enter(LBS_DEB_SPI); |
879 | ||
8973a6e7 RD |
880 | /* |
881 | * Read the host interrupt status register to see what we | |
882 | * can do. | |
883 | */ | |
16f775be VK |
884 | err = spu_read_u16(card, IF_SPI_HOST_INT_STATUS_REG, |
885 | &hiStatus); | |
886 | if (err) { | |
f3a57fd1 | 887 | netdev_err(priv->dev, "I/O error\n"); |
16f775be VK |
888 | goto err; |
889 | } | |
890 | ||
891 | if (hiStatus & IF_SPI_HIST_CMD_UPLOAD_RDY) { | |
892 | err = if_spi_c2h_cmd(card); | |
893 | if (err) | |
d2b21f19 | 894 | goto err; |
16f775be VK |
895 | } |
896 | if (hiStatus & IF_SPI_HIST_RX_UPLOAD_RDY) { | |
897 | err = if_spi_c2h_data(card); | |
898 | if (err) | |
899 | goto err; | |
900 | } | |
d2b21f19 | 901 | |
8973a6e7 RD |
902 | /* |
903 | * workaround: in PS mode, the card does not set the Command | |
904 | * Download Ready bit, but it sets TX Download Ready. | |
905 | */ | |
16f775be VK |
906 | if (hiStatus & IF_SPI_HIST_CMD_DOWNLOAD_RDY || |
907 | (card->priv->psstate != PS_STATE_FULL_POWER && | |
908 | (hiStatus & IF_SPI_HIST_TX_DOWNLOAD_RDY))) { | |
8973a6e7 RD |
909 | /* |
910 | * This means two things. First of all, | |
16f775be VK |
911 | * if there was a previous command sent, the card has |
912 | * successfully received it. | |
913 | * Secondly, it is now ready to download another | |
914 | * command. | |
915 | */ | |
916 | lbs_host_to_card_done(card->priv); | |
917 | ||
8973a6e7 | 918 | /* Do we have any command packets from the host to send? */ |
16f775be VK |
919 | packet = NULL; |
920 | spin_lock_irqsave(&card->buffer_lock, flags); | |
921 | if (!list_empty(&card->cmd_packet_list)) { | |
922 | packet = (struct if_spi_packet *)(card-> | |
923 | cmd_packet_list.next); | |
924 | list_del(&packet->list); | |
2674f82d | 925 | } |
16f775be | 926 | spin_unlock_irqrestore(&card->buffer_lock, flags); |
b3781c74 | 927 | |
16f775be VK |
928 | if (packet) |
929 | if_spi_h2c(card, packet, MVMS_CMD); | |
930 | } | |
931 | if (hiStatus & IF_SPI_HIST_TX_DOWNLOAD_RDY) { | |
8973a6e7 | 932 | /* Do we have any data packets from the host to send? */ |
16f775be VK |
933 | packet = NULL; |
934 | spin_lock_irqsave(&card->buffer_lock, flags); | |
935 | if (!list_empty(&card->data_packet_list)) { | |
936 | packet = (struct if_spi_packet *)(card-> | |
937 | data_packet_list.next); | |
938 | list_del(&packet->list); | |
d2b21f19 | 939 | } |
16f775be | 940 | spin_unlock_irqrestore(&card->buffer_lock, flags); |
d2b21f19 | 941 | |
16f775be VK |
942 | if (packet) |
943 | if_spi_h2c(card, packet, MVMS_DAT); | |
944 | } | |
945 | if (hiStatus & IF_SPI_HIST_CARD_EVENT) | |
946 | if_spi_e2h(card); | |
d2b21f19 CM |
947 | |
948 | err: | |
16f775be | 949 | if (err) |
f3a57fd1 | 950 | netdev_err(priv->dev, "%s: got error %d\n", __func__, err); |
d2b21f19 | 951 | |
16f775be | 952 | lbs_deb_leave(LBS_DEB_SPI); |
d2b21f19 CM |
953 | } |
954 | ||
955 | /* | |
956 | * Host to Card | |
957 | * | |
958 | * Called from Libertas to transfer some data to the WLAN device | |
8973a6e7 RD |
959 | * We can't sleep here. |
960 | */ | |
d2b21f19 CM |
961 | static int if_spi_host_to_card(struct lbs_private *priv, |
962 | u8 type, u8 *buf, u16 nb) | |
963 | { | |
964 | int err = 0; | |
16f775be | 965 | unsigned long flags; |
d2b21f19 | 966 | struct if_spi_card *card = priv->card; |
16f775be VK |
967 | struct if_spi_packet *packet; |
968 | u16 blen; | |
d2b21f19 CM |
969 | |
970 | lbs_deb_enter_args(LBS_DEB_SPI, "type %d, bytes %d", type, nb); | |
971 | ||
16f775be | 972 | if (nb == 0) { |
f3a57fd1 JP |
973 | netdev_err(priv->dev, "%s: invalid size requested: %d\n", |
974 | __func__, nb); | |
16f775be VK |
975 | err = -EINVAL; |
976 | goto out; | |
977 | } | |
978 | blen = ALIGN(nb, 4); | |
979 | packet = kzalloc(sizeof(struct if_spi_packet) + blen, GFP_ATOMIC); | |
980 | if (!packet) { | |
981 | err = -ENOMEM; | |
982 | goto out; | |
983 | } | |
984 | packet->blen = blen; | |
985 | memcpy(packet->buffer, buf, nb); | |
986 | memset(packet->buffer + nb, 0, blen - nb); | |
d2b21f19 CM |
987 | |
988 | switch (type) { | |
989 | case MVMS_CMD: | |
16f775be VK |
990 | priv->dnld_sent = DNLD_CMD_SENT; |
991 | spin_lock_irqsave(&card->buffer_lock, flags); | |
992 | list_add_tail(&packet->list, &card->cmd_packet_list); | |
993 | spin_unlock_irqrestore(&card->buffer_lock, flags); | |
d2b21f19 CM |
994 | break; |
995 | case MVMS_DAT: | |
16f775be VK |
996 | priv->dnld_sent = DNLD_DATA_SENT; |
997 | spin_lock_irqsave(&card->buffer_lock, flags); | |
998 | list_add_tail(&packet->list, &card->data_packet_list); | |
999 | spin_unlock_irqrestore(&card->buffer_lock, flags); | |
d2b21f19 CM |
1000 | break; |
1001 | default: | |
f3a57fd1 JP |
1002 | netdev_err(priv->dev, "can't transfer buffer of type %d\n", |
1003 | type); | |
d2b21f19 CM |
1004 | err = -EINVAL; |
1005 | break; | |
1006 | } | |
1007 | ||
16f775be VK |
1008 | /* Queue spi xfer work */ |
1009 | queue_work(card->workqueue, &card->packet_work); | |
1010 | out: | |
d2b21f19 CM |
1011 | lbs_deb_leave_args(LBS_DEB_SPI, "err=%d", err); |
1012 | return err; | |
1013 | } | |
1014 | ||
1015 | /* | |
1016 | * Host Interrupts | |
1017 | * | |
1018 | * Service incoming interrupts from the WLAN device. We can't sleep here, so | |
16f775be | 1019 | * don't try to talk on the SPI bus, just queue the SPI xfer work. |
d2b21f19 CM |
1020 | */ |
1021 | static irqreturn_t if_spi_host_interrupt(int irq, void *dev_id) | |
1022 | { | |
1023 | struct if_spi_card *card = dev_id; | |
1024 | ||
16f775be VK |
1025 | queue_work(card->workqueue, &card->packet_work); |
1026 | ||
d2b21f19 CM |
1027 | return IRQ_HANDLED; |
1028 | } | |
1029 | ||
1030 | /* | |
1031 | * SPI callbacks | |
1032 | */ | |
1033 | ||
16f775be | 1034 | static int if_spi_init_card(struct if_spi_card *card) |
d2b21f19 | 1035 | { |
f3a57fd1 | 1036 | struct lbs_private *priv = card->priv; |
16f775be VK |
1037 | struct spi_device *spi = card->spi; |
1038 | int err, i; | |
d2b21f19 | 1039 | u32 scratch; |
915a824e DW |
1040 | const struct firmware *helper = NULL; |
1041 | const struct firmware *mainfw = NULL; | |
d2b21f19 CM |
1042 | |
1043 | lbs_deb_enter(LBS_DEB_SPI); | |
1044 | ||
16f775be | 1045 | err = spu_init(card, card->pdata->use_dummy_writes); |
d2b21f19 | 1046 | if (err) |
16f775be | 1047 | goto out; |
d2b21f19 CM |
1048 | err = spu_get_chip_revision(card, &card->card_id, &card->card_rev); |
1049 | if (err) | |
16f775be | 1050 | goto out; |
d2b21f19 | 1051 | |
d2b21f19 CM |
1052 | err = spu_read_u32(card, IF_SPI_SCRATCH_4_REG, &scratch); |
1053 | if (err) | |
16f775be | 1054 | goto out; |
d2b21f19 CM |
1055 | if (scratch == SUCCESSFUL_FW_DOWNLOAD_MAGIC) |
1056 | lbs_deb_spi("Firmware is already loaded for " | |
1057 | "Marvell WLAN 802.11 adapter\n"); | |
1058 | else { | |
915a824e DW |
1059 | /* Check if we support this card */ |
1060 | for (i = 0; i < ARRAY_SIZE(fw_table); i++) { | |
1061 | if (card->card_id == fw_table[i].model) | |
1062 | break; | |
1063 | } | |
1064 | if (i == ARRAY_SIZE(fw_table)) { | |
f3a57fd1 JP |
1065 | netdev_err(priv->dev, "Unsupported chip_id: 0x%02x\n", |
1066 | card->card_id); | |
915a824e | 1067 | err = -ENODEV; |
16f775be | 1068 | goto out; |
915a824e DW |
1069 | } |
1070 | ||
1071 | err = lbs_get_firmware(&card->spi->dev, NULL, NULL, | |
1072 | card->card_id, &fw_table[0], &helper, | |
1073 | &mainfw); | |
1074 | if (err) { | |
f3a57fd1 JP |
1075 | netdev_err(priv->dev, "failed to find firmware (%d)\n", |
1076 | err); | |
16f775be | 1077 | goto out; |
915a824e | 1078 | } |
d2b21f19 CM |
1079 | |
1080 | lbs_deb_spi("Initializing FW for Marvell WLAN 802.11 adapter " | |
1081 | "(chip_id = 0x%04x, chip_rev = 0x%02x) " | |
1082 | "attached to SPI bus_num %d, chip_select %d. " | |
1083 | "spi->max_speed_hz=%d\n", | |
1084 | card->card_id, card->card_rev, | |
1085 | spi->master->bus_num, spi->chip_select, | |
1086 | spi->max_speed_hz); | |
915a824e | 1087 | err = if_spi_prog_helper_firmware(card, helper); |
d2b21f19 | 1088 | if (err) |
16f775be | 1089 | goto out; |
915a824e | 1090 | err = if_spi_prog_main_firmware(card, mainfw); |
d2b21f19 | 1091 | if (err) |
16f775be | 1092 | goto out; |
d2b21f19 CM |
1093 | lbs_deb_spi("loaded FW for Marvell WLAN 802.11 adapter\n"); |
1094 | } | |
1095 | ||
1096 | err = spu_set_interrupt_mode(card, 0, 1); | |
16f775be VK |
1097 | if (err) |
1098 | goto out; | |
1099 | ||
1100 | out: | |
1101 | if (helper) | |
1102 | release_firmware(helper); | |
1103 | if (mainfw) | |
1104 | release_firmware(mainfw); | |
1105 | ||
1106 | lbs_deb_leave_args(LBS_DEB_SPI, "err %d\n", err); | |
1107 | ||
1108 | return err; | |
1109 | } | |
1110 | ||
f39de992 VK |
1111 | static void if_spi_resume_worker(struct work_struct *work) |
1112 | { | |
1113 | struct if_spi_card *card; | |
1114 | ||
1115 | card = container_of(work, struct if_spi_card, resume_work); | |
1116 | ||
1117 | if (card->suspended) { | |
1118 | if (card->pdata->setup) | |
1119 | card->pdata->setup(card->spi); | |
1120 | ||
1121 | /* Init card ... */ | |
1122 | if_spi_init_card(card); | |
1123 | ||
1124 | enable_irq(card->spi->irq); | |
1125 | ||
1126 | /* And resume it ... */ | |
1127 | lbs_resume(card->priv); | |
1128 | ||
1129 | card->suspended = 0; | |
1130 | } | |
1131 | } | |
1132 | ||
16f775be VK |
1133 | static int __devinit if_spi_probe(struct spi_device *spi) |
1134 | { | |
1135 | struct if_spi_card *card; | |
1136 | struct lbs_private *priv = NULL; | |
1137 | struct libertas_spi_platform_data *pdata = spi->dev.platform_data; | |
1138 | int err = 0; | |
1139 | ||
1140 | lbs_deb_enter(LBS_DEB_SPI); | |
1141 | ||
1142 | if (!pdata) { | |
1143 | err = -EINVAL; | |
1144 | goto out; | |
1145 | } | |
1146 | ||
1147 | if (pdata->setup) { | |
1148 | err = pdata->setup(spi); | |
1149 | if (err) | |
1150 | goto out; | |
1151 | } | |
1152 | ||
1153 | /* Allocate card structure to represent this specific device */ | |
1154 | card = kzalloc(sizeof(struct if_spi_card), GFP_KERNEL); | |
1155 | if (!card) { | |
1156 | err = -ENOMEM; | |
1157 | goto teardown; | |
1158 | } | |
1159 | spi_set_drvdata(spi, card); | |
1160 | card->pdata = pdata; | |
1161 | card->spi = spi; | |
1162 | card->prev_xfer_time = jiffies; | |
1163 | ||
1164 | INIT_LIST_HEAD(&card->cmd_packet_list); | |
1165 | INIT_LIST_HEAD(&card->data_packet_list); | |
1166 | spin_lock_init(&card->buffer_lock); | |
1167 | ||
1168 | /* Initialize the SPI Interface Unit */ | |
1169 | ||
1170 | /* Firmware load */ | |
1171 | err = if_spi_init_card(card); | |
d2b21f19 | 1172 | if (err) |
4d1d4985 | 1173 | goto free_card; |
d2b21f19 | 1174 | |
8973a6e7 RD |
1175 | /* |
1176 | * Register our card with libertas. | |
1177 | * This will call alloc_etherdev. | |
1178 | */ | |
d2b21f19 CM |
1179 | priv = lbs_add_card(card, &spi->dev); |
1180 | if (!priv) { | |
1181 | err = -ENOMEM; | |
4d1d4985 | 1182 | goto free_card; |
d2b21f19 CM |
1183 | } |
1184 | card->priv = priv; | |
f39de992 | 1185 | priv->setup_fw_on_resume = 1; |
d2b21f19 CM |
1186 | priv->card = card; |
1187 | priv->hw_host_to_card = if_spi_host_to_card; | |
49125454 AK |
1188 | priv->enter_deep_sleep = NULL; |
1189 | priv->exit_deep_sleep = NULL; | |
1190 | priv->reset_deep_sleep_wakeup = NULL; | |
d2b21f19 | 1191 | priv->fw_ready = 1; |
d2b21f19 CM |
1192 | |
1193 | /* Initialize interrupt handling stuff. */ | |
16f775be VK |
1194 | card->workqueue = create_workqueue("libertas_spi"); |
1195 | INIT_WORK(&card->packet_work, if_spi_host_to_card_worker); | |
f39de992 | 1196 | INIT_WORK(&card->resume_work, if_spi_resume_worker); |
b26ed97c | 1197 | |
d2b21f19 CM |
1198 | err = request_irq(spi->irq, if_spi_host_interrupt, |
1199 | IRQF_TRIGGER_FALLING, "libertas_spi", card); | |
1200 | if (err) { | |
0e4e06ae | 1201 | pr_err("can't get host irq line-- request_irq failed\n"); |
16f775be | 1202 | goto terminate_workqueue; |
d2b21f19 CM |
1203 | } |
1204 | ||
8973a6e7 RD |
1205 | /* |
1206 | * Start the card. | |
d2b21f19 | 1207 | * This will call register_netdev, and we'll start |
8973a6e7 RD |
1208 | * getting interrupts... |
1209 | */ | |
d2b21f19 CM |
1210 | err = lbs_start_card(priv); |
1211 | if (err) | |
1212 | goto release_irq; | |
1213 | ||
1214 | lbs_deb_spi("Finished initializing WLAN module.\n"); | |
1215 | ||
1216 | /* successful exit */ | |
1217 | goto out; | |
1218 | ||
1219 | release_irq: | |
1220 | free_irq(spi->irq, card); | |
16f775be VK |
1221 | terminate_workqueue: |
1222 | flush_workqueue(card->workqueue); | |
1223 | destroy_workqueue(card->workqueue); | |
d2b21f19 | 1224 | lbs_remove_card(priv); /* will call free_netdev */ |
d2b21f19 CM |
1225 | free_card: |
1226 | free_if_spi_card(card); | |
16f775be VK |
1227 | teardown: |
1228 | if (pdata->teardown) | |
1229 | pdata->teardown(spi); | |
d2b21f19 CM |
1230 | out: |
1231 | lbs_deb_leave_args(LBS_DEB_SPI, "err %d\n", err); | |
1232 | return err; | |
1233 | } | |
1234 | ||
1235 | static int __devexit libertas_spi_remove(struct spi_device *spi) | |
1236 | { | |
1237 | struct if_spi_card *card = spi_get_drvdata(spi); | |
1238 | struct lbs_private *priv = card->priv; | |
1239 | ||
1240 | lbs_deb_spi("libertas_spi_remove\n"); | |
1241 | lbs_deb_enter(LBS_DEB_SPI); | |
d2b21f19 | 1242 | |
f39de992 VK |
1243 | cancel_work_sync(&card->resume_work); |
1244 | ||
d2b21f19 | 1245 | lbs_stop_card(priv); |
efcfd1f2 AY |
1246 | lbs_remove_card(priv); /* will call free_netdev */ |
1247 | ||
d2b21f19 | 1248 | free_irq(spi->irq, card); |
16f775be VK |
1249 | flush_workqueue(card->workqueue); |
1250 | destroy_workqueue(card->workqueue); | |
0c2bec96 MR |
1251 | if (card->pdata->teardown) |
1252 | card->pdata->teardown(spi); | |
d2b21f19 CM |
1253 | free_if_spi_card(card); |
1254 | lbs_deb_leave(LBS_DEB_SPI); | |
1255 | return 0; | |
1256 | } | |
1257 | ||
f39de992 VK |
1258 | static int if_spi_suspend(struct device *dev) |
1259 | { | |
1260 | struct spi_device *spi = to_spi_device(dev); | |
1261 | struct if_spi_card *card = spi_get_drvdata(spi); | |
1262 | ||
1263 | if (!card->suspended) { | |
1264 | lbs_suspend(card->priv); | |
1265 | flush_workqueue(card->workqueue); | |
1266 | disable_irq(spi->irq); | |
1267 | ||
1268 | if (card->pdata->teardown) | |
1269 | card->pdata->teardown(spi); | |
1270 | card->suspended = 1; | |
1271 | } | |
1272 | ||
1273 | return 0; | |
1274 | } | |
1275 | ||
1276 | static int if_spi_resume(struct device *dev) | |
1277 | { | |
1278 | struct spi_device *spi = to_spi_device(dev); | |
1279 | struct if_spi_card *card = spi_get_drvdata(spi); | |
1280 | ||
1281 | /* Schedule delayed work */ | |
1282 | schedule_work(&card->resume_work); | |
1283 | ||
1284 | return 0; | |
1285 | } | |
1286 | ||
1287 | static const struct dev_pm_ops if_spi_pm_ops = { | |
1288 | .suspend = if_spi_suspend, | |
1289 | .resume = if_spi_resume, | |
1290 | }; | |
1291 | ||
d2b21f19 CM |
1292 | static struct spi_driver libertas_spi_driver = { |
1293 | .probe = if_spi_probe, | |
1294 | .remove = __devexit_p(libertas_spi_remove), | |
1295 | .driver = { | |
1296 | .name = "libertas_spi", | |
1297 | .bus = &spi_bus_type, | |
1298 | .owner = THIS_MODULE, | |
f39de992 | 1299 | .pm = &if_spi_pm_ops, |
d2b21f19 CM |
1300 | }, |
1301 | }; | |
1302 | ||
1303 | /* | |
1304 | * Module functions | |
1305 | */ | |
1306 | ||
1307 | static int __init if_spi_init_module(void) | |
1308 | { | |
1309 | int ret = 0; | |
1310 | lbs_deb_enter(LBS_DEB_SPI); | |
1311 | printk(KERN_INFO "libertas_spi: Libertas SPI driver\n"); | |
1312 | ret = spi_register_driver(&libertas_spi_driver); | |
1313 | lbs_deb_leave(LBS_DEB_SPI); | |
1314 | return ret; | |
1315 | } | |
1316 | ||
1317 | static void __exit if_spi_exit_module(void) | |
1318 | { | |
1319 | lbs_deb_enter(LBS_DEB_SPI); | |
1320 | spi_unregister_driver(&libertas_spi_driver); | |
1321 | lbs_deb_leave(LBS_DEB_SPI); | |
1322 | } | |
1323 | ||
1324 | module_init(if_spi_init_module); | |
1325 | module_exit(if_spi_exit_module); | |
1326 | ||
1327 | MODULE_DESCRIPTION("Libertas SPI WLAN Driver"); | |
1328 | MODULE_AUTHOR("Andrey Yurovsky <andrey@cozybit.com>, " | |
1329 | "Colin McCabe <colin@cozybit.com>"); | |
1330 | MODULE_LICENSE("GPL"); | |
e0626e38 | 1331 | MODULE_ALIAS("spi:libertas_spi"); |