1 // SPDX-License-Identifier: GPL-2.0+
2 /* Copyright (c) 2018 Quantenna Communications */
4 #include <linux/kernel.h>
5 #include <linux/firmware.h>
7 #include <linux/vmalloc.h>
8 #include <linux/delay.h>
9 #include <linux/interrupt.h>
10 #include <linux/sched.h>
11 #include <linux/completion.h>
12 #include <linux/crc32.h>
13 #include <linux/spinlock.h>
14 #include <linux/circ_buf.h>
15 #include <linux/log2.h>
17 #include "pcie_priv.h"
18 #include "pearl_pcie_regs.h"
19 #include "pearl_pcie_ipc.h"
20 #include "qtn_hw_ids.h"
26 #define PEARL_TX_BD_SIZE_DEFAULT 32
28 struct qtnf_pearl_bda {
31 __le32 bda_pci_endian;
37 u8 bda_boardname[PCIE_BDA_NAMELEN];
38 __le32 bda_rc_msi_enabled;
39 u8 bda_hhbm_list[PCIE_HHBM_MAX_SIZE];
40 __le32 bda_dsbw_start_index;
41 __le32 bda_dsbw_end_index;
42 __le32 bda_dsbw_total_bytes;
43 __le32 bda_rc_tx_bd_base;
44 __le32 bda_rc_tx_bd_num;
45 u8 bda_pcie_mac[QTN_ENET_ADDR_LENGTH];
46 struct qtnf_shm_ipc_region bda_shm_reg1 __aligned(4096); /* host TX */
47 struct qtnf_shm_ipc_region bda_shm_reg2 __aligned(4096); /* host RX */
50 struct qtnf_pearl_tx_bd {
57 struct qtnf_pearl_rx_bd {
66 struct qtnf_pearl_fw_hdr {
75 struct qtnf_pcie_pearl_state {
76 struct qtnf_pcie_bus_priv base;
78 /* lock for irq configuration changes */
81 struct qtnf_pearl_bda __iomem *bda;
82 void __iomem *pcie_reg_base;
84 struct qtnf_pearl_tx_bd *tx_bd_vbase;
85 dma_addr_t tx_bd_pbase;
87 struct qtnf_pearl_rx_bd *rx_bd_vbase;
88 dma_addr_t rx_bd_pbase;
90 dma_addr_t bd_table_paddr;
94 u32 pcie_irq_rx_count;
95 u32 pcie_irq_tx_count;
96 u32 pcie_irq_uf_count;
99 static inline void qtnf_init_hdp_irqs(struct qtnf_pcie_pearl_state *ps)
103 spin_lock_irqsave(&ps->irq_lock, flags);
104 ps->pcie_irq_mask = (PCIE_HDP_INT_RX_BITS | PCIE_HDP_INT_TX_BITS);
105 spin_unlock_irqrestore(&ps->irq_lock, flags);
108 static inline void qtnf_enable_hdp_irqs(struct qtnf_pcie_pearl_state *ps)
112 spin_lock_irqsave(&ps->irq_lock, flags);
113 writel(ps->pcie_irq_mask, PCIE_HDP_INT_EN(ps->pcie_reg_base));
114 spin_unlock_irqrestore(&ps->irq_lock, flags);
117 static inline void qtnf_disable_hdp_irqs(struct qtnf_pcie_pearl_state *ps)
121 spin_lock_irqsave(&ps->irq_lock, flags);
122 writel(0x0, PCIE_HDP_INT_EN(ps->pcie_reg_base));
123 spin_unlock_irqrestore(&ps->irq_lock, flags);
126 static inline void qtnf_en_rxdone_irq(struct qtnf_pcie_pearl_state *ps)
130 spin_lock_irqsave(&ps->irq_lock, flags);
131 ps->pcie_irq_mask |= PCIE_HDP_INT_RX_BITS;
132 writel(ps->pcie_irq_mask, PCIE_HDP_INT_EN(ps->pcie_reg_base));
133 spin_unlock_irqrestore(&ps->irq_lock, flags);
136 static inline void qtnf_dis_rxdone_irq(struct qtnf_pcie_pearl_state *ps)
140 spin_lock_irqsave(&ps->irq_lock, flags);
141 ps->pcie_irq_mask &= ~PCIE_HDP_INT_RX_BITS;
142 writel(ps->pcie_irq_mask, PCIE_HDP_INT_EN(ps->pcie_reg_base));
143 spin_unlock_irqrestore(&ps->irq_lock, flags);
146 static inline void qtnf_en_txdone_irq(struct qtnf_pcie_pearl_state *ps)
150 spin_lock_irqsave(&ps->irq_lock, flags);
151 ps->pcie_irq_mask |= PCIE_HDP_INT_TX_BITS;
152 writel(ps->pcie_irq_mask, PCIE_HDP_INT_EN(ps->pcie_reg_base));
153 spin_unlock_irqrestore(&ps->irq_lock, flags);
156 static inline void qtnf_dis_txdone_irq(struct qtnf_pcie_pearl_state *ps)
160 spin_lock_irqsave(&ps->irq_lock, flags);
161 ps->pcie_irq_mask &= ~PCIE_HDP_INT_TX_BITS;
162 writel(ps->pcie_irq_mask, PCIE_HDP_INT_EN(ps->pcie_reg_base));
163 spin_unlock_irqrestore(&ps->irq_lock, flags);
166 static void qtnf_deassert_intx(struct qtnf_pcie_pearl_state *ps)
168 void __iomem *reg = ps->base.sysctl_bar + PEARL_PCIE_CFG0_OFFSET;
172 cfg &= ~PEARL_ASSERT_INTX;
173 qtnf_non_posted_write(cfg, reg);
176 static void qtnf_pearl_reset_ep(struct qtnf_pcie_pearl_state *ps)
178 const u32 data = QTN_PEARL_IPC_IRQ_WORD(QTN_PEARL_LHOST_EP_RESET);
179 void __iomem *reg = ps->base.sysctl_bar +
180 QTN_PEARL_SYSCTL_LHOST_IRQ_OFFSET;
182 qtnf_non_posted_write(data, reg);
183 msleep(QTN_EP_RESET_WAIT_MS);
184 pci_restore_state(ps->base.pdev);
187 static void qtnf_pcie_pearl_ipc_gen_ep_int(void *arg)
189 const struct qtnf_pcie_pearl_state *ps = arg;
190 const u32 data = QTN_PEARL_IPC_IRQ_WORD(QTN_PEARL_LHOST_IPC_IRQ);
191 void __iomem *reg = ps->base.sysctl_bar +
192 QTN_PEARL_SYSCTL_LHOST_IRQ_OFFSET;
194 qtnf_non_posted_write(data, reg);
197 static int qtnf_is_state(__le32 __iomem *reg, u32 state)
204 static void qtnf_set_state(__le32 __iomem *reg, u32 state)
208 qtnf_non_posted_write(state | s, reg);
211 static void qtnf_clear_state(__le32 __iomem *reg, u32 state)
215 qtnf_non_posted_write(s & ~state, reg);
218 static int qtnf_poll_state(__le32 __iomem *reg, u32 state, u32 delay_in_ms)
222 while ((qtnf_is_state(reg, state) == 0)) {
223 usleep_range(1000, 1200);
224 if (++timeout > delay_in_ms)
231 static int pearl_alloc_bd_table(struct qtnf_pcie_pearl_state *ps)
233 struct qtnf_pcie_bus_priv *priv = &ps->base;
238 len = priv->tx_bd_num * sizeof(struct qtnf_pearl_tx_bd) +
239 priv->rx_bd_num * sizeof(struct qtnf_pearl_rx_bd);
241 vaddr = dmam_alloc_coherent(&priv->pdev->dev, len, &paddr, GFP_KERNEL);
247 memset(vaddr, 0, len);
249 ps->bd_table_vaddr = vaddr;
250 ps->bd_table_paddr = paddr;
251 ps->bd_table_len = len;
253 ps->tx_bd_vbase = vaddr;
254 ps->tx_bd_pbase = paddr;
256 pr_debug("TX descriptor table: vaddr=0x%p paddr=%pad\n", vaddr, &paddr);
258 priv->tx_bd_r_index = 0;
259 priv->tx_bd_w_index = 0;
263 vaddr = ((struct qtnf_pearl_tx_bd *)vaddr) + priv->tx_bd_num;
264 paddr += priv->tx_bd_num * sizeof(struct qtnf_pearl_tx_bd);
266 ps->rx_bd_vbase = vaddr;
267 ps->rx_bd_pbase = paddr;
269 #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
270 writel(QTN_HOST_HI32(paddr),
271 PCIE_HDP_TX_HOST_Q_BASE_H(ps->pcie_reg_base));
273 writel(QTN_HOST_LO32(paddr),
274 PCIE_HDP_TX_HOST_Q_BASE_L(ps->pcie_reg_base));
275 writel(priv->rx_bd_num | (sizeof(struct qtnf_pearl_rx_bd)) << 16,
276 PCIE_HDP_TX_HOST_Q_SZ_CTRL(ps->pcie_reg_base));
278 pr_debug("RX descriptor table: vaddr=0x%p paddr=%pad\n", vaddr, &paddr);
283 static int pearl_skb2rbd_attach(struct qtnf_pcie_pearl_state *ps, u16 index)
285 struct qtnf_pcie_bus_priv *priv = &ps->base;
286 struct qtnf_pearl_rx_bd *rxbd;
290 skb = __netdev_alloc_skb_ip_align(NULL, SKB_BUF_SIZE, GFP_ATOMIC);
292 priv->rx_skb[index] = NULL;
296 priv->rx_skb[index] = skb;
297 rxbd = &ps->rx_bd_vbase[index];
299 paddr = pci_map_single(priv->pdev, skb->data,
300 SKB_BUF_SIZE, PCI_DMA_FROMDEVICE);
301 if (pci_dma_mapping_error(priv->pdev, paddr)) {
302 pr_err("skb DMA mapping error: %pad\n", &paddr);
306 /* keep rx skb paddrs in rx buffer descriptors for cleanup purposes */
307 rxbd->addr = cpu_to_le32(QTN_HOST_LO32(paddr));
308 rxbd->addr_h = cpu_to_le32(QTN_HOST_HI32(paddr));
311 priv->rx_bd_w_index = index;
313 /* sync up all descriptor updates */
316 #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
317 writel(QTN_HOST_HI32(paddr),
318 PCIE_HDP_HHBM_BUF_PTR_H(ps->pcie_reg_base));
320 writel(QTN_HOST_LO32(paddr),
321 PCIE_HDP_HHBM_BUF_PTR(ps->pcie_reg_base));
323 writel(index, PCIE_HDP_TX_HOST_Q_WR_PTR(ps->pcie_reg_base));
327 static int pearl_alloc_rx_buffers(struct qtnf_pcie_pearl_state *ps)
332 memset(ps->rx_bd_vbase, 0x0,
333 ps->base.rx_bd_num * sizeof(struct qtnf_pearl_rx_bd));
335 for (i = 0; i < ps->base.rx_bd_num; i++) {
336 ret = pearl_skb2rbd_attach(ps, i);
344 /* all rx/tx activity should have ceased before calling this function */
345 static void qtnf_pearl_free_xfer_buffers(struct qtnf_pcie_pearl_state *ps)
347 struct qtnf_pcie_bus_priv *priv = &ps->base;
348 struct qtnf_pearl_tx_bd *txbd;
349 struct qtnf_pearl_rx_bd *rxbd;
354 /* free rx buffers */
355 for (i = 0; i < priv->rx_bd_num; i++) {
356 if (priv->rx_skb && priv->rx_skb[i]) {
357 rxbd = &ps->rx_bd_vbase[i];
358 skb = priv->rx_skb[i];
359 paddr = QTN_HOST_ADDR(le32_to_cpu(rxbd->addr_h),
360 le32_to_cpu(rxbd->addr));
361 pci_unmap_single(priv->pdev, paddr, SKB_BUF_SIZE,
363 dev_kfree_skb_any(skb);
364 priv->rx_skb[i] = NULL;
368 /* free tx buffers */
369 for (i = 0; i < priv->tx_bd_num; i++) {
370 if (priv->tx_skb && priv->tx_skb[i]) {
371 txbd = &ps->tx_bd_vbase[i];
372 skb = priv->tx_skb[i];
373 paddr = QTN_HOST_ADDR(le32_to_cpu(txbd->addr_h),
374 le32_to_cpu(txbd->addr));
375 pci_unmap_single(priv->pdev, paddr, skb->len,
377 dev_kfree_skb_any(skb);
378 priv->tx_skb[i] = NULL;
383 static int pearl_hhbm_init(struct qtnf_pcie_pearl_state *ps)
387 val = readl(PCIE_HHBM_CONFIG(ps->pcie_reg_base));
388 val |= HHBM_CONFIG_SOFT_RESET;
389 writel(val, PCIE_HHBM_CONFIG(ps->pcie_reg_base));
390 usleep_range(50, 100);
391 val &= ~HHBM_CONFIG_SOFT_RESET;
392 #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
395 writel(val, PCIE_HHBM_CONFIG(ps->pcie_reg_base));
396 writel(ps->base.rx_bd_num, PCIE_HHBM_Q_LIMIT_REG(ps->pcie_reg_base));
401 static int qtnf_pcie_pearl_init_xfer(struct qtnf_pcie_pearl_state *ps,
402 unsigned int tx_bd_size)
404 struct qtnf_pcie_bus_priv *priv = &ps->base;
409 tx_bd_size = PEARL_TX_BD_SIZE_DEFAULT;
411 val = tx_bd_size * sizeof(struct qtnf_pearl_tx_bd);
413 if (!is_power_of_2(tx_bd_size) || val > PCIE_HHBM_MAX_SIZE) {
414 pr_warn("bad tx_bd_size value %u\n", tx_bd_size);
415 priv->tx_bd_num = PEARL_TX_BD_SIZE_DEFAULT;
417 priv->tx_bd_num = tx_bd_size;
420 priv->rx_bd_w_index = 0;
421 priv->rx_bd_r_index = 0;
423 if (!priv->rx_bd_num || !is_power_of_2(priv->rx_bd_num)) {
424 pr_err("rx_bd_size_param %u is not power of two\n",
429 val = priv->rx_bd_num * sizeof(dma_addr_t);
430 if (val > PCIE_HHBM_MAX_SIZE) {
431 pr_err("rx_bd_size_param %u is too large\n",
436 ret = pearl_hhbm_init(ps);
438 pr_err("failed to init h/w queues\n");
442 ret = qtnf_pcie_alloc_skb_array(priv);
444 pr_err("failed to allocate skb array\n");
448 ret = pearl_alloc_bd_table(ps);
450 pr_err("failed to allocate bd table\n");
454 ret = pearl_alloc_rx_buffers(ps);
456 pr_err("failed to allocate rx buffers\n");
463 static void qtnf_pearl_data_tx_reclaim(struct qtnf_pcie_pearl_state *ps)
465 struct qtnf_pcie_bus_priv *priv = &ps->base;
466 struct qtnf_pearl_tx_bd *txbd;
474 spin_lock_irqsave(&priv->tx_reclaim_lock, flags);
476 tx_done_index = readl(PCIE_HDP_RX0DMA_CNT(ps->pcie_reg_base))
477 & (priv->tx_bd_num - 1);
479 i = priv->tx_bd_r_index;
481 while (CIRC_CNT(tx_done_index, i, priv->tx_bd_num)) {
482 skb = priv->tx_skb[i];
484 txbd = &ps->tx_bd_vbase[i];
485 paddr = QTN_HOST_ADDR(le32_to_cpu(txbd->addr_h),
486 le32_to_cpu(txbd->addr));
487 pci_unmap_single(priv->pdev, paddr, skb->len,
491 qtnf_update_tx_stats(skb->dev, skb);
492 if (unlikely(priv->tx_stopped)) {
493 qtnf_wake_all_queues(skb->dev);
494 priv->tx_stopped = 0;
498 dev_kfree_skb_any(skb);
501 priv->tx_skb[i] = NULL;
504 if (++i >= priv->tx_bd_num)
508 priv->tx_reclaim_done += count;
509 priv->tx_reclaim_req++;
510 priv->tx_bd_r_index = i;
512 spin_unlock_irqrestore(&priv->tx_reclaim_lock, flags);
515 static int qtnf_tx_queue_ready(struct qtnf_pcie_pearl_state *ps)
517 struct qtnf_pcie_bus_priv *priv = &ps->base;
519 if (!CIRC_SPACE(priv->tx_bd_w_index, priv->tx_bd_r_index,
521 qtnf_pearl_data_tx_reclaim(ps);
523 if (!CIRC_SPACE(priv->tx_bd_w_index, priv->tx_bd_r_index,
525 pr_warn_ratelimited("reclaim full Tx queue\n");
526 priv->tx_full_count++;
534 static int qtnf_pcie_data_tx(struct qtnf_bus *bus, struct sk_buff *skb)
536 struct qtnf_pcie_pearl_state *ps = get_bus_priv(bus);
537 struct qtnf_pcie_bus_priv *priv = &ps->base;
538 dma_addr_t txbd_paddr, skb_paddr;
539 struct qtnf_pearl_tx_bd *txbd;
545 spin_lock_irqsave(&priv->tx_lock, flags);
547 if (!qtnf_tx_queue_ready(ps)) {
549 netif_tx_stop_all_queues(skb->dev);
550 priv->tx_stopped = 1;
553 spin_unlock_irqrestore(&priv->tx_lock, flags);
554 return NETDEV_TX_BUSY;
557 i = priv->tx_bd_w_index;
558 priv->tx_skb[i] = skb;
561 skb_paddr = pci_map_single(priv->pdev, skb->data,
562 skb->len, PCI_DMA_TODEVICE);
563 if (pci_dma_mapping_error(priv->pdev, skb_paddr)) {
564 pr_err("skb DMA mapping error: %pad\n", &skb_paddr);
569 txbd = &ps->tx_bd_vbase[i];
570 txbd->addr = cpu_to_le32(QTN_HOST_LO32(skb_paddr));
571 txbd->addr_h = cpu_to_le32(QTN_HOST_HI32(skb_paddr));
573 info = (len & QTN_PCIE_TX_DESC_LEN_MASK) << QTN_PCIE_TX_DESC_LEN_SHIFT;
574 txbd->info = cpu_to_le32(info);
576 /* sync up all descriptor updates before passing them to EP */
579 /* write new TX descriptor to PCIE_RX_FIFO on EP */
580 txbd_paddr = ps->tx_bd_pbase + i * sizeof(struct qtnf_pearl_tx_bd);
582 #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
583 writel(QTN_HOST_HI32(txbd_paddr),
584 PCIE_HDP_HOST_WR_DESC0_H(ps->pcie_reg_base));
586 writel(QTN_HOST_LO32(txbd_paddr),
587 PCIE_HDP_HOST_WR_DESC0(ps->pcie_reg_base));
589 if (++i >= priv->tx_bd_num)
592 priv->tx_bd_w_index = i;
596 pr_err_ratelimited("drop skb\n");
598 skb->dev->stats.tx_dropped++;
599 dev_kfree_skb_any(skb);
602 priv->tx_done_count++;
603 spin_unlock_irqrestore(&priv->tx_lock, flags);
605 qtnf_pearl_data_tx_reclaim(ps);
610 static irqreturn_t qtnf_pcie_pearl_interrupt(int irq, void *data)
612 struct qtnf_bus *bus = (struct qtnf_bus *)data;
613 struct qtnf_pcie_pearl_state *ps = get_bus_priv(bus);
614 struct qtnf_pcie_bus_priv *priv = &ps->base;
617 priv->pcie_irq_count++;
618 status = readl(PCIE_HDP_INT_STATUS(ps->pcie_reg_base));
620 qtnf_shm_ipc_irq_handler(&priv->shm_ipc_ep_in);
621 qtnf_shm_ipc_irq_handler(&priv->shm_ipc_ep_out);
623 if (!(status & ps->pcie_irq_mask))
626 if (status & PCIE_HDP_INT_RX_BITS)
627 ps->pcie_irq_rx_count++;
629 if (status & PCIE_HDP_INT_TX_BITS)
630 ps->pcie_irq_tx_count++;
632 if (status & PCIE_HDP_INT_HHBM_UF)
633 ps->pcie_irq_uf_count++;
635 if (status & PCIE_HDP_INT_RX_BITS) {
636 qtnf_dis_rxdone_irq(ps);
637 napi_schedule(&bus->mux_napi);
640 if (status & PCIE_HDP_INT_TX_BITS) {
641 qtnf_dis_txdone_irq(ps);
642 tasklet_hi_schedule(&priv->reclaim_tq);
646 /* H/W workaround: clean all bits, not only enabled */
647 qtnf_non_posted_write(~0U, PCIE_HDP_INT_STATUS(ps->pcie_reg_base));
649 if (!priv->msi_enabled)
650 qtnf_deassert_intx(ps);
655 static int qtnf_rx_data_ready(struct qtnf_pcie_pearl_state *ps)
657 u16 index = ps->base.rx_bd_r_index;
658 struct qtnf_pearl_rx_bd *rxbd;
661 rxbd = &ps->rx_bd_vbase[index];
662 descw = le32_to_cpu(rxbd->info);
664 if (descw & QTN_TXDONE_MASK)
670 static int qtnf_pcie_pearl_rx_poll(struct napi_struct *napi, int budget)
672 struct qtnf_bus *bus = container_of(napi, struct qtnf_bus, mux_napi);
673 struct qtnf_pcie_pearl_state *ps = get_bus_priv(bus);
674 struct qtnf_pcie_bus_priv *priv = &ps->base;
675 struct net_device *ndev = NULL;
676 struct sk_buff *skb = NULL;
678 struct qtnf_pearl_rx_bd *rxbd;
679 dma_addr_t skb_paddr;
687 while (processed < budget) {
688 if (!qtnf_rx_data_ready(ps))
691 r_idx = priv->rx_bd_r_index;
692 rxbd = &ps->rx_bd_vbase[r_idx];
693 descw = le32_to_cpu(rxbd->info);
695 skb = priv->rx_skb[r_idx];
696 psize = QTN_GET_LEN(descw);
699 if (!(descw & QTN_TXDONE_MASK)) {
700 pr_warn("skip invalid rxbd[%d]\n", r_idx);
705 pr_warn("skip missing rx_skb[%d]\n", r_idx);
709 if (skb && (skb_tailroom(skb) < psize)) {
710 pr_err("skip packet with invalid length: %u > %u\n",
711 psize, skb_tailroom(skb));
716 skb_paddr = QTN_HOST_ADDR(le32_to_cpu(rxbd->addr_h),
717 le32_to_cpu(rxbd->addr));
718 pci_unmap_single(priv->pdev, skb_paddr, SKB_BUF_SIZE,
724 ndev = qtnf_classify_skb(bus, skb);
726 qtnf_update_rx_stats(ndev, skb);
727 skb->protocol = eth_type_trans(skb, ndev);
728 napi_gro_receive(napi, skb);
730 pr_debug("drop untagged skb\n");
731 bus->mux_dev.stats.rx_dropped++;
732 dev_kfree_skb_any(skb);
736 bus->mux_dev.stats.rx_dropped++;
737 dev_kfree_skb_any(skb);
741 priv->rx_skb[r_idx] = NULL;
742 if (++r_idx >= priv->rx_bd_num)
745 priv->rx_bd_r_index = r_idx;
747 /* repalce processed buffer by a new one */
748 w_idx = priv->rx_bd_w_index;
749 while (CIRC_SPACE(priv->rx_bd_w_index, priv->rx_bd_r_index,
750 priv->rx_bd_num) > 0) {
751 if (++w_idx >= priv->rx_bd_num)
754 ret = pearl_skb2rbd_attach(ps, w_idx);
756 pr_err("failed to allocate new rx_skb[%d]\n",
766 if (processed < budget) {
768 qtnf_en_rxdone_irq(ps);
775 qtnf_pcie_data_tx_timeout(struct qtnf_bus *bus, struct net_device *ndev)
777 struct qtnf_pcie_pearl_state *ps = (void *)get_bus_priv(bus);
779 tasklet_hi_schedule(&ps->base.reclaim_tq);
782 static void qtnf_pcie_data_rx_start(struct qtnf_bus *bus)
784 struct qtnf_pcie_pearl_state *ps = (void *)get_bus_priv(bus);
786 qtnf_enable_hdp_irqs(ps);
787 napi_enable(&bus->mux_napi);
790 static void qtnf_pcie_data_rx_stop(struct qtnf_bus *bus)
792 struct qtnf_pcie_pearl_state *ps = (void *)get_bus_priv(bus);
794 napi_disable(&bus->mux_napi);
795 qtnf_disable_hdp_irqs(ps);
798 static const struct qtnf_bus_ops qtnf_pcie_pearl_bus_ops = {
799 /* control path methods */
800 .control_tx = qtnf_pcie_control_tx,
802 /* data path methods */
803 .data_tx = qtnf_pcie_data_tx,
804 .data_tx_timeout = qtnf_pcie_data_tx_timeout,
805 .data_rx_start = qtnf_pcie_data_rx_start,
806 .data_rx_stop = qtnf_pcie_data_rx_stop,
809 static int qtnf_dbg_irq_stats(struct seq_file *s, void *data)
811 struct qtnf_bus *bus = dev_get_drvdata(s->private);
812 struct qtnf_pcie_pearl_state *ps = get_bus_priv(bus);
813 u32 reg = readl(PCIE_HDP_INT_EN(ps->pcie_reg_base));
816 seq_printf(s, "pcie_irq_count(%u)\n", ps->base.pcie_irq_count);
817 seq_printf(s, "pcie_irq_tx_count(%u)\n", ps->pcie_irq_tx_count);
818 status = reg & PCIE_HDP_INT_TX_BITS;
819 seq_printf(s, "pcie_irq_tx_status(%s)\n",
820 (status == PCIE_HDP_INT_TX_BITS) ? "EN" : "DIS");
821 seq_printf(s, "pcie_irq_rx_count(%u)\n", ps->pcie_irq_rx_count);
822 status = reg & PCIE_HDP_INT_RX_BITS;
823 seq_printf(s, "pcie_irq_rx_status(%s)\n",
824 (status == PCIE_HDP_INT_RX_BITS) ? "EN" : "DIS");
825 seq_printf(s, "pcie_irq_uf_count(%u)\n", ps->pcie_irq_uf_count);
826 status = reg & PCIE_HDP_INT_HHBM_UF;
827 seq_printf(s, "pcie_irq_hhbm_uf_status(%s)\n",
828 (status == PCIE_HDP_INT_HHBM_UF) ? "EN" : "DIS");
833 static int qtnf_dbg_hdp_stats(struct seq_file *s, void *data)
835 struct qtnf_bus *bus = dev_get_drvdata(s->private);
836 struct qtnf_pcie_pearl_state *ps = get_bus_priv(bus);
837 struct qtnf_pcie_bus_priv *priv = &ps->base;
839 seq_printf(s, "tx_full_count(%u)\n", priv->tx_full_count);
840 seq_printf(s, "tx_done_count(%u)\n", priv->tx_done_count);
841 seq_printf(s, "tx_reclaim_done(%u)\n", priv->tx_reclaim_done);
842 seq_printf(s, "tx_reclaim_req(%u)\n", priv->tx_reclaim_req);
844 seq_printf(s, "tx_bd_r_index(%u)\n", priv->tx_bd_r_index);
845 seq_printf(s, "tx_bd_p_index(%u)\n",
846 readl(PCIE_HDP_RX0DMA_CNT(ps->pcie_reg_base))
847 & (priv->tx_bd_num - 1));
848 seq_printf(s, "tx_bd_w_index(%u)\n", priv->tx_bd_w_index);
849 seq_printf(s, "tx queue len(%u)\n",
850 CIRC_CNT(priv->tx_bd_w_index, priv->tx_bd_r_index,
853 seq_printf(s, "rx_bd_r_index(%u)\n", priv->rx_bd_r_index);
854 seq_printf(s, "rx_bd_p_index(%u)\n",
855 readl(PCIE_HDP_TX0DMA_CNT(ps->pcie_reg_base))
856 & (priv->rx_bd_num - 1));
857 seq_printf(s, "rx_bd_w_index(%u)\n", priv->rx_bd_w_index);
858 seq_printf(s, "rx alloc queue len(%u)\n",
859 CIRC_SPACE(priv->rx_bd_w_index, priv->rx_bd_r_index,
865 static int qtnf_ep_fw_send(struct pci_dev *pdev, uint32_t size,
866 int blk, const u8 *pblk, const u8 *fw)
868 struct qtnf_bus *bus = pci_get_drvdata(pdev);
870 struct qtnf_pearl_fw_hdr *hdr;
873 int hds = sizeof(*hdr);
874 struct sk_buff *skb = NULL;
878 skb = __dev_alloc_skb(QTN_PCIE_FW_BUFSZ, GFP_KERNEL);
882 skb->len = QTN_PCIE_FW_BUFSZ;
885 hdr = (struct qtnf_pearl_fw_hdr *)skb->data;
886 memcpy(hdr->boardflg, QTN_PCIE_BOARDFLG, strlen(QTN_PCIE_BOARDFLG));
887 hdr->fwsize = cpu_to_le32(size);
888 hdr->seqnum = cpu_to_le32(blk);
891 hdr->type = cpu_to_le32(QTN_FW_DSUB);
893 hdr->type = cpu_to_le32(QTN_FW_DBEGIN);
895 pdata = skb->data + hds;
897 len = QTN_PCIE_FW_BUFSZ - hds;
898 if (pblk >= (fw + size - len)) {
899 len = fw + size - pblk;
900 hdr->type = cpu_to_le32(QTN_FW_DEND);
903 hdr->pktlen = cpu_to_le32(len);
904 memcpy(pdata, pblk, len);
905 hdr->crc = cpu_to_le32(~crc32(0, pdata, len));
907 ret = qtnf_pcie_data_tx(bus, skb);
909 return (ret == NETDEV_TX_OK) ? len : 0;
913 qtnf_ep_fw_load(struct qtnf_pcie_pearl_state *ps, const u8 *fw, u32 fw_size)
915 int blk_size = QTN_PCIE_FW_BUFSZ - sizeof(struct qtnf_pearl_fw_hdr);
916 int blk_count = fw_size / blk_size + ((fw_size % blk_size) ? 1 : 0);
922 pr_debug("FW upload started: fw_addr=0x%p size=%d\n", fw, fw_size);
924 while (blk < blk_count) {
925 if (++threshold > 10000) {
926 pr_err("FW upload failed: too many retries\n");
930 len = qtnf_ep_fw_send(ps->base.pdev, fw_size, blk, pblk, fw);
934 if (!((blk + 1) & QTN_PCIE_FW_DLMASK) ||
935 (blk == (blk_count - 1))) {
936 qtnf_set_state(&ps->bda->bda_rc_state,
938 if (qtnf_poll_state(&ps->bda->bda_ep_state,
940 QTN_FW_DL_TIMEOUT_MS)) {
941 pr_err("FW upload failed: SYNC timed out\n");
945 qtnf_clear_state(&ps->bda->bda_ep_state,
948 if (qtnf_is_state(&ps->bda->bda_ep_state,
950 if (blk == (blk_count - 1)) {
952 blk_count & QTN_PCIE_FW_DLMASK;
954 pblk -= ((last_round - 1) *
957 blk -= QTN_PCIE_FW_DLMASK;
958 pblk -= QTN_PCIE_FW_DLMASK * blk_size;
961 qtnf_clear_state(&ps->bda->bda_ep_state,
964 pr_warn("FW upload retry: block #%d\n", blk);
968 qtnf_pearl_data_tx_reclaim(ps);
975 pr_debug("FW upload completed: totally sent %d blocks\n", blk);
979 static void qtnf_pearl_fw_work_handler(struct work_struct *work)
981 struct qtnf_bus *bus = container_of(work, struct qtnf_bus, fw_work);
982 struct qtnf_pcie_pearl_state *ps = (void *)get_bus_priv(bus);
983 struct pci_dev *pdev = ps->base.pdev;
984 const struct firmware *fw;
986 u32 state = QTN_RC_FW_LOADRDY | QTN_RC_FW_QLINK;
987 const char *fwname = QTN_PCI_PEARL_FW_NAME;
988 bool fw_boot_success = false;
990 if (ps->base.flashboot) {
991 state |= QTN_RC_FW_FLASHBOOT;
993 ret = request_firmware(&fw, fwname, &pdev->dev);
995 pr_err("failed to get firmware %s\n", fwname);
1000 qtnf_set_state(&ps->bda->bda_rc_state, state);
1002 if (qtnf_poll_state(&ps->bda->bda_ep_state, QTN_EP_FW_LOADRDY,
1003 QTN_FW_DL_TIMEOUT_MS)) {
1004 pr_err("card is not ready\n");
1006 if (!ps->base.flashboot)
1007 release_firmware(fw);
1012 qtnf_clear_state(&ps->bda->bda_ep_state, QTN_EP_FW_LOADRDY);
1014 if (ps->base.flashboot) {
1015 pr_info("booting firmware from flash\n");
1018 pr_info("starting firmware upload: %s\n", fwname);
1020 ret = qtnf_ep_fw_load(ps, fw->data, fw->size);
1021 release_firmware(fw);
1023 pr_err("firmware upload error\n");
1028 if (qtnf_poll_state(&ps->bda->bda_ep_state, QTN_EP_FW_DONE,
1029 QTN_FW_DL_TIMEOUT_MS)) {
1030 pr_err("firmware bringup timed out\n");
1034 pr_info("firmware is up and running\n");
1036 if (qtnf_poll_state(&ps->bda->bda_ep_state,
1037 QTN_EP_FW_QLINK_DONE, QTN_FW_QLINK_TIMEOUT_MS)) {
1038 pr_err("firmware runtime failure\n");
1042 fw_boot_success = true;
1045 qtnf_pcie_fw_boot_done(bus, fw_boot_success);
1047 if (fw_boot_success) {
1048 qtnf_debugfs_add_entry(bus, "hdp_stats", qtnf_dbg_hdp_stats);
1049 qtnf_debugfs_add_entry(bus, "irq_stats", qtnf_dbg_irq_stats);
1053 static void qtnf_pearl_reclaim_tasklet_fn(unsigned long data)
1055 struct qtnf_pcie_pearl_state *ps = (void *)data;
1057 qtnf_pearl_data_tx_reclaim(ps);
1058 qtnf_en_txdone_irq(ps);
1061 static u64 qtnf_pearl_dma_mask_get(void)
1063 #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
1064 return DMA_BIT_MASK(64);
1066 return DMA_BIT_MASK(32);
1070 static int qtnf_pcie_pearl_probe(struct qtnf_bus *bus, unsigned int tx_bd_size)
1072 struct qtnf_shm_ipc_int ipc_int;
1073 struct qtnf_pcie_pearl_state *ps = get_bus_priv(bus);
1074 struct pci_dev *pdev = ps->base.pdev;
1077 bus->bus_ops = &qtnf_pcie_pearl_bus_ops;
1078 spin_lock_init(&ps->irq_lock);
1079 INIT_WORK(&bus->fw_work, qtnf_pearl_fw_work_handler);
1081 ps->pcie_reg_base = ps->base.dmareg_bar;
1082 ps->bda = ps->base.epmem_bar;
1083 writel(ps->base.msi_enabled, &ps->bda->bda_rc_msi_enabled);
1085 ret = qtnf_pcie_pearl_init_xfer(ps, tx_bd_size);
1087 pr_err("PCIE xfer init failed\n");
1091 /* init default irq settings */
1092 qtnf_init_hdp_irqs(ps);
1094 /* start with disabled irqs */
1095 qtnf_disable_hdp_irqs(ps);
1097 ret = devm_request_irq(&pdev->dev, pdev->irq,
1098 &qtnf_pcie_pearl_interrupt, 0,
1099 "qtnf_pearl_irq", (void *)bus);
1101 pr_err("failed to request pcie irq %d\n", pdev->irq);
1102 qtnf_pearl_free_xfer_buffers(ps);
1106 tasklet_init(&ps->base.reclaim_tq, qtnf_pearl_reclaim_tasklet_fn,
1108 netif_napi_add(&bus->mux_dev, &bus->mux_napi,
1109 qtnf_pcie_pearl_rx_poll, 10);
1111 ipc_int.fn = qtnf_pcie_pearl_ipc_gen_ep_int;
1113 qtnf_pcie_init_shm_ipc(&ps->base, &ps->bda->bda_shm_reg1,
1114 &ps->bda->bda_shm_reg2, &ipc_int);
1119 static void qtnf_pcie_pearl_remove(struct qtnf_bus *bus)
1121 struct qtnf_pcie_pearl_state *ps = get_bus_priv(bus);
1123 qtnf_pearl_reset_ep(ps);
1124 qtnf_pearl_free_xfer_buffers(ps);
1127 #ifdef CONFIG_PM_SLEEP
1128 static int qtnf_pcie_pearl_suspend(struct qtnf_bus *bus)
1133 static int qtnf_pcie_pearl_resume(struct qtnf_bus *bus)
1139 struct qtnf_bus *qtnf_pcie_pearl_alloc(struct pci_dev *pdev)
1141 struct qtnf_bus *bus;
1142 struct qtnf_pcie_pearl_state *ps;
1144 bus = devm_kzalloc(&pdev->dev, sizeof(*bus) + sizeof(*ps), GFP_KERNEL);
1148 ps = get_bus_priv(bus);
1149 ps->base.probe_cb = qtnf_pcie_pearl_probe;
1150 ps->base.remove_cb = qtnf_pcie_pearl_remove;
1151 ps->base.dma_mask_get_cb = qtnf_pearl_dma_mask_get;
1152 #ifdef CONFIG_PM_SLEEP
1153 ps->base.resume_cb = qtnf_pcie_pearl_resume;
1154 ps->base.suspend_cb = qtnf_pcie_pearl_suspend;