net/nfp: fix internal port addressing
[dpdk.git] / drivers / net / octeontx_ep / otx2_ep_vf.c
index 6368ddc..64cd873 100644 (file)
@@ -71,6 +71,221 @@ otx2_vf_setup_device_regs(struct otx_ep_device *otx_ep)
        otx2_vf_setup_global_output_regs(otx_ep);
 }
 
+static void
+otx2_vf_setup_iq_regs(struct otx_ep_device *otx_ep, uint32_t iq_no)
+{
+       struct otx_ep_instr_queue *iq = otx_ep->instr_queue[iq_no];
+       volatile uint64_t reg_val = 0ull;
+
+       reg_val = otx2_read64(otx_ep->hw_addr + SDP_VF_R_IN_CONTROL(iq_no));
+
+       /* Wait till IDLE to set to 1, not supposed to configure BADDR
+        * as long as IDLE is 0
+        */
+       if (!(reg_val & SDP_VF_R_IN_CTL_IDLE)) {
+               do {
+                       reg_val = otx2_read64(otx_ep->hw_addr +
+                                             SDP_VF_R_IN_CONTROL(iq_no));
+               } while (!(reg_val & SDP_VF_R_IN_CTL_IDLE));
+       }
+
+       /* Write the start of the input queue's ring and its size  */
+       otx2_write64(iq->base_addr_dma, otx_ep->hw_addr +
+                    SDP_VF_R_IN_INSTR_BADDR(iq_no));
+       otx2_write64(iq->nb_desc, otx_ep->hw_addr +
+                    SDP_VF_R_IN_INSTR_RSIZE(iq_no));
+
+       /* Remember the doorbell & instruction count register addr
+        * for this queue
+        */
+       iq->doorbell_reg = (uint8_t *)otx_ep->hw_addr +
+                          SDP_VF_R_IN_INSTR_DBELL(iq_no);
+       iq->inst_cnt_reg = (uint8_t *)otx_ep->hw_addr +
+                          SDP_VF_R_IN_CNTS(iq_no);
+
+       otx_ep_dbg("InstQ[%d]:dbell reg @ 0x%p instcnt_reg @ 0x%p",
+                  iq_no, iq->doorbell_reg, iq->inst_cnt_reg);
+
+       do {
+               reg_val = rte_read32(iq->inst_cnt_reg);
+               rte_write32(reg_val, iq->inst_cnt_reg);
+       } while (reg_val != 0);
+
+       /* IN INTR_THRESHOLD is set to max(FFFFFFFF) which disable the IN INTR
+        * to raise
+        */
+       otx2_write64(OTX_EP_CLEAR_SDP_IN_INT_LVLS,
+                    otx_ep->hw_addr + SDP_VF_R_IN_INT_LEVELS(iq_no));
+}
+
+static void
+otx2_vf_setup_oq_regs(struct otx_ep_device *otx_ep, uint32_t oq_no)
+{
+       volatile uint64_t reg_val = 0ull;
+       uint64_t oq_ctl = 0ull;
+       struct otx_ep_droq *droq = otx_ep->droq[oq_no];
+
+       /* Wait on IDLE to set to 1, supposed to configure BADDR
+        * as log as IDLE is 0
+        */
+       reg_val = otx2_read64(otx_ep->hw_addr + SDP_VF_R_OUT_CONTROL(oq_no));
+
+       while (!(reg_val & SDP_VF_R_OUT_CTL_IDLE)) {
+               reg_val = otx2_read64(otx_ep->hw_addr +
+                                     SDP_VF_R_OUT_CONTROL(oq_no));
+       }
+
+       otx2_write64(droq->desc_ring_dma, otx_ep->hw_addr +
+                    SDP_VF_R_OUT_SLIST_BADDR(oq_no));
+       otx2_write64(droq->nb_desc, otx_ep->hw_addr +
+                    SDP_VF_R_OUT_SLIST_RSIZE(oq_no));
+
+       oq_ctl = otx2_read64(otx_ep->hw_addr + SDP_VF_R_OUT_CONTROL(oq_no));
+
+       /* Clear the ISIZE and BSIZE (22-0) */
+       oq_ctl &= ~(OTX_EP_CLEAR_ISIZE_BSIZE);
+
+       /* Populate the BSIZE (15-0) */
+       oq_ctl |= (droq->buffer_size & OTX_EP_DROQ_BUFSZ_MASK);
+
+       otx2_write64(oq_ctl, otx_ep->hw_addr + SDP_VF_R_OUT_CONTROL(oq_no));
+
+       /* Mapped address of the pkt_sent and pkts_credit regs */
+       droq->pkts_sent_reg = (uint8_t *)otx_ep->hw_addr +
+                             SDP_VF_R_OUT_CNTS(oq_no);
+       droq->pkts_credit_reg = (uint8_t *)otx_ep->hw_addr +
+                               SDP_VF_R_OUT_SLIST_DBELL(oq_no);
+
+       rte_write64(OTX_EP_CLEAR_OUT_INT_LVLS,
+                   otx_ep->hw_addr + SDP_VF_R_OUT_INT_LEVELS(oq_no));
+
+       /* Clear PKT_CNT register */
+       rte_write64(OTX_EP_CLEAR_SDP_OUT_PKT_CNT, (uint8_t *)otx_ep->hw_addr +
+                   SDP_VF_R_OUT_PKT_CNT(oq_no));
+
+       /* Clear the OQ doorbell  */
+       rte_write32(OTX_EP_CLEAR_SLIST_DBELL, droq->pkts_credit_reg);
+       while ((rte_read32(droq->pkts_credit_reg) != 0ull)) {
+               rte_write32(OTX_EP_CLEAR_SLIST_DBELL, droq->pkts_credit_reg);
+               rte_delay_ms(1);
+       }
+       otx_ep_dbg("SDP_R[%d]_credit:%x", oq_no,
+                  rte_read32(droq->pkts_credit_reg));
+
+       /* Clear the OQ_OUT_CNTS doorbell  */
+       reg_val = rte_read32(droq->pkts_sent_reg);
+       rte_write32((uint32_t)reg_val, droq->pkts_sent_reg);
+
+       otx_ep_dbg("SDP_R[%d]_sent: %x", oq_no,
+                  rte_read32(droq->pkts_sent_reg));
+
+       while (((rte_read32(droq->pkts_sent_reg)) != 0ull)) {
+               reg_val = rte_read32(droq->pkts_sent_reg);
+               rte_write32((uint32_t)reg_val, droq->pkts_sent_reg);
+               rte_delay_ms(1);
+       }
+       otx_ep_dbg("SDP_R[%d]_sent: %x", oq_no,
+                  rte_read32(droq->pkts_sent_reg));
+}
+
+static int
+otx2_vf_enable_iq(struct otx_ep_device *otx_ep, uint32_t q_no)
+{
+       uint64_t loop = SDP_VF_BUSY_LOOP_COUNT;
+       uint64_t reg_val = 0ull;
+
+       /* Resetting doorbells during IQ enabling also to handle abrupt
+        * guest reboot. IQ reset does not clear the doorbells.
+        */
+       otx2_write64(0xFFFFFFFF, otx_ep->hw_addr +
+                    SDP_VF_R_IN_INSTR_DBELL(q_no));
+
+       while (((otx2_read64(otx_ep->hw_addr +
+                SDP_VF_R_IN_INSTR_DBELL(q_no))) != 0ull) && loop--) {
+               rte_delay_ms(1);
+       }
+
+       if (!loop) {
+               otx_ep_err("INSTR DBELL not coming back to 0\n");
+               return -EIO;
+       }
+
+       reg_val = otx2_read64(otx_ep->hw_addr + SDP_VF_R_IN_ENABLE(q_no));
+       reg_val |= 0x1ull;
+
+       otx2_write64(reg_val, otx_ep->hw_addr + SDP_VF_R_IN_ENABLE(q_no));
+
+       otx2_info("IQ[%d] enable done", q_no);
+
+       return 0;
+}
+
+static int
+otx2_vf_enable_oq(struct otx_ep_device *otx_ep, uint32_t q_no)
+{
+       uint64_t reg_val = 0ull;
+
+       reg_val = otx2_read64(otx_ep->hw_addr + SDP_VF_R_OUT_ENABLE(q_no));
+       reg_val |= 0x1ull;
+       otx2_write64(reg_val, otx_ep->hw_addr + SDP_VF_R_OUT_ENABLE(q_no));
+
+       otx2_info("OQ[%d] enable done", q_no);
+
+       return 0;
+}
+
+static int
+otx2_vf_enable_io_queues(struct otx_ep_device *otx_ep)
+{
+       uint32_t q_no = 0;
+       int ret;
+
+       for (q_no = 0; q_no < otx_ep->nb_tx_queues; q_no++) {
+               ret = otx2_vf_enable_iq(otx_ep, q_no);
+               if (ret)
+                       return ret;
+       }
+
+       for (q_no = 0; q_no < otx_ep->nb_rx_queues; q_no++)
+               otx2_vf_enable_oq(otx_ep, q_no);
+
+       return 0;
+}
+
+static void
+otx2_vf_disable_iq(struct otx_ep_device *otx_ep, uint32_t q_no)
+{
+       uint64_t reg_val = 0ull;
+
+       /* Reset the doorbell register for this Input Queue. */
+       reg_val = otx2_read64(otx_ep->hw_addr + SDP_VF_R_IN_ENABLE(q_no));
+       reg_val &= ~0x1ull;
+
+       otx2_write64(reg_val, otx_ep->hw_addr + SDP_VF_R_IN_ENABLE(q_no));
+}
+
+static void
+otx2_vf_disable_oq(struct otx_ep_device *otx_ep, uint32_t q_no)
+{
+       volatile uint64_t reg_val = 0ull;
+
+       reg_val = otx2_read64(otx_ep->hw_addr + SDP_VF_R_OUT_ENABLE(q_no));
+       reg_val &= ~0x1ull;
+
+       otx2_write64(reg_val, otx_ep->hw_addr + SDP_VF_R_OUT_ENABLE(q_no));
+}
+
+static void
+otx2_vf_disable_io_queues(struct otx_ep_device *otx_ep)
+{
+       uint32_t q_no = 0;
+
+       for (q_no = 0; q_no < otx_ep->sriov_info.rings_per_vf; q_no++) {
+               otx2_vf_disable_iq(otx_ep, q_no);
+               otx2_vf_disable_oq(otx_ep, q_no);
+       }
+}
+
 static const struct otx_ep_config default_otx2_ep_conf = {
        /* IQ attributes */
        .iq                        = {
@@ -125,7 +340,19 @@ otx2_ep_vf_setup_device(struct otx_ep_device *otx_ep)
 
        otx2_info("SDP RPVF: %d", otx_ep->sriov_info.rings_per_vf);
 
+       otx_ep->fn_list.setup_iq_regs       = otx2_vf_setup_iq_regs;
+       otx_ep->fn_list.setup_oq_regs       = otx2_vf_setup_oq_regs;
+
        otx_ep->fn_list.setup_device_regs   = otx2_vf_setup_device_regs;
 
+       otx_ep->fn_list.enable_io_queues    = otx2_vf_enable_io_queues;
+       otx_ep->fn_list.disable_io_queues   = otx2_vf_disable_io_queues;
+
+       otx_ep->fn_list.enable_iq           = otx2_vf_enable_iq;
+       otx_ep->fn_list.disable_iq          = otx2_vf_disable_iq;
+
+       otx_ep->fn_list.enable_oq           = otx2_vf_enable_oq;
+       otx_ep->fn_list.disable_oq          = otx2_vf_disable_oq;
+
        return 0;
 }