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