qede: Add support for link

This adds basic link functionality to qede - driver still doesn't provide
users with an API to change any link property, but it does request qed to
initialize the link using default configuration, and registers a callback
that allows it to get link notifications.

This patch adds the ability of the driver to set the carrier as active and
to enable traffic as a result of async. link notifications.
Following this patch, driver should be capable of running traffic.

Signed-off-by: Sudarsana Kalluru <Sudarsana.Kalluru@qlogic.com>
Signed-off-by: Yuval Mintz <Yuval.Mintz@qlogic.com>
Signed-off-by: Ariel Elior <Ariel.Elior@qlogic.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/qlogic/qede/qede_main.c b/drivers/net/ethernet/qlogic/qede/qede_main.c
index 0351204317e74820c7f1a747ef97c03965715fc5..890439cbec7e630e6964710d12f1e04631d2b875 100644 (file)
--- a/drivers/net/ethernet/qlogic/qede/qede_main.c
+++ b/drivers/net/ethernet/qlogic/qede/qede_main.c
@@ -87,6 +87,7 @@ static int qede_probe(struct pci_dev *pdev, const struct pci_device_id *id);
 static void qede_remove(struct pci_dev *pdev);
 static int qede_alloc_rx_buffer(struct qede_dev *edev,
                                struct qede_rx_queue *rxq);
+static void qede_link_update(void *dev, struct qed_link_output *link);
 
 static struct pci_driver qede_pci_driver = {
        .name = "qede",
@@ -95,6 +96,12 @@ static struct pci_driver qede_pci_driver = {
        .remove = qede_remove,
 };
 
+static struct qed_eth_cb_ops qede_ll_ops = {
+       {
+               .link_update = qede_link_update,
+       },
+};
+
 static int qede_netdev_event(struct notifier_block *this, unsigned long event,
                             void *ptr)
 {
@@ -1304,6 +1311,8 @@ static int __qede_probe(struct pci_dev *pdev, u32 dp_module, u8 dp_level,
 
        edev->ops->common->set_id(cdev, edev->ndev->name, DRV_MODULE_VERSION);
 
+       edev->ops->register_ops(cdev, &qede_ll_ops, edev);
+
        INIT_DELAYED_WORK(&edev->sp_task, qede_sp_task);
        mutex_init(&edev->qede_lock);
 
@@ -2099,6 +2108,7 @@ enum qede_unload_mode {
 
 static void qede_unload(struct qede_dev *edev, enum qede_unload_mode mode)
 {
+       struct qed_link_params link_params;
        int rc;
 
        DP_INFO(edev, "Starting qede unload\n");
@@ -2110,6 +2120,10 @@ static void qede_unload(struct qede_dev *edev, enum qede_unload_mode mode)
        netif_tx_disable(edev->ndev);
        netif_carrier_off(edev->ndev);
 
+       /* Reset the link */
+       memset(&link_params, 0, sizeof(link_params));
+       link_params.link_up = false;
+       edev->ops->common->set_link(edev->cdev, &link_params);
        rc = qede_stop_queues(edev);
        if (rc) {
                qede_sync_free_irqs(edev);
@@ -2140,6 +2154,8 @@ enum qede_load_mode {
 
 static int qede_load(struct qede_dev *edev, enum qede_load_mode mode)
 {
+       struct qed_link_params link_params;
+       struct qed_link_output link_output;
        int rc;
 
        DP_INFO(edev, "Starting qede load\n");
@@ -2183,6 +2199,17 @@ static int qede_load(struct qede_dev *edev, enum qede_load_mode mode)
        mutex_lock(&edev->qede_lock);
        edev->state = QEDE_STATE_OPEN;
        mutex_unlock(&edev->qede_lock);
+
+       /* Ask for link-up using current configuration */
+       memset(&link_params, 0, sizeof(link_params));
+       link_params.link_up = true;
+       edev->ops->common->set_link(edev->cdev, &link_params);
+
+       /* Query whether link is already-up */
+       memset(&link_output, 0, sizeof(link_output));
+       edev->ops->common->get_link(edev->cdev, &link_output);
+       qede_link_update(edev, &link_output);
+
        DP_INFO(edev, "Ending successfully qede load\n");
 
        return 0;
@@ -2223,6 +2250,26 @@ static int qede_close(struct net_device *ndev)
        return 0;
 }
 
+static void qede_link_update(void *dev, struct qed_link_output *link)
+{
+       struct qede_dev *edev = dev;
+
+       if (!netif_running(edev->ndev)) {
+               DP_VERBOSE(edev, NETIF_MSG_LINK, "Interface is not running\n");
+               return;
+       }
+
+       if (link->link_up) {
+               DP_NOTICE(edev, "Link is up\n");
+               netif_tx_start_all_queues(edev->ndev);
+               netif_carrier_on(edev->ndev);
+       } else {
+               DP_NOTICE(edev, "Link is down\n");
+               netif_tx_disable(edev->ndev);
+               netif_carrier_off(edev->ndev);
+       }
+}
+
 static int qede_set_mac_addr(struct net_device *ndev, void *p)
 {
        struct qede_dev *edev = netdev_priv(ndev);