[PATCH net-next 11/11] ibmvnic: Reset sub-crqs during driver reset

[Nathan Fontenot]

When the ibmvnic driver is resetting, we can just reset the sub crqs
instead of releasing all of their resources and re-allocting them.

Signed-off-by: Nathan Fontenot <nf...@linux.vnet.ibm.com>
---
 drivers/net/ethernet/ibm/ibmvnic.c |   46 ++++++++++++++++++++++++++++++++++--
 1 file changed, 43 insertions(+), 3 deletions(-)

diff --git a/drivers/net/ethernet/ibm/ibmvnic.c 
b/drivers/net/ethernet/ibm/ibmvnic.c
index 5661a04..8dcf580 100644
--- a/drivers/net/ethernet/ibm/ibmvnic.c
+++ b/drivers/net/ethernet/ibm/ibmvnic.c
@@ -1320,8 +1320,6 @@ static int do_reset(struct ibmvnic_adapter *adapter,
                 */
                adapter->state = VNIC_PROBED;
 
-               release_sub_crqs(adapter);
-
                rc = ibmvnic_init(adapter);
                if (rc)
                        return 0;
@@ -1728,6 +1726,45 @@ static void ibmvnic_get_ethtool_stats(struct net_device 
*dev,
 
 /* Routines for managing CRQs/sCRQs  */
 
+static int reset_one_sub_crq_queue(struct ibmvnic_adapter *adapter,
+                                  struct ibmvnic_sub_crq_queue *scrq)
+{
+       int rc;
+
+       if (scrq->irq) {
+               free_irq(scrq->irq, scrq);
+               irq_dispose_mapping(scrq->irq);
+               scrq->irq = 0;
+       }
+
+       memset(scrq->msgs, 0, 2 * PAGE_SIZE);
+       scrq->cur = 0;
+
+       rc = h_reg_sub_crq(adapter->vdev->unit_address, scrq->msg_token,
+                          4 * PAGE_SIZE, &scrq->crq_num, &scrq->hw_irq);
+       return rc;
+}
+
+static int reset_sub_crq_queues(struct ibmvnic_adapter *adapter)
+{
+       int i, rc;
+
+       for (i = 0; i < adapter->req_tx_queues; i++) {
+               rc = reset_one_sub_crq_queue(adapter, adapter->tx_scrq[i]);
+               if (rc)
+                       return rc;
+       }
+
+       for (i = 0; i < adapter->req_rx_queues; i++) {
+               rc = reset_one_sub_crq_queue(adapter, adapter->rx_scrq[i]);
+               if (rc)
+                       return rc;
+       }
+
+       rc = init_sub_crq_irqs(adapter);
+       return rc;
+}
+
 static void release_sub_crq_queue(struct ibmvnic_adapter *adapter,
                                  struct ibmvnic_sub_crq_queue *scrq)
 {
@@ -3607,7 +3644,10 @@ static int ibmvnic_init(struct ibmvnic_adapter *adapter)
                return -1;
        }
 
-       rc = init_sub_crqs(adapter);
+       if (adapter->resetting)
+               rc = reset_sub_crq_queues(adapter);
+       else
+               rc = init_sub_crqs(adapter);
        if (rc) {
                dev_err(dev, "Initialization of sub crqs failed\n");
                release_crq_queue(adapter);