4 files changed, 38 insertions, 1 deletions

diff --git a/drivers/net/ethernet/brocade/bna/bna_tx_rx.c b/drivers/net/ethernet/brocade/bna/bna_tx_rx.c
index 066704efe34d..276fcb589f4b 100644
--- a/drivers/net/ethernet/brocade/bna/bna_tx_rx.c
+++ b/drivers/net/ethernet/brocade/bna/bna_tx_rx.c
@@ -1335,6 +1335,12 @@ do {								    \
         }                                                              \
 } while (0)
 
+#define call_rx_stall_cbfn(rx)                                          \
+do {                                                                    \
+        if ((rx)->rx_stall_cbfn)                                        \
+                (rx)->rx_stall_cbfn((rx)->bna->bnad, (rx));             \
+} while (0)
+
 #define bfi_enet_datapath_q_init(bfi_q, bna_qpt)                        \
 do {                                                                    \
         struct bna_dma_addr cur_q_addr =                                \
@@ -1467,6 +1473,7 @@ bna_rx_sm_rxf_stop_wait(struct bna_rx *rx, enum bna_rx_event event)
         case RX_E_FAIL:
                 bfa_fsm_set_state(rx, bna_rx_sm_cleanup_wait);
                 bna_rxf_fail(&rx->rxf);
+                call_rx_stall_cbfn(rx);
                 rx->rx_cleanup_cbfn(rx->bna->bnad, rx);
                 break;
 
@@ -1476,6 +1483,7 @@ bna_rx_sm_rxf_stop_wait(struct bna_rx *rx, enum bna_rx_event event)
 
         case RX_E_RXF_STOPPED:
                 bfa_fsm_set_state(rx, bna_rx_sm_stop_wait);
+                call_rx_stall_cbfn(rx);
                 bna_rx_enet_stop(rx);
                 break;
 
@@ -1516,6 +1524,7 @@ bna_rx_sm_started(struct bna_rx *rx, enum bna_rx_event event)
                 bfa_fsm_set_state(rx, bna_rx_sm_failed);
                 bna_ethport_cb_rx_stopped(&rx->bna->ethport);
                 bna_rxf_fail(&rx->rxf);
+                call_rx_stall_cbfn(rx);
                 rx->rx_cleanup_cbfn(rx->bna->bnad, rx);
                 break;
 
@@ -1536,6 +1545,7 @@ static void bna_rx_sm_rxf_start_wait(struct bna_rx *rx,
         case RX_E_FAIL:
                 bfa_fsm_set_state(rx, bna_rx_sm_failed);
                 bna_rxf_fail(&rx->rxf);
+                call_rx_stall_cbfn(rx);
                 rx->rx_cleanup_cbfn(rx->bna->bnad, rx);
                 break;
 
@@ -2369,6 +2379,7 @@ bna_rx_create(struct bna *bna, struct bnad *bnad,
         rx->rcb_destroy_cbfn = rx_cbfn->rcb_destroy_cbfn;
         rx->ccb_setup_cbfn = rx_cbfn->ccb_setup_cbfn;
         rx->ccb_destroy_cbfn = rx_cbfn->ccb_destroy_cbfn;
+        rx->rx_stall_cbfn = rx_cbfn->rx_stall_cbfn;
         /* Following callbacks are mandatory */
         rx->rx_cleanup_cbfn = rx_cbfn->rx_cleanup_cbfn;
         rx->rx_post_cbfn = rx_cbfn->rx_post_cbfn;
diff --git a/drivers/net/ethernet/brocade/bna/bna_types.h b/drivers/net/ethernet/brocade/bna/bna_types.h
index 242d7997ffb2..d090fbfb12fa 100644
--- a/drivers/net/ethernet/brocade/bna/bna_types.h
+++ b/drivers/net/ethernet/brocade/bna/bna_types.h
@@ -847,6 +847,7 @@ struct bna_rx {
         void (*rcb_destroy_cbfn)(struct bnad *, struct bna_rcb *);
         void (*ccb_setup_cbfn)(struct bnad *, struct bna_ccb *);
         void (*ccb_destroy_cbfn)(struct bnad *, struct bna_ccb *);
+        void (*rx_stall_cbfn)(struct bnad *, struct bna_rx *);
         void (*rx_cleanup_cbfn)(struct bnad *, struct bna_rx *);
         void (*rx_post_cbfn)(struct bnad *, struct bna_rx *);
 
@@ -864,6 +865,7 @@ struct bna_rx_event_cbfn {
         void (*rcb_destroy_cbfn)(struct bnad *, struct bna_rcb *);
         void (*ccb_setup_cbfn)(struct bnad *, struct bna_ccb *);
         void (*ccb_destroy_cbfn)(struct bnad *, struct bna_ccb *);
+        void (*rx_stall_cbfn)(struct bnad *, struct bna_rx *);
         /* Mandatory */
         void (*rx_cleanup_cbfn)(struct bnad *, struct bna_rx *);
         void (*rx_post_cbfn)(struct bnad *, struct bna_rx *);
diff --git a/drivers/net/ethernet/brocade/bna/bnad.c b/drivers/net/ethernet/brocade/bna/bnad.c
index d76d7cb0dd0e..2f4ced66612a 100644
--- a/drivers/net/ethernet/brocade/bna/bnad.c
+++ b/drivers/net/ethernet/brocade/bna/bnad.c
@@ -396,7 +396,7 @@ finishing:
                 unmap_q->producer_index = unmap_prod;
                 rcb->producer_index = unmap_prod;
                 smp_mb();
-                if (likely(test_bit(BNAD_RXQ_STARTED, &rcb->flags)))
+                if (likely(test_bit(BNAD_RXQ_POST_OK, &rcb->flags)))
                         bna_rxq_prod_indx_doorbell(rcb);
         }
 }
@@ -956,6 +956,27 @@ bnad_cb_tx_cleanup(struct bnad *bnad, struct bna_tx *tx)
 }
 
 static void
+bnad_cb_rx_stall(struct bnad *bnad, struct bna_rx *rx)
+{
+        struct bnad_rx_info *rx_info = (struct bnad_rx_info *)rx->priv;
+        struct bna_ccb *ccb;
+        struct bnad_rx_ctrl *rx_ctrl;
+        int i;
+
+        for (i = 0; i < BNAD_MAX_RXP_PER_RX; i++) {
+                rx_ctrl = &rx_info->rx_ctrl[i];
+                ccb = rx_ctrl->ccb;
+                if (!ccb)
+                        continue;
+
+                clear_bit(BNAD_RXQ_POST_OK, &ccb->rcb[0]->flags);
+
+                if (ccb->rcb[1])
+                        clear_bit(BNAD_RXQ_POST_OK, &ccb->rcb[1]->flags);
+        }
+}
+
+static void
 bnad_cb_rx_cleanup(struct bnad *bnad, struct bna_rx *rx)
 {
         struct bnad_rx_info *rx_info = (struct bnad_rx_info *)rx->priv;
@@ -1009,6 +1030,7 @@ bnad_cb_rx_post(struct bnad *bnad, struct bna_rx *rx)
                         bnad_free_all_rxbufs(bnad, rcb);
 
                         set_bit(BNAD_RXQ_STARTED, &rcb->flags);
+                        set_bit(BNAD_RXQ_POST_OK, &rcb->flags);
                         unmap_q = rcb->unmap_q;
 
                         /* Now allocate & post buffers for this RCB */
@@ -1898,6 +1920,7 @@ bnad_setup_rx(struct bnad *bnad, u32 rx_id)
                 .rcb_destroy_cbfn = bnad_cb_rcb_destroy,
                 .ccb_setup_cbfn = bnad_cb_ccb_setup,
                 .ccb_destroy_cbfn = bnad_cb_ccb_destroy,
+                .rx_stall_cbfn = bnad_cb_rx_stall,
                 .rx_cleanup_cbfn = bnad_cb_rx_cleanup,
                 .rx_post_cbfn = bnad_cb_rx_post,
         };
diff --git a/drivers/net/ethernet/brocade/bna/bnad.h b/drivers/net/ethernet/brocade/bna/bnad.h
index 1c9328d564d2..50fb36aedd5d 100644
--- a/drivers/net/ethernet/brocade/bna/bnad.h
+++ b/drivers/net/ethernet/brocade/bna/bnad.h
@@ -103,6 +103,7 @@ struct bnad_rx_ctrl {
 /* Bit positions for rcb->flags */
 #define BNAD_RXQ_REFILL                 0
 #define BNAD_RXQ_STARTED                1
+#define BNAD_RXQ_POST_OK                2
 
 /* Resource limits */
 #define BNAD_NUM_TXQ                    (bnad->num_tx * bnad->num_txq_per_tx)