net/liquidio: support device reset in driver
[dpdk.git] / drivers / net / liquidio / base / lio_23xx_vf.c
index 6270af5..e30c20d 100644 (file)
@@ -31,6 +31,8 @@
  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
 
+#include <string.h>
+
 #include <rte_ethdev.h>
 #include <rte_cycles.h>
 #include <rte_malloc.h>
@@ -198,6 +200,61 @@ cn23xx_vf_setup_device_regs(struct lio_device *lio_dev)
        return 0;
 }
 
+static void
+cn23xx_vf_setup_iq_regs(struct lio_device *lio_dev, uint32_t iq_no)
+{
+       struct lio_instr_queue *iq = lio_dev->instr_queue[iq_no];
+       uint64_t pkt_in_done = 0;
+
+       PMD_INIT_FUNC_TRACE();
+
+       /* Write the start of the input queue's ring and its size */
+       lio_write_csr64(lio_dev, CN23XX_SLI_IQ_BASE_ADDR64(iq_no),
+                       iq->base_addr_dma);
+       lio_write_csr(lio_dev, CN23XX_SLI_IQ_SIZE(iq_no), iq->max_count);
+
+       /* Remember the doorbell & instruction count register addr
+        * for this queue
+        */
+       iq->doorbell_reg = (uint8_t *)lio_dev->hw_addr +
+                               CN23XX_SLI_IQ_DOORBELL(iq_no);
+       iq->inst_cnt_reg = (uint8_t *)lio_dev->hw_addr +
+                               CN23XX_SLI_IQ_INSTR_COUNT64(iq_no);
+       lio_dev_dbg(lio_dev, "InstQ[%d]:dbell reg @ 0x%p instcnt_reg @ 0x%p\n",
+                   iq_no, iq->doorbell_reg, iq->inst_cnt_reg);
+
+       /* Store the current instruction counter (used in flush_iq
+        * calculation)
+        */
+       pkt_in_done = rte_read64(iq->inst_cnt_reg);
+
+       /* Clear the count by writing back what we read, but don't
+        * enable data traffic here
+        */
+       rte_write64(pkt_in_done, iq->inst_cnt_reg);
+}
+
+static void
+cn23xx_vf_setup_oq_regs(struct lio_device *lio_dev, uint32_t oq_no)
+{
+       struct lio_droq *droq = lio_dev->droq[oq_no];
+
+       PMD_INIT_FUNC_TRACE();
+
+       lio_write_csr64(lio_dev, CN23XX_SLI_OQ_BASE_ADDR64(oq_no),
+                       droq->desc_ring_dma);
+       lio_write_csr(lio_dev, CN23XX_SLI_OQ_SIZE(oq_no), droq->max_count);
+
+       lio_write_csr(lio_dev, CN23XX_SLI_OQ_BUFF_INFO_SIZE(oq_no),
+                     (droq->buffer_size | (OCTEON_RH_SIZE << 16)));
+
+       /* Get the mapped address of the pkt_sent and pkts_credit regs */
+       droq->pkts_sent_reg = (uint8_t *)lio_dev->hw_addr +
+                                       CN23XX_SLI_OQ_PKTS_SENT(oq_no);
+       droq->pkts_credit_reg = (uint8_t *)lio_dev->hw_addr +
+                                       CN23XX_SLI_OQ_PKTS_CREDIT(oq_no);
+}
+
 static void
 cn23xx_vf_free_mbox(struct lio_device *lio_dev)
 {
@@ -255,6 +312,92 @@ cn23xx_vf_setup_mbox(struct lio_device *lio_dev)
        return 0;
 }
 
+static int
+cn23xx_vf_enable_io_queues(struct lio_device *lio_dev)
+{
+       uint32_t q_no;
+
+       PMD_INIT_FUNC_TRACE();
+
+       for (q_no = 0; q_no < lio_dev->num_iqs; q_no++) {
+               uint64_t reg_val;
+
+               /* set the corresponding IQ IS_64B bit */
+               if (lio_dev->io_qmask.iq64B & (1ULL << q_no)) {
+                       reg_val = lio_read_csr64(
+                                       lio_dev,
+                                       CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
+                       reg_val = reg_val | CN23XX_PKT_INPUT_CTL_IS_64B;
+                       lio_write_csr64(lio_dev,
+                                       CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
+                                       reg_val);
+               }
+
+               /* set the corresponding IQ ENB bit */
+               if (lio_dev->io_qmask.iq & (1ULL << q_no)) {
+                       reg_val = lio_read_csr64(
+                                       lio_dev,
+                                       CN23XX_SLI_IQ_PKT_CONTROL64(q_no));
+                       reg_val = reg_val | CN23XX_PKT_INPUT_CTL_RING_ENB;
+                       lio_write_csr64(lio_dev,
+                                       CN23XX_SLI_IQ_PKT_CONTROL64(q_no),
+                                       reg_val);
+               }
+       }
+       for (q_no = 0; q_no < lio_dev->num_oqs; q_no++) {
+               uint32_t reg_val;
+
+               /* set the corresponding OQ ENB bit */
+               if (lio_dev->io_qmask.oq & (1ULL << q_no)) {
+                       reg_val = lio_read_csr(
+                                       lio_dev,
+                                       CN23XX_SLI_OQ_PKT_CONTROL(q_no));
+                       reg_val = reg_val | CN23XX_PKT_OUTPUT_CTL_RING_ENB;
+                       lio_write_csr(lio_dev,
+                                     CN23XX_SLI_OQ_PKT_CONTROL(q_no),
+                                     reg_val);
+               }
+       }
+
+       return 0;
+}
+
+static void
+cn23xx_vf_disable_io_queues(struct lio_device *lio_dev)
+{
+       uint32_t num_queues;
+
+       PMD_INIT_FUNC_TRACE();
+
+       /* per HRM, rings can only be disabled via reset operation,
+        * NOT via SLI_PKT()_INPUT/OUTPUT_CONTROL[ENB]
+        */
+       num_queues = lio_dev->num_iqs;
+       if (num_queues < lio_dev->num_oqs)
+               num_queues = lio_dev->num_oqs;
+
+       cn23xx_vf_reset_io_queues(lio_dev, num_queues);
+}
+
+void
+cn23xx_vf_ask_pf_to_do_flr(struct lio_device *lio_dev)
+{
+       struct lio_mbox_cmd mbox_cmd;
+
+       memset(&mbox_cmd, 0, sizeof(struct lio_mbox_cmd));
+       mbox_cmd.msg.s.type = LIO_MBOX_REQUEST;
+       mbox_cmd.msg.s.resp_needed = 0;
+       mbox_cmd.msg.s.cmd = LIO_VF_FLR_REQUEST;
+       mbox_cmd.msg.s.len = 1;
+       mbox_cmd.q_no = 0;
+       mbox_cmd.recv_len = 0;
+       mbox_cmd.recv_status = 0;
+       mbox_cmd.fn = NULL;
+       mbox_cmd.fn_arg = 0;
+
+       lio_mbox_write(lio_dev, &mbox_cmd);
+}
+
 static void
 cn23xx_pfvf_hs_callback(struct lio_device *lio_dev,
                        struct lio_mbox_cmd *cmd, void *arg)
@@ -279,8 +422,8 @@ cn23xx_pfvf_handshake(struct lio_device *lio_dev)
 {
        struct lio_mbox_cmd mbox_cmd;
        struct lio_version *lio_ver = (struct lio_version *)&mbox_cmd.data[0];
+       uint32_t q_no, count = 0;
        rte_atomic64_t status;
-       uint32_t count = 0;
        uint32_t pfmajor;
        uint32_t vfmajor;
        uint32_t ret;
@@ -322,6 +465,10 @@ cn23xx_pfvf_handshake(struct lio_device *lio_dev)
                return -1;
        }
 
+       for (q_no = 0; q_no < lio_dev->num_iqs; q_no++)
+               lio_dev->instr_queue[q_no]->txpciq.s.pkind =
+                                               lio_dev->pfvf_hsword.pkind;
+
        vfmajor = LIO_BASE_MAJOR_VERSION;
        pfmajor = ret >> 16;
        if (pfmajor != vfmajor) {
@@ -336,6 +483,9 @@ cn23xx_pfvf_handshake(struct lio_device *lio_dev)
                ret = 0;
        }
 
+       lio_dev_dbg(lio_dev, "got data from PF pkind is %d\n",
+                   lio_dev->pfvf_hsword.pkind);
+
        return ret;
 }
 
@@ -375,11 +525,16 @@ cn23xx_vf_setup_device(struct lio_device *lio_dev)
        if (lio_dev->default_config == NULL)
                return -1;
 
+       lio_dev->fn_list.setup_iq_regs          = cn23xx_vf_setup_iq_regs;
+       lio_dev->fn_list.setup_oq_regs          = cn23xx_vf_setup_oq_regs;
        lio_dev->fn_list.setup_mbox             = cn23xx_vf_setup_mbox;
        lio_dev->fn_list.free_mbox              = cn23xx_vf_free_mbox;
 
        lio_dev->fn_list.setup_device_regs      = cn23xx_vf_setup_device_regs;
 
+       lio_dev->fn_list.enable_io_queues       = cn23xx_vf_enable_io_queues;
+       lio_dev->fn_list.disable_io_queues      = cn23xx_vf_disable_io_queues;
+
        return 0;
 }