cxgb3 - parity initialization for T3C adapters.

Add parity initialization for T3C adapters.

Signed-off-by: Divy Le Ray <divy@chelsio.com>
Signed-off-by: Jeff Garzik <jeff@garzik.org>

1 files changed, 82 insertions, 0 deletions

diff --git a/drivers/net/cxgb3/cxgb3_main.c b/drivers/net/cxgb3/cxgb3_main.c
index 944423c497d2..d1aa7779796e 100644
--- a/drivers/net/cxgb3/cxgb3_main.c
+++ b/drivers/net/cxgb3/cxgb3_main.c
@@ -306,6 +306,77 @@ static int request_msix_data_irqs(struct adapter *adap)
         return 0;
 }
 
+static int await_mgmt_replies(struct adapter *adap, unsigned long init_cnt,
+                              unsigned long n)
+{
+        int attempts = 5;
+
+        while (adap->sge.qs[0].rspq.offload_pkts < init_cnt + n) {
+                if (!--attempts)
+                        return -ETIMEDOUT;
+                msleep(10);
+        }
+        return 0;
+}
+
+static int init_tp_parity(struct adapter *adap)
+{
+        int i;
+        struct sk_buff *skb;
+        struct cpl_set_tcb_field *greq;
+        unsigned long cnt = adap->sge.qs[0].rspq.offload_pkts;
+
+        t3_tp_set_offload_mode(adap, 1);
+
+        for (i = 0; i < 16; i++) {
+                struct cpl_smt_write_req *req;
+
+                skb = alloc_skb(sizeof(*req), GFP_KERNEL | __GFP_NOFAIL);
+                req = (struct cpl_smt_write_req *)__skb_put(skb, sizeof(*req));
+                memset(req, 0, sizeof(*req));
+                req->wr.wr_hi = htonl(V_WR_OP(FW_WROPCODE_FORWARD));
+                OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SMT_WRITE_REQ, i));
+                req->iff = i;
+                t3_mgmt_tx(adap, skb);
+        }
+
+        for (i = 0; i < 2048; i++) {
+                struct cpl_l2t_write_req *req;
+
+                skb = alloc_skb(sizeof(*req), GFP_KERNEL | __GFP_NOFAIL);
+                req = (struct cpl_l2t_write_req *)__skb_put(skb, sizeof(*req));
+                memset(req, 0, sizeof(*req));
+                req->wr.wr_hi = htonl(V_WR_OP(FW_WROPCODE_FORWARD));
+                OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_L2T_WRITE_REQ, i));
+                req->params = htonl(V_L2T_W_IDX(i));
+                t3_mgmt_tx(adap, skb);
+        }
+
+        for (i = 0; i < 2048; i++) {
+                struct cpl_rte_write_req *req;
+
+                skb = alloc_skb(sizeof(*req), GFP_KERNEL | __GFP_NOFAIL);
+                req = (struct cpl_rte_write_req *)__skb_put(skb, sizeof(*req));
+                memset(req, 0, sizeof(*req));
+                req->wr.wr_hi = htonl(V_WR_OP(FW_WROPCODE_FORWARD));
+                OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_RTE_WRITE_REQ, i));
+                req->l2t_idx = htonl(V_L2T_W_IDX(i));
+                t3_mgmt_tx(adap, skb);
+        }
+
+        skb = alloc_skb(sizeof(*greq), GFP_KERNEL | __GFP_NOFAIL);
+        greq = (struct cpl_set_tcb_field *)__skb_put(skb, sizeof(*greq));
+        memset(greq, 0, sizeof(*greq));
+        greq->wr.wr_hi = htonl(V_WR_OP(FW_WROPCODE_FORWARD));
+        OPCODE_TID(greq) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, 0));
+        greq->mask = cpu_to_be64(1);
+        t3_mgmt_tx(adap, skb);
+
+        i = await_mgmt_replies(adap, cnt, 16 + 2048 + 2048 + 1);
+        t3_tp_set_offload_mode(adap, 0);
+        return i;
+}
+
 /**
  *      setup_rss - configure RSS
  *      @adap: the adapter
@@ -817,6 +888,7 @@ static int cxgb_up(struct adapter *adap)
                 if (err)
                         goto out;
 
+                t3_set_reg_field(adap, A_TP_PARA_REG5, 0, F_RXDDPOFFINIT);
                 t3_write_reg(adap, A_ULPRX_TDDP_PSZ, V_HPZ0(PAGE_SHIFT - 12));
 
                 err = setup_sge_qsets(adap);
@@ -856,6 +928,16 @@ static int cxgb_up(struct adapter *adap)
         t3_sge_start(adap);
         t3_intr_enable(adap);
 
+        if (adap->params.rev >= T3_REV_C && !(adap->flags & TP_PARITY_INIT) &&
+            is_offload(adap) && init_tp_parity(adap) == 0)
+                adap->flags |= TP_PARITY_INIT;
+
+        if (adap->flags & TP_PARITY_INIT) {
+                t3_write_reg(adap, A_TP_INT_CAUSE,
+                             F_CMCACHEPERR | F_ARPLUTPERR);
+                t3_write_reg(adap, A_TP_INT_ENABLE, 0x7fbfffff);
+        }
+
         if ((adap->flags & (USING_MSIX | QUEUES_BOUND)) == USING_MSIX)
                 bind_qsets(adap);
         adap->flags |= QUEUES_BOUND;