octeontx2-pf: Register and handle link notifications

PF and AF (admin function) shares 64KB of reserved memory region for
communication. This region is shared for
 - Messages sent by PF and responses sent by AF.
 - Notifications sent by AF and ACKs sent by PF.

This patch adds infrastructure to handle notifications sent
by AF and adds handlers to process them.

One of the main usecase of notifications from AF is physical
link changes. So this patch adds registration of PF with AF
to receive link status change notifications and also adds
the handler for that notification.

Signed-off-by: Linu Cherian <lcherian@marvell.com>
Signed-off-by: Tomasz Duszynski <tduszynski@marvell.com>
Signed-off-by: Sunil Goutham <sgoutham@marvell.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/marvell/octeontx2/nic/otx2_common.h b/drivers/net/ethernet/marvell/octeontx2/nic/otx2_common.h
index 11948540dd4a559eabe8014586bbb4de6d024472..16d7dd70a2afcbecf4e4b225505edd782a2a5918 100644 (file)
--- a/drivers/net/ethernet/marvell/octeontx2/nic/otx2_common.h
+++ b/drivers/net/ethernet/marvell/octeontx2/nic/otx2_common.h
@@ -135,6 +135,9 @@ struct otx2_nic {
        void                    *iommu_domain;
        u16                     rbsize; /* Receive buffer size */
 
+#define OTX2_FLAG_INTF_DOWN                    BIT_ULL(2)
+       u64                     flags;
+
        struct otx2_qset        qset;
        struct otx2_hw          hw;
        struct pci_dev          *pdev;
@@ -145,6 +148,7 @@ struct otx2_nic {
        struct workqueue_struct *mbox_wq;
 
        u16                     pcifunc; /* RVU PF_FUNC */
+       struct cgx_link_user_info linfo;
 
        /* Block address of NIX either BLKADDR_NIX0 or BLKADDR_NIX1 */
        int                     nix_blkaddr;
@@ -485,6 +489,7 @@ int otx2_txschq_stop(struct otx2_nic *pfvf);
 void otx2_sqb_flush(struct otx2_nic *pfvf);
 dma_addr_t otx2_alloc_rbuf(struct otx2_nic *pfvf, struct otx2_pool *pool,
                           gfp_t gfp);
+int otx2_rxtx_enable(struct otx2_nic *pfvf, bool enable);
 void otx2_ctx_disable(struct mbox *mbox, int type, bool npa);
 void otx2_cleanup_rx_cqes(struct otx2_nic *pfvf, struct otx2_cq_queue *cq);
 void otx2_cleanup_tx_cqes(struct otx2_nic *pfvf, struct otx2_cq_queue *cq);

diff --git a/drivers/net/ethernet/marvell/octeontx2/nic/otx2_pf.c b/drivers/net/ethernet/marvell/octeontx2/nic/otx2_pf.c
index a18bf5facaaf0bb8dd52b72d82bc28ed0a100594..8cb1cf56d388504aa9f2f29f0b3308c68e315384 100644 (file)
--- a/drivers/net/ethernet/marvell/octeontx2/nic/otx2_pf.c
+++ b/drivers/net/ethernet/marvell/octeontx2/nic/otx2_pf.c
@@ -167,6 +167,38 @@ static void otx2_pfaf_mbox_handler(struct work_struct *work)
        otx2_mbox_reset(mbox, 0);
 }
 
+static void otx2_handle_link_event(struct otx2_nic *pf)
+{
+       struct cgx_link_user_info *linfo = &pf->linfo;
+       struct net_device *netdev = pf->netdev;
+
+       pr_info("%s NIC Link is %s %d Mbps %s duplex\n", netdev->name,
+               linfo->link_up ? "UP" : "DOWN", linfo->speed,
+               linfo->full_duplex ? "Full" : "Half");
+       if (linfo->link_up) {
+               netif_carrier_on(netdev);
+               netif_tx_start_all_queues(netdev);
+       } else {
+               netif_tx_stop_all_queues(netdev);
+               netif_carrier_off(netdev);
+       }
+}
+
+int otx2_mbox_up_handler_cgx_link_event(struct otx2_nic *pf,
+                                       struct cgx_link_info_msg *msg,
+                                       struct msg_rsp *rsp)
+{
+       /* Copy the link info sent by AF */
+       pf->linfo = msg->link_info;
+
+       /* interface has not been fully configured yet */
+       if (pf->flags & OTX2_FLAG_INTF_DOWN)
+               return 0;
+
+       otx2_handle_link_event(pf);
+       return 0;
+}
+
 static int otx2_process_mbox_msg_up(struct otx2_nic *pf,
                                    struct mbox_msghdr *req)
 {
@@ -367,6 +399,27 @@ exit:
        return err;
 }
 
+static int otx2_cgx_config_linkevents(struct otx2_nic *pf, bool enable)
+{
+       struct msg_req *msg;
+       int err;
+
+       otx2_mbox_lock(&pf->mbox);
+       if (enable)
+               msg = otx2_mbox_alloc_msg_cgx_start_linkevents(&pf->mbox);
+       else
+               msg = otx2_mbox_alloc_msg_cgx_stop_linkevents(&pf->mbox);
+
+       if (!msg) {
+               otx2_mbox_unlock(&pf->mbox);
+               return -ENOMEM;
+       }
+
+       err = otx2_sync_mbox_msg(&pf->mbox);
+       otx2_mbox_unlock(&pf->mbox);
+       return err;
+}
+
 static int otx2_set_real_num_queues(struct net_device *netdev,
                                    int tx_queues, int rx_queues)
 {
@@ -690,6 +743,18 @@ static int otx2_open(struct net_device *netdev)
 
        otx2_set_cints_affinity(pf);
 
+       pf->flags &= ~OTX2_FLAG_INTF_DOWN;
+       /* 'intf_down' may be checked on any cpu */
+       smp_wmb();
+
+       /* we have already received link status notification */
+       if (pf->linfo.link_up && !(pf->pcifunc & RVU_PFVF_FUNC_MASK))
+               otx2_handle_link_event(pf);
+
+       err = otx2_rxtx_enable(pf, true);
+       if (err)
+               goto err_free_cints;
+
        return 0;
 
 err_free_cints:
@@ -713,6 +778,13 @@ static int otx2_stop(struct net_device *netdev)
        netif_carrier_off(netdev);
        netif_tx_stop_all_queues(netdev);
 
+       pf->flags |= OTX2_FLAG_INTF_DOWN;
+       /* 'intf_down' may be checked on any cpu */
+       smp_wmb();
+
+       /* First stop packet Rx/Tx */
+       otx2_rxtx_enable(pf, false);
+
        /* Cleanup CQ NAPI and IRQ */
        vec = pf->hw.nix_msixoff + NIX_LF_CINT_VEC_START;
        for (qidx = 0; qidx < pf->hw.cint_cnt; qidx++) {
@@ -867,6 +939,7 @@ static int otx2_probe(struct pci_dev *pdev, const struct pci_device_id *id)
        pf->netdev = netdev;
        pf->pdev = pdev;
        pf->dev = dev;
+       pf->flags |= OTX2_FLAG_INTF_DOWN;
 
        hw = &pf->hw;
        hw->pdev = pdev;
@@ -959,6 +1032,9 @@ static int otx2_probe(struct pci_dev *pdev, const struct pci_device_id *id)
                goto err_detach_rsrc;
        }
 
+       /* Enable link notifications */
+       otx2_cgx_config_linkevents(pf, true);
+
        return 0;
 
 err_detach_rsrc:
@@ -987,6 +1063,9 @@ static void otx2_remove(struct pci_dev *pdev)
 
        pf = netdev_priv(netdev);
 
+       /* Disable link notifications */
+       otx2_cgx_config_linkevents(pf, false);
+
        unregister_netdev(netdev);
        otx2_detach_resources(&pf->mbox);
        otx2_disable_mbox_intr(pf);

diff --git a/drivers/net/ethernet/marvell/octeontx2/nic/otx2_txrx.c b/drivers/net/ethernet/marvell/octeontx2/nic/otx2_txrx.c
index f19f5d04411054452e960ebaf4485375efd59e2e..87b579a121ab907208638a7d2f231801dad5a4b1 100644 (file)
--- a/drivers/net/ethernet/marvell/octeontx2/nic/otx2_txrx.c
+++ b/drivers/net/ethernet/marvell/octeontx2/nic/otx2_txrx.c
@@ -315,6 +315,10 @@ int otx2_napi_handler(struct napi_struct *napi, int budget)
        otx2_write64(pfvf, NIX_LF_CINTX_INT(cq_poll->cint_idx), BIT_ULL(0));
 
        if (workdone < budget && napi_complete_done(napi, workdone)) {
+               /* If interface is going down, don't re-enable IRQ */
+               if (pfvf->flags & OTX2_FLAG_INTF_DOWN)
+                       return workdone;
+
                /* Re-enable interrupts */
                otx2_write64(pfvf, NIX_LF_CINTX_ENA_W1S(cq_poll->cint_idx),
                             BIT_ULL(0));
@@ -531,3 +535,24 @@ void otx2_cleanup_tx_cqes(struct otx2_nic *pfvf, struct otx2_cq_queue *cq)
        otx2_write64(pfvf, NIX_LF_CQ_OP_DOOR,
                     ((u64)cq->cq_idx << 32) | processed_cqe);
 }
+
+int otx2_rxtx_enable(struct otx2_nic *pfvf, bool enable)
+{
+       struct msg_req *msg;
+       int err;
+
+       otx2_mbox_lock(&pfvf->mbox);
+       if (enable)
+               msg = otx2_mbox_alloc_msg_nix_lf_start_rx(&pfvf->mbox);
+       else
+               msg = otx2_mbox_alloc_msg_nix_lf_stop_rx(&pfvf->mbox);
+
+       if (!msg) {
+               otx2_mbox_unlock(&pfvf->mbox);
+               return -ENOMEM;
+       }
+
+       err = otx2_sync_mbox_msg(&pfvf->mbox);
+       otx2_mbox_unlock(&pfvf->mbox);
+       return err;
+}