net/mlx4_en: Move filters cleanup to a proper location
[linux/fpc-iii.git] / drivers / net / wireless / rsi / rsi_91x_sdio_ops.c
blob40d72312f3df21dd6e4e12019febd6363a6f7912
1 /**
2 * Copyright (c) 2014 Redpine Signals Inc.
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 #include <linux/firmware.h>
19 #include "rsi_sdio.h"
20 #include "rsi_common.h"
22 /**
23 * rsi_sdio_master_access_msword() - This function sets the AHB master access
24 * MS word in the SDIO slave registers.
25 * @adapter: Pointer to the adapter structure.
26 * @ms_word: ms word need to be initialized.
28 * Return: status: 0 on success, -1 on failure.
30 static int rsi_sdio_master_access_msword(struct rsi_hw *adapter,
31 u16 ms_word)
33 u8 byte;
34 u8 function = 0;
35 int status = 0;
37 byte = (u8)(ms_word & 0x00FF);
39 rsi_dbg(INIT_ZONE,
40 "%s: MASTER_ACCESS_MSBYTE:0x%x\n", __func__, byte);
42 status = rsi_sdio_write_register(adapter,
43 function,
44 SDIO_MASTER_ACCESS_MSBYTE,
45 &byte);
46 if (status) {
47 rsi_dbg(ERR_ZONE,
48 "%s: fail to access MASTER_ACCESS_MSBYTE\n",
49 __func__);
50 return -1;
53 byte = (u8)(ms_word >> 8);
55 rsi_dbg(INIT_ZONE, "%s:MASTER_ACCESS_LSBYTE:0x%x\n", __func__, byte);
56 status = rsi_sdio_write_register(adapter,
57 function,
58 SDIO_MASTER_ACCESS_LSBYTE,
59 &byte);
60 return status;
63 /**
64 * rsi_copy_to_card() - This function includes the actual funtionality of
65 * copying the TA firmware to the card.Basically this
66 * function includes opening the TA file,reading the
67 * TA file and writing their values in blocks of data.
68 * @common: Pointer to the driver private structure.
69 * @fw: Pointer to the firmware value to be written.
70 * @len: length of firmware file.
71 * @num_blocks: Number of blocks to be written to the card.
73 * Return: 0 on success and -1 on failure.
75 static int rsi_copy_to_card(struct rsi_common *common,
76 const u8 *fw,
77 u32 len,
78 u32 num_blocks)
80 struct rsi_hw *adapter = common->priv;
81 struct rsi_91x_sdiodev *dev =
82 (struct rsi_91x_sdiodev *)adapter->rsi_dev;
83 u32 indx, ii;
84 u32 block_size = dev->tx_blk_size;
85 u32 lsb_address;
86 __le32 data[] = { TA_HOLD_THREAD_VALUE, TA_SOFT_RST_CLR,
87 TA_PC_ZERO, TA_RELEASE_THREAD_VALUE };
88 u32 address[] = { TA_HOLD_THREAD_REG, TA_SOFT_RESET_REG,
89 TA_TH0_PC_REG, TA_RELEASE_THREAD_REG };
90 u32 base_address;
91 u16 msb_address;
93 base_address = TA_LOAD_ADDRESS;
94 msb_address = base_address >> 16;
96 for (indx = 0, ii = 0; ii < num_blocks; ii++, indx += block_size) {
97 lsb_address = ((u16) base_address | RSI_SD_REQUEST_MASTER);
98 if (rsi_sdio_write_register_multiple(adapter,
99 lsb_address,
100 (u8 *)(fw + indx),
101 block_size)) {
102 rsi_dbg(ERR_ZONE,
103 "%s: Unable to load %s blk\n", __func__,
104 FIRMWARE_RSI9113);
105 return -1;
107 rsi_dbg(INIT_ZONE, "%s: loading block: %d\n", __func__, ii);
108 base_address += block_size;
109 if ((base_address >> 16) != msb_address) {
110 msb_address += 1;
111 if (rsi_sdio_master_access_msword(adapter,
112 msb_address)) {
113 rsi_dbg(ERR_ZONE,
114 "%s: Unable to set ms word reg\n",
115 __func__);
116 return -1;
121 if (len % block_size) {
122 lsb_address = ((u16) base_address | RSI_SD_REQUEST_MASTER);
123 if (rsi_sdio_write_register_multiple(adapter,
124 lsb_address,
125 (u8 *)(fw + indx),
126 len % block_size)) {
127 rsi_dbg(ERR_ZONE,
128 "%s: Unable to load f/w\n", __func__);
129 return -1;
132 rsi_dbg(INIT_ZONE,
133 "%s: Succesfully loaded TA instructions\n", __func__);
135 if (rsi_sdio_master_access_msword(adapter, TA_BASE_ADDR)) {
136 rsi_dbg(ERR_ZONE,
137 "%s: Unable to set ms word to common reg\n",
138 __func__);
139 return -1;
142 for (ii = 0; ii < ARRAY_SIZE(data); ii++) {
143 /* Bringing TA out of reset */
144 if (rsi_sdio_write_register_multiple(adapter,
145 (address[ii] |
146 RSI_SD_REQUEST_MASTER),
147 (u8 *)&data[ii],
148 4)) {
149 rsi_dbg(ERR_ZONE,
150 "%s: Unable to hold TA threads\n", __func__);
151 return -1;
155 rsi_dbg(INIT_ZONE, "%s: loaded firmware\n", __func__);
156 return 0;
160 * rsi_load_ta_instructions() - This function includes the actual funtionality
161 * of loading the TA firmware.This function also
162 * includes opening the TA file,reading the TA
163 * file and writing their value in blocks of data.
164 * @common: Pointer to the driver private structure.
166 * Return: status: 0 on success, -1 on failure.
168 static int rsi_load_ta_instructions(struct rsi_common *common)
170 struct rsi_hw *adapter = common->priv;
171 struct rsi_91x_sdiodev *dev =
172 (struct rsi_91x_sdiodev *)adapter->rsi_dev;
173 u32 len;
174 u32 num_blocks;
175 const u8 *fw;
176 const struct firmware *fw_entry = NULL;
177 u32 block_size = dev->tx_blk_size;
178 int status = 0;
179 u32 base_address;
180 u16 msb_address;
182 if (rsi_sdio_master_access_msword(adapter, TA_BASE_ADDR)) {
183 rsi_dbg(ERR_ZONE,
184 "%s: Unable to set ms word to common reg\n",
185 __func__);
186 return -1;
188 base_address = TA_LOAD_ADDRESS;
189 msb_address = (base_address >> 16);
191 if (rsi_sdio_master_access_msword(adapter, msb_address)) {
192 rsi_dbg(ERR_ZONE,
193 "%s: Unable to set ms word reg\n", __func__);
194 return -1;
197 status = request_firmware(&fw_entry, FIRMWARE_RSI9113, adapter->device);
198 if (status < 0) {
199 rsi_dbg(ERR_ZONE, "%s Firmware file %s not found\n",
200 __func__, FIRMWARE_RSI9113);
201 return status;
204 /* Copy firmware into DMA-accessible memory */
205 fw = kmemdup(fw_entry->data, fw_entry->size, GFP_KERNEL);
206 if (!fw) {
207 status = -ENOMEM;
208 goto out;
210 len = fw_entry->size;
212 if (len % 4)
213 len += (4 - (len % 4));
215 num_blocks = (len / block_size);
217 rsi_dbg(INIT_ZONE, "%s: Instruction size:%d\n", __func__, len);
218 rsi_dbg(INIT_ZONE, "%s: num blocks: %d\n", __func__, num_blocks);
220 status = rsi_copy_to_card(common, fw, len, num_blocks);
221 kfree(fw);
223 out:
224 release_firmware(fw_entry);
225 return status;
229 * rsi_process_pkt() - This Function reads rx_blocks register and figures out
230 * the size of the rx pkt.
231 * @common: Pointer to the driver private structure.
233 * Return: 0 on success, -1 on failure.
235 static int rsi_process_pkt(struct rsi_common *common)
237 struct rsi_hw *adapter = common->priv;
238 u8 num_blks = 0;
239 u32 rcv_pkt_len = 0;
240 int status = 0;
242 status = rsi_sdio_read_register(adapter,
243 SDIO_RX_NUM_BLOCKS_REG,
244 &num_blks);
246 if (status) {
247 rsi_dbg(ERR_ZONE,
248 "%s: Failed to read pkt length from the card:\n",
249 __func__);
250 return status;
252 rcv_pkt_len = (num_blks * 256);
254 common->rx_data_pkt = kmalloc(rcv_pkt_len, GFP_KERNEL);
255 if (!common->rx_data_pkt) {
256 rsi_dbg(ERR_ZONE, "%s: Failed in memory allocation\n",
257 __func__);
258 return -ENOMEM;
261 status = rsi_sdio_host_intf_read_pkt(adapter,
262 common->rx_data_pkt,
263 rcv_pkt_len);
264 if (status) {
265 rsi_dbg(ERR_ZONE, "%s: Failed to read packet from card\n",
266 __func__);
267 goto fail;
270 status = rsi_read_pkt(common, rcv_pkt_len);
272 fail:
273 kfree(common->rx_data_pkt);
274 return status;
278 * rsi_init_sdio_slave_regs() - This function does the actual initialization
279 * of SDBUS slave registers.
280 * @adapter: Pointer to the adapter structure.
282 * Return: status: 0 on success, -1 on failure.
284 int rsi_init_sdio_slave_regs(struct rsi_hw *adapter)
286 struct rsi_91x_sdiodev *dev =
287 (struct rsi_91x_sdiodev *)adapter->rsi_dev;
288 u8 function = 0;
289 u8 byte;
290 int status = 0;
292 if (dev->next_read_delay) {
293 byte = dev->next_read_delay;
294 status = rsi_sdio_write_register(adapter,
295 function,
296 SDIO_NXT_RD_DELAY2,
297 &byte);
298 if (status) {
299 rsi_dbg(ERR_ZONE,
300 "%s: Failed to write SDIO_NXT_RD_DELAY2\n",
301 __func__);
302 return -1;
306 if (dev->sdio_high_speed_enable) {
307 rsi_dbg(INIT_ZONE, "%s: Enabling SDIO High speed\n", __func__);
308 byte = 0x3;
310 status = rsi_sdio_write_register(adapter,
311 function,
312 SDIO_REG_HIGH_SPEED,
313 &byte);
314 if (status) {
315 rsi_dbg(ERR_ZONE,
316 "%s: Failed to enable SDIO high speed\n",
317 __func__);
318 return -1;
322 /* This tells SDIO FIFO when to start read to host */
323 rsi_dbg(INIT_ZONE, "%s: Initialzing SDIO read start level\n", __func__);
324 byte = 0x24;
326 status = rsi_sdio_write_register(adapter,
327 function,
328 SDIO_READ_START_LVL,
329 &byte);
330 if (status) {
331 rsi_dbg(ERR_ZONE,
332 "%s: Failed to write SDIO_READ_START_LVL\n", __func__);
333 return -1;
336 rsi_dbg(INIT_ZONE, "%s: Initialzing FIFO ctrl registers\n", __func__);
337 byte = (128 - 32);
339 status = rsi_sdio_write_register(adapter,
340 function,
341 SDIO_READ_FIFO_CTL,
342 &byte);
343 if (status) {
344 rsi_dbg(ERR_ZONE,
345 "%s: Failed to write SDIO_READ_FIFO_CTL\n", __func__);
346 return -1;
349 byte = 32;
350 status = rsi_sdio_write_register(adapter,
351 function,
352 SDIO_WRITE_FIFO_CTL,
353 &byte);
354 if (status) {
355 rsi_dbg(ERR_ZONE,
356 "%s: Failed to write SDIO_WRITE_FIFO_CTL\n", __func__);
357 return -1;
360 return 0;
364 * rsi_interrupt_handler() - This function read and process SDIO interrupts.
365 * @adapter: Pointer to the adapter structure.
367 * Return: None.
369 void rsi_interrupt_handler(struct rsi_hw *adapter)
371 struct rsi_common *common = adapter->priv;
372 struct rsi_91x_sdiodev *dev =
373 (struct rsi_91x_sdiodev *)adapter->rsi_dev;
374 int status;
375 enum sdio_interrupt_type isr_type;
376 u8 isr_status = 0;
377 u8 fw_status = 0;
379 dev->rx_info.sdio_int_counter++;
381 do {
382 mutex_lock(&common->tx_rxlock);
383 status = rsi_sdio_read_register(common->priv,
384 RSI_FN1_INT_REGISTER,
385 &isr_status);
386 if (status) {
387 rsi_dbg(ERR_ZONE,
388 "%s: Failed to Read Intr Status Register\n",
389 __func__);
390 mutex_unlock(&common->tx_rxlock);
391 return;
394 if (isr_status == 0) {
395 rsi_set_event(&common->tx_thread.event);
396 dev->rx_info.sdio_intr_status_zero++;
397 mutex_unlock(&common->tx_rxlock);
398 return;
401 rsi_dbg(ISR_ZONE, "%s: Intr_status = %x %d %d\n",
402 __func__, isr_status, (1 << MSDU_PKT_PENDING),
403 (1 << FW_ASSERT_IND));
405 do {
406 RSI_GET_SDIO_INTERRUPT_TYPE(isr_status, isr_type);
408 switch (isr_type) {
409 case BUFFER_AVAILABLE:
410 dev->rx_info.watch_bufferfull_count = 0;
411 dev->rx_info.buffer_full = false;
412 dev->rx_info.semi_buffer_full = false;
413 dev->rx_info.mgmt_buffer_full = false;
414 rsi_sdio_ack_intr(common->priv,
415 (1 << PKT_BUFF_AVAILABLE));
416 rsi_set_event(&common->tx_thread.event);
418 rsi_dbg(ISR_ZONE,
419 "%s: ==> BUFFER_AVAILABLE <==\n",
420 __func__);
421 dev->rx_info.buf_available_counter++;
422 break;
424 case FIRMWARE_ASSERT_IND:
425 rsi_dbg(ERR_ZONE,
426 "%s: ==> FIRMWARE Assert <==\n",
427 __func__);
428 status = rsi_sdio_read_register(common->priv,
429 SDIO_FW_STATUS_REG,
430 &fw_status);
431 if (status) {
432 rsi_dbg(ERR_ZONE,
433 "%s: Failed to read f/w reg\n",
434 __func__);
435 } else {
436 rsi_dbg(ERR_ZONE,
437 "%s: Firmware Status is 0x%x\n",
438 __func__ , fw_status);
439 rsi_sdio_ack_intr(common->priv,
440 (1 << FW_ASSERT_IND));
443 common->fsm_state = FSM_CARD_NOT_READY;
444 break;
446 case MSDU_PACKET_PENDING:
447 rsi_dbg(ISR_ZONE, "Pkt pending interrupt\n");
448 dev->rx_info.total_sdio_msdu_pending_intr++;
450 status = rsi_process_pkt(common);
451 if (status) {
452 rsi_dbg(ERR_ZONE,
453 "%s: Failed to read pkt\n",
454 __func__);
455 mutex_unlock(&common->tx_rxlock);
456 return;
458 break;
459 default:
460 rsi_sdio_ack_intr(common->priv, isr_status);
461 dev->rx_info.total_sdio_unknown_intr++;
462 isr_status = 0;
463 rsi_dbg(ISR_ZONE,
464 "Unknown Interrupt %x\n",
465 isr_status);
466 break;
468 isr_status ^= BIT(isr_type - 1);
469 } while (isr_status);
470 mutex_unlock(&common->tx_rxlock);
471 } while (1);
475 * rsi_device_init() - This Function Initializes The HAL.
476 * @common: Pointer to the driver private structure.
478 * Return: 0 on success, -1 on failure.
480 int rsi_sdio_device_init(struct rsi_common *common)
482 if (rsi_load_ta_instructions(common))
483 return -1;
485 if (rsi_sdio_master_access_msword(common->priv, MISC_CFG_BASE_ADDR)) {
486 rsi_dbg(ERR_ZONE, "%s: Unable to set ms word reg\n",
487 __func__);
488 return -1;
490 rsi_dbg(INIT_ZONE,
491 "%s: Setting ms word to 0x41050000\n", __func__);
493 return 0;
497 * rsi_sdio_read_buffer_status_register() - This function is used to the read
498 * buffer status register and set
499 * relevant fields in
500 * rsi_91x_sdiodev struct.
501 * @adapter: Pointer to the driver hw structure.
502 * @q_num: The Q number whose status is to be found.
504 * Return: status: -1 on failure or else queue full/stop is indicated.
506 int rsi_sdio_read_buffer_status_register(struct rsi_hw *adapter, u8 q_num)
508 struct rsi_common *common = adapter->priv;
509 struct rsi_91x_sdiodev *dev =
510 (struct rsi_91x_sdiodev *)adapter->rsi_dev;
511 u8 buf_status = 0;
512 int status = 0;
514 status = rsi_sdio_read_register(common->priv,
515 RSI_DEVICE_BUFFER_STATUS_REGISTER,
516 &buf_status);
518 if (status) {
519 rsi_dbg(ERR_ZONE,
520 "%s: Failed to read status register\n", __func__);
521 return -1;
524 if (buf_status & (BIT(PKT_MGMT_BUFF_FULL))) {
525 if (!dev->rx_info.mgmt_buffer_full)
526 dev->rx_info.mgmt_buf_full_counter++;
527 dev->rx_info.mgmt_buffer_full = true;
528 } else {
529 dev->rx_info.mgmt_buffer_full = false;
532 if (buf_status & (BIT(PKT_BUFF_FULL))) {
533 if (!dev->rx_info.buffer_full)
534 dev->rx_info.buf_full_counter++;
535 dev->rx_info.buffer_full = true;
536 } else {
537 dev->rx_info.buffer_full = false;
540 if (buf_status & (BIT(PKT_BUFF_SEMI_FULL))) {
541 if (!dev->rx_info.semi_buffer_full)
542 dev->rx_info.buf_semi_full_counter++;
543 dev->rx_info.semi_buffer_full = true;
544 } else {
545 dev->rx_info.semi_buffer_full = false;
548 if ((q_num == MGMT_SOFT_Q) && (dev->rx_info.mgmt_buffer_full))
549 return QUEUE_FULL;
551 if (dev->rx_info.buffer_full)
552 return QUEUE_FULL;
554 return QUEUE_NOT_FULL;
558 * rsi_sdio_determine_event_timeout() - This Function determines the event
559 * timeout duration.
560 * @adapter: Pointer to the adapter structure.
562 * Return: timeout duration is returned.
564 int rsi_sdio_determine_event_timeout(struct rsi_hw *adapter)
566 struct rsi_91x_sdiodev *dev =
567 (struct rsi_91x_sdiodev *)adapter->rsi_dev;
569 /* Once buffer full is seen, event timeout to occur every 2 msecs */
570 if (dev->rx_info.buffer_full)
571 return 2;
573 return EVENT_WAIT_FOREVER;