OSDN Git Service

octeontx2-pf: MTU, MAC and RX mode config support
authorSunil Goutham <sgoutham@marvell.com>
Mon, 27 Jan 2020 13:05:23 +0000 (18:35 +0530)
committerDavid S. Miller <davem@davemloft.net>
Mon, 27 Jan 2020 13:33:39 +0000 (14:33 +0100)
This patch addes support to change interface MTU, MAC address
retrieval and config, RX mode ie unicast, multicast and promiscuous.
Also added link loopback support

Signed-off-by: Tomasz Duszynski <tduszynski@marvell.com>
Signed-off-by: Subbaraya Sundeep <sbhatta@marvell.com>
Signed-off-by: Sunil Goutham <sgoutham@marvell.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
drivers/net/ethernet/marvell/octeontx2/af/mbox.h
drivers/net/ethernet/marvell/octeontx2/af/rvu_nix.c
drivers/net/ethernet/marvell/octeontx2/nic/otx2_common.c
drivers/net/ethernet/marvell/octeontx2/nic/otx2_common.h
drivers/net/ethernet/marvell/octeontx2/nic/otx2_pf.c
drivers/net/ethernet/marvell/octeontx2/nic/otx2_txrx.h

index a589748..8bbc1f1 100644 (file)
@@ -210,7 +210,8 @@ M(NIX_SET_RX_CFG,   0x8010, nix_set_rx_cfg, nix_rx_cfg, msg_rsp)    \
 M(NIX_LSO_FORMAT_CFG,  0x8011, nix_lso_format_cfg,                     \
                                 nix_lso_format_cfg,                    \
                                 nix_lso_format_cfg_rsp)                \
-M(NIX_RXVLAN_ALLOC,    0x8012, nix_rxvlan_alloc, msg_req, msg_rsp)
+M(NIX_RXVLAN_ALLOC,    0x8012, nix_rxvlan_alloc, msg_req, msg_rsp)     \
+M(NIX_GET_MAC_ADDR, 0x8018, nix_get_mac_addr, msg_req, nix_get_mac_addr_rsp) \
 
 /* Messages initiated by AF (range 0xC00 - 0xDFF) */
 #define MBOX_UP_CGX_MESSAGES                                           \
@@ -618,6 +619,11 @@ struct nix_set_mac_addr {
        u8 mac_addr[ETH_ALEN]; /* MAC address to be set for this pcifunc */
 };
 
+struct nix_get_mac_addr_rsp {
+       struct mbox_msghdr hdr;
+       u8 mac_addr[ETH_ALEN];
+};
+
 struct nix_mark_format_cfg {
        struct mbox_msghdr hdr;
        u8 offset;
index 8a59f7d..eb5e542 100644 (file)
@@ -2546,6 +2546,23 @@ int rvu_mbox_handler_nix_set_mac_addr(struct rvu *rvu,
        return 0;
 }
 
+int rvu_mbox_handler_nix_get_mac_addr(struct rvu *rvu,
+                                     struct msg_req *req,
+                                     struct nix_get_mac_addr_rsp *rsp)
+{
+       u16 pcifunc = req->hdr.pcifunc;
+       struct rvu_pfvf *pfvf;
+
+       if (!is_nixlf_attached(rvu, pcifunc))
+               return NIX_AF_ERR_AF_LF_INVALID;
+
+       pfvf = rvu_get_pfvf(rvu, pcifunc);
+
+       ether_addr_copy(rsp->mac_addr, pfvf->mac_addr);
+
+       return 0;
+}
+
 int rvu_mbox_handler_nix_set_rx_mode(struct rvu *rvu, struct nix_rx_mode *req,
                                     struct msg_rsp *rsp)
 {
index e9bd2d6..836b3c8 100644 (file)
 #include "otx2_common.h"
 #include "otx2_struct.h"
 
+/* Sync MAC address with RVU AF */
+static int otx2_hw_set_mac_addr(struct otx2_nic *pfvf, u8 *mac)
+{
+       struct nix_set_mac_addr *req;
+       int err;
+
+       otx2_mbox_lock(&pfvf->mbox);
+       req = otx2_mbox_alloc_msg_nix_set_mac_addr(&pfvf->mbox);
+       if (!req) {
+               otx2_mbox_unlock(&pfvf->mbox);
+               return -ENOMEM;
+       }
+
+       ether_addr_copy(req->mac_addr, mac);
+
+       err = otx2_sync_mbox_msg(&pfvf->mbox);
+       otx2_mbox_unlock(&pfvf->mbox);
+       return err;
+}
+
+static int otx2_hw_get_mac_addr(struct otx2_nic *pfvf,
+                               struct net_device *netdev)
+{
+       struct nix_get_mac_addr_rsp *rsp;
+       struct mbox_msghdr *msghdr;
+       struct msg_req *req;
+       int err;
+
+       otx2_mbox_lock(&pfvf->mbox);
+       req = otx2_mbox_alloc_msg_nix_get_mac_addr(&pfvf->mbox);
+       if (!req) {
+               otx2_mbox_unlock(&pfvf->mbox);
+               return -ENOMEM;
+       }
+
+       err = otx2_sync_mbox_msg(&pfvf->mbox);
+       if (err) {
+               otx2_mbox_unlock(&pfvf->mbox);
+               return err;
+       }
+
+       msghdr = otx2_mbox_get_rsp(&pfvf->mbox.mbox, 0, &req->hdr);
+       if (!msghdr) {
+               otx2_mbox_unlock(&pfvf->mbox);
+               return -ENOMEM;
+       }
+       rsp = (struct nix_get_mac_addr_rsp *)msghdr;
+       ether_addr_copy(netdev->dev_addr, rsp->mac_addr);
+       otx2_mbox_unlock(&pfvf->mbox);
+
+       return 0;
+}
+
+int otx2_set_mac_address(struct net_device *netdev, void *p)
+{
+       struct otx2_nic *pfvf = netdev_priv(netdev);
+       struct sockaddr *addr = p;
+
+       if (!is_valid_ether_addr(addr->sa_data))
+               return -EADDRNOTAVAIL;
+
+       if (!otx2_hw_set_mac_addr(pfvf, addr->sa_data))
+               memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
+       else
+               return -EPERM;
+
+       return 0;
+}
+
+int otx2_hw_set_mtu(struct otx2_nic *pfvf, int mtu)
+{
+       struct nix_frs_cfg *req;
+       int err;
+
+       otx2_mbox_lock(&pfvf->mbox);
+       req = otx2_mbox_alloc_msg_nix_set_hw_frs(&pfvf->mbox);
+       if (!req) {
+               otx2_mbox_unlock(&pfvf->mbox);
+               return -ENOMEM;
+       }
+
+       /* SMQ config limits maximum pkt size that can be transmitted */
+       req->update_smq = true;
+       pfvf->max_frs = mtu +  OTX2_ETH_HLEN;
+       req->maxlen = pfvf->max_frs;
+
+       err = otx2_sync_mbox_msg(&pfvf->mbox);
+       otx2_mbox_unlock(&pfvf->mbox);
+       return err;
+}
+
 void otx2_config_irq_coalescing(struct otx2_nic *pfvf, int qidx)
 {
        /* Configure CQE interrupt coalescing parameters
@@ -63,6 +154,20 @@ ret:
        return iova;
 }
 
+void otx2_get_mac_from_af(struct net_device *netdev)
+{
+       struct otx2_nic *pfvf = netdev_priv(netdev);
+       int err;
+
+       err = otx2_hw_get_mac_addr(pfvf, netdev);
+       if (err)
+               dev_warn(pfvf->dev, "Failed to read mac from hardware\n");
+
+       /* If AF doesn't provide a valid MAC, generate a random one */
+       if (!is_valid_ether_addr(netdev->dev_addr))
+               eth_hw_addr_random(netdev);
+}
+
 static int otx2_get_link(struct otx2_nic *pfvf)
 {
        int link = 0;
@@ -97,6 +202,9 @@ int otx2_txschq_config(struct otx2_nic *pfvf, int lvl)
        /* Set topology e.t.c configuration */
        if (lvl == NIX_TXSCH_LVL_SMQ) {
                req->reg[0] = NIX_AF_SMQX_CFG(schq);
+               req->regval[0] = ((pfvf->netdev->mtu  + OTX2_ETH_HLEN) << 8) |
+                                  OTX2_MIN_MTU;
+
                req->regval[0] |= (0x20ULL << 51) | (0x80ULL << 39) |
                                  (0x2ULL << 36);
                req->num_regs++;
index 16d7dd7..8c29b63 100644 (file)
@@ -133,6 +133,7 @@ struct otx2_nic {
        void __iomem            *reg_base;
        struct net_device       *netdev;
        void                    *iommu_domain;
+       u16                     max_frs;
        u16                     rbsize; /* Receive buffer size */
 
 #define OTX2_FLAG_INTF_DOWN                    BIT_ULL(2)
@@ -469,7 +470,9 @@ static inline void otx2_dma_unmap_page(struct otx2_nic *pfvf,
 /* MSI-X APIs */
 void otx2_free_cints(struct otx2_nic *pfvf, int n);
 void otx2_set_cints_affinity(struct otx2_nic *pfvf);
-
+int otx2_set_mac_address(struct net_device *netdev, void *p);
+int otx2_hw_set_mtu(struct otx2_nic *pfvf, int mtu);
+void otx2_get_mac_from_af(struct net_device *netdev);
 void otx2_config_irq_coalescing(struct otx2_nic *pfvf, int qidx);
 
 /* RVU block related APIs */
@@ -503,4 +506,7 @@ void mbox_handler_nix_lf_alloc(struct otx2_nic *pfvf,
                               struct nix_lf_alloc_rsp *rsp);
 void mbox_handler_nix_txsch_alloc(struct otx2_nic *pf,
                                  struct nix_txsch_alloc_rsp *rsp);
+
+int otx2_open(struct net_device *netdev);
+int otx2_stop(struct net_device *netdev);
 #endif /* OTX2_COMMON_H */
index 8cb1cf5..60a67b9 100644 (file)
@@ -43,6 +43,24 @@ enum {
        TYPE_PFVF,
 };
 
+static int otx2_change_mtu(struct net_device *netdev, int new_mtu)
+{
+       bool if_up = netif_running(netdev);
+       int err = 0;
+
+       if (if_up)
+               otx2_stop(netdev);
+
+       netdev_info(netdev, "Changing MTU from %d to %d\n",
+                   netdev->mtu, new_mtu);
+       netdev->mtu = new_mtu;
+
+       if (if_up)
+               err = otx2_open(netdev);
+
+       return err;
+}
+
 static void otx2_queue_work(struct mbox *mw, struct workqueue_struct *mbox_wq,
                            int first, int mdevs, u64 intr, int type)
 {
@@ -420,6 +438,27 @@ static int otx2_cgx_config_linkevents(struct otx2_nic *pf, bool enable)
        return err;
 }
 
+static int otx2_cgx_config_loopback(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_intlbk_enable(&pf->mbox);
+       else
+               msg = otx2_mbox_alloc_msg_cgx_intlbk_disable(&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)
 {
@@ -519,7 +558,7 @@ static int otx2_init_hw_resources(struct otx2_nic *pf)
        hw->pool_cnt = hw->rqpool_cnt + hw->sqpool_cnt;
 
        /* Get the size of receive buffers to allocate */
-       pf->rbsize = RCV_FRAG_LEN(pf->netdev->mtu);
+       pf->rbsize = RCV_FRAG_LEN(pf->netdev->mtu + OTX2_ETH_HLEN);
 
        otx2_mbox_lock(mbox);
        /* NPA init */
@@ -658,7 +697,7 @@ static void otx2_free_hw_resources(struct otx2_nic *pf)
        otx2_mbox_unlock(mbox);
 }
 
-static int otx2_open(struct net_device *netdev)
+int otx2_open(struct net_device *netdev)
 {
        struct otx2_nic *pf = netdev_priv(netdev);
        struct otx2_cq_poll *cq_poll = NULL;
@@ -715,6 +754,11 @@ static int otx2_open(struct net_device *netdev)
                napi_enable(&cq_poll->napi);
        }
 
+       /* Set maximum frame size allowed in HW */
+       err = otx2_hw_set_mtu(pf, netdev->mtu);
+       if (err)
+               goto err_disable_napi;
+
        /* Register CQ IRQ handlers */
        vec = pf->hw.nix_msixoff + NIX_LF_CINT_VEC_START;
        for (qidx = 0; qidx < pf->hw.cint_cnt; qidx++) {
@@ -759,6 +803,7 @@ static int otx2_open(struct net_device *netdev)
 
 err_free_cints:
        otx2_free_cints(pf, qidx);
+err_disable_napi:
        otx2_disable_napi(pf);
        otx2_free_hw_resources(pf);
 err_free_mem:
@@ -768,7 +813,7 @@ err_free_mem:
        return err;
 }
 
-static int otx2_stop(struct net_device *netdev)
+int otx2_stop(struct net_device *netdev)
 {
        struct otx2_nic *pf = netdev_priv(netdev);
        struct otx2_cq_poll *cq_poll = NULL;
@@ -847,10 +892,53 @@ static netdev_tx_t otx2_xmit(struct sk_buff *skb, struct net_device *netdev)
        return NETDEV_TX_OK;
 }
 
+static void otx2_set_rx_mode(struct net_device *netdev)
+{
+       struct otx2_nic *pf = netdev_priv(netdev);
+       struct nix_rx_mode *req;
+
+       if (!(netdev->flags & IFF_UP))
+               return;
+
+       otx2_mbox_lock(&pf->mbox);
+       req = otx2_mbox_alloc_msg_nix_set_rx_mode(&pf->mbox);
+       if (!req) {
+               otx2_mbox_unlock(&pf->mbox);
+               return;
+       }
+
+       req->mode = NIX_RX_MODE_UCAST;
+
+       /* We don't support MAC address filtering yet */
+       if (netdev->flags & IFF_PROMISC)
+               req->mode |= NIX_RX_MODE_PROMISC;
+       else if (netdev->flags & (IFF_ALLMULTI | IFF_MULTICAST))
+               req->mode |= NIX_RX_MODE_ALLMULTI;
+
+       otx2_sync_mbox_msg(&pf->mbox);
+       otx2_mbox_unlock(&pf->mbox);
+}
+
+static int otx2_set_features(struct net_device *netdev,
+                            netdev_features_t features)
+{
+       netdev_features_t changed = features ^ netdev->features;
+       struct otx2_nic *pf = netdev_priv(netdev);
+
+       if ((changed & NETIF_F_LOOPBACK) && netif_running(netdev))
+               return otx2_cgx_config_loopback(pf,
+                                               features & NETIF_F_LOOPBACK);
+       return 0;
+}
+
 static const struct net_device_ops otx2_netdev_ops = {
        .ndo_open               = otx2_open,
        .ndo_stop               = otx2_stop,
        .ndo_start_xmit         = otx2_xmit,
+       .ndo_set_mac_address    = otx2_set_mac_address,
+       .ndo_change_mtu         = otx2_change_mtu,
+       .ndo_set_rx_mode        = otx2_set_rx_mode,
+       .ndo_set_features       = otx2_set_features,
 };
 
 static int otx2_check_pf_usable(struct otx2_nic *nic)
@@ -1005,6 +1093,9 @@ static int otx2_probe(struct pci_dev *pdev, const struct pci_device_id *id)
 
        otx2_setup_dev_hw_settings(pf);
 
+       /* Assign default mac address */
+       otx2_get_mac_from_af(netdev);
+
        /* NPA's pool is a stack to which SW frees buffer pointers via Aura.
         * HW allocates buffer pointer from stack and uses it for DMA'ing
         * ingress packet. In some scenarios HW can free back allocated buffer
@@ -1022,10 +1113,14 @@ static int otx2_probe(struct pci_dev *pdev, const struct pci_device_id *id)
                               NETIF_F_IPV6_CSUM | NETIF_F_SG);
        netdev->features |= netdev->hw_features;
 
-       netdev->hw_features |= NETIF_F_RXALL;
+       netdev->hw_features |= NETIF_F_LOOPBACK | NETIF_F_RXALL;
 
        netdev->netdev_ops = &otx2_netdev_ops;
 
+       /* MTU range: 64 - 9190 */
+       netdev->min_mtu = OTX2_MIN_MTU;
+       netdev->max_mtu = OTX2_MAX_MTU;
+
        err = register_netdev(netdev);
        if (err) {
                dev_err(dev, "Failed to register netdevice\n");
index d9683c3..bad2259 100644 (file)
 #define OTX2_DATA_ALIGN(X)     ALIGN(X, OTX2_ALIGN)
 #define OTX2_HEAD_ROOM         OTX2_ALIGN
 
+#define        OTX2_ETH_HLEN           (VLAN_ETH_HLEN + VLAN_HLEN)
+#define        OTX2_MIN_MTU            64
+#define        OTX2_MAX_MTU            (9212 - OTX2_ETH_HLEN)
+
 #define OTX2_MAX_FRAGS_IN_SQE  9
 
 /* Rx buffer size should be in multiples of 128bytes */