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