Add port management commands that apply to the physical
ports associated with the PCI device, which might be
shared among several logical interfaces.

Signed-off-by: Alfredo Cardigliano <cardigli...@ntop.org>
Reviewed-by: Shannon Nelson <snel...@pensando.io>
---
 drivers/net/ionic/ionic.h        |    6 ++
 drivers/net/ionic/ionic_dev.c    |  127 +++++++++++++++++++++++++++++++++++++
 drivers/net/ionic/ionic_dev.h    |   18 +++++
 drivers/net/ionic/ionic_ethdev.c |   16 +++++
 drivers/net/ionic/ionic_main.c   |  131 ++++++++++++++++++++++++++++++++++++++
 5 files changed, 298 insertions(+)

diff --git a/drivers/net/ionic/ionic.h b/drivers/net/ionic/ionic.h
index 1f91e0a10..c15dc6b44 100644
--- a/drivers/net/ionic/ionic.h
+++ b/drivers/net/ionic/ionic.h
@@ -7,6 +7,8 @@
 
 #include <stdint.h>
 
+#include <rte_bus_pci.h>
+
 #include "ionic_dev.h"
 #include "ionic_if.h"
 #include "ionic_osdep.h"
@@ -60,4 +62,8 @@ int ionic_identify(struct ionic_adapter *adapter);
 int ionic_init(struct ionic_adapter *adapter);
 int ionic_reset(struct ionic_adapter *adapter);
 
+int ionic_port_identify(struct ionic_adapter *adapter);
+int ionic_port_init(struct ionic_adapter *adapter);
+int ionic_port_reset(struct ionic_adapter *adapter);
+
 #endif /* _IONIC_H_ */
diff --git a/drivers/net/ionic/ionic_dev.c b/drivers/net/ionic/ionic_dev.c
index 5cdcaa104..7a9890175 100644
--- a/drivers/net/ionic/ionic_dev.c
+++ b/drivers/net/ionic/ionic_dev.c
@@ -126,3 +126,130 @@ ionic_dev_cmd_reset(struct ionic_dev *idev)
 
        ionic_dev_cmd_go(idev, &cmd);
 }
+
+/* Port commands */
+
+void
+ionic_dev_cmd_port_identify(struct ionic_dev *idev)
+{
+       union ionic_dev_cmd cmd = {
+               .port_init.opcode = IONIC_CMD_PORT_IDENTIFY,
+               .port_init.index = 0,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_init(struct ionic_dev *idev)
+{
+       union ionic_dev_cmd cmd = {
+               .port_init.opcode = IONIC_CMD_PORT_INIT,
+               .port_init.index = 0,
+               .port_init.info_pa = idev->port_info_pa,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_reset(struct ionic_dev *idev)
+{
+       union ionic_dev_cmd cmd = {
+               .port_reset.opcode = IONIC_CMD_PORT_RESET,
+               .port_reset.index = 0,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_state(struct ionic_dev *idev, uint8_t state)
+{
+       union ionic_dev_cmd cmd = {
+               .port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
+               .port_setattr.index = 0,
+               .port_setattr.attr = IONIC_PORT_ATTR_STATE,
+               .port_setattr.state = state,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_speed(struct ionic_dev *idev, uint32_t speed)
+{
+       union ionic_dev_cmd cmd = {
+               .port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
+               .port_setattr.index = 0,
+               .port_setattr.attr = IONIC_PORT_ATTR_SPEED,
+               .port_setattr.speed = speed,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_mtu(struct ionic_dev *idev, uint32_t mtu)
+{
+       union ionic_dev_cmd cmd = {
+               .port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
+               .port_setattr.index = 0,
+               .port_setattr.attr = IONIC_PORT_ATTR_MTU,
+               .port_setattr.mtu = mtu,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_autoneg(struct ionic_dev *idev, uint8_t an_enable)
+{
+       union ionic_dev_cmd cmd = {
+               .port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
+               .port_setattr.index = 0,
+               .port_setattr.attr = IONIC_PORT_ATTR_AUTONEG,
+               .port_setattr.an_enable = an_enable,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_fec(struct ionic_dev *idev, uint8_t fec_type)
+{
+       union ionic_dev_cmd cmd = {
+               .port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
+               .port_setattr.index = 0,
+               .port_setattr.attr = IONIC_PORT_ATTR_FEC,
+               .port_setattr.fec_type = fec_type,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_pause(struct ionic_dev *idev, uint8_t pause_type)
+{
+       union ionic_dev_cmd cmd = {
+               .port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
+               .port_setattr.index = 0,
+               .port_setattr.attr = IONIC_PORT_ATTR_PAUSE,
+               .port_setattr.pause_type = pause_type,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
+
+void
+ionic_dev_cmd_port_loopback(struct ionic_dev *idev, uint8_t loopback_mode)
+{
+       union ionic_dev_cmd cmd = {
+               .port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
+               .port_setattr.index = 0,
+               .port_setattr.attr = IONIC_PORT_ATTR_LOOPBACK,
+               .port_setattr.loopback_mode = loopback_mode,
+       };
+
+       ionic_dev_cmd_go(idev, &cmd);
+}
diff --git a/drivers/net/ionic/ionic_dev.h b/drivers/net/ionic/ionic_dev.h
index a157e4175..aaa031980 100644
--- a/drivers/net/ionic/ionic_dev.h
+++ b/drivers/net/ionic/ionic_dev.h
@@ -21,6 +21,7 @@
 #define IONIC_API_VERSION              "3"
 
 #define IONIC_DEVCMD_TIMEOUT   30 /* devcmd_timeout */
+#define        IONIC_ALIGN             4096
 
 struct ionic_adapter;
 
@@ -122,6 +123,11 @@ struct ionic_dev {
        struct ionic_intr __iomem *intr_ctrl;
 
        struct ionic_intr_status __iomem *intr_status;
+
+       struct ionic_port_info *port_info;
+       const struct rte_memzone *port_info_z;
+       rte_iova_t port_info_pa;
+       uint32_t port_info_sz;
 };
 
 int ionic_dev_setup(struct ionic_adapter *adapter);
@@ -135,4 +141,16 @@ void ionic_dev_cmd_identify(struct ionic_dev *idev, 
uint8_t ver);
 void ionic_dev_cmd_init(struct ionic_dev *idev);
 void ionic_dev_cmd_reset(struct ionic_dev *idev);
 
+void ionic_dev_cmd_port_identify(struct ionic_dev *idev);
+void ionic_dev_cmd_port_init(struct ionic_dev *idev);
+void ionic_dev_cmd_port_reset(struct ionic_dev *idev);
+void ionic_dev_cmd_port_state(struct ionic_dev *idev, uint8_t state);
+void ionic_dev_cmd_port_speed(struct ionic_dev *idev, uint32_t speed);
+void ionic_dev_cmd_port_mtu(struct ionic_dev *idev, uint32_t mtu);
+void ionic_dev_cmd_port_autoneg(struct ionic_dev *idev, uint8_t an_enable);
+void ionic_dev_cmd_port_fec(struct ionic_dev *idev, uint8_t fec_type);
+void ionic_dev_cmd_port_pause(struct ionic_dev *idev, uint8_t pause_type);
+void ionic_dev_cmd_port_loopback(struct ionic_dev *idev,
+               uint8_t loopback_mode);
+
 #endif /* _IONIC_DEV_H_ */
diff --git a/drivers/net/ionic/ionic_ethdev.c b/drivers/net/ionic/ionic_ethdev.c
index 148d6f236..61999bf1d 100644
--- a/drivers/net/ionic/ionic_ethdev.c
+++ b/drivers/net/ionic/ionic_ethdev.c
@@ -103,6 +103,22 @@ eth_ionic_pci_probe(struct rte_pci_driver *pci_drv 
__rte_unused,
                return err;
        }
 
+       /* Configure the ports */
+       err = ionic_port_identify(adapter);
+
+       if (err) {
+               ionic_init_print(ERR, "Cannot identify port: %d, aborting\n",
+                               err);
+               return err;
+       }
+
+       err = ionic_port_init(adapter);
+
+       if (err) {
+               ionic_init_print(ERR, "Cannot init port: %d, aborting\n", err);
+               return err;
+       }
+
        rte_spinlock_lock(&ionic_pci_adapters_lock);
        LIST_INSERT_HEAD(&ionic_pci_adapters, adapter, pci_adapters);
        rte_spinlock_unlock(&ionic_pci_adapters_lock);
diff --git a/drivers/net/ionic/ionic_main.c b/drivers/net/ionic/ionic_main.c
index 79a141140..0feb713a9 100644
--- a/drivers/net/ionic/ionic_main.c
+++ b/drivers/net/ionic/ionic_main.c
@@ -2,6 +2,8 @@
  * Copyright(c) 2018-2019 Pensando Systems, Inc. All rights reserved.
  */
 
+#include <rte_memzone.h>
+
 #include "ionic.h"
 
 static int
@@ -131,3 +133,132 @@ ionic_reset(struct ionic_adapter *adapter)
        err = ionic_dev_cmd_wait_check(idev, IONIC_DEVCMD_TIMEOUT);
        return err;
 }
+
+int
+ionic_port_identify(struct ionic_adapter *adapter)
+{
+       struct ionic_dev *idev = &adapter->idev;
+       struct ionic_identity *ident = &adapter->ident;
+       unsigned int port_words = sizeof(ident->port.words) /
+               sizeof(ident->port.words[0]);
+       unsigned int cmd_words = sizeof(idev->dev_cmd->data) /
+               sizeof(idev->dev_cmd->data[0]);
+       unsigned int i;
+       unsigned int nwords;
+       int err;
+
+       ionic_dev_cmd_port_identify(idev);
+       err = ionic_dev_cmd_wait_check(idev, IONIC_DEVCMD_TIMEOUT);
+       if (!err) {
+               nwords = RTE_MIN(port_words, cmd_words);
+               for (i = 0; i < nwords; i++)
+                       ident->port.words[i] =
+                                       ioread32(&idev->dev_cmd->data[i]);
+       }
+
+       ionic_init_print(INFO, "speed %d ", ident->port.config.speed);
+       ionic_init_print(INFO, "mtu %d ", ident->port.config.mtu);
+       ionic_init_print(INFO, "state %d ", ident->port.config.state);
+       ionic_init_print(INFO, "an_enable %d ", ident->port.config.an_enable);
+       ionic_init_print(INFO, "fec_type %d ", ident->port.config.fec_type);
+       ionic_init_print(INFO, "pause_type %d ", ident->port.config.pause_type);
+       ionic_init_print(INFO, "loopback_mode %d",
+                       ident->port.config.loopback_mode);
+
+       return err;
+}
+
+static const struct rte_memzone *
+ionic_memzone_reserve(const char *name, uint32_t len, int socket_id)
+{
+       const struct rte_memzone *mz;
+
+       mz = rte_memzone_lookup(name);
+       if (mz)
+               return mz;
+
+       mz = rte_memzone_reserve_aligned(name, len, socket_id,
+                       RTE_MEMZONE_IOVA_CONTIG, IONIC_ALIGN);
+       return mz;
+}
+
+int
+ionic_port_init(struct ionic_adapter *adapter)
+{
+       struct ionic_dev *idev = &adapter->idev;
+       struct ionic_identity *ident = &adapter->ident;
+       char z_name[RTE_MEMZONE_NAMESIZE];
+       unsigned int config_words = sizeof(ident->port.config.words) /
+               sizeof(ident->port.config.words[0]);
+       unsigned int cmd_words = sizeof(idev->dev_cmd->data) /
+               sizeof(idev->dev_cmd->data[0]);
+       unsigned int nwords;
+       unsigned int i;
+       int err;
+
+       if (idev->port_info)
+               return 0;
+
+       idev->port_info_sz = RTE_ALIGN(sizeof(*idev->port_info), PAGE_SIZE);
+
+       snprintf(z_name, sizeof(z_name), "%s_port_%s_info",
+                       IONIC_DRV_NAME,
+                       adapter->pci_dev->device.name);
+
+       idev->port_info_z = ionic_memzone_reserve(z_name, idev->port_info_sz,
+                       SOCKET_ID_ANY);
+
+       if (!idev->port_info_z) {
+               ionic_init_print(ERR, "Cannot reserve port info DMA memory");
+               return -ENOMEM;
+       }
+
+       idev->port_info = idev->port_info_z->addr;
+       idev->port_info_pa = idev->port_info_z->iova;
+
+       nwords = RTE_MIN(config_words, cmd_words);
+
+       for (i = 0; i < nwords; i++)
+               iowrite32(ident->port.config.words[i], &idev->dev_cmd->data[i]);
+
+       ionic_dev_cmd_port_init(idev);
+       err = ionic_dev_cmd_wait_check(idev, IONIC_DEVCMD_TIMEOUT);
+
+       if (err) {
+               ionic_init_print(ERR, "Failed to init port\n");
+               return err;
+       }
+
+       ionic_dev_cmd_port_state(idev, IONIC_PORT_ADMIN_STATE_UP);
+       err = ionic_dev_cmd_wait_check(idev, IONIC_DEVCMD_TIMEOUT);
+
+       if (err) {
+               ionic_init_print(WARNING, "Failed to bring port UP\n");
+               return err;
+       }
+
+       return 0;
+}
+
+int
+ionic_port_reset(struct ionic_adapter *adapter)
+{
+       struct ionic_dev *idev = &adapter->idev;
+       int err;
+
+       if (!idev->port_info)
+               return 0;
+
+       ionic_dev_cmd_port_reset(idev);
+       err = ionic_dev_cmd_wait_check(idev, IONIC_DEVCMD_TIMEOUT);
+
+       if (err) {
+               ionic_init_print(ERR, "Failed to reset port\n");
+               return err;
+       }
+
+       idev->port_info = NULL;
+       idev->port_info_pa = 0;
+
+       return 0;
+}

Reply via email to