1 /*
2 * Copyright (c) 2014 Redpine Signals Inc.
3 *
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.
7 *
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.
15 *
16 */
17
18 #include <linux/firmware.h>
19 #include <net/rsi_91x.h>
20 #include "rsi_sdio.h"
21 #include "rsi_common.h"
22
23 /**
24 * rsi_sdio_master_access_msword() - This function sets the AHB master access
25 * MS word in the SDIO slave registers.
26 * @adapter: Pointer to the adapter structure.
27 * @ms_word: ms word need to be initialized.
28 *
29 * Return: status: 0 on success, -1 on failure.
30 */
rsi_sdio_master_access_msword(struct rsi_hw * adapter,u16 ms_word)31 int rsi_sdio_master_access_msword(struct rsi_hw *adapter, u16 ms_word)
32 {
33 u8 byte;
34 u8 function = 0;
35 int status = 0;
36
37 byte = (u8)(ms_word & 0x00FF);
38
39 rsi_dbg(INIT_ZONE,
40 "%s: MASTER_ACCESS_MSBYTE:0x%x\n", __func__, byte);
41
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;
51 }
52
53 byte = (u8)(ms_word >> 8);
54
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;
61 }
62
63 static void rsi_rx_handler(struct rsi_hw *adapter);
64
rsi_sdio_rx_thread(struct rsi_common * common)65 void rsi_sdio_rx_thread(struct rsi_common *common)
66 {
67 struct rsi_hw *adapter = common->priv;
68 struct rsi_91x_sdiodev *sdev = adapter->rsi_dev;
69
70 do {
71 rsi_wait_event(&sdev->rx_thread.event, EVENT_WAIT_FOREVER);
72 rsi_reset_event(&sdev->rx_thread.event);
73 rsi_rx_handler(adapter);
74 } while (!atomic_read(&sdev->rx_thread.thread_done));
75
76 rsi_dbg(INFO_ZONE, "%s: Terminated SDIO RX thread\n", __func__);
77 atomic_inc(&sdev->rx_thread.thread_done);
78 kthread_complete_and_exit(&sdev->rx_thread.completion, 0);
79 }
80
81 /**
82 * rsi_process_pkt() - This Function reads rx_blocks register and figures out
83 * the size of the rx pkt.
84 * @common: Pointer to the driver private structure.
85 *
86 * Return: 0 on success, -1 on failure.
87 */
rsi_process_pkt(struct rsi_common * common)88 static int rsi_process_pkt(struct rsi_common *common)
89 {
90 struct rsi_hw *adapter = common->priv;
91 struct rsi_91x_sdiodev *dev = adapter->rsi_dev;
92 u8 num_blks = 0;
93 u32 rcv_pkt_len = 0;
94 int status = 0;
95 u8 value = 0;
96
97 num_blks = ((adapter->interrupt_status & 1) |
98 ((adapter->interrupt_status >> RECV_NUM_BLOCKS) << 1));
99
100 if (!num_blks) {
101 status = rsi_sdio_read_register(adapter,
102 SDIO_RX_NUM_BLOCKS_REG,
103 &value);
104 if (status) {
105 rsi_dbg(ERR_ZONE,
106 "%s: Failed to read pkt length from the card:\n",
107 __func__);
108 return status;
109 }
110 num_blks = value & 0x1f;
111 }
112
113 if (dev->write_fail == 2)
114 rsi_sdio_ack_intr(common->priv, (1 << MSDU_PKT_PENDING));
115
116 if (unlikely(!num_blks)) {
117 dev->write_fail = 2;
118 return -1;
119 }
120
121 rcv_pkt_len = (num_blks * 256);
122
123 status = rsi_sdio_host_intf_read_pkt(adapter, dev->pktbuffer,
124 rcv_pkt_len);
125 if (status) {
126 rsi_dbg(ERR_ZONE, "%s: Failed to read packet from card\n",
127 __func__);
128 return status;
129 }
130
131 status = rsi_read_pkt(common, dev->pktbuffer, rcv_pkt_len);
132 if (status) {
133 rsi_dbg(ERR_ZONE, "Failed to read the packet\n");
134 return status;
135 }
136
137 return 0;
138 }
139
140 /**
141 * rsi_init_sdio_slave_regs() - This function does the actual initialization
142 * of SDBUS slave registers.
143 * @adapter: Pointer to the adapter structure.
144 *
145 * Return: status: 0 on success, -1 on failure.
146 */
rsi_init_sdio_slave_regs(struct rsi_hw * adapter)147 int rsi_init_sdio_slave_regs(struct rsi_hw *adapter)
148 {
149 struct rsi_91x_sdiodev *dev = adapter->rsi_dev;
150 u8 function = 0;
151 u8 byte;
152 int status = 0;
153
154 if (dev->next_read_delay) {
155 byte = dev->next_read_delay;
156 status = rsi_sdio_write_register(adapter,
157 function,
158 SDIO_NXT_RD_DELAY2,
159 &byte);
160 if (status) {
161 rsi_dbg(ERR_ZONE,
162 "%s: Failed to write SDIO_NXT_RD_DELAY2\n",
163 __func__);
164 return -1;
165 }
166 }
167
168 if (dev->sdio_high_speed_enable) {
169 rsi_dbg(INIT_ZONE, "%s: Enabling SDIO High speed\n", __func__);
170 byte = 0x3;
171
172 status = rsi_sdio_write_register(adapter,
173 function,
174 SDIO_REG_HIGH_SPEED,
175 &byte);
176 if (status) {
177 rsi_dbg(ERR_ZONE,
178 "%s: Failed to enable SDIO high speed\n",
179 __func__);
180 return -1;
181 }
182 }
183
184 /* This tells SDIO FIFO when to start read to host */
185 rsi_dbg(INIT_ZONE, "%s: Initializing SDIO read start level\n", __func__);
186 byte = 0x24;
187
188 status = rsi_sdio_write_register(adapter,
189 function,
190 SDIO_READ_START_LVL,
191 &byte);
192 if (status) {
193 rsi_dbg(ERR_ZONE,
194 "%s: Failed to write SDIO_READ_START_LVL\n", __func__);
195 return -1;
196 }
197
198 rsi_dbg(INIT_ZONE, "%s: Initializing FIFO ctrl registers\n", __func__);
199 byte = (128 - 32);
200
201 status = rsi_sdio_write_register(adapter,
202 function,
203 SDIO_READ_FIFO_CTL,
204 &byte);
205 if (status) {
206 rsi_dbg(ERR_ZONE,
207 "%s: Failed to write SDIO_READ_FIFO_CTL\n", __func__);
208 return -1;
209 }
210
211 byte = 32;
212 status = rsi_sdio_write_register(adapter,
213 function,
214 SDIO_WRITE_FIFO_CTL,
215 &byte);
216 if (status) {
217 rsi_dbg(ERR_ZONE,
218 "%s: Failed to write SDIO_WRITE_FIFO_CTL\n", __func__);
219 return -1;
220 }
221
222 return 0;
223 }
224
225 /**
226 * rsi_rx_handler() - Read and process SDIO interrupts.
227 * @adapter: Pointer to the adapter structure.
228 *
229 * Return: None.
230 */
rsi_rx_handler(struct rsi_hw * adapter)231 static void rsi_rx_handler(struct rsi_hw *adapter)
232 {
233 struct rsi_common *common = adapter->priv;
234 struct rsi_91x_sdiodev *dev = adapter->rsi_dev;
235 int status;
236 u8 isr_status = 0;
237 u8 fw_status = 0;
238
239 dev->rx_info.sdio_int_counter++;
240
241 do {
242 mutex_lock(&common->rx_lock);
243 status = rsi_sdio_read_register(common->priv,
244 RSI_FN1_INT_REGISTER,
245 &isr_status);
246 if (status) {
247 rsi_dbg(ERR_ZONE,
248 "%s: Failed to Read Intr Status Register\n",
249 __func__);
250 mutex_unlock(&common->rx_lock);
251 return;
252 }
253 adapter->interrupt_status = isr_status;
254
255 if (isr_status == 0) {
256 rsi_set_event(&common->tx_thread.event);
257 dev->rx_info.sdio_intr_status_zero++;
258 mutex_unlock(&common->rx_lock);
259 return;
260 }
261
262 rsi_dbg(ISR_ZONE, "%s: Intr_status = %x %d %d\n",
263 __func__, isr_status, (1 << MSDU_PKT_PENDING),
264 (1 << FW_ASSERT_IND));
265
266 if (isr_status & BIT(PKT_BUFF_AVAILABLE)) {
267 status = rsi_sdio_check_buffer_status(adapter, 0);
268 if (status < 0)
269 rsi_dbg(ERR_ZONE,
270 "%s: Failed to check buffer status\n",
271 __func__);
272 rsi_sdio_ack_intr(common->priv,
273 BIT(PKT_BUFF_AVAILABLE));
274 rsi_set_event(&common->tx_thread.event);
275
276 rsi_dbg(ISR_ZONE, "%s: ==> BUFFER_AVAILABLE <==\n",
277 __func__);
278 dev->buff_status_updated = true;
279
280 isr_status &= ~BIT(PKT_BUFF_AVAILABLE);
281 }
282
283 if (isr_status & BIT(FW_ASSERT_IND)) {
284 rsi_dbg(ERR_ZONE, "%s: ==> FIRMWARE Assert <==\n",
285 __func__);
286 status = rsi_sdio_read_register(common->priv,
287 SDIO_FW_STATUS_REG,
288 &fw_status);
289 if (status) {
290 rsi_dbg(ERR_ZONE,
291 "%s: Failed to read f/w reg\n",
292 __func__);
293 } else {
294 rsi_dbg(ERR_ZONE,
295 "%s: Firmware Status is 0x%x\n",
296 __func__, fw_status);
297 rsi_sdio_ack_intr(common->priv,
298 BIT(FW_ASSERT_IND));
299 }
300
301 common->fsm_state = FSM_CARD_NOT_READY;
302
303 isr_status &= ~BIT(FW_ASSERT_IND);
304 }
305
306 if (isr_status & BIT(MSDU_PKT_PENDING)) {
307 rsi_dbg(ISR_ZONE, "Pkt pending interrupt\n");
308 dev->rx_info.total_sdio_msdu_pending_intr++;
309
310 status = rsi_process_pkt(common);
311 if (status) {
312 rsi_dbg(ERR_ZONE, "%s: Failed to read pkt\n",
313 __func__);
314 mutex_unlock(&common->rx_lock);
315 return;
316 }
317
318 isr_status &= ~BIT(MSDU_PKT_PENDING);
319 }
320
321 if (isr_status) {
322 rsi_sdio_ack_intr(common->priv, isr_status);
323 dev->rx_info.total_sdio_unknown_intr++;
324 isr_status = 0;
325 rsi_dbg(ISR_ZONE, "Unknown Interrupt %x\n",
326 isr_status);
327 }
328
329 mutex_unlock(&common->rx_lock);
330 } while (1);
331 }
332
333 /* This function is used to read buffer status register and
334 * set relevant fields in rsi_91x_sdiodev struct.
335 */
rsi_sdio_check_buffer_status(struct rsi_hw * adapter,u8 q_num)336 int rsi_sdio_check_buffer_status(struct rsi_hw *adapter, u8 q_num)
337 {
338 struct rsi_common *common = adapter->priv;
339 struct rsi_91x_sdiodev *dev = adapter->rsi_dev;
340 u8 buf_status = 0;
341 int status = 0;
342 static int counter = 4;
343
344 if (!dev->buff_status_updated && counter) {
345 counter--;
346 goto out;
347 }
348
349 dev->buff_status_updated = false;
350 status = rsi_sdio_read_register(common->priv,
351 RSI_DEVICE_BUFFER_STATUS_REGISTER,
352 &buf_status);
353
354 if (status) {
355 rsi_dbg(ERR_ZONE,
356 "%s: Failed to read status register\n", __func__);
357 return -1;
358 }
359
360 if (buf_status & (BIT(PKT_MGMT_BUFF_FULL))) {
361 if (!dev->rx_info.mgmt_buffer_full)
362 dev->rx_info.mgmt_buf_full_counter++;
363 dev->rx_info.mgmt_buffer_full = true;
364 } else {
365 dev->rx_info.mgmt_buffer_full = false;
366 }
367
368 if (buf_status & (BIT(PKT_BUFF_FULL))) {
369 if (!dev->rx_info.buffer_full)
370 dev->rx_info.buf_full_counter++;
371 dev->rx_info.buffer_full = true;
372 } else {
373 dev->rx_info.buffer_full = false;
374 }
375
376 if (buf_status & (BIT(PKT_BUFF_SEMI_FULL))) {
377 if (!dev->rx_info.semi_buffer_full)
378 dev->rx_info.buf_semi_full_counter++;
379 dev->rx_info.semi_buffer_full = true;
380 } else {
381 dev->rx_info.semi_buffer_full = false;
382 }
383
384 if (dev->rx_info.mgmt_buffer_full || dev->rx_info.buf_full_counter)
385 counter = 1;
386 else
387 counter = 4;
388
389 out:
390 if ((q_num == MGMT_SOFT_Q) && (dev->rx_info.mgmt_buffer_full))
391 return QUEUE_FULL;
392
393 if ((q_num < MGMT_SOFT_Q) && (dev->rx_info.buffer_full))
394 return QUEUE_FULL;
395
396 return QUEUE_NOT_FULL;
397 }
398
399 /**
400 * rsi_sdio_determine_event_timeout() - This Function determines the event
401 * timeout duration.
402 * @adapter: Pointer to the adapter structure.
403 *
404 * Return: timeout duration is returned.
405 */
rsi_sdio_determine_event_timeout(struct rsi_hw * adapter)406 int rsi_sdio_determine_event_timeout(struct rsi_hw *adapter)
407 {
408 struct rsi_91x_sdiodev *dev = adapter->rsi_dev;
409
410 /* Once buffer full is seen, event timeout to occur every 2 msecs */
411 if (dev->rx_info.buffer_full)
412 return 2;
413
414 return EVENT_WAIT_FOREVER;
415 }
416
