Imported Upstream version 16.07-rc1
[deb_dpdk.git] / drivers / net / qede / base / ecore_cxt.c
diff --git a/drivers/net/qede/base/ecore_cxt.c b/drivers/net/qede/base/ecore_cxt.c
new file mode 100644 (file)
index 0000000..1201c1a
--- /dev/null
@@ -0,0 +1,1961 @@
+/*
+ * Copyright (c) 2016 QLogic Corporation.
+ * All rights reserved.
+ * www.qlogic.com
+ *
+ * See LICENSE.qede_pmd for copyright and licensing details.
+ */
+
+#include "bcm_osal.h"
+#include "reg_addr.h"
+#include "ecore_hsi_common.h"
+#include "ecore_hsi_eth.h"
+#include "ecore_rt_defs.h"
+#include "ecore_status.h"
+#include "ecore.h"
+#include "ecore_init_ops.h"
+#include "ecore_init_fw_funcs.h"
+#include "ecore_cxt.h"
+#include "ecore_hw.h"
+#include "ecore_dev_api.h"
+
+/* Max number of connection types in HW (DQ/CDU etc.) */
+#define MAX_CONN_TYPES         PROTOCOLID_COMMON
+#define NUM_TASK_TYPES         2
+#define NUM_TASK_PF_SEGMENTS   4
+#define NUM_TASK_VF_SEGMENTS   1
+
+/* Doorbell-Queue constants */
+#define DQ_RANGE_SHIFT 4
+#define DQ_RANGE_ALIGN (1 << DQ_RANGE_SHIFT)
+
+/* Searcher constants */
+#define SRC_MIN_NUM_ELEMS 256
+
+/* Timers constants */
+#define TM_SHIFT       7
+#define TM_ALIGN       (1 << TM_SHIFT)
+#define TM_ELEM_SIZE   4
+
+/* ILT constants */
+/* If for some reason, HW P size is modified to be less than 32K,
+ * special handling needs to be made for CDU initialization
+ */
+#define ILT_DEFAULT_HW_P_SIZE  3
+
+#define ILT_PAGE_IN_BYTES(hw_p_size)   (1U << ((hw_p_size) + 12))
+#define ILT_CFG_REG(cli, reg)          PSWRQ2_REG_##cli##_##reg##_RT_OFFSET
+
+/* ILT entry structure */
+#define ILT_ENTRY_PHY_ADDR_MASK                0x000FFFFFFFFFFFULL
+#define ILT_ENTRY_PHY_ADDR_SHIFT       0
+#define ILT_ENTRY_VALID_MASK           0x1ULL
+#define ILT_ENTRY_VALID_SHIFT          52
+#define ILT_ENTRY_IN_REGS              2
+#define ILT_REG_SIZE_IN_BYTES          4
+
+/* connection context union */
+union conn_context {
+       struct core_conn_context core_ctx;
+       struct eth_conn_context eth_ctx;
+};
+
+struct src_ent {
+       u8 opaque[56];
+       u64 next;
+};
+
+#define CDUT_SEG_ALIGNMET 3    /* in 4k chunks */
+#define CDUT_SEG_ALIGNMET_IN_BYTES (1 << (CDUT_SEG_ALIGNMET + 12))
+
+#define CONN_CXT_SIZE(p_hwfn) \
+       ALIGNED_TYPE_SIZE(union conn_context, p_hwfn)
+
+/* PF per protocl configuration object */
+#define TASK_SEGMENTS   (NUM_TASK_PF_SEGMENTS + NUM_TASK_VF_SEGMENTS)
+#define TASK_SEGMENT_VF (NUM_TASK_PF_SEGMENTS)
+
+struct ecore_tid_seg {
+       u32 count;
+       u8 type;
+       bool has_fl_mem;
+};
+
+struct ecore_conn_type_cfg {
+       u32 cid_count;
+       u32 cid_start;
+       u32 cids_per_vf;
+       struct ecore_tid_seg tid_seg[TASK_SEGMENTS];
+};
+
+/* ILT Client configuration,
+ * Per connection type (protocol) resources (cids, tis, vf cids etc.)
+ * 1 - for connection context (CDUC) and for each task context we need two
+ * values, for regular task context and for force load memory
+ */
+#define ILT_CLI_PF_BLOCKS      (1 + NUM_TASK_PF_SEGMENTS * 2)
+#define ILT_CLI_VF_BLOCKS      (1 + NUM_TASK_VF_SEGMENTS * 2)
+#define CDUC_BLK               (0)
+#define CDUT_SEG_BLK(n)                (1 + (u8)(n))
+#define CDUT_FL_SEG_BLK(n, X)  (1 + (n) + NUM_TASK_##X##_SEGMENTS)
+
+enum ilt_clients {
+       ILT_CLI_CDUC,
+       ILT_CLI_CDUT,
+       ILT_CLI_QM,
+       ILT_CLI_TM,
+       ILT_CLI_SRC,
+       ILT_CLI_MAX
+};
+
+struct ilt_cfg_pair {
+       u32 reg;
+       u32 val;
+};
+
+struct ecore_ilt_cli_blk {
+       u32 total_size;         /* 0 means not active */
+       u32 real_size_in_page;
+       u32 start_line;
+       u32 dynamic_line_cnt;
+};
+
+struct ecore_ilt_client_cfg {
+       bool active;
+
+       /* ILT boundaries */
+       struct ilt_cfg_pair first;
+       struct ilt_cfg_pair last;
+       struct ilt_cfg_pair p_size;
+
+       /* ILT client blocks for PF */
+       struct ecore_ilt_cli_blk pf_blks[ILT_CLI_PF_BLOCKS];
+       u32 pf_total_lines;
+
+       /* ILT client blocks for VFs */
+       struct ecore_ilt_cli_blk vf_blks[ILT_CLI_VF_BLOCKS];
+       u32 vf_total_lines;
+};
+
+/* Per Path -
+ *      ILT shadow table
+ *      Protocol acquired CID lists
+ *      PF start line in ILT
+ */
+struct ecore_dma_mem {
+       dma_addr_t p_phys;
+       void *p_virt;
+       osal_size_t size;
+};
+
+#define MAP_WORD_SIZE          sizeof(unsigned long)
+#define BITS_PER_MAP_WORD      (MAP_WORD_SIZE * 8)
+
+struct ecore_cid_acquired_map {
+       u32 start_cid;
+       u32 max_count;
+       unsigned long *cid_map;
+};
+
+struct ecore_cxt_mngr {
+       /* Per protocl configuration */
+       struct ecore_conn_type_cfg conn_cfg[MAX_CONN_TYPES];
+
+       /* computed ILT structure */
+       struct ecore_ilt_client_cfg clients[ILT_CLI_MAX];
+
+       /* Task type sizes */
+       u32 task_type_size[NUM_TASK_TYPES];
+
+       /* total number of VFs for this hwfn -
+        * ALL VFs are symmetric in terms of HW resources
+        */
+       u32 vf_count;
+
+       /* Acquired CIDs */
+       struct ecore_cid_acquired_map acquired[MAX_CONN_TYPES];
+
+       /* ILT  shadow table */
+       struct ecore_dma_mem *ilt_shadow;
+       u32 pf_start_line;
+
+       /* SRC T2 */
+       struct ecore_dma_mem *t2;
+       u32 t2_num_pages;
+       u64 first_free;
+       u64 last_free;
+};
+
+/* check if resources/configuration is required according to protocol type */
+static OSAL_INLINE bool src_proto(enum protocol_type type)
+{
+       return type == PROTOCOLID_TOE;
+}
+
+static OSAL_INLINE bool tm_cid_proto(enum protocol_type type)
+{
+       return type == PROTOCOLID_TOE;
+}
+
+/* counts the iids for the CDU/CDUC ILT client configuration */
+struct ecore_cdu_iids {
+       u32 pf_cids;
+       u32 per_vf_cids;
+};
+
+static void ecore_cxt_cdu_iids(struct ecore_cxt_mngr *p_mngr,
+                              struct ecore_cdu_iids *iids)
+{
+       u32 type;
+
+       for (type = 0; type < MAX_CONN_TYPES; type++) {
+               iids->pf_cids += p_mngr->conn_cfg[type].cid_count;
+               iids->per_vf_cids += p_mngr->conn_cfg[type].cids_per_vf;
+       }
+}
+
+/* counts the iids for the Searcher block configuration */
+struct ecore_src_iids {
+       u32 pf_cids;
+       u32 per_vf_cids;
+};
+
+static OSAL_INLINE void ecore_cxt_src_iids(struct ecore_cxt_mngr *p_mngr,
+                                          struct ecore_src_iids *iids)
+{
+       u32 i;
+
+       for (i = 0; i < MAX_CONN_TYPES; i++) {
+               if (!src_proto(i))
+                       continue;
+
+               iids->pf_cids += p_mngr->conn_cfg[i].cid_count;
+               iids->per_vf_cids += p_mngr->conn_cfg[i].cids_per_vf;
+       }
+}
+
+/* counts the iids for the Timers block configuration */
+struct ecore_tm_iids {
+       u32 pf_cids;
+       u32 pf_tids[NUM_TASK_PF_SEGMENTS];      /* per segment */
+       u32 pf_tids_total;
+       u32 per_vf_cids;
+       u32 per_vf_tids;
+};
+
+static OSAL_INLINE void ecore_cxt_tm_iids(struct ecore_cxt_mngr *p_mngr,
+                                         struct ecore_tm_iids *iids)
+{
+       u32 i, j;
+
+       for (i = 0; i < MAX_CONN_TYPES; i++) {
+               struct ecore_conn_type_cfg *p_cfg = &p_mngr->conn_cfg[i];
+
+               if (tm_cid_proto(i)) {
+                       iids->pf_cids += p_cfg->cid_count;
+                       iids->per_vf_cids += p_cfg->cids_per_vf;
+               }
+       }
+
+       iids->pf_cids = ROUNDUP(iids->pf_cids, TM_ALIGN);
+       iids->per_vf_cids = ROUNDUP(iids->per_vf_cids, TM_ALIGN);
+       iids->per_vf_tids = ROUNDUP(iids->per_vf_tids, TM_ALIGN);
+
+       for (iids->pf_tids_total = 0, j = 0; j < NUM_TASK_PF_SEGMENTS; j++) {
+               iids->pf_tids[j] = ROUNDUP(iids->pf_tids[j], TM_ALIGN);
+               iids->pf_tids_total += iids->pf_tids[j];
+       }
+}
+
+void ecore_cxt_qm_iids(struct ecore_hwfn *p_hwfn, struct ecore_qm_iids *iids)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       struct ecore_tid_seg *segs;
+       u32 vf_cids = 0, type, j;
+       u32 vf_tids = 0;
+
+       for (type = 0; type < MAX_CONN_TYPES; type++) {
+               iids->cids += p_mngr->conn_cfg[type].cid_count;
+               vf_cids += p_mngr->conn_cfg[type].cids_per_vf;
+
+               segs = p_mngr->conn_cfg[type].tid_seg;
+               /* for each segment there is at most one
+                * protocol for which count is not 0.
+                */
+               for (j = 0; j < NUM_TASK_PF_SEGMENTS; j++)
+                       iids->tids += segs[j].count;
+
+               /* The last array elelment is for the VFs. As for PF
+                * segments there can be only one protocol for
+                * which this value is not 0.
+                */
+               vf_tids += segs[NUM_TASK_PF_SEGMENTS].count;
+       }
+
+       iids->vf_cids += vf_cids * p_mngr->vf_count;
+       iids->tids += vf_tids * p_mngr->vf_count;
+
+       DP_VERBOSE(p_hwfn, ECORE_MSG_ILT,
+                  "iids: CIDS %08x vf_cids %08x tids %08x vf_tids %08x\n",
+                  iids->cids, iids->vf_cids, iids->tids, vf_tids);
+}
+
+static struct ecore_tid_seg *ecore_cxt_tid_seg_info(struct ecore_hwfn *p_hwfn,
+                                                   u32 seg)
+{
+       struct ecore_cxt_mngr *p_cfg = p_hwfn->p_cxt_mngr;
+       u32 i;
+
+       /* Find the protocol with tid count > 0 for this segment.
+        * Note: there can only be one and this is already validated.
+        */
+       for (i = 0; i < MAX_CONN_TYPES; i++) {
+               if (p_cfg->conn_cfg[i].tid_seg[seg].count)
+                       return &p_cfg->conn_cfg[i].tid_seg[seg];
+       }
+       return OSAL_NULL;
+}
+
+/* set the iids (cid/tid) count per protocol */
+void ecore_cxt_set_proto_cid_count(struct ecore_hwfn *p_hwfn,
+                                  enum protocol_type type,
+                                  u32 cid_count, u32 vf_cid_cnt)
+{
+       struct ecore_cxt_mngr *p_mgr = p_hwfn->p_cxt_mngr;
+       struct ecore_conn_type_cfg *p_conn = &p_mgr->conn_cfg[type];
+
+       p_conn->cid_count = ROUNDUP(cid_count, DQ_RANGE_ALIGN);
+       p_conn->cids_per_vf = ROUNDUP(vf_cid_cnt, DQ_RANGE_ALIGN);
+}
+
+u32 ecore_cxt_get_proto_cid_count(struct ecore_hwfn *p_hwfn,
+                                 enum protocol_type type, u32 *vf_cid)
+{
+       if (vf_cid)
+               *vf_cid = p_hwfn->p_cxt_mngr->conn_cfg[type].cids_per_vf;
+
+       return p_hwfn->p_cxt_mngr->conn_cfg[type].cid_count;
+}
+
+u32 ecore_cxt_get_proto_cid_start(struct ecore_hwfn *p_hwfn,
+                                 enum protocol_type type)
+{
+       return p_hwfn->p_cxt_mngr->acquired[type].start_cid;
+}
+
+static u32 ecore_cxt_get_proto_tid_count(struct ecore_hwfn *p_hwfn,
+                                        enum protocol_type type)
+{
+       u32 cnt = 0;
+       int i;
+
+       for (i = 0; i < TASK_SEGMENTS; i++)
+               cnt += p_hwfn->p_cxt_mngr->conn_cfg[type].tid_seg[i].count;
+
+       return cnt;
+}
+
+static OSAL_INLINE void
+ecore_cxt_set_proto_tid_count(struct ecore_hwfn *p_hwfn,
+                             enum protocol_type proto,
+                             u8 seg, u8 seg_type, u32 count, bool has_fl)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       struct ecore_tid_seg *p_seg = &p_mngr->conn_cfg[proto].tid_seg[seg];
+
+       p_seg->count = count;
+       p_seg->has_fl_mem = has_fl;
+       p_seg->type = seg_type;
+}
+
+/* the *p_line parameter must be either 0 for the first invocation or the
+ * value returned in the previous invocation.
+ */
+static void ecore_ilt_cli_blk_fill(struct ecore_ilt_client_cfg *p_cli,
+                                  struct ecore_ilt_cli_blk *p_blk,
+                                  u32 start_line,
+                                  u32 total_size, u32 elem_size)
+{
+       u32 ilt_size = ILT_PAGE_IN_BYTES(p_cli->p_size.val);
+
+       /* verfiy called once for each block */
+       if (p_blk->total_size)
+               return;
+
+       p_blk->total_size = total_size;
+       p_blk->real_size_in_page = 0;
+       if (elem_size)
+               p_blk->real_size_in_page = (ilt_size / elem_size) * elem_size;
+       p_blk->start_line = start_line;
+}
+
+static void ecore_ilt_cli_adv_line(struct ecore_hwfn *p_hwfn,
+                                  struct ecore_ilt_client_cfg *p_cli,
+                                  struct ecore_ilt_cli_blk *p_blk,
+                                  u32 *p_line, enum ilt_clients client_id)
+{
+       if (!p_blk->total_size)
+               return;
+
+       if (!p_cli->active)
+               p_cli->first.val = *p_line;
+
+       p_cli->active = true;
+       *p_line += DIV_ROUND_UP(p_blk->total_size, p_blk->real_size_in_page);
+       p_cli->last.val = *p_line - 1;
+
+       DP_VERBOSE(p_hwfn, ECORE_MSG_ILT,
+                  "ILT[Client %d] - Lines: [%08x - %08x]. Block - Size %08x [Real %08x] Start line %d\n",
+                  client_id, p_cli->first.val, p_cli->last.val,
+                  p_blk->total_size, p_blk->real_size_in_page,
+                  p_blk->start_line);
+}
+
+static u32 ecore_ilt_get_dynamic_line_cnt(struct ecore_hwfn *p_hwfn,
+                                         enum ilt_clients ilt_client)
+{
+       u32 cid_count = p_hwfn->p_cxt_mngr->conn_cfg[PROTOCOLID_ROCE].cid_count;
+       struct ecore_ilt_client_cfg *p_cli;
+       u32 lines_to_skip = 0;
+       u32 cxts_per_p;
+
+       /* TBD MK: ILT code should be simplified once PROTO enum is changed */
+
+       if (ilt_client == ILT_CLI_CDUC) {
+               p_cli = &p_hwfn->p_cxt_mngr->clients[ILT_CLI_CDUC];
+
+               cxts_per_p = ILT_PAGE_IN_BYTES(p_cli->p_size.val) /
+                   (u32)CONN_CXT_SIZE(p_hwfn);
+
+               lines_to_skip = cid_count / cxts_per_p;
+       }
+
+       return lines_to_skip;
+}
+
+enum _ecore_status_t ecore_cxt_cfg_ilt_compute(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 curr_line, total, i, task_size, line;
+       struct ecore_ilt_client_cfg *p_cli;
+       struct ecore_ilt_cli_blk *p_blk;
+       struct ecore_cdu_iids cdu_iids;
+       struct ecore_src_iids src_iids;
+       struct ecore_qm_iids qm_iids;
+       struct ecore_tm_iids tm_iids;
+       struct ecore_tid_seg *p_seg;
+
+       OSAL_MEM_ZERO(&qm_iids, sizeof(qm_iids));
+       OSAL_MEM_ZERO(&cdu_iids, sizeof(cdu_iids));
+       OSAL_MEM_ZERO(&src_iids, sizeof(src_iids));
+       OSAL_MEM_ZERO(&tm_iids, sizeof(tm_iids));
+
+       p_mngr->pf_start_line = RESC_START(p_hwfn, ECORE_ILT);
+
+       DP_VERBOSE(p_hwfn, ECORE_MSG_ILT,
+                  "hwfn [%d] - Set context manager starting line to be 0x%08x\n",
+                  p_hwfn->my_id, p_hwfn->p_cxt_mngr->pf_start_line);
+
+       /* CDUC */
+       p_cli = &p_mngr->clients[ILT_CLI_CDUC];
+
+       curr_line = p_mngr->pf_start_line;
+
+       /* CDUC PF */
+       p_cli->pf_total_lines = 0;
+
+       /* get the counters for the CDUC,CDUC and QM clients  */
+       ecore_cxt_cdu_iids(p_mngr, &cdu_iids);
+
+       p_blk = &p_cli->pf_blks[CDUC_BLK];
+
+       total = cdu_iids.pf_cids * CONN_CXT_SIZE(p_hwfn);
+
+       ecore_ilt_cli_blk_fill(p_cli, p_blk, curr_line,
+                              total, CONN_CXT_SIZE(p_hwfn));
+
+       ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line, ILT_CLI_CDUC);
+       p_cli->pf_total_lines = curr_line - p_blk->start_line;
+
+       p_blk->dynamic_line_cnt = ecore_ilt_get_dynamic_line_cnt(p_hwfn,
+                                                                ILT_CLI_CDUC);
+
+       /* CDUC VF */
+       p_blk = &p_cli->vf_blks[CDUC_BLK];
+       total = cdu_iids.per_vf_cids * CONN_CXT_SIZE(p_hwfn);
+
+       ecore_ilt_cli_blk_fill(p_cli, p_blk, curr_line,
+                              total, CONN_CXT_SIZE(p_hwfn));
+
+       ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line, ILT_CLI_CDUC);
+       p_cli->vf_total_lines = curr_line - p_blk->start_line;
+
+       for (i = 1; i < p_mngr->vf_count; i++)
+               ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                      ILT_CLI_CDUC);
+
+       /* CDUT PF */
+       p_cli = &p_mngr->clients[ILT_CLI_CDUT];
+       p_cli->first.val = curr_line;
+
+       /* first the 'working' task memory */
+       for (i = 0; i < NUM_TASK_PF_SEGMENTS; i++) {
+               p_seg = ecore_cxt_tid_seg_info(p_hwfn, i);
+               if (!p_seg || p_seg->count == 0)
+                       continue;
+
+               p_blk = &p_cli->pf_blks[CDUT_SEG_BLK(i)];
+               total = p_seg->count * p_mngr->task_type_size[p_seg->type];
+               ecore_ilt_cli_blk_fill(p_cli, p_blk, curr_line, total,
+                                      p_mngr->task_type_size[p_seg->type]);
+
+               ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                      ILT_CLI_CDUT);
+       }
+
+       /* next the 'init' task memory (forced load memory) */
+       for (i = 0; i < NUM_TASK_PF_SEGMENTS; i++) {
+               p_seg = ecore_cxt_tid_seg_info(p_hwfn, i);
+               if (!p_seg || p_seg->count == 0)
+                       continue;
+
+               p_blk = &p_cli->pf_blks[CDUT_FL_SEG_BLK(i, PF)];
+
+               if (!p_seg->has_fl_mem) {
+                       /* The segment is active (total size pf 'working'
+                        * memory is > 0) but has no FL (forced-load, Init)
+                        * memory. Thus:
+                        *
+                        * 1.   The total-size in the corrsponding FL block of
+                        *      the ILT client is set to 0 - No ILT line are
+                        *      provisioned and no ILT memory allocated.
+                        *
+                        * 2.   The start-line of said block is set to the
+                        *      start line of the matching working memory
+                        *      block in the ILT client. This is later used to
+                        *      configure the CDU segment offset registers and
+                        *      results in an FL command for TIDs of this
+                        *      segment behaves as regular load commands
+                        *      (loading TIDs from the working memory).
+                        */
+                       line = p_cli->pf_blks[CDUT_SEG_BLK(i)].start_line;
+
+                       ecore_ilt_cli_blk_fill(p_cli, p_blk, line, 0, 0);
+                       continue;
+               }
+               total = p_seg->count * p_mngr->task_type_size[p_seg->type];
+
+               ecore_ilt_cli_blk_fill(p_cli, p_blk,
+                                      curr_line, total,
+                                      p_mngr->task_type_size[p_seg->type]);
+
+               ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                      ILT_CLI_CDUT);
+       }
+       p_cli->pf_total_lines = curr_line - p_cli->pf_blks[0].start_line;
+
+       /* CDUT VF */
+       p_seg = ecore_cxt_tid_seg_info(p_hwfn, TASK_SEGMENT_VF);
+       if (p_seg && p_seg->count) {
+               /* Stricly speaking we need to iterate over all VF
+                * task segment types, but a VF has only 1 segment
+                */
+
+               /* 'working' memory */
+               total = p_seg->count * p_mngr->task_type_size[p_seg->type];
+
+               p_blk = &p_cli->vf_blks[CDUT_SEG_BLK(0)];
+               ecore_ilt_cli_blk_fill(p_cli, p_blk,
+                                      curr_line, total,
+                                      p_mngr->task_type_size[p_seg->type]);
+
+               ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                      ILT_CLI_CDUT);
+
+               /* 'init' memory */
+               p_blk = &p_cli->vf_blks[CDUT_FL_SEG_BLK(0, VF)];
+               if (!p_seg->has_fl_mem) {
+                       /* see comment above */
+                       line = p_cli->vf_blks[CDUT_SEG_BLK(0)].start_line;
+                       ecore_ilt_cli_blk_fill(p_cli, p_blk, line, 0, 0);
+               } else {
+                       task_size = p_mngr->task_type_size[p_seg->type];
+                       ecore_ilt_cli_blk_fill(p_cli, p_blk,
+                                              curr_line, total, task_size);
+                       ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                              ILT_CLI_CDUT);
+               }
+               p_cli->vf_total_lines = curr_line -
+                   p_cli->vf_blks[0].start_line;
+
+               /* Now for the rest of the VFs */
+               for (i = 1; i < p_mngr->vf_count; i++) {
+                       p_blk = &p_cli->vf_blks[CDUT_SEG_BLK(0)];
+                       ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                              ILT_CLI_CDUT);
+
+                       p_blk = &p_cli->vf_blks[CDUT_FL_SEG_BLK(0, VF)];
+                       ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                              ILT_CLI_CDUT);
+               }
+       }
+
+       /* QM */
+       p_cli = &p_mngr->clients[ILT_CLI_QM];
+       p_blk = &p_cli->pf_blks[0];
+
+       ecore_cxt_qm_iids(p_hwfn, &qm_iids);
+       total = ecore_qm_pf_mem_size(p_hwfn->rel_pf_id, qm_iids.cids,
+                                    qm_iids.vf_cids, qm_iids.tids,
+                                    p_hwfn->qm_info.num_pqs,
+                                    p_hwfn->qm_info.num_vf_pqs);
+
+       DP_VERBOSE(p_hwfn, ECORE_MSG_ILT,
+                  "QM ILT Info, (cids=%d, vf_cids=%d, tids=%d, num_pqs=%d,"
+                  " num_vf_pqs=%d, memory_size=%d)\n",
+                  qm_iids.cids, qm_iids.vf_cids, qm_iids.tids,
+                  p_hwfn->qm_info.num_pqs, p_hwfn->qm_info.num_vf_pqs, total);
+
+       ecore_ilt_cli_blk_fill(p_cli, p_blk, curr_line, total * 0x1000,
+                              QM_PQ_ELEMENT_SIZE);
+
+       ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line, ILT_CLI_QM);
+       p_cli->pf_total_lines = curr_line - p_blk->start_line;
+
+       /* SRC */
+       p_cli = &p_mngr->clients[ILT_CLI_SRC];
+       ecore_cxt_src_iids(p_mngr, &src_iids);
+
+       /* Both the PF and VFs searcher connections are stored in the per PF
+        * database. Thus sum the PF searcher cids and all the VFs searcher
+        * cids.
+        */
+       total = src_iids.pf_cids + src_iids.per_vf_cids * p_mngr->vf_count;
+       if (total) {
+               u32 local_max = OSAL_MAX_T(u32, total,
+                                          SRC_MIN_NUM_ELEMS);
+
+               total = OSAL_ROUNDUP_POW_OF_TWO(local_max);
+
+               p_blk = &p_cli->pf_blks[0];
+               ecore_ilt_cli_blk_fill(p_cli, p_blk, curr_line,
+                                      total * sizeof(struct src_ent),
+                                      sizeof(struct src_ent));
+
+               ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                      ILT_CLI_SRC);
+               p_cli->pf_total_lines = curr_line - p_blk->start_line;
+       }
+
+       /* TM PF */
+       p_cli = &p_mngr->clients[ILT_CLI_TM];
+       ecore_cxt_tm_iids(p_mngr, &tm_iids);
+       total = tm_iids.pf_cids + tm_iids.pf_tids_total;
+       if (total) {
+               p_blk = &p_cli->pf_blks[0];
+               ecore_ilt_cli_blk_fill(p_cli, p_blk, curr_line,
+                                      total * TM_ELEM_SIZE, TM_ELEM_SIZE);
+
+               ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                      ILT_CLI_TM);
+               p_cli->pf_total_lines = curr_line - p_blk->start_line;
+       }
+
+       /* TM VF */
+       total = tm_iids.per_vf_cids + tm_iids.per_vf_tids;
+       if (total) {
+               p_blk = &p_cli->vf_blks[0];
+               ecore_ilt_cli_blk_fill(p_cli, p_blk, curr_line,
+                                      total * TM_ELEM_SIZE, TM_ELEM_SIZE);
+
+               ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                      ILT_CLI_TM);
+               p_cli->pf_total_lines = curr_line - p_blk->start_line;
+
+               for (i = 1; i < p_mngr->vf_count; i++) {
+                       ecore_ilt_cli_adv_line(p_hwfn, p_cli, p_blk, &curr_line,
+                                              ILT_CLI_TM);
+               }
+       }
+
+       if (curr_line - p_hwfn->p_cxt_mngr->pf_start_line >
+           RESC_NUM(p_hwfn, ECORE_ILT)) {
+               DP_ERR(p_hwfn, "too many ilt lines...#lines=%d\n",
+                      curr_line - p_hwfn->p_cxt_mngr->pf_start_line);
+               return ECORE_INVAL;
+       }
+
+       return ECORE_SUCCESS;
+}
+
+static void ecore_cxt_src_t2_free(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 i;
+
+       if (!p_mngr->t2)
+               return;
+
+       for (i = 0; i < p_mngr->t2_num_pages; i++)
+               if (p_mngr->t2[i].p_virt)
+                       OSAL_DMA_FREE_COHERENT(p_hwfn->p_dev,
+                                              p_mngr->t2[i].p_virt,
+                                              p_mngr->t2[i].p_phys,
+                                              p_mngr->t2[i].size);
+
+       OSAL_FREE(p_hwfn->p_dev, p_mngr->t2);
+       p_mngr->t2 = OSAL_NULL;
+}
+
+static enum _ecore_status_t ecore_cxt_src_t2_alloc(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 conn_num, total_size, ent_per_page, psz, i;
+       struct ecore_ilt_client_cfg *p_src;
+       struct ecore_src_iids src_iids;
+       struct ecore_dma_mem *p_t2;
+       enum _ecore_status_t rc;
+
+       OSAL_MEM_ZERO(&src_iids, sizeof(src_iids));
+
+       /* if the SRC ILT client is inactive - there are no connection
+        * requiring the searcer, leave.
+        */
+       p_src = &p_hwfn->p_cxt_mngr->clients[ILT_CLI_SRC];
+       if (!p_src->active)
+               return ECORE_SUCCESS;
+
+       ecore_cxt_src_iids(p_mngr, &src_iids);
+       conn_num = src_iids.pf_cids + src_iids.per_vf_cids * p_mngr->vf_count;
+       total_size = conn_num * sizeof(struct src_ent);
+
+       /* use the same page size as the SRC ILT client */
+       psz = ILT_PAGE_IN_BYTES(p_src->p_size.val);
+       p_mngr->t2_num_pages = DIV_ROUND_UP(total_size, psz);
+
+       /* allocate t2 */
+       p_mngr->t2 = OSAL_ZALLOC(p_hwfn->p_dev, GFP_KERNEL,
+                                p_mngr->t2_num_pages *
+                                sizeof(struct ecore_dma_mem));
+       if (!p_mngr->t2) {
+               DP_NOTICE(p_hwfn, true, "Failed to allocate t2 table\n");
+               rc = ECORE_NOMEM;
+               goto t2_fail;
+       }
+
+       /* allocate t2 pages */
+       for (i = 0; i < p_mngr->t2_num_pages; i++) {
+               u32 size = OSAL_MIN_T(u32, total_size, psz);
+               void **p_virt = &p_mngr->t2[i].p_virt;
+
+               *p_virt = OSAL_DMA_ALLOC_COHERENT(p_hwfn->p_dev,
+                                                 &p_mngr->t2[i].p_phys, size);
+               if (!p_mngr->t2[i].p_virt) {
+                       rc = ECORE_NOMEM;
+                       goto t2_fail;
+               }
+               OSAL_MEM_ZERO(*p_virt, size);
+               p_mngr->t2[i].size = size;
+               total_size -= size;
+       }
+
+       /* Set the t2 pointers */
+
+       /* entries per page - must be a power of two */
+       ent_per_page = psz / sizeof(struct src_ent);
+
+       p_mngr->first_free = (u64)p_mngr->t2[0].p_phys;
+
+       p_t2 = &p_mngr->t2[(conn_num - 1) / ent_per_page];
+       p_mngr->last_free = (u64)p_t2->p_phys +
+           ((conn_num - 1) & (ent_per_page - 1)) * sizeof(struct src_ent);
+
+       for (i = 0; i < p_mngr->t2_num_pages; i++) {
+               u32 ent_num = OSAL_MIN_T(u32, ent_per_page, conn_num);
+               struct src_ent *entries = p_mngr->t2[i].p_virt;
+               u64 p_ent_phys = (u64)p_mngr->t2[i].p_phys, val;
+               u32 j;
+
+               for (j = 0; j < ent_num - 1; j++) {
+                       val = p_ent_phys + (j + 1) * sizeof(struct src_ent);
+                       entries[j].next = OSAL_CPU_TO_BE64(val);
+               }
+
+               if (i < p_mngr->t2_num_pages - 1)
+                       val = (u64)p_mngr->t2[i + 1].p_phys;
+               else
+                       val = 0;
+               entries[j].next = OSAL_CPU_TO_BE64(val);
+
+               conn_num -= ent_per_page;
+       }
+
+       return ECORE_SUCCESS;
+
+t2_fail:
+       ecore_cxt_src_t2_free(p_hwfn);
+       return rc;
+}
+
+/* Total number of ILT lines used by this PF */
+static u32 ecore_cxt_ilt_shadow_size(struct ecore_ilt_client_cfg *ilt_clients)
+{
+       u32 size = 0;
+       u32 i;
+
+       for (i = 0; i < ILT_CLI_MAX; i++)
+               if (!ilt_clients[i].active)
+                       continue;
+               else
+                       size += (ilt_clients[i].last.val -
+                               ilt_clients[i].first.val + 1);
+
+       return size;
+}
+
+static void ecore_ilt_shadow_free(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_ilt_client_cfg *p_cli = p_hwfn->p_cxt_mngr->clients;
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 ilt_size, i;
+
+       ilt_size = ecore_cxt_ilt_shadow_size(p_cli);
+
+       for (i = 0; p_mngr->ilt_shadow && i < ilt_size; i++) {
+               struct ecore_dma_mem *p_dma = &p_mngr->ilt_shadow[i];
+
+               if (p_dma->p_virt)
+                       OSAL_DMA_FREE_COHERENT(p_hwfn->p_dev,
+                                              p_dma->p_virt,
+                                              p_dma->p_phys, p_dma->size);
+               p_dma->p_virt = OSAL_NULL;
+       }
+       OSAL_FREE(p_hwfn->p_dev, p_mngr->ilt_shadow);
+}
+
+static enum _ecore_status_t
+ecore_ilt_blk_alloc(struct ecore_hwfn *p_hwfn,
+                   struct ecore_ilt_cli_blk *p_blk,
+                   enum ilt_clients ilt_client, u32 start_line_offset)
+{
+       struct ecore_dma_mem *ilt_shadow = p_hwfn->p_cxt_mngr->ilt_shadow;
+       u32 lines, line, sz_left, lines_to_skip = 0;
+
+       /* Special handling for RoCE that supports dynamic allocation */
+       if (ilt_client == ILT_CLI_CDUT)
+               return ECORE_SUCCESS;
+
+       lines_to_skip = p_blk->dynamic_line_cnt;
+
+       if (!p_blk->total_size)
+               return ECORE_SUCCESS;
+
+       sz_left = p_blk->total_size;
+       lines = DIV_ROUND_UP(sz_left, p_blk->real_size_in_page) - lines_to_skip;
+       line = p_blk->start_line + start_line_offset -
+           p_hwfn->p_cxt_mngr->pf_start_line + lines_to_skip;
+
+       for (; lines; lines--) {
+               dma_addr_t p_phys;
+               void *p_virt;
+               u32 size;
+
+               size = OSAL_MIN_T(u32, sz_left, p_blk->real_size_in_page);
+
+/* @DPDK */
+#define ILT_BLOCK_ALIGN_SIZE 0x1000
+               p_virt = OSAL_DMA_ALLOC_COHERENT_ALIGNED(p_hwfn->p_dev,
+                                                        &p_phys, size,
+                                                        ILT_BLOCK_ALIGN_SIZE);
+               if (!p_virt)
+                       return ECORE_NOMEM;
+               OSAL_MEM_ZERO(p_virt, size);
+
+               ilt_shadow[line].p_phys = p_phys;
+               ilt_shadow[line].p_virt = p_virt;
+               ilt_shadow[line].size = size;
+
+               DP_VERBOSE(p_hwfn, ECORE_MSG_ILT,
+                          "ILT shadow: Line [%d] Physical 0x%" PRIx64
+                          " Virtual %p Size %d\n",
+                          line, (u64)p_phys, p_virt, size);
+
+               sz_left -= size;
+               line++;
+       }
+
+       return ECORE_SUCCESS;
+}
+
+static enum _ecore_status_t ecore_ilt_shadow_alloc(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       struct ecore_ilt_client_cfg *clients = p_mngr->clients;
+       struct ecore_ilt_cli_blk *p_blk;
+       enum _ecore_status_t rc;
+       u32 size, i, j, k;
+
+       size = ecore_cxt_ilt_shadow_size(clients);
+       p_mngr->ilt_shadow = OSAL_ZALLOC(p_hwfn->p_dev, GFP_KERNEL,
+                                        size * sizeof(struct ecore_dma_mem));
+
+       if (!p_mngr->ilt_shadow) {
+               DP_NOTICE(p_hwfn, true, "Failed to allocate ilt shadow table");
+               rc = ECORE_NOMEM;
+               goto ilt_shadow_fail;
+       }
+
+       DP_VERBOSE(p_hwfn, ECORE_MSG_ILT,
+                  "Allocated 0x%x bytes for ilt shadow\n",
+                  (u32)(size * sizeof(struct ecore_dma_mem)));
+
+       for (i = 0; i < ILT_CLI_MAX; i++)
+               if (!clients[i].active) {
+                       continue;
+               } else {
+               for (j = 0; j < ILT_CLI_PF_BLOCKS; j++) {
+                       p_blk = &clients[i].pf_blks[j];
+                       rc = ecore_ilt_blk_alloc(p_hwfn, p_blk, i, 0);
+                       if (rc != ECORE_SUCCESS)
+                               goto ilt_shadow_fail;
+               }
+               for (k = 0; k < p_mngr->vf_count; k++) {
+                       for (j = 0; j < ILT_CLI_VF_BLOCKS; j++) {
+                               u32 lines = clients[i].vf_total_lines * k;
+
+                               p_blk = &clients[i].vf_blks[j];
+                               rc = ecore_ilt_blk_alloc(p_hwfn, p_blk,
+                                                        i, lines);
+                               if (rc != ECORE_SUCCESS)
+                                       goto ilt_shadow_fail;
+                       }
+               }
+       }
+
+       return ECORE_SUCCESS;
+
+ilt_shadow_fail:
+       ecore_ilt_shadow_free(p_hwfn);
+       return rc;
+}
+
+static void ecore_cid_map_free(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 type;
+
+       for (type = 0; type < MAX_CONN_TYPES; type++) {
+               OSAL_FREE(p_hwfn->p_dev, p_mngr->acquired[type].cid_map);
+               p_mngr->acquired[type].max_count = 0;
+               p_mngr->acquired[type].start_cid = 0;
+       }
+}
+
+static enum _ecore_status_t ecore_cid_map_alloc(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 start_cid = 0;
+       u32 type;
+
+       for (type = 0; type < MAX_CONN_TYPES; type++) {
+               u32 cid_cnt = p_hwfn->p_cxt_mngr->conn_cfg[type].cid_count;
+               u32 size;
+
+               if (cid_cnt == 0)
+                       continue;
+
+               size = MAP_WORD_SIZE * DIV_ROUND_UP(cid_cnt, BITS_PER_MAP_WORD);
+               p_mngr->acquired[type].cid_map = OSAL_ZALLOC(p_hwfn->p_dev,
+                                                            GFP_KERNEL, size);
+               if (!p_mngr->acquired[type].cid_map)
+                       goto cid_map_fail;
+
+               p_mngr->acquired[type].max_count = cid_cnt;
+               p_mngr->acquired[type].start_cid = start_cid;
+
+               p_hwfn->p_cxt_mngr->conn_cfg[type].cid_start = start_cid;
+
+               DP_VERBOSE(p_hwfn, ECORE_MSG_CXT,
+                          "Type %08x start: %08x count %08x\n",
+                          type, p_mngr->acquired[type].start_cid,
+                          p_mngr->acquired[type].max_count);
+               start_cid += cid_cnt;
+       }
+
+       return ECORE_SUCCESS;
+
+cid_map_fail:
+       ecore_cid_map_free(p_hwfn);
+       return ECORE_NOMEM;
+}
+
+enum _ecore_status_t ecore_cxt_mngr_alloc(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr;
+       u32 i;
+
+       p_mngr = OSAL_ZALLOC(p_hwfn->p_dev, GFP_KERNEL, sizeof(*p_mngr));
+       if (!p_mngr) {
+               DP_NOTICE(p_hwfn, true,
+                         "Failed to allocate `struct ecore_cxt_mngr'\n");
+               return ECORE_NOMEM;
+       }
+
+       /* Initialize ILT client registers */
+       p_mngr->clients[ILT_CLI_CDUC].first.reg = ILT_CFG_REG(CDUC, FIRST_ILT);
+       p_mngr->clients[ILT_CLI_CDUC].last.reg = ILT_CFG_REG(CDUC, LAST_ILT);
+       p_mngr->clients[ILT_CLI_CDUC].p_size.reg = ILT_CFG_REG(CDUC, P_SIZE);
+
+       p_mngr->clients[ILT_CLI_QM].first.reg = ILT_CFG_REG(QM, FIRST_ILT);
+       p_mngr->clients[ILT_CLI_QM].last.reg = ILT_CFG_REG(QM, LAST_ILT);
+       p_mngr->clients[ILT_CLI_QM].p_size.reg = ILT_CFG_REG(QM, P_SIZE);
+
+       p_mngr->clients[ILT_CLI_TM].first.reg = ILT_CFG_REG(TM, FIRST_ILT);
+       p_mngr->clients[ILT_CLI_TM].last.reg = ILT_CFG_REG(TM, LAST_ILT);
+       p_mngr->clients[ILT_CLI_TM].p_size.reg = ILT_CFG_REG(TM, P_SIZE);
+
+       p_mngr->clients[ILT_CLI_SRC].first.reg = ILT_CFG_REG(SRC, FIRST_ILT);
+       p_mngr->clients[ILT_CLI_SRC].last.reg = ILT_CFG_REG(SRC, LAST_ILT);
+       p_mngr->clients[ILT_CLI_SRC].p_size.reg = ILT_CFG_REG(SRC, P_SIZE);
+
+       p_mngr->clients[ILT_CLI_CDUT].first.reg = ILT_CFG_REG(CDUT, FIRST_ILT);
+       p_mngr->clients[ILT_CLI_CDUT].last.reg = ILT_CFG_REG(CDUT, LAST_ILT);
+       p_mngr->clients[ILT_CLI_CDUT].p_size.reg = ILT_CFG_REG(CDUT, P_SIZE);
+
+       /* default ILT page size for all clients is 32K */
+       for (i = 0; i < ILT_CLI_MAX; i++)
+               p_mngr->clients[i].p_size.val = ILT_DEFAULT_HW_P_SIZE;
+
+       /* Initialize task sizes */
+       p_mngr->task_type_size[0] = 512;        /* @DPDK */
+       p_mngr->task_type_size[1] = 128;        /* @DPDK */
+
+       p_mngr->vf_count = p_hwfn->p_dev->sriov_info.total_vfs;
+       /* Set the cxt mangr pointer priori to further allocations */
+       p_hwfn->p_cxt_mngr = p_mngr;
+
+       return ECORE_SUCCESS;
+}
+
+enum _ecore_status_t ecore_cxt_tables_alloc(struct ecore_hwfn *p_hwfn)
+{
+       enum _ecore_status_t rc;
+
+       /* Allocate the ILT shadow table */
+       rc = ecore_ilt_shadow_alloc(p_hwfn);
+       if (rc) {
+               DP_NOTICE(p_hwfn, true, "Failed to allocate ilt memory\n");
+               goto tables_alloc_fail;
+       }
+
+       /* Allocate the T2  table */
+       rc = ecore_cxt_src_t2_alloc(p_hwfn);
+       if (rc) {
+               DP_NOTICE(p_hwfn, true, "Failed to allocate T2 memory\n");
+               goto tables_alloc_fail;
+       }
+
+       /* Allocate and initialize the acquired cids bitmaps */
+       rc = ecore_cid_map_alloc(p_hwfn);
+       if (rc) {
+               DP_NOTICE(p_hwfn, true, "Failed to allocate cid maps\n");
+               goto tables_alloc_fail;
+       }
+
+       return ECORE_SUCCESS;
+
+tables_alloc_fail:
+       ecore_cxt_mngr_free(p_hwfn);
+       return rc;
+}
+
+void ecore_cxt_mngr_free(struct ecore_hwfn *p_hwfn)
+{
+       if (!p_hwfn->p_cxt_mngr)
+               return;
+
+       ecore_cid_map_free(p_hwfn);
+       ecore_cxt_src_t2_free(p_hwfn);
+       ecore_ilt_shadow_free(p_hwfn);
+       OSAL_FREE(p_hwfn->p_dev, p_hwfn->p_cxt_mngr);
+
+       p_hwfn->p_cxt_mngr = OSAL_NULL;
+}
+
+void ecore_cxt_mngr_setup(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       int type;
+
+       /* Reset acquired cids */
+       for (type = 0; type < MAX_CONN_TYPES; type++) {
+               u32 cid_cnt = p_hwfn->p_cxt_mngr->conn_cfg[type].cid_count;
+               u32 i;
+
+               if (cid_cnt == 0)
+                       continue;
+
+               for (i = 0; i < DIV_ROUND_UP(cid_cnt, BITS_PER_MAP_WORD); i++)
+                       p_mngr->acquired[type].cid_map[i] = 0;
+       }
+}
+
+/* HW initialization helper (per Block, per phase) */
+
+/* CDU Common */
+#define CDUC_CXT_SIZE_SHIFT                                            \
+       CDU_REG_CID_ADDR_PARAMS_CONTEXT_SIZE_SHIFT
+
+#define CDUC_CXT_SIZE_MASK                                             \
+       (CDU_REG_CID_ADDR_PARAMS_CONTEXT_SIZE >> CDUC_CXT_SIZE_SHIFT)
+
+#define CDUC_BLOCK_WASTE_SHIFT                                         \
+       CDU_REG_CID_ADDR_PARAMS_BLOCK_WASTE_SHIFT
+
+#define CDUC_BLOCK_WASTE_MASK                                          \
+       (CDU_REG_CID_ADDR_PARAMS_BLOCK_WASTE >> CDUC_BLOCK_WASTE_SHIFT)
+
+#define CDUC_NCIB_SHIFT                                                        \
+       CDU_REG_CID_ADDR_PARAMS_NCIB_SHIFT
+
+#define CDUC_NCIB_MASK                                                 \
+       (CDU_REG_CID_ADDR_PARAMS_NCIB >> CDUC_NCIB_SHIFT)
+
+#define CDUT_TYPE0_CXT_SIZE_SHIFT                                      \
+       CDU_REG_SEGMENT0_PARAMS_T0_TID_SIZE_SHIFT
+
+#define CDUT_TYPE0_CXT_SIZE_MASK                                       \
+       (CDU_REG_SEGMENT0_PARAMS_T0_TID_SIZE >>                         \
+       CDUT_TYPE0_CXT_SIZE_SHIFT)
+
+#define CDUT_TYPE0_BLOCK_WASTE_SHIFT                                   \
+       CDU_REG_SEGMENT0_PARAMS_T0_TID_BLOCK_WASTE_SHIFT
+
+#define CDUT_TYPE0_BLOCK_WASTE_MASK                                    \
+       (CDU_REG_SEGMENT0_PARAMS_T0_TID_BLOCK_WASTE >>                  \
+       CDUT_TYPE0_BLOCK_WASTE_SHIFT)
+
+#define CDUT_TYPE0_NCIB_SHIFT                                          \
+       CDU_REG_SEGMENT0_PARAMS_T0_NUM_TIDS_IN_BLOCK_SHIFT
+
+#define CDUT_TYPE0_NCIB_MASK                                           \
+       (CDU_REG_SEGMENT0_PARAMS_T0_NUM_TIDS_IN_BLOCK >>                \
+       CDUT_TYPE0_NCIB_SHIFT)
+
+#define CDUT_TYPE1_CXT_SIZE_SHIFT                                      \
+       CDU_REG_SEGMENT1_PARAMS_T1_TID_SIZE_SHIFT
+
+#define CDUT_TYPE1_CXT_SIZE_MASK                                       \
+       (CDU_REG_SEGMENT1_PARAMS_T1_TID_SIZE >>                         \
+       CDUT_TYPE1_CXT_SIZE_SHIFT)
+
+#define CDUT_TYPE1_BLOCK_WASTE_SHIFT                                   \
+       CDU_REG_SEGMENT1_PARAMS_T1_TID_BLOCK_WASTE_SHIFT
+
+#define CDUT_TYPE1_BLOCK_WASTE_MASK                                    \
+       (CDU_REG_SEGMENT1_PARAMS_T1_TID_BLOCK_WASTE >>                  \
+       CDUT_TYPE1_BLOCK_WASTE_SHIFT)
+
+#define CDUT_TYPE1_NCIB_SHIFT                                          \
+       CDU_REG_SEGMENT1_PARAMS_T1_NUM_TIDS_IN_BLOCK_SHIFT
+
+#define CDUT_TYPE1_NCIB_MASK                                           \
+       (CDU_REG_SEGMENT1_PARAMS_T1_NUM_TIDS_IN_BLOCK >>                \
+       CDUT_TYPE1_NCIB_SHIFT)
+
+static void ecore_cdu_init_common(struct ecore_hwfn *p_hwfn)
+{
+       u32 page_sz, elems_per_page, block_waste, cxt_size, cdu_params = 0;
+
+       /* CDUC - connection configuration */
+       page_sz = p_hwfn->p_cxt_mngr->clients[ILT_CLI_CDUC].p_size.val;
+       cxt_size = CONN_CXT_SIZE(p_hwfn);
+       elems_per_page = ILT_PAGE_IN_BYTES(page_sz) / cxt_size;
+       block_waste = ILT_PAGE_IN_BYTES(page_sz) - elems_per_page * cxt_size;
+
+       SET_FIELD(cdu_params, CDUC_CXT_SIZE, cxt_size);
+       SET_FIELD(cdu_params, CDUC_BLOCK_WASTE, block_waste);
+       SET_FIELD(cdu_params, CDUC_NCIB, elems_per_page);
+       STORE_RT_REG(p_hwfn, CDU_REG_CID_ADDR_PARAMS_RT_OFFSET, cdu_params);
+
+       /* CDUT - type-0 tasks configuration */
+       page_sz = p_hwfn->p_cxt_mngr->clients[ILT_CLI_CDUT].p_size.val;
+       cxt_size = p_hwfn->p_cxt_mngr->task_type_size[0];
+       elems_per_page = ILT_PAGE_IN_BYTES(page_sz) / cxt_size;
+       block_waste = ILT_PAGE_IN_BYTES(page_sz) - elems_per_page * cxt_size;
+
+       /* cxt size and block-waste are multipes of 8 */
+       cdu_params = 0;
+       SET_FIELD(cdu_params, CDUT_TYPE0_CXT_SIZE, (cxt_size >> 3));
+       SET_FIELD(cdu_params, CDUT_TYPE0_BLOCK_WASTE, (block_waste >> 3));
+       SET_FIELD(cdu_params, CDUT_TYPE0_NCIB, elems_per_page);
+       STORE_RT_REG(p_hwfn, CDU_REG_SEGMENT0_PARAMS_RT_OFFSET, cdu_params);
+
+       /* CDUT - type-1 tasks configuration */
+       cxt_size = p_hwfn->p_cxt_mngr->task_type_size[1];
+       elems_per_page = ILT_PAGE_IN_BYTES(page_sz) / cxt_size;
+       block_waste = ILT_PAGE_IN_BYTES(page_sz) - elems_per_page * cxt_size;
+
+       /* cxt size and block-waste are multipes of 8 */
+       cdu_params = 0;
+       SET_FIELD(cdu_params, CDUT_TYPE1_CXT_SIZE, (cxt_size >> 3));
+       SET_FIELD(cdu_params, CDUT_TYPE1_BLOCK_WASTE, (block_waste >> 3));
+       SET_FIELD(cdu_params, CDUT_TYPE1_NCIB, elems_per_page);
+       STORE_RT_REG(p_hwfn, CDU_REG_SEGMENT1_PARAMS_RT_OFFSET, cdu_params);
+}
+
+/* CDU PF */
+#define CDU_SEG_REG_TYPE_SHIFT         CDU_SEG_TYPE_OFFSET_REG_TYPE_SHIFT
+#define CDU_SEG_REG_TYPE_MASK          0x1
+#define CDU_SEG_REG_OFFSET_SHIFT       0
+#define CDU_SEG_REG_OFFSET_MASK                CDU_SEG_TYPE_OFFSET_REG_OFFSET_MASK
+
+static void ecore_cdu_init_pf(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_ilt_client_cfg *p_cli;
+       struct ecore_tid_seg *p_seg;
+       u32 cdu_seg_params, offset;
+       int i;
+
+       static const u32 rt_type_offset_arr[] = {
+               CDU_REG_PF_SEG0_TYPE_OFFSET_RT_OFFSET,
+               CDU_REG_PF_SEG1_TYPE_OFFSET_RT_OFFSET,
+               CDU_REG_PF_SEG2_TYPE_OFFSET_RT_OFFSET,
+               CDU_REG_PF_SEG3_TYPE_OFFSET_RT_OFFSET
+       };
+
+       static const u32 rt_type_offset_fl_arr[] = {
+               CDU_REG_PF_FL_SEG0_TYPE_OFFSET_RT_OFFSET,
+               CDU_REG_PF_FL_SEG1_TYPE_OFFSET_RT_OFFSET,
+               CDU_REG_PF_FL_SEG2_TYPE_OFFSET_RT_OFFSET,
+               CDU_REG_PF_FL_SEG3_TYPE_OFFSET_RT_OFFSET
+       };
+
+       p_cli = &p_hwfn->p_cxt_mngr->clients[ILT_CLI_CDUT];
+
+       /* There are initializations only for CDUT during pf Phase */
+       for (i = 0; i < NUM_TASK_PF_SEGMENTS; i++) {
+               /* Segment 0 */
+               p_seg = ecore_cxt_tid_seg_info(p_hwfn, i);
+               if (!p_seg)
+                       continue;
+
+               /* Note: start_line is already adjusted for the CDU
+                * segment register granularity, so we just need to
+                * divide. Adjustment is implicit as we assume ILT
+                * Page size is larger than 32K!
+                */
+               offset = (ILT_PAGE_IN_BYTES(p_cli->p_size.val) *
+                         (p_cli->pf_blks[CDUT_SEG_BLK(i)].start_line -
+                          p_cli->first.val)) / CDUT_SEG_ALIGNMET_IN_BYTES;
+
+               cdu_seg_params = 0;
+               SET_FIELD(cdu_seg_params, CDU_SEG_REG_TYPE, p_seg->type);
+               SET_FIELD(cdu_seg_params, CDU_SEG_REG_OFFSET, offset);
+               STORE_RT_REG(p_hwfn, rt_type_offset_arr[i], cdu_seg_params);
+
+               offset = (ILT_PAGE_IN_BYTES(p_cli->p_size.val) *
+                         (p_cli->pf_blks[CDUT_FL_SEG_BLK(i, PF)].start_line -
+                          p_cli->first.val)) / CDUT_SEG_ALIGNMET_IN_BYTES;
+
+               cdu_seg_params = 0;
+               SET_FIELD(cdu_seg_params, CDU_SEG_REG_TYPE, p_seg->type);
+               SET_FIELD(cdu_seg_params, CDU_SEG_REG_OFFSET, offset);
+               STORE_RT_REG(p_hwfn, rt_type_offset_fl_arr[i], cdu_seg_params);
+       }
+}
+
+void ecore_qm_init_pf(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_qm_info *qm_info = &p_hwfn->qm_info;
+       struct ecore_qm_iids iids;
+
+       OSAL_MEM_ZERO(&iids, sizeof(iids));
+       ecore_cxt_qm_iids(p_hwfn, &iids);
+
+       ecore_qm_pf_rt_init(p_hwfn, p_hwfn->p_main_ptt, p_hwfn->port_id,
+                           p_hwfn->rel_pf_id, qm_info->max_phys_tcs_per_port,
+                           p_hwfn->first_on_engine,
+                           iids.cids, iids.vf_cids, iids.tids,
+                           qm_info->start_pq,
+                           qm_info->num_pqs - qm_info->num_vf_pqs,
+                           qm_info->num_vf_pqs,
+                           qm_info->start_vport,
+                           qm_info->num_vports, qm_info->pf_wfq,
+                           qm_info->pf_rl, p_hwfn->qm_info.qm_pq_params,
+                           p_hwfn->qm_info.qm_vport_params);
+}
+
+/* CM PF */
+static enum _ecore_status_t ecore_cm_init_pf(struct ecore_hwfn *p_hwfn)
+{
+       union ecore_qm_pq_params pq_params;
+       u16 pq;
+
+       /* XCM pure-LB queue */
+       OSAL_MEMSET(&pq_params, 0, sizeof(pq_params));
+       pq_params.core.tc = LB_TC;
+       pq = ecore_get_qm_pq(p_hwfn, PROTOCOLID_CORE, &pq_params);
+       STORE_RT_REG(p_hwfn, XCM_REG_CON_PHY_Q3_RT_OFFSET, pq);
+
+       return ECORE_SUCCESS;
+}
+
+/* DQ PF */
+static void ecore_dq_init_pf(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 dq_pf_max_cid = 0, dq_vf_max_cid = 0;
+
+       dq_pf_max_cid += (p_mngr->conn_cfg[0].cid_count >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_PF_MAX_ICID_0_RT_OFFSET, dq_pf_max_cid);
+
+       dq_vf_max_cid += (p_mngr->conn_cfg[0].cids_per_vf >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_VF_MAX_ICID_0_RT_OFFSET, dq_vf_max_cid);
+
+       dq_pf_max_cid += (p_mngr->conn_cfg[1].cid_count >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_PF_MAX_ICID_1_RT_OFFSET, dq_pf_max_cid);
+
+       dq_vf_max_cid += (p_mngr->conn_cfg[1].cids_per_vf >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_VF_MAX_ICID_1_RT_OFFSET, dq_vf_max_cid);
+
+       dq_pf_max_cid += (p_mngr->conn_cfg[2].cid_count >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_PF_MAX_ICID_2_RT_OFFSET, dq_pf_max_cid);
+
+       dq_vf_max_cid += (p_mngr->conn_cfg[2].cids_per_vf >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_VF_MAX_ICID_2_RT_OFFSET, dq_vf_max_cid);
+
+       dq_pf_max_cid += (p_mngr->conn_cfg[3].cid_count >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_PF_MAX_ICID_3_RT_OFFSET, dq_pf_max_cid);
+
+       dq_vf_max_cid += (p_mngr->conn_cfg[3].cids_per_vf >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_VF_MAX_ICID_3_RT_OFFSET, dq_vf_max_cid);
+
+       dq_pf_max_cid += (p_mngr->conn_cfg[4].cid_count >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_PF_MAX_ICID_4_RT_OFFSET, dq_pf_max_cid);
+
+       dq_vf_max_cid += (p_mngr->conn_cfg[4].cids_per_vf >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_VF_MAX_ICID_4_RT_OFFSET, dq_vf_max_cid);
+
+       dq_pf_max_cid += (p_mngr->conn_cfg[5].cid_count >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_PF_MAX_ICID_5_RT_OFFSET, dq_pf_max_cid);
+
+       dq_vf_max_cid += (p_mngr->conn_cfg[5].cids_per_vf >> DQ_RANGE_SHIFT);
+       STORE_RT_REG(p_hwfn, DORQ_REG_VF_MAX_ICID_5_RT_OFFSET, dq_vf_max_cid);
+
+       /* Connection types 6 & 7 are not in use, yet they must be configured
+        * as the highest possible connection. Not configuring them means the
+        * defaults will be  used, and with a large number of cids a bug may
+        * occur, if the defaults will be smaller than dq_pf_max_cid /
+        * dq_vf_max_cid.
+        */
+       STORE_RT_REG(p_hwfn, DORQ_REG_PF_MAX_ICID_6_RT_OFFSET, dq_pf_max_cid);
+       STORE_RT_REG(p_hwfn, DORQ_REG_VF_MAX_ICID_6_RT_OFFSET, dq_vf_max_cid);
+
+       STORE_RT_REG(p_hwfn, DORQ_REG_PF_MAX_ICID_7_RT_OFFSET, dq_pf_max_cid);
+       STORE_RT_REG(p_hwfn, DORQ_REG_VF_MAX_ICID_7_RT_OFFSET, dq_vf_max_cid);
+}
+
+static void ecore_ilt_bounds_init(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_ilt_client_cfg *ilt_clients;
+       int i;
+
+       ilt_clients = p_hwfn->p_cxt_mngr->clients;
+       for (i = 0; i < ILT_CLI_MAX; i++)
+               if (!ilt_clients[i].active) {
+                       continue;
+               } else {
+               STORE_RT_REG(p_hwfn,
+                            ilt_clients[i].first.reg,
+                            ilt_clients[i].first.val);
+               STORE_RT_REG(p_hwfn,
+                            ilt_clients[i].last.reg, ilt_clients[i].last.val);
+               STORE_RT_REG(p_hwfn,
+                            ilt_clients[i].p_size.reg,
+                            ilt_clients[i].p_size.val);
+       }
+}
+
+static void ecore_ilt_vf_bounds_init(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_ilt_client_cfg *p_cli;
+       u32 blk_factor;
+
+       /* For simplicty  we set the 'block' to be an ILT page */
+       STORE_RT_REG(p_hwfn,
+                    PSWRQ2_REG_VF_BASE_RT_OFFSET,
+                    p_hwfn->hw_info.first_vf_in_pf);
+       STORE_RT_REG(p_hwfn,
+                    PSWRQ2_REG_VF_LAST_ILT_RT_OFFSET,
+                    p_hwfn->hw_info.first_vf_in_pf +
+                    p_hwfn->p_dev->sriov_info.total_vfs);
+
+       p_cli = &p_hwfn->p_cxt_mngr->clients[ILT_CLI_CDUC];
+       blk_factor = OSAL_LOG2(ILT_PAGE_IN_BYTES(p_cli->p_size.val) >> 10);
+       if (p_cli->active) {
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_CDUC_BLOCKS_FACTOR_RT_OFFSET,
+                            blk_factor);
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_CDUC_NUMBER_OF_PF_BLOCKS_RT_OFFSET,
+                            p_cli->pf_total_lines);
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_CDUC_VF_BLOCKS_RT_OFFSET,
+                            p_cli->vf_total_lines);
+       }
+
+       p_cli = &p_hwfn->p_cxt_mngr->clients[ILT_CLI_CDUT];
+       blk_factor = OSAL_LOG2(ILT_PAGE_IN_BYTES(p_cli->p_size.val) >> 10);
+       if (p_cli->active) {
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_CDUT_BLOCKS_FACTOR_RT_OFFSET,
+                            blk_factor);
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_CDUT_NUMBER_OF_PF_BLOCKS_RT_OFFSET,
+                            p_cli->pf_total_lines);
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_CDUT_VF_BLOCKS_RT_OFFSET,
+                            p_cli->vf_total_lines);
+       }
+
+       p_cli = &p_hwfn->p_cxt_mngr->clients[ILT_CLI_TM];
+       blk_factor = OSAL_LOG2(ILT_PAGE_IN_BYTES(p_cli->p_size.val) >> 10);
+       if (p_cli->active) {
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_TM_BLOCKS_FACTOR_RT_OFFSET, blk_factor);
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_TM_NUMBER_OF_PF_BLOCKS_RT_OFFSET,
+                            p_cli->pf_total_lines);
+               STORE_RT_REG(p_hwfn,
+                            PSWRQ2_REG_TM_VF_BLOCKS_RT_OFFSET,
+                            p_cli->vf_total_lines);
+       }
+}
+
+/* ILT (PSWRQ2) PF */
+static void ecore_ilt_init_pf(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_ilt_client_cfg *clients;
+       struct ecore_cxt_mngr *p_mngr;
+       struct ecore_dma_mem *p_shdw;
+       u32 line, rt_offst, i;
+
+       ecore_ilt_bounds_init(p_hwfn);
+       ecore_ilt_vf_bounds_init(p_hwfn);
+
+       p_mngr = p_hwfn->p_cxt_mngr;
+       p_shdw = p_mngr->ilt_shadow;
+       clients = p_hwfn->p_cxt_mngr->clients;
+
+       for (i = 0; i < ILT_CLI_MAX; i++)
+               if (!clients[i].active) {
+                       continue;
+               } else {
+               /* Client's 1st val and RT array are absolute, ILT shadows'
+                * lines are relative.
+                */
+               line = clients[i].first.val - p_mngr->pf_start_line;
+               rt_offst = PSWRQ2_REG_ILT_MEMORY_RT_OFFSET +
+                   clients[i].first.val * ILT_ENTRY_IN_REGS;
+
+               for (; line <= clients[i].last.val - p_mngr->pf_start_line;
+                    line++, rt_offst += ILT_ENTRY_IN_REGS) {
+                       u64 ilt_hw_entry = 0;
+
+                       /** p_virt could be OSAL_NULL incase of dynamic
+                        *  allocation
+                        */
+                       if (p_shdw[line].p_virt != OSAL_NULL) {
+                               SET_FIELD(ilt_hw_entry, ILT_ENTRY_VALID, 1ULL);
+                               SET_FIELD(ilt_hw_entry, ILT_ENTRY_PHY_ADDR,
+                                         (p_shdw[line].p_phys >> 12));
+
+                               DP_VERBOSE(p_hwfn, ECORE_MSG_ILT,
+                                       "Setting RT[0x%08x] from"
+                                       " ILT[0x%08x] [Client is %d] to"
+                                       " Physical addr: 0x%" PRIx64 "\n",
+                                       rt_offst, line, i,
+                                       (u64)(p_shdw[line].p_phys >> 12));
+                       }
+
+                       STORE_RT_REG_AGG(p_hwfn, rt_offst, ilt_hw_entry);
+               }
+       }
+}
+
+/* SRC (Searcher) PF */
+static void ecore_src_init_pf(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 rounded_conn_num, conn_num, conn_max;
+       struct ecore_src_iids src_iids;
+
+       OSAL_MEM_ZERO(&src_iids, sizeof(src_iids));
+       ecore_cxt_src_iids(p_mngr, &src_iids);
+       conn_num = src_iids.pf_cids + src_iids.per_vf_cids * p_mngr->vf_count;
+       if (!conn_num)
+               return;
+
+       conn_max = OSAL_MAX_T(u32, conn_num, SRC_MIN_NUM_ELEMS);
+       rounded_conn_num = OSAL_ROUNDUP_POW_OF_TWO(conn_max);
+
+       STORE_RT_REG(p_hwfn, SRC_REG_COUNTFREE_RT_OFFSET, conn_num);
+       STORE_RT_REG(p_hwfn, SRC_REG_NUMBER_HASH_BITS_RT_OFFSET,
+                    OSAL_LOG2(rounded_conn_num));
+
+       STORE_RT_REG_AGG(p_hwfn, SRC_REG_FIRSTFREE_RT_OFFSET,
+                        p_hwfn->p_cxt_mngr->first_free);
+       STORE_RT_REG_AGG(p_hwfn, SRC_REG_LASTFREE_RT_OFFSET,
+                        p_hwfn->p_cxt_mngr->last_free);
+}
+
+/* Timers PF */
+#define TM_CFG_NUM_IDS_SHIFT           0
+#define TM_CFG_NUM_IDS_MASK            0xFFFFULL
+#define TM_CFG_PRE_SCAN_OFFSET_SHIFT   16
+#define TM_CFG_PRE_SCAN_OFFSET_MASK    0x1FFULL
+#define TM_CFG_PARENT_PF_SHIFT         25
+#define TM_CFG_PARENT_PF_MASK          0x7ULL
+
+#define TM_CFG_CID_PRE_SCAN_ROWS_SHIFT 30
+#define TM_CFG_CID_PRE_SCAN_ROWS_MASK  0x1FFULL
+
+#define TM_CFG_TID_OFFSET_SHIFT                30
+#define TM_CFG_TID_OFFSET_MASK         0x7FFFFULL
+#define TM_CFG_TID_PRE_SCAN_ROWS_SHIFT 49
+#define TM_CFG_TID_PRE_SCAN_ROWS_MASK  0x1FFULL
+
+static void ecore_tm_init_pf(struct ecore_hwfn *p_hwfn)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 active_seg_mask = 0, tm_offset, rt_reg;
+       struct ecore_tm_iids tm_iids;
+       u64 cfg_word;
+       u8 i;
+
+       OSAL_MEM_ZERO(&tm_iids, sizeof(tm_iids));
+       ecore_cxt_tm_iids(p_mngr, &tm_iids);
+
+       /* @@@TBD No pre-scan for now */
+
+       /* Note: We assume consecutive VFs for a PF */
+       for (i = 0; i < p_mngr->vf_count; i++) {
+               cfg_word = 0;
+               SET_FIELD(cfg_word, TM_CFG_NUM_IDS, tm_iids.per_vf_cids);
+               SET_FIELD(cfg_word, TM_CFG_PRE_SCAN_OFFSET, 0);
+               SET_FIELD(cfg_word, TM_CFG_PARENT_PF, p_hwfn->rel_pf_id);
+               SET_FIELD(cfg_word, TM_CFG_CID_PRE_SCAN_ROWS, 0);
+
+               rt_reg = TM_REG_CONFIG_CONN_MEM_RT_OFFSET +
+                   (sizeof(cfg_word) / sizeof(u32)) *
+                   (p_hwfn->hw_info.first_vf_in_pf + i);
+               STORE_RT_REG_AGG(p_hwfn, rt_reg, cfg_word);
+       }
+
+       cfg_word = 0;
+       SET_FIELD(cfg_word, TM_CFG_NUM_IDS, tm_iids.pf_cids);
+       SET_FIELD(cfg_word, TM_CFG_PRE_SCAN_OFFSET, 0);
+       SET_FIELD(cfg_word, TM_CFG_PARENT_PF, 0);       /* n/a for PF */
+       SET_FIELD(cfg_word, TM_CFG_CID_PRE_SCAN_ROWS, 0);
+
+       rt_reg = TM_REG_CONFIG_CONN_MEM_RT_OFFSET +
+           (sizeof(cfg_word) / sizeof(u32)) *
+           (NUM_OF_VFS(p_hwfn->p_dev) + p_hwfn->rel_pf_id);
+       STORE_RT_REG_AGG(p_hwfn, rt_reg, cfg_word);
+
+       /* enale scan */
+       STORE_RT_REG(p_hwfn, TM_REG_PF_ENABLE_CONN_RT_OFFSET,
+                    tm_iids.pf_cids ? 0x1 : 0x0);
+
+       /* @@@TBD how to enable the scan for the VFs */
+
+       tm_offset = tm_iids.per_vf_cids;
+
+       /* Note: We assume consecutive VFs for a PF */
+       for (i = 0; i < p_mngr->vf_count; i++) {
+               cfg_word = 0;
+               SET_FIELD(cfg_word, TM_CFG_NUM_IDS, tm_iids.per_vf_tids);
+               SET_FIELD(cfg_word, TM_CFG_PRE_SCAN_OFFSET, 0);
+               SET_FIELD(cfg_word, TM_CFG_PARENT_PF, p_hwfn->rel_pf_id);
+               SET_FIELD(cfg_word, TM_CFG_TID_OFFSET, tm_offset);
+               SET_FIELD(cfg_word, TM_CFG_TID_PRE_SCAN_ROWS, (u64)0);
+
+               rt_reg = TM_REG_CONFIG_TASK_MEM_RT_OFFSET +
+                   (sizeof(cfg_word) / sizeof(u32)) *
+                   (p_hwfn->hw_info.first_vf_in_pf + i);
+
+               STORE_RT_REG_AGG(p_hwfn, rt_reg, cfg_word);
+       }
+
+       tm_offset = tm_iids.pf_cids;
+       for (i = 0; i < NUM_TASK_PF_SEGMENTS; i++) {
+               cfg_word = 0;
+               SET_FIELD(cfg_word, TM_CFG_NUM_IDS, tm_iids.pf_tids[i]);
+               SET_FIELD(cfg_word, TM_CFG_PRE_SCAN_OFFSET, 0);
+               SET_FIELD(cfg_word, TM_CFG_PARENT_PF, 0);
+               SET_FIELD(cfg_word, TM_CFG_TID_OFFSET, tm_offset);
+               SET_FIELD(cfg_word, TM_CFG_TID_PRE_SCAN_ROWS, (u64)0);
+
+               rt_reg = TM_REG_CONFIG_TASK_MEM_RT_OFFSET +
+                   (sizeof(cfg_word) / sizeof(u32)) *
+                   (NUM_OF_VFS(p_hwfn->p_dev) +
+                    p_hwfn->rel_pf_id * NUM_TASK_PF_SEGMENTS + i);
+
+               STORE_RT_REG_AGG(p_hwfn, rt_reg, cfg_word);
+               active_seg_mask |= (tm_iids.pf_tids[i] ? (1 << i) : 0);
+
+               tm_offset += tm_iids.pf_tids[i];
+       }
+
+       STORE_RT_REG(p_hwfn, TM_REG_PF_ENABLE_TASK_RT_OFFSET, active_seg_mask);
+
+       /* @@@TBD how to enable the scan for the VFs */
+}
+
+static void ecore_prs_init_common(struct ecore_hwfn *p_hwfn)
+{
+}
+
+void ecore_cxt_hw_init_common(struct ecore_hwfn *p_hwfn)
+{
+       /* CDU configuration */
+       ecore_cdu_init_common(p_hwfn);
+       ecore_prs_init_common(p_hwfn);
+}
+
+void ecore_cxt_hw_init_pf(struct ecore_hwfn *p_hwfn)
+{
+       ecore_qm_init_pf(p_hwfn);
+       ecore_cm_init_pf(p_hwfn);
+       ecore_dq_init_pf(p_hwfn);
+       ecore_cdu_init_pf(p_hwfn);
+       ecore_ilt_init_pf(p_hwfn);
+       ecore_src_init_pf(p_hwfn);
+       ecore_tm_init_pf(p_hwfn);
+}
+
+enum _ecore_status_t ecore_cxt_acquire_cid(struct ecore_hwfn *p_hwfn,
+                                          enum protocol_type type, u32 *p_cid)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 rel_cid;
+
+       if (type >= MAX_CONN_TYPES || !p_mngr->acquired[type].cid_map) {
+               DP_NOTICE(p_hwfn, true, "Invalid protocol type %d", type);
+               return ECORE_INVAL;
+       }
+
+       rel_cid = OSAL_FIND_FIRST_ZERO_BIT(p_mngr->acquired[type].cid_map,
+                                          p_mngr->acquired[type].max_count);
+
+       if (rel_cid >= p_mngr->acquired[type].max_count) {
+               DP_NOTICE(p_hwfn, false, "no CID available for protocol %d",
+                         type);
+               return ECORE_NORESOURCES;
+       }
+
+       OSAL_SET_BIT(rel_cid, p_mngr->acquired[type].cid_map);
+
+       *p_cid = rel_cid + p_mngr->acquired[type].start_cid;
+
+       return ECORE_SUCCESS;
+}
+
+static bool ecore_cxt_test_cid_acquired(struct ecore_hwfn *p_hwfn,
+                                       u32 cid, enum protocol_type *p_type)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       struct ecore_cid_acquired_map *p_map;
+       enum protocol_type p;
+       u32 rel_cid;
+
+       /* Iterate over protocols and find matching cid range */
+       for (p = 0; p < MAX_CONN_TYPES; p++) {
+               p_map = &p_mngr->acquired[p];
+
+               if (!p_map->cid_map)
+                       continue;
+               if (cid >= p_map->start_cid &&
+                   cid < p_map->start_cid + p_map->max_count) {
+                       break;
+               }
+       }
+       *p_type = p;
+
+       if (p == MAX_CONN_TYPES) {
+               DP_NOTICE(p_hwfn, true, "Invalid CID %d", cid);
+               return false;
+       }
+       rel_cid = cid - p_map->start_cid;
+       if (!OSAL_TEST_BIT(rel_cid, p_map->cid_map)) {
+               DP_NOTICE(p_hwfn, true, "CID %d not acquired", cid);
+               return false;
+       }
+       return true;
+}
+
+void ecore_cxt_release_cid(struct ecore_hwfn *p_hwfn, u32 cid)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       enum protocol_type type;
+       bool b_acquired;
+       u32 rel_cid;
+
+       /* Test acquired and find matching per-protocol map */
+       b_acquired = ecore_cxt_test_cid_acquired(p_hwfn, cid, &type);
+
+       if (!b_acquired)
+               return;
+
+       rel_cid = cid - p_mngr->acquired[type].start_cid;
+       OSAL_CLEAR_BIT(rel_cid, p_mngr->acquired[type].cid_map);
+}
+
+enum _ecore_status_t ecore_cxt_get_cid_info(struct ecore_hwfn *p_hwfn,
+                                           struct ecore_cxt_info *p_info)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 conn_cxt_size, hw_p_size, cxts_per_p, line;
+       enum protocol_type type;
+       bool b_acquired;
+
+       /* Test acquired and find matching per-protocol map */
+       b_acquired = ecore_cxt_test_cid_acquired(p_hwfn, p_info->iid, &type);
+
+       if (!b_acquired)
+               return ECORE_INVAL;
+
+       /* set the protocl type */
+       p_info->type = type;
+
+       /* compute context virtual pointer */
+       hw_p_size = p_hwfn->p_cxt_mngr->clients[ILT_CLI_CDUC].p_size.val;
+
+       conn_cxt_size = CONN_CXT_SIZE(p_hwfn);
+       cxts_per_p = ILT_PAGE_IN_BYTES(hw_p_size) / conn_cxt_size;
+       line = p_info->iid / cxts_per_p;
+
+       /* Make sure context is allocated (dynamic allocation) */
+       if (!p_mngr->ilt_shadow[line].p_virt)
+               return ECORE_INVAL;
+
+       p_info->p_cxt = (u8 *)p_mngr->ilt_shadow[line].p_virt +
+           p_info->iid % cxts_per_p * conn_cxt_size;
+
+       DP_VERBOSE(p_hwfn, (ECORE_MSG_ILT | ECORE_MSG_CXT),
+               "Accessing ILT shadow[%d]: CXT pointer is at %p (for iid %d)\n",
+               (p_info->iid / cxts_per_p), p_info->p_cxt, p_info->iid);
+
+       return ECORE_SUCCESS;
+}
+
+enum _ecore_status_t ecore_cxt_set_pf_params(struct ecore_hwfn *p_hwfn)
+{
+       /* Set the number of required CORE connections */
+       u32 core_cids = 1;      /* SPQ */
+
+       ecore_cxt_set_proto_cid_count(p_hwfn, PROTOCOLID_CORE, core_cids, 0);
+
+       switch (p_hwfn->hw_info.personality) {
+       case ECORE_PCI_ETH:
+               {
+                       struct ecore_eth_pf_params *p_params =
+                           &p_hwfn->pf_params.eth_pf_params;
+
+                       ecore_cxt_set_proto_cid_count(p_hwfn,
+                               PROTOCOLID_ETH,
+                               p_params->num_cons, 1); /* FIXME VF count... */
+
+                       break;
+               }
+       default:
+               return ECORE_INVAL;
+       }
+
+       return ECORE_SUCCESS;
+}
+
+enum _ecore_status_t ecore_cxt_get_tid_mem_info(struct ecore_hwfn *p_hwfn,
+                                               struct ecore_tid_mem *p_info)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       u32 proto, seg, total_lines, i, shadow_line;
+       struct ecore_ilt_client_cfg *p_cli;
+       struct ecore_ilt_cli_blk *p_fl_seg;
+       struct ecore_tid_seg *p_seg_info;
+
+       /* Verify the personality */
+       switch (p_hwfn->hw_info.personality) {
+       default:
+               return ECORE_INVAL;
+       }
+
+       p_cli = &p_mngr->clients[ILT_CLI_CDUT];
+       if (!p_cli->active)
+               return ECORE_INVAL;
+
+       p_seg_info = &p_mngr->conn_cfg[proto].tid_seg[seg];
+       if (!p_seg_info->has_fl_mem)
+               return ECORE_INVAL;
+
+       p_fl_seg = &p_cli->pf_blks[CDUT_FL_SEG_BLK(seg, PF)];
+       total_lines = DIV_ROUND_UP(p_fl_seg->total_size,
+                                  p_fl_seg->real_size_in_page);
+
+       for (i = 0; i < total_lines; i++) {
+               shadow_line = i + p_fl_seg->start_line -
+                   p_hwfn->p_cxt_mngr->pf_start_line;
+               p_info->blocks[i] = p_mngr->ilt_shadow[shadow_line].p_virt;
+       }
+       p_info->waste = ILT_PAGE_IN_BYTES(p_cli->p_size.val) -
+           p_fl_seg->real_size_in_page;
+       p_info->tid_size = p_mngr->task_type_size[p_seg_info->type];
+       p_info->num_tids_per_block = p_fl_seg->real_size_in_page /
+           p_info->tid_size;
+
+       return ECORE_SUCCESS;
+}
+
+/* This function is very RoCE oriented, if another protocol in the future
+ * will want this feature we'll need to modify the function to be more generic
+ */
+static enum _ecore_status_t
+ecore_cxt_free_ilt_range(struct ecore_hwfn *p_hwfn,
+                        enum ecore_cxt_elem_type elem_type,
+                        u32 start_iid, u32 count)
+{
+       u32 reg_offset, elem_size, hw_p_size, elems_per_p;
+       u32 start_line, end_line, shadow_start_line, shadow_end_line;
+       struct ecore_ilt_client_cfg *p_cli;
+       struct ecore_ilt_cli_blk *p_blk;
+       u32 end_iid = start_iid + count;
+       struct ecore_ptt *p_ptt;
+       u64 ilt_hw_entry = 0;
+       u32 i;
+
+       if (elem_type == ECORE_ELEM_CXT) {
+               p_cli = &p_hwfn->p_cxt_mngr->clients[ILT_CLI_CDUC];
+               elem_size = CONN_CXT_SIZE(p_hwfn);
+               p_blk = &p_cli->pf_blks[CDUC_BLK];
+       }
+
+       /* Calculate line in ilt */
+       hw_p_size = p_cli->p_size.val;
+       elems_per_p = ILT_PAGE_IN_BYTES(hw_p_size) / elem_size;
+       start_line = p_blk->start_line + (start_iid / elems_per_p);
+       end_line = p_blk->start_line + (end_iid / elems_per_p);
+       if (((end_iid + 1) / elems_per_p) != (end_iid / elems_per_p))
+               end_line--;
+
+       shadow_start_line = start_line - p_hwfn->p_cxt_mngr->pf_start_line;
+       shadow_end_line = end_line - p_hwfn->p_cxt_mngr->pf_start_line;
+
+       p_ptt = ecore_ptt_acquire(p_hwfn);
+       if (!p_ptt) {
+               DP_NOTICE(p_hwfn, false,
+                         "ECORE_TIME_OUT on ptt acquire - dynamic allocation");
+               return ECORE_TIMEOUT;
+       }
+
+       for (i = shadow_start_line; i < shadow_end_line; i++) {
+               if (!p_hwfn->p_cxt_mngr->ilt_shadow[i].p_virt)
+                       continue;
+
+               OSAL_DMA_FREE_COHERENT(p_hwfn->p_dev,
+                                      p_hwfn->p_cxt_mngr->ilt_shadow[i].p_virt,
+                                      p_hwfn->p_cxt_mngr->ilt_shadow[i].p_phys,
+                                      p_hwfn->p_cxt_mngr->ilt_shadow[i].size);
+
+               p_hwfn->p_cxt_mngr->ilt_shadow[i].p_virt = OSAL_NULL;
+               p_hwfn->p_cxt_mngr->ilt_shadow[i].p_phys = 0;
+               p_hwfn->p_cxt_mngr->ilt_shadow[i].size = 0;
+
+               /* compute absolute offset */
+               reg_offset = PSWRQ2_REG_ILT_MEMORY +
+                   ((start_line++) * ILT_REG_SIZE_IN_BYTES *
+                    ILT_ENTRY_IN_REGS);
+
+               ecore_wr(p_hwfn, p_ptt, reg_offset, U64_LO(ilt_hw_entry));
+               ecore_wr(p_hwfn, p_ptt, reg_offset + ILT_REG_SIZE_IN_BYTES,
+                        U64_HI(ilt_hw_entry));
+       }
+
+       ecore_ptt_release(p_hwfn, p_ptt);
+
+       return ECORE_SUCCESS;
+}
+
+enum _ecore_status_t ecore_cxt_free_proto_ilt(struct ecore_hwfn *p_hwfn,
+                                             enum protocol_type proto)
+{
+       enum _ecore_status_t rc;
+       u32 cid;
+
+       /* Free Connection CXT */
+       rc = ecore_cxt_free_ilt_range(p_hwfn, ECORE_ELEM_CXT,
+                                     ecore_cxt_get_proto_cid_start(p_hwfn,
+                                                                   proto),
+                                     ecore_cxt_get_proto_cid_count(p_hwfn,
+                                                                   proto,
+                                                                   &cid));
+
+       if (rc)
+               return rc;
+
+       /* Free Task CXT */
+       rc = ecore_cxt_free_ilt_range(p_hwfn, ECORE_ELEM_TASK, 0,
+                                     ecore_cxt_get_proto_tid_count(p_hwfn,
+                                                                   proto));
+
+       return rc;
+}
+
+enum _ecore_status_t ecore_cxt_get_task_ctx(struct ecore_hwfn *p_hwfn,
+                                           u32 tid,
+                                           u8 ctx_type, void **pp_task_ctx)
+{
+       struct ecore_cxt_mngr *p_mngr = p_hwfn->p_cxt_mngr;
+       struct ecore_ilt_client_cfg *p_cli;
+       struct ecore_ilt_cli_blk *p_seg;
+       struct ecore_tid_seg *p_seg_info;
+       u32 proto, seg;
+       u32 total_lines;
+       u32 tid_size, ilt_idx;
+       u32 num_tids_per_block;
+
+       /* Verify the personality */
+       switch (p_hwfn->hw_info.personality) {
+       default:
+               return ECORE_INVAL;
+       }
+
+       p_cli = &p_mngr->clients[ILT_CLI_CDUT];
+       if (!p_cli->active)
+               return ECORE_INVAL;
+
+       p_seg_info = &p_mngr->conn_cfg[proto].tid_seg[seg];
+
+       if (ctx_type == ECORE_CTX_WORKING_MEM) {
+               p_seg = &p_cli->pf_blks[CDUT_SEG_BLK(seg)];
+       } else if (ctx_type == ECORE_CTX_FL_MEM) {
+               if (!p_seg_info->has_fl_mem)
+                       return ECORE_INVAL;
+               p_seg = &p_cli->pf_blks[CDUT_FL_SEG_BLK(seg, PF)];
+       } else {
+               return ECORE_INVAL;
+       }
+       total_lines = DIV_ROUND_UP(p_seg->total_size, p_seg->real_size_in_page);
+       tid_size = p_mngr->task_type_size[p_seg_info->type];
+       num_tids_per_block = p_seg->real_size_in_page / tid_size;
+
+       if (total_lines < tid / num_tids_per_block)
+               return ECORE_INVAL;
+
+       ilt_idx = tid / num_tids_per_block + p_seg->start_line -
+           p_mngr->pf_start_line;
+       *pp_task_ctx = (u8 *)p_mngr->ilt_shadow[ilt_idx].p_virt +
+           (tid % num_tids_per_block) * tid_size;
+
+       return ECORE_SUCCESS;
+}