1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
24
25#include <linux/interrupt.h>
26#include <linux/soc/qcom/smem_state.h>
27#include "wcn36xx.h"
28#include "txrx.h"
29
30static void wcn36xx_ccu_write_register(struct wcn36xx *wcn, int addr, int data)
31{
32 wcn36xx_dbg(WCN36XX_DBG_DXE,
33 "wcn36xx_ccu_write_register: addr=%x, data=%x\n",
34 addr, data);
35
36 writel(data, wcn->ccu_base + addr);
37}
38
39static void wcn36xx_dxe_write_register(struct wcn36xx *wcn, int addr, int data)
40{
41 wcn36xx_dbg(WCN36XX_DBG_DXE,
42 "wcn36xx_dxe_write_register: addr=%x, data=%x\n",
43 addr, data);
44
45 writel(data, wcn->dxe_base + addr);
46}
47
48static void wcn36xx_dxe_read_register(struct wcn36xx *wcn, int addr, int *data)
49{
50 *data = readl(wcn->dxe_base + addr);
51
52 wcn36xx_dbg(WCN36XX_DBG_DXE,
53 "wcn36xx_dxe_read_register: addr=%x, data=%x\n",
54 addr, *data);
55}
56
57static void wcn36xx_dxe_free_ctl_block(struct wcn36xx_dxe_ch *ch)
58{
59 struct wcn36xx_dxe_ctl *ctl = ch->head_blk_ctl, *next;
60 int i;
61
62 for (i = 0; i < ch->desc_num && ctl; i++) {
63 next = ctl->next;
64 kfree(ctl);
65 ctl = next;
66 }
67}
68
69static int wcn36xx_dxe_allocate_ctl_block(struct wcn36xx_dxe_ch *ch)
70{
71 struct wcn36xx_dxe_ctl *prev_ctl = NULL;
72 struct wcn36xx_dxe_ctl *cur_ctl = NULL;
73 int i;
74
75 spin_lock_init(&ch->lock);
76 for (i = 0; i < ch->desc_num; i++) {
77 cur_ctl = kzalloc(sizeof(*cur_ctl), GFP_KERNEL);
78 if (!cur_ctl)
79 goto out_fail;
80
81 spin_lock_init(&cur_ctl->skb_lock);
82 cur_ctl->ctl_blk_order = i;
83 if (i == 0) {
84 ch->head_blk_ctl = cur_ctl;
85 ch->tail_blk_ctl = cur_ctl;
86 } else if (ch->desc_num - 1 == i) {
87 prev_ctl->next = cur_ctl;
88 cur_ctl->next = ch->head_blk_ctl;
89 } else {
90 prev_ctl->next = cur_ctl;
91 }
92 prev_ctl = cur_ctl;
93 }
94
95 return 0;
96
97out_fail:
98 wcn36xx_dxe_free_ctl_block(ch);
99 return -ENOMEM;
100}
101
102int wcn36xx_dxe_alloc_ctl_blks(struct wcn36xx *wcn)
103{
104 int ret;
105
106 wcn->dxe_tx_l_ch.ch_type = WCN36XX_DXE_CH_TX_L;
107 wcn->dxe_tx_h_ch.ch_type = WCN36XX_DXE_CH_TX_H;
108 wcn->dxe_rx_l_ch.ch_type = WCN36XX_DXE_CH_RX_L;
109 wcn->dxe_rx_h_ch.ch_type = WCN36XX_DXE_CH_RX_H;
110
111 wcn->dxe_tx_l_ch.desc_num = WCN36XX_DXE_CH_DESC_NUMB_TX_L;
112 wcn->dxe_tx_h_ch.desc_num = WCN36XX_DXE_CH_DESC_NUMB_TX_H;
113 wcn->dxe_rx_l_ch.desc_num = WCN36XX_DXE_CH_DESC_NUMB_RX_L;
114 wcn->dxe_rx_h_ch.desc_num = WCN36XX_DXE_CH_DESC_NUMB_RX_H;
115
116 wcn->dxe_tx_l_ch.dxe_wq = WCN36XX_DXE_WQ_TX_L;
117 wcn->dxe_tx_h_ch.dxe_wq = WCN36XX_DXE_WQ_TX_H;
118
119 wcn->dxe_tx_l_ch.ctrl_bd = WCN36XX_DXE_CTRL_TX_L_BD;
120 wcn->dxe_tx_h_ch.ctrl_bd = WCN36XX_DXE_CTRL_TX_H_BD;
121
122 wcn->dxe_tx_l_ch.ctrl_skb = WCN36XX_DXE_CTRL_TX_L_SKB;
123 wcn->dxe_tx_h_ch.ctrl_skb = WCN36XX_DXE_CTRL_TX_H_SKB;
124
125 wcn->dxe_tx_l_ch.reg_ctrl = WCN36XX_DXE_REG_CTL_TX_L;
126 wcn->dxe_tx_h_ch.reg_ctrl = WCN36XX_DXE_REG_CTL_TX_H;
127
128 wcn->dxe_tx_l_ch.def_ctrl = WCN36XX_DXE_CH_DEFAULT_CTL_TX_L;
129 wcn->dxe_tx_h_ch.def_ctrl = WCN36XX_DXE_CH_DEFAULT_CTL_TX_H;
130
131
132 ret = wcn36xx_dxe_allocate_ctl_block(&wcn->dxe_tx_l_ch);
133 if (ret)
134 goto out_err;
135 ret = wcn36xx_dxe_allocate_ctl_block(&wcn->dxe_tx_h_ch);
136 if (ret)
137 goto out_err;
138 ret = wcn36xx_dxe_allocate_ctl_block(&wcn->dxe_rx_l_ch);
139 if (ret)
140 goto out_err;
141 ret = wcn36xx_dxe_allocate_ctl_block(&wcn->dxe_rx_h_ch);
142 if (ret)
143 goto out_err;
144
145
146 ret = qcom_smem_state_update_bits(wcn->tx_enable_state,
147 WCN36XX_SMSM_WLAN_TX_ENABLE |
148 WCN36XX_SMSM_WLAN_TX_RINGS_EMPTY,
149 WCN36XX_SMSM_WLAN_TX_RINGS_EMPTY);
150 if (ret)
151 goto out_err;
152
153 return 0;
154
155out_err:
156 wcn36xx_err("Failed to allocate DXE control blocks\n");
157 wcn36xx_dxe_free_ctl_blks(wcn);
158 return -ENOMEM;
159}
160
161void wcn36xx_dxe_free_ctl_blks(struct wcn36xx *wcn)
162{
163 wcn36xx_dxe_free_ctl_block(&wcn->dxe_tx_l_ch);
164 wcn36xx_dxe_free_ctl_block(&wcn->dxe_tx_h_ch);
165 wcn36xx_dxe_free_ctl_block(&wcn->dxe_rx_l_ch);
166 wcn36xx_dxe_free_ctl_block(&wcn->dxe_rx_h_ch);
167}
168
169static int wcn36xx_dxe_init_descs(struct device *dev, struct wcn36xx_dxe_ch *wcn_ch)
170{
171 struct wcn36xx_dxe_desc *cur_dxe = NULL;
172 struct wcn36xx_dxe_desc *prev_dxe = NULL;
173 struct wcn36xx_dxe_ctl *cur_ctl = NULL;
174 size_t size;
175 int i;
176
177 size = wcn_ch->desc_num * sizeof(struct wcn36xx_dxe_desc);
178 wcn_ch->cpu_addr = dma_alloc_coherent(dev, size, &wcn_ch->dma_addr,
179 GFP_KERNEL);
180 if (!wcn_ch->cpu_addr)
181 return -ENOMEM;
182
183 memset(wcn_ch->cpu_addr, 0, size);
184
185 cur_dxe = (struct wcn36xx_dxe_desc *)wcn_ch->cpu_addr;
186 cur_ctl = wcn_ch->head_blk_ctl;
187
188 for (i = 0; i < wcn_ch->desc_num; i++) {
189 cur_ctl->desc = cur_dxe;
190 cur_ctl->desc_phy_addr = wcn_ch->dma_addr +
191 i * sizeof(struct wcn36xx_dxe_desc);
192
193 switch (wcn_ch->ch_type) {
194 case WCN36XX_DXE_CH_TX_L:
195 cur_dxe->ctrl = WCN36XX_DXE_CTRL_TX_L;
196 cur_dxe->dst_addr_l = WCN36XX_DXE_WQ_TX_L;
197 break;
198 case WCN36XX_DXE_CH_TX_H:
199 cur_dxe->ctrl = WCN36XX_DXE_CTRL_TX_H;
200 cur_dxe->dst_addr_l = WCN36XX_DXE_WQ_TX_H;
201 break;
202 case WCN36XX_DXE_CH_RX_L:
203 cur_dxe->ctrl = WCN36XX_DXE_CTRL_RX_L;
204 cur_dxe->src_addr_l = WCN36XX_DXE_WQ_RX_L;
205 break;
206 case WCN36XX_DXE_CH_RX_H:
207 cur_dxe->ctrl = WCN36XX_DXE_CTRL_RX_H;
208 cur_dxe->src_addr_l = WCN36XX_DXE_WQ_RX_H;
209 break;
210 }
211 if (0 == i) {
212 cur_dxe->phy_next_l = 0;
213 } else if ((0 < i) && (i < wcn_ch->desc_num - 1)) {
214 prev_dxe->phy_next_l =
215 cur_ctl->desc_phy_addr;
216 } else if (i == (wcn_ch->desc_num - 1)) {
217 prev_dxe->phy_next_l =
218 cur_ctl->desc_phy_addr;
219 cur_dxe->phy_next_l =
220 wcn_ch->head_blk_ctl->desc_phy_addr;
221 }
222 cur_ctl = cur_ctl->next;
223 prev_dxe = cur_dxe;
224 cur_dxe++;
225 }
226
227 return 0;
228}
229
230static void wcn36xx_dxe_deinit_descs(struct device *dev, struct wcn36xx_dxe_ch *wcn_ch)
231{
232 size_t size;
233
234 size = wcn_ch->desc_num * sizeof(struct wcn36xx_dxe_desc);
235 dma_free_coherent(dev, size,wcn_ch->cpu_addr, wcn_ch->dma_addr);
236}
237
238static void wcn36xx_dxe_init_tx_bd(struct wcn36xx_dxe_ch *ch,
239 struct wcn36xx_dxe_mem_pool *pool)
240{
241 int i, chunk_size = pool->chunk_size;
242 dma_addr_t bd_phy_addr = pool->phy_addr;
243 void *bd_cpu_addr = pool->virt_addr;
244 struct wcn36xx_dxe_ctl *cur = ch->head_blk_ctl;
245
246 for (i = 0; i < ch->desc_num; i++) {
247
248
249 if (!(i & 1)) {
250 cur->bd_phy_addr = bd_phy_addr;
251 cur->bd_cpu_addr = bd_cpu_addr;
252 bd_phy_addr += chunk_size;
253 bd_cpu_addr += chunk_size;
254 } else {
255 cur->bd_phy_addr = 0;
256 cur->bd_cpu_addr = NULL;
257 }
258 cur = cur->next;
259 }
260}
261
262static int wcn36xx_dxe_enable_ch_int(struct wcn36xx *wcn, u16 wcn_ch)
263{
264 int reg_data = 0;
265
266 wcn36xx_dxe_read_register(wcn,
267 WCN36XX_DXE_INT_MASK_REG,
268 ®_data);
269
270 reg_data |= wcn_ch;
271
272 wcn36xx_dxe_write_register(wcn,
273 WCN36XX_DXE_INT_MASK_REG,
274 (int)reg_data);
275 return 0;
276}
277
278static int wcn36xx_dxe_fill_skb(struct device *dev, struct wcn36xx_dxe_ctl *ctl)
279{
280 struct wcn36xx_dxe_desc *dxe = ctl->desc;
281 struct sk_buff *skb;
282
283 skb = alloc_skb(WCN36XX_PKT_SIZE, GFP_ATOMIC);
284 if (skb == NULL)
285 return -ENOMEM;
286
287 dxe->dst_addr_l = dma_map_single(dev,
288 skb_tail_pointer(skb),
289 WCN36XX_PKT_SIZE,
290 DMA_FROM_DEVICE);
291 if (dma_mapping_error(dev, dxe->dst_addr_l)) {
292 dev_err(dev, "unable to map skb\n");
293 kfree_skb(skb);
294 return -ENOMEM;
295 }
296 ctl->skb = skb;
297
298 return 0;
299}
300
301static int wcn36xx_dxe_ch_alloc_skb(struct wcn36xx *wcn,
302 struct wcn36xx_dxe_ch *wcn_ch)
303{
304 int i;
305 struct wcn36xx_dxe_ctl *cur_ctl = NULL;
306
307 cur_ctl = wcn_ch->head_blk_ctl;
308
309 for (i = 0; i < wcn_ch->desc_num; i++) {
310 wcn36xx_dxe_fill_skb(wcn->dev, cur_ctl);
311 cur_ctl = cur_ctl->next;
312 }
313
314 return 0;
315}
316
317static void wcn36xx_dxe_ch_free_skbs(struct wcn36xx *wcn,
318 struct wcn36xx_dxe_ch *wcn_ch)
319{
320 struct wcn36xx_dxe_ctl *cur = wcn_ch->head_blk_ctl;
321 int i;
322
323 for (i = 0; i < wcn_ch->desc_num; i++) {
324 kfree_skb(cur->skb);
325 cur = cur->next;
326 }
327}
328
329void wcn36xx_dxe_tx_ack_ind(struct wcn36xx *wcn, u32 status)
330{
331 struct ieee80211_tx_info *info;
332 struct sk_buff *skb;
333 unsigned long flags;
334
335 spin_lock_irqsave(&wcn->dxe_lock, flags);
336 skb = wcn->tx_ack_skb;
337 wcn->tx_ack_skb = NULL;
338 spin_unlock_irqrestore(&wcn->dxe_lock, flags);
339
340 if (!skb) {
341 wcn36xx_warn("Spurious TX complete indication\n");
342 return;
343 }
344
345 info = IEEE80211_SKB_CB(skb);
346
347 if (status == 1)
348 info->flags |= IEEE80211_TX_STAT_ACK;
349
350 wcn36xx_dbg(WCN36XX_DBG_DXE, "dxe tx ack status: %d\n", status);
351
352 ieee80211_tx_status_irqsafe(wcn->hw, skb);
353 ieee80211_wake_queues(wcn->hw);
354}
355
356static void reap_tx_dxes(struct wcn36xx *wcn, struct wcn36xx_dxe_ch *ch)
357{
358 struct wcn36xx_dxe_ctl *ctl;
359 struct ieee80211_tx_info *info;
360 unsigned long flags;
361
362
363
364
365
366
367 spin_lock_irqsave(&ch->lock, flags);
368 ctl = ch->tail_blk_ctl;
369 do {
370 if (ctl->desc->ctrl & WCN36xx_DXE_CTRL_VLD)
371 break;
372 if (ctl->skb) {
373 dma_unmap_single(wcn->dev, ctl->desc->src_addr_l,
374 ctl->skb->len, DMA_TO_DEVICE);
375 info = IEEE80211_SKB_CB(ctl->skb);
376 if (!(info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS)) {
377
378 ieee80211_free_txskb(wcn->hw, ctl->skb);
379 }
380 spin_lock(&ctl->skb_lock);
381 if (wcn->queues_stopped) {
382 wcn->queues_stopped = false;
383 ieee80211_wake_queues(wcn->hw);
384 }
385 spin_unlock(&ctl->skb_lock);
386
387 ctl->skb = NULL;
388 }
389 ctl = ctl->next;
390 } while (ctl != ch->head_blk_ctl &&
391 !(ctl->desc->ctrl & WCN36xx_DXE_CTRL_VLD));
392
393 ch->tail_blk_ctl = ctl;
394 spin_unlock_irqrestore(&ch->lock, flags);
395}
396
397static irqreturn_t wcn36xx_irq_tx_complete(int irq, void *dev)
398{
399 struct wcn36xx *wcn = (struct wcn36xx *)dev;
400 int int_src, int_reason;
401
402 wcn36xx_dxe_read_register(wcn, WCN36XX_DXE_INT_SRC_RAW_REG, &int_src);
403
404 if (int_src & WCN36XX_INT_MASK_CHAN_TX_H) {
405 wcn36xx_dxe_read_register(wcn,
406 WCN36XX_DXE_CH_STATUS_REG_ADDR_TX_H,
407 &int_reason);
408
409 wcn36xx_dxe_write_register(wcn,
410 WCN36XX_DXE_0_INT_CLR,
411 WCN36XX_INT_MASK_CHAN_TX_H);
412
413 if (int_reason & WCN36XX_CH_STAT_INT_ERR_MASK ) {
414 wcn36xx_dxe_write_register(wcn,
415 WCN36XX_DXE_0_INT_ERR_CLR,
416 WCN36XX_INT_MASK_CHAN_TX_H);
417
418 wcn36xx_err("DXE IRQ reported error: 0x%x in high TX channel\n",
419 int_src);
420 }
421
422 if (int_reason & WCN36XX_CH_STAT_INT_DONE_MASK) {
423 wcn36xx_dxe_write_register(wcn,
424 WCN36XX_DXE_0_INT_DONE_CLR,
425 WCN36XX_INT_MASK_CHAN_TX_H);
426 }
427
428 if (int_reason & WCN36XX_CH_STAT_INT_ED_MASK) {
429 wcn36xx_dxe_write_register(wcn,
430 WCN36XX_DXE_0_INT_ED_CLR,
431 WCN36XX_INT_MASK_CHAN_TX_H);
432 }
433
434 wcn36xx_dbg(WCN36XX_DBG_DXE, "dxe tx ready high\n");
435 reap_tx_dxes(wcn, &wcn->dxe_tx_h_ch);
436 }
437
438 if (int_src & WCN36XX_INT_MASK_CHAN_TX_L) {
439 wcn36xx_dxe_read_register(wcn,
440 WCN36XX_DXE_CH_STATUS_REG_ADDR_TX_L,
441 &int_reason);
442
443 wcn36xx_dxe_write_register(wcn,
444 WCN36XX_DXE_0_INT_CLR,
445 WCN36XX_INT_MASK_CHAN_TX_L);
446
447
448 if (int_reason & WCN36XX_CH_STAT_INT_ERR_MASK ) {
449 wcn36xx_dxe_write_register(wcn,
450 WCN36XX_DXE_0_INT_ERR_CLR,
451 WCN36XX_INT_MASK_CHAN_TX_L);
452
453 wcn36xx_err("DXE IRQ reported error: 0x%x in low TX channel\n",
454 int_src);
455 }
456
457 if (int_reason & WCN36XX_CH_STAT_INT_DONE_MASK) {
458 wcn36xx_dxe_write_register(wcn,
459 WCN36XX_DXE_0_INT_DONE_CLR,
460 WCN36XX_INT_MASK_CHAN_TX_L);
461 }
462
463 if (int_reason & WCN36XX_CH_STAT_INT_ED_MASK) {
464 wcn36xx_dxe_write_register(wcn,
465 WCN36XX_DXE_0_INT_ED_CLR,
466 WCN36XX_INT_MASK_CHAN_TX_L);
467 }
468
469 wcn36xx_dbg(WCN36XX_DBG_DXE, "dxe tx ready low\n");
470 reap_tx_dxes(wcn, &wcn->dxe_tx_l_ch);
471 }
472
473 return IRQ_HANDLED;
474}
475
476static irqreturn_t wcn36xx_irq_rx_ready(int irq, void *dev)
477{
478 struct wcn36xx *wcn = (struct wcn36xx *)dev;
479
480 disable_irq_nosync(wcn->rx_irq);
481 wcn36xx_dxe_rx_frame(wcn);
482 enable_irq(wcn->rx_irq);
483 return IRQ_HANDLED;
484}
485
486static int wcn36xx_dxe_request_irqs(struct wcn36xx *wcn)
487{
488 int ret;
489
490 ret = request_irq(wcn->tx_irq, wcn36xx_irq_tx_complete,
491 IRQF_TRIGGER_HIGH, "wcn36xx_tx", wcn);
492 if (ret) {
493 wcn36xx_err("failed to alloc tx irq\n");
494 goto out_err;
495 }
496
497 ret = request_irq(wcn->rx_irq, wcn36xx_irq_rx_ready, IRQF_TRIGGER_HIGH,
498 "wcn36xx_rx", wcn);
499 if (ret) {
500 wcn36xx_err("failed to alloc rx irq\n");
501 goto out_txirq;
502 }
503
504 enable_irq_wake(wcn->rx_irq);
505
506 return 0;
507
508out_txirq:
509 free_irq(wcn->tx_irq, wcn);
510out_err:
511 return ret;
512
513}
514
515static int wcn36xx_rx_handle_packets(struct wcn36xx *wcn,
516 struct wcn36xx_dxe_ch *ch)
517{
518 struct wcn36xx_dxe_ctl *ctl = ch->head_blk_ctl;
519 struct wcn36xx_dxe_desc *dxe = ctl->desc;
520 dma_addr_t dma_addr;
521 struct sk_buff *skb;
522 int ret = 0, int_mask;
523 u32 value;
524
525 if (ch->ch_type == WCN36XX_DXE_CH_RX_L) {
526 value = WCN36XX_DXE_CTRL_RX_L;
527 int_mask = WCN36XX_DXE_INT_CH1_MASK;
528 } else {
529 value = WCN36XX_DXE_CTRL_RX_H;
530 int_mask = WCN36XX_DXE_INT_CH3_MASK;
531 }
532
533 while (!(dxe->ctrl & WCN36xx_DXE_CTRL_VLD)) {
534 skb = ctl->skb;
535 dma_addr = dxe->dst_addr_l;
536 ret = wcn36xx_dxe_fill_skb(wcn->dev, ctl);
537 if (0 == ret) {
538
539
540
541 dma_unmap_single(wcn->dev, dma_addr, WCN36XX_PKT_SIZE,
542 DMA_FROM_DEVICE);
543 wcn36xx_rx_skb(wcn, skb);
544 }
545
546 dxe->ctrl = value;
547 ctl = ctl->next;
548 dxe = ctl->desc;
549 }
550 wcn36xx_dxe_write_register(wcn, WCN36XX_DXE_ENCH_ADDR, int_mask);
551
552 ch->head_blk_ctl = ctl;
553 return 0;
554}
555
556void wcn36xx_dxe_rx_frame(struct wcn36xx *wcn)
557{
558 int int_src;
559
560 wcn36xx_dxe_read_register(wcn, WCN36XX_DXE_INT_SRC_RAW_REG, &int_src);
561
562
563 if (int_src & WCN36XX_DXE_INT_CH1_MASK) {
564 wcn36xx_dxe_write_register(wcn, WCN36XX_DXE_0_INT_CLR,
565 WCN36XX_DXE_INT_CH1_MASK);
566 wcn36xx_rx_handle_packets(wcn, &(wcn->dxe_rx_l_ch));
567 }
568
569
570 if (int_src & WCN36XX_DXE_INT_CH3_MASK) {
571
572 wcn36xx_dxe_write_register(wcn, WCN36XX_DXE_0_INT_CLR,
573 WCN36XX_DXE_INT_CH3_MASK);
574 wcn36xx_rx_handle_packets(wcn, &(wcn->dxe_rx_h_ch));
575 }
576
577 if (!int_src)
578 wcn36xx_warn("No DXE interrupt pending\n");
579}
580
581int wcn36xx_dxe_allocate_mem_pools(struct wcn36xx *wcn)
582{
583 size_t s;
584 void *cpu_addr;
585
586
587
588
589 wcn->mgmt_mem_pool.chunk_size = WCN36XX_BD_CHUNK_SIZE +
590 16 - (WCN36XX_BD_CHUNK_SIZE % 8);
591
592 s = wcn->mgmt_mem_pool.chunk_size * WCN36XX_DXE_CH_DESC_NUMB_TX_H;
593 cpu_addr = dma_alloc_coherent(wcn->dev, s, &wcn->mgmt_mem_pool.phy_addr,
594 GFP_KERNEL);
595 if (!cpu_addr)
596 goto out_err;
597
598 wcn->mgmt_mem_pool.virt_addr = cpu_addr;
599 memset(cpu_addr, 0, s);
600
601
602
603
604 wcn->data_mem_pool.chunk_size = WCN36XX_BD_CHUNK_SIZE +
605 16 - (WCN36XX_BD_CHUNK_SIZE % 8);
606
607 s = wcn->data_mem_pool.chunk_size * WCN36XX_DXE_CH_DESC_NUMB_TX_L;
608 cpu_addr = dma_alloc_coherent(wcn->dev, s, &wcn->data_mem_pool.phy_addr,
609 GFP_KERNEL);
610 if (!cpu_addr)
611 goto out_err;
612
613 wcn->data_mem_pool.virt_addr = cpu_addr;
614 memset(cpu_addr, 0, s);
615
616 return 0;
617
618out_err:
619 wcn36xx_dxe_free_mem_pools(wcn);
620 wcn36xx_err("Failed to allocate BD mempool\n");
621 return -ENOMEM;
622}
623
624void wcn36xx_dxe_free_mem_pools(struct wcn36xx *wcn)
625{
626 if (wcn->mgmt_mem_pool.virt_addr)
627 dma_free_coherent(wcn->dev, wcn->mgmt_mem_pool.chunk_size *
628 WCN36XX_DXE_CH_DESC_NUMB_TX_H,
629 wcn->mgmt_mem_pool.virt_addr,
630 wcn->mgmt_mem_pool.phy_addr);
631
632 if (wcn->data_mem_pool.virt_addr) {
633 dma_free_coherent(wcn->dev, wcn->data_mem_pool.chunk_size *
634 WCN36XX_DXE_CH_DESC_NUMB_TX_L,
635 wcn->data_mem_pool.virt_addr,
636 wcn->data_mem_pool.phy_addr);
637 }
638}
639
640int wcn36xx_dxe_tx_frame(struct wcn36xx *wcn,
641 struct wcn36xx_vif *vif_priv,
642 struct wcn36xx_tx_bd *bd,
643 struct sk_buff *skb,
644 bool is_low)
645{
646 struct wcn36xx_dxe_ctl *ctl = NULL;
647 struct wcn36xx_dxe_desc *desc = NULL;
648 struct wcn36xx_dxe_ch *ch = NULL;
649 unsigned long flags;
650 int ret;
651
652 ch = is_low ? &wcn->dxe_tx_l_ch : &wcn->dxe_tx_h_ch;
653
654 spin_lock_irqsave(&ch->lock, flags);
655 ctl = ch->head_blk_ctl;
656
657 spin_lock(&ctl->next->skb_lock);
658
659
660
661
662
663
664 if (NULL != ctl->next->skb) {
665 ieee80211_stop_queues(wcn->hw);
666 wcn->queues_stopped = true;
667 spin_unlock(&ctl->next->skb_lock);
668 spin_unlock_irqrestore(&ch->lock, flags);
669 return -EBUSY;
670 }
671 spin_unlock(&ctl->next->skb_lock);
672
673 ctl->skb = NULL;
674 desc = ctl->desc;
675
676
677 memcpy(ctl->bd_cpu_addr, bd, sizeof(*bd));
678
679
680 desc->src_addr_l = ctl->bd_phy_addr;
681
682 desc->dst_addr_l = ch->dxe_wq;
683 desc->fr_len = sizeof(struct wcn36xx_tx_bd);
684 desc->ctrl = ch->ctrl_bd;
685
686 wcn36xx_dbg(WCN36XX_DBG_DXE, "DXE TX\n");
687
688 wcn36xx_dbg_dump(WCN36XX_DBG_DXE_DUMP, "DESC1 >>> ",
689 (char *)desc, sizeof(*desc));
690 wcn36xx_dbg_dump(WCN36XX_DBG_DXE_DUMP,
691 "BD >>> ", (char *)ctl->bd_cpu_addr,
692 sizeof(struct wcn36xx_tx_bd));
693
694
695 ctl = ctl->next;
696 ctl->skb = skb;
697 desc = ctl->desc;
698 if (ctl->bd_cpu_addr) {
699 wcn36xx_err("bd_cpu_addr cannot be NULL for skb DXE\n");
700 ret = -EINVAL;
701 goto unlock;
702 }
703
704 desc->src_addr_l = dma_map_single(wcn->dev,
705 ctl->skb->data,
706 ctl->skb->len,
707 DMA_TO_DEVICE);
708
709 desc->dst_addr_l = ch->dxe_wq;
710 desc->fr_len = ctl->skb->len;
711
712
713 desc->ctrl = ch->ctrl_skb;
714
715 wcn36xx_dbg_dump(WCN36XX_DBG_DXE_DUMP, "DESC2 >>> ",
716 (char *)desc, sizeof(*desc));
717 wcn36xx_dbg_dump(WCN36XX_DBG_DXE_DUMP, "SKB >>> ",
718 (char *)ctl->skb->data, ctl->skb->len);
719
720
721 ch->head_blk_ctl = ctl->next;
722
723
724
725
726
727
728 if (is_low && vif_priv->pw_state == WCN36XX_BMPS) {
729 qcom_smem_state_update_bits(wcn->tx_rings_empty_state,
730 WCN36XX_SMSM_WLAN_TX_ENABLE,
731 WCN36XX_SMSM_WLAN_TX_ENABLE);
732 } else {
733
734
735
736 wcn36xx_dxe_write_register(wcn,
737 ch->reg_ctrl, ch->def_ctrl);
738 }
739
740 ret = 0;
741unlock:
742 spin_unlock_irqrestore(&ch->lock, flags);
743 return ret;
744}
745
746int wcn36xx_dxe_init(struct wcn36xx *wcn)
747{
748 int reg_data = 0, ret;
749
750 reg_data = WCN36XX_DXE_REG_RESET;
751 wcn36xx_dxe_write_register(wcn, WCN36XX_DXE_REG_CSR_RESET, reg_data);
752
753
754 reg_data = (WCN36XX_DXE_INT_CH3_MASK | WCN36XX_DXE_INT_CH1_MASK) << 16 |
755 WCN36XX_DXE_INT_CH0_MASK | WCN36XX_DXE_INT_CH4_MASK;
756 if (wcn->is_pronto)
757 wcn36xx_ccu_write_register(wcn, WCN36XX_CCU_DXE_INT_SELECT_PRONTO, reg_data);
758 else
759 wcn36xx_ccu_write_register(wcn, WCN36XX_CCU_DXE_INT_SELECT_RIVA, reg_data);
760
761
762
763
764 ret = wcn36xx_dxe_init_descs(wcn->dev, &wcn->dxe_tx_l_ch);
765 if (ret) {
766 dev_err(wcn->dev, "Error allocating descriptor\n");
767 return ret;
768 }
769 wcn36xx_dxe_init_tx_bd(&wcn->dxe_tx_l_ch, &wcn->data_mem_pool);
770
771
772 wcn36xx_dxe_write_register(wcn, WCN36XX_DXE_CH_NEXT_DESC_ADDR_TX_L,
773 wcn->dxe_tx_l_ch.head_blk_ctl->desc_phy_addr);
774
775
776 wcn36xx_dxe_write_register(wcn,
777 WCN36XX_DXE_CH_DEST_ADDR_TX_L,
778 WCN36XX_DXE_WQ_TX_L);
779
780 wcn36xx_dxe_read_register(wcn, WCN36XX_DXE_REG_CH_EN, ®_data);
781 wcn36xx_dxe_enable_ch_int(wcn, WCN36XX_INT_MASK_CHAN_TX_L);
782
783
784
785
786 ret = wcn36xx_dxe_init_descs(wcn->dev, &wcn->dxe_tx_h_ch);
787 if (ret) {
788 dev_err(wcn->dev, "Error allocating descriptor\n");
789 goto out_err_txh_ch;
790 }
791
792 wcn36xx_dxe_init_tx_bd(&wcn->dxe_tx_h_ch, &wcn->mgmt_mem_pool);
793
794
795 wcn36xx_dxe_write_register(wcn, WCN36XX_DXE_CH_NEXT_DESC_ADDR_TX_H,
796 wcn->dxe_tx_h_ch.head_blk_ctl->desc_phy_addr);
797
798
799 wcn36xx_dxe_write_register(wcn,
800 WCN36XX_DXE_CH_DEST_ADDR_TX_H,
801 WCN36XX_DXE_WQ_TX_H);
802
803 wcn36xx_dxe_read_register(wcn, WCN36XX_DXE_REG_CH_EN, ®_data);
804
805
806 wcn36xx_dxe_enable_ch_int(wcn, WCN36XX_INT_MASK_CHAN_TX_H);
807
808
809
810
811 ret = wcn36xx_dxe_init_descs(wcn->dev, &wcn->dxe_rx_l_ch);
812 if (ret) {
813 dev_err(wcn->dev, "Error allocating descriptor\n");
814 goto out_err_rxl_ch;
815 }
816
817
818
819 wcn36xx_dxe_ch_alloc_skb(wcn, &wcn->dxe_rx_l_ch);
820
821
822 wcn36xx_dxe_write_register(wcn, WCN36XX_DXE_CH_NEXT_DESC_ADDR_RX_L,
823 wcn->dxe_rx_l_ch.head_blk_ctl->desc_phy_addr);
824
825
826 wcn36xx_dxe_write_register(wcn,
827 WCN36XX_DXE_CH_SRC_ADDR_RX_L,
828 WCN36XX_DXE_WQ_RX_L);
829
830
831 wcn36xx_dxe_write_register(wcn,
832 WCN36XX_DXE_CH_DEST_ADDR_RX_L,
833 wcn->dxe_rx_l_ch.head_blk_ctl->desc->phy_next_l);
834
835
836 wcn36xx_dxe_write_register(wcn,
837 WCN36XX_DXE_REG_CTL_RX_L,
838 WCN36XX_DXE_CH_DEFAULT_CTL_RX_L);
839
840
841 wcn36xx_dxe_enable_ch_int(wcn, WCN36XX_INT_MASK_CHAN_RX_L);
842
843
844
845
846 ret = wcn36xx_dxe_init_descs(wcn->dev, &wcn->dxe_rx_h_ch);
847 if (ret) {
848 dev_err(wcn->dev, "Error allocating descriptor\n");
849 goto out_err_rxh_ch;
850 }
851
852
853 wcn36xx_dxe_ch_alloc_skb(wcn, &wcn->dxe_rx_h_ch);
854
855
856 wcn36xx_dxe_write_register(wcn, WCN36XX_DXE_CH_NEXT_DESC_ADDR_RX_H,
857 wcn->dxe_rx_h_ch.head_blk_ctl->desc_phy_addr);
858
859
860 wcn36xx_dxe_write_register(wcn,
861 WCN36XX_DXE_CH_SRC_ADDR_RX_H,
862 WCN36XX_DXE_WQ_RX_H);
863
864
865 wcn36xx_dxe_write_register(wcn,
866 WCN36XX_DXE_CH_DEST_ADDR_RX_H,
867 wcn->dxe_rx_h_ch.head_blk_ctl->desc->phy_next_l);
868
869
870 wcn36xx_dxe_write_register(wcn,
871 WCN36XX_DXE_REG_CTL_RX_H,
872 WCN36XX_DXE_CH_DEFAULT_CTL_RX_H);
873
874
875 wcn36xx_dxe_enable_ch_int(wcn, WCN36XX_INT_MASK_CHAN_RX_H);
876
877 ret = wcn36xx_dxe_request_irqs(wcn);
878 if (ret < 0)
879 goto out_err_irq;
880
881 return 0;
882
883out_err_irq:
884 wcn36xx_dxe_deinit_descs(wcn->dev, &wcn->dxe_rx_h_ch);
885out_err_rxh_ch:
886 wcn36xx_dxe_deinit_descs(wcn->dev, &wcn->dxe_rx_l_ch);
887out_err_rxl_ch:
888 wcn36xx_dxe_deinit_descs(wcn->dev, &wcn->dxe_tx_h_ch);
889out_err_txh_ch:
890 wcn36xx_dxe_deinit_descs(wcn->dev, &wcn->dxe_tx_l_ch);
891
892 return ret;
893}
894
895void wcn36xx_dxe_deinit(struct wcn36xx *wcn)
896{
897 free_irq(wcn->tx_irq, wcn);
898 free_irq(wcn->rx_irq, wcn);
899
900 if (wcn->tx_ack_skb) {
901 ieee80211_tx_status_irqsafe(wcn->hw, wcn->tx_ack_skb);
902 wcn->tx_ack_skb = NULL;
903 }
904
905 wcn36xx_dxe_ch_free_skbs(wcn, &wcn->dxe_rx_l_ch);
906 wcn36xx_dxe_ch_free_skbs(wcn, &wcn->dxe_rx_h_ch);
907}
908
