event/dlb2: add v2.5 create dir port
authorTimothy McDaniel <timothy.mcdaniel@intel.com>
Sat, 1 May 2021 19:03:45 +0000 (14:03 -0500)
committerJerin Jacob <jerinj@marvell.com>
Mon, 3 May 2021 09:46:30 +0000 (11:46 +0200)
Update the low level HW functions responsible for
creating directed ports. These functions create the
producer port (PP), configure the consumer queue (CQ),
configure queue depth, and validate the port creation
arguments.

The logic is very similar to what was done for v2.0,
but the new combined register map for v2.0 and v2.5
uses new register names and bit names.  Additionally,
new register access macros are used so that the code
can perform the correct action, based on the hardware
version, v2.0 or v2.5.

Signed-off-by: Timothy McDaniel <timothy.mcdaniel@intel.com>
drivers/event/dlb2/pf/base/dlb2_resource.c
drivers/event/dlb2/pf/base/dlb2_resource_new.c

index 45d096e..70c52e9 100644 (file)
@@ -65,18 +65,6 @@ static inline void dlb2_flush_csr(struct dlb2_hw *hw)
        DLB2_CSR_RD(hw, DLB2_SYS_TOTAL_VAS);
 }
 
-static void dlb2_dir_port_cq_enable(struct dlb2_hw *hw,
-                                   struct dlb2_dir_pq_pair *port)
-{
-       union dlb2_lsp_cq_dir_dsbl reg;
-
-       reg.field.disabled = 0;
-
-       DLB2_CSR_WR(hw, DLB2_LSP_CQ_DIR_DSBL(port->id.phys_id), reg.val);
-
-       dlb2_flush_csr(hw);
-}
-
 static u32 dlb2_dir_queue_depth(struct dlb2_hw *hw,
                                struct dlb2_dir_pq_pair *queue)
 {
@@ -1216,25 +1204,6 @@ int dlb2_set_group_sequence_numbers(struct dlb2_hw *hw,
        return 0;
 }
 
-static void
-dlb2_log_create_dir_port_args(struct dlb2_hw *hw,
-                             u32 domain_id,
-                             uintptr_t cq_dma_base,
-                             struct dlb2_create_dir_port_args *args,
-                             bool vdev_req,
-                             unsigned int vdev_id)
-{
-       DLB2_HW_DBG(hw, "DLB2 create directed port arguments:\n");
-       if (vdev_req)
-               DLB2_HW_DBG(hw, "(Request from vdev %d)\n", vdev_id);
-       DLB2_HW_DBG(hw, "\tDomain ID:                 %d\n",
-                   domain_id);
-       DLB2_HW_DBG(hw, "\tCQ depth:                  %d\n",
-                   args->cq_depth);
-       DLB2_HW_DBG(hw, "\tCQ base address:           0x%lx\n",
-                   cq_dma_base);
-}
-
 static struct dlb2_dir_pq_pair *
 dlb2_get_domain_used_dir_pq(struct dlb2_hw *hw,
                            u32 id,
@@ -1256,401 +1225,6 @@ dlb2_get_domain_used_dir_pq(struct dlb2_hw *hw,
        return NULL;
 }
 
-static int
-dlb2_verify_create_dir_port_args(struct dlb2_hw *hw,
-                                u32 domain_id,
-                                uintptr_t cq_dma_base,
-                                struct dlb2_create_dir_port_args *args,
-                                struct dlb2_cmd_response *resp,
-                                bool vdev_req,
-                                unsigned int vdev_id)
-{
-       struct dlb2_hw_domain *domain;
-
-       domain = dlb2_get_domain_from_id(hw, domain_id, vdev_req, vdev_id);
-
-       if (domain == NULL) {
-               resp->status = DLB2_ST_INVALID_DOMAIN_ID;
-               return -EINVAL;
-       }
-
-       if (!domain->configured) {
-               resp->status = DLB2_ST_DOMAIN_NOT_CONFIGURED;
-               return -EINVAL;
-       }
-
-       if (domain->started) {
-               resp->status = DLB2_ST_DOMAIN_STARTED;
-               return -EINVAL;
-       }
-
-       /*
-        * If the user claims the queue is already configured, validate
-        * the queue ID, its domain, and whether the queue is configured.
-        */
-       if (args->queue_id != -1) {
-               struct dlb2_dir_pq_pair *queue;
-
-               queue = dlb2_get_domain_used_dir_pq(hw,
-                                                   args->queue_id,
-                                                   vdev_req,
-                                                   domain);
-
-               if (queue == NULL || queue->domain_id.phys_id !=
-                               domain->id.phys_id ||
-                               !queue->queue_configured) {
-                       resp->status = DLB2_ST_INVALID_DIR_QUEUE_ID;
-                       return -EINVAL;
-               }
-       }
-
-       /*
-        * If the port's queue is not configured, validate that a free
-        * port-queue pair is available.
-        */
-       if (args->queue_id == -1 &&
-           dlb2_list_empty(&domain->avail_dir_pq_pairs)) {
-               resp->status = DLB2_ST_DIR_PORTS_UNAVAILABLE;
-               return -EINVAL;
-       }
-
-       /* Check cache-line alignment */
-       if ((cq_dma_base & 0x3F) != 0) {
-               resp->status = DLB2_ST_INVALID_CQ_VIRT_ADDR;
-               return -EINVAL;
-       }
-
-       if (args->cq_depth != 1 &&
-           args->cq_depth != 2 &&
-           args->cq_depth != 4 &&
-           args->cq_depth != 8 &&
-           args->cq_depth != 16 &&
-           args->cq_depth != 32 &&
-           args->cq_depth != 64 &&
-           args->cq_depth != 128 &&
-           args->cq_depth != 256 &&
-           args->cq_depth != 512 &&
-           args->cq_depth != 1024) {
-               resp->status = DLB2_ST_INVALID_CQ_DEPTH;
-               return -EINVAL;
-       }
-
-       return 0;
-}
-
-static void dlb2_dir_port_configure_pp(struct dlb2_hw *hw,
-                                      struct dlb2_hw_domain *domain,
-                                      struct dlb2_dir_pq_pair *port,
-                                      bool vdev_req,
-                                      unsigned int vdev_id)
-{
-       union dlb2_sys_dir_pp2vas r0 = { {0} };
-       union dlb2_sys_dir_pp_v r4 = { {0} };
-
-       r0.field.vas = domain->id.phys_id;
-
-       DLB2_CSR_WR(hw, DLB2_SYS_DIR_PP2VAS(port->id.phys_id), r0.val);
-
-       if (vdev_req) {
-               union dlb2_sys_vf_dir_vpp2pp r1 = { {0} };
-               union dlb2_sys_dir_pp2vdev r2 = { {0} };
-               union dlb2_sys_vf_dir_vpp_v r3 = { {0} };
-               unsigned int offs;
-               u32 virt_id;
-
-               /*
-                * DLB uses producer port address bits 17:12 to determine the
-                * producer port ID. In Scalable IOV mode, PP accesses come
-                * through the PF MMIO window for the physical producer port,
-                * so for translation purposes the virtual and physical port
-                * IDs are equal.
-                */
-               if (hw->virt_mode == DLB2_VIRT_SRIOV)
-                       virt_id = port->id.virt_id;
-               else
-                       virt_id = port->id.phys_id;
-
-               r1.field.pp = port->id.phys_id;
-
-               offs = vdev_id * DLB2_MAX_NUM_DIR_PORTS(hw->ver) + virt_id;
-
-               DLB2_CSR_WR(hw, DLB2_SYS_VF_DIR_VPP2PP(offs), r1.val);
-
-               r2.field.vdev = vdev_id;
-
-               DLB2_CSR_WR(hw,
-                           DLB2_SYS_DIR_PP2VDEV(port->id.phys_id),
-                           r2.val);
-
-               r3.field.vpp_v = 1;
-
-               DLB2_CSR_WR(hw, DLB2_SYS_VF_DIR_VPP_V(offs), r3.val);
-       }
-
-       r4.field.pp_v = 1;
-
-       DLB2_CSR_WR(hw,
-                   DLB2_SYS_DIR_PP_V(port->id.phys_id),
-                   r4.val);
-}
-
-static int dlb2_dir_port_configure_cq(struct dlb2_hw *hw,
-                                     struct dlb2_hw_domain *domain,
-                                     struct dlb2_dir_pq_pair *port,
-                                     uintptr_t cq_dma_base,
-                                     struct dlb2_create_dir_port_args *args,
-                                     bool vdev_req,
-                                     unsigned int vdev_id)
-{
-       union dlb2_sys_dir_cq_addr_l r0 = { {0} };
-       union dlb2_sys_dir_cq_addr_u r1 = { {0} };
-       union dlb2_sys_dir_cq2vf_pf_ro r2 = { {0} };
-       union dlb2_chp_dir_cq_tkn_depth_sel r3 = { {0} };
-       union dlb2_lsp_cq_dir_tkn_depth_sel_dsi r4 = { {0} };
-       union dlb2_sys_dir_cq_fmt r9 = { {0} };
-       union dlb2_sys_dir_cq_at r10 = { {0} };
-       union dlb2_sys_dir_cq_pasid r11 = { {0} };
-       union dlb2_chp_dir_cq2vas r12 = { {0} };
-
-       /* The CQ address is 64B-aligned, and the DLB only wants bits [63:6] */
-       r0.field.addr_l = cq_dma_base >> 6;
-
-       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_ADDR_L(port->id.phys_id), r0.val);
-
-       r1.field.addr_u = cq_dma_base >> 32;
-
-       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_ADDR_U(port->id.phys_id), r1.val);
-
-       /*
-        * 'ro' == relaxed ordering. This setting allows DLB2 to write
-        * cache lines out-of-order (but QEs within a cache line are always
-        * updated in-order).
-        */
-       r2.field.vf = vdev_id;
-       r2.field.is_pf = !vdev_req && (hw->virt_mode != DLB2_VIRT_SIOV);
-       r2.field.ro = 1;
-
-       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ2VF_PF_RO(port->id.phys_id), r2.val);
-
-       if (args->cq_depth <= 8) {
-               r3.field.token_depth_select = 1;
-       } else if (args->cq_depth == 16) {
-               r3.field.token_depth_select = 2;
-       } else if (args->cq_depth == 32) {
-               r3.field.token_depth_select = 3;
-       } else if (args->cq_depth == 64) {
-               r3.field.token_depth_select = 4;
-       } else if (args->cq_depth == 128) {
-               r3.field.token_depth_select = 5;
-       } else if (args->cq_depth == 256) {
-               r3.field.token_depth_select = 6;
-       } else if (args->cq_depth == 512) {
-               r3.field.token_depth_select = 7;
-       } else if (args->cq_depth == 1024) {
-               r3.field.token_depth_select = 8;
-       } else {
-               DLB2_HW_ERR(hw,
-                           "[%s():%d] Internal error: invalid CQ depth\n",
-                           __func__, __LINE__);
-               return -EFAULT;
-       }
-
-       DLB2_CSR_WR(hw,
-                   DLB2_CHP_DIR_CQ_TKN_DEPTH_SEL(port->id.phys_id),
-                   r3.val);
-
-       /*
-        * To support CQs with depth less than 8, program the token count
-        * register with a non-zero initial value. Operations such as domain
-        * reset must take this initial value into account when quiescing the
-        * CQ.
-        */
-       port->init_tkn_cnt = 0;
-
-       if (args->cq_depth < 8) {
-               union dlb2_lsp_cq_dir_tkn_cnt r13 = { {0} };
-
-               port->init_tkn_cnt = 8 - args->cq_depth;
-
-               r13.field.count = port->init_tkn_cnt;
-
-               DLB2_CSR_WR(hw,
-                           DLB2_LSP_CQ_DIR_TKN_CNT(port->id.phys_id),
-                           r13.val);
-       } else {
-               DLB2_CSR_WR(hw,
-                           DLB2_LSP_CQ_DIR_TKN_CNT(port->id.phys_id),
-                           DLB2_LSP_CQ_DIR_TKN_CNT_RST);
-       }
-
-       r4.field.token_depth_select = r3.field.token_depth_select;
-       r4.field.disable_wb_opt = 0;
-       r4.field.ignore_depth = 0;
-
-       DLB2_CSR_WR(hw,
-                   DLB2_LSP_CQ_DIR_TKN_DEPTH_SEL_DSI(port->id.phys_id),
-                   r4.val);
-
-       /* Reset the CQ write pointer */
-       DLB2_CSR_WR(hw,
-                   DLB2_CHP_DIR_CQ_WPTR(port->id.phys_id),
-                   DLB2_CHP_DIR_CQ_WPTR_RST);
-
-       /* Virtualize the PPID */
-       r9.field.keep_pf_ppid = 0;
-
-       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_FMT(port->id.phys_id), r9.val);
-
-       /*
-        * Address translation (AT) settings: 0: untranslated, 2: translated
-        * (see ATS spec regarding Address Type field for more details)
-        */
-       r10.field.cq_at = 0;
-
-       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_AT(port->id.phys_id), r10.val);
-
-       if (vdev_req && hw->virt_mode == DLB2_VIRT_SIOV) {
-               r11.field.pasid = hw->pasid[vdev_id];
-               r11.field.fmt2 = 1;
-       }
-
-       DLB2_CSR_WR(hw,
-                   DLB2_SYS_DIR_CQ_PASID(port->id.phys_id),
-                   r11.val);
-
-       r12.field.cq2vas = domain->id.phys_id;
-
-       DLB2_CSR_WR(hw, DLB2_CHP_DIR_CQ2VAS(port->id.phys_id), r12.val);
-
-       return 0;
-}
-
-static int dlb2_configure_dir_port(struct dlb2_hw *hw,
-                                  struct dlb2_hw_domain *domain,
-                                  struct dlb2_dir_pq_pair *port,
-                                  uintptr_t cq_dma_base,
-                                  struct dlb2_create_dir_port_args *args,
-                                  bool vdev_req,
-                                  unsigned int vdev_id)
-{
-       int ret;
-
-       ret = dlb2_dir_port_configure_cq(hw,
-                                        domain,
-                                        port,
-                                        cq_dma_base,
-                                        args,
-                                        vdev_req,
-                                        vdev_id);
-
-       if (ret < 0)
-               return ret;
-
-       dlb2_dir_port_configure_pp(hw,
-                                  domain,
-                                  port,
-                                  vdev_req,
-                                  vdev_id);
-
-       dlb2_dir_port_cq_enable(hw, port);
-
-       port->enabled = true;
-
-       port->port_configured = true;
-
-       return 0;
-}
-
-/**
- * dlb2_hw_create_dir_port() - Allocate and initialize a DLB directed port
- *     and queue. The port/queue pair have the same ID and name.
- * @hw:        Contains the current state of the DLB2 hardware.
- * @domain_id: Domain ID
- * @args: User-provided arguments.
- * @cq_dma_base: Base DMA address for consumer queue memory
- * @resp: Response to user.
- * @vdev_req: Request came from a virtual device.
- * @vdev_id: If vdev_req is true, this contains the virtual device's ID.
- *
- * Return: returns < 0 on error, 0 otherwise. If the driver is unable to
- * satisfy a request, resp->status will be set accordingly.
- */
-int dlb2_hw_create_dir_port(struct dlb2_hw *hw,
-                           u32 domain_id,
-                           struct dlb2_create_dir_port_args *args,
-                           uintptr_t cq_dma_base,
-                           struct dlb2_cmd_response *resp,
-                           bool vdev_req,
-                           unsigned int vdev_id)
-{
-       struct dlb2_dir_pq_pair *port;
-       struct dlb2_hw_domain *domain;
-       int ret;
-
-       dlb2_log_create_dir_port_args(hw,
-                                     domain_id,
-                                     cq_dma_base,
-                                     args,
-                                     vdev_req,
-                                     vdev_id);
-
-       /*
-        * Verify that hardware resources are available before attempting to
-        * satisfy the request. This simplifies the error unwinding code.
-        */
-       ret = dlb2_verify_create_dir_port_args(hw,
-                                              domain_id,
-                                              cq_dma_base,
-                                              args,
-                                              resp,
-                                              vdev_req,
-                                              vdev_id);
-       if (ret)
-               return ret;
-
-       domain = dlb2_get_domain_from_id(hw, domain_id, vdev_req, vdev_id);
-
-       if (args->queue_id != -1)
-               port = dlb2_get_domain_used_dir_pq(hw,
-                                                  args->queue_id,
-                                                  vdev_req,
-                                                  domain);
-       else
-               port = DLB2_DOM_LIST_HEAD(domain->avail_dir_pq_pairs,
-                                         typeof(*port));
-       if (port == NULL) {
-               DLB2_HW_ERR(hw,
-                           "[%s():%d] Internal error: no available dir ports\n",
-                           __func__, __LINE__);
-               return -EFAULT;
-       }
-
-       ret = dlb2_configure_dir_port(hw,
-                                     domain,
-                                     port,
-                                     cq_dma_base,
-                                     args,
-                                     vdev_req,
-                                     vdev_id);
-       if (ret < 0)
-               return ret;
-
-       /*
-        * Configuration succeeded, so move the resource from the 'avail' to
-        * the 'used' list (if it's not already there).
-        */
-       if (args->queue_id == -1) {
-               dlb2_list_del(&domain->avail_dir_pq_pairs, &port->domain_list);
-
-               dlb2_list_add(&domain->used_dir_pq_pairs, &port->domain_list);
-       }
-
-       resp->status = 0;
-       resp->id = (vdev_req) ? port->id.virt_id : port->id.phys_id;
-
-       return 0;
-}
-
 static void dlb2_configure_dir_queue(struct dlb2_hw *hw,
                                     struct dlb2_hw_domain *domain,
                                     struct dlb2_dir_pq_pair *queue,
index 2eb39e2..4e4b390 100644 (file)
@@ -4443,3 +4443,417 @@ int dlb2_hw_create_ldb_port(struct dlb2_hw *hw,
 
        return 0;
 }
+
+static void
+dlb2_log_create_dir_port_args(struct dlb2_hw *hw,
+                             u32 domain_id,
+                             uintptr_t cq_dma_base,
+                             struct dlb2_create_dir_port_args *args,
+                             bool vdev_req,
+                             unsigned int vdev_id)
+{
+       DLB2_HW_DBG(hw, "DLB2 create directed port arguments:\n");
+       if (vdev_req)
+               DLB2_HW_DBG(hw, "(Request from vdev %d)\n", vdev_id);
+       DLB2_HW_DBG(hw, "\tDomain ID:                 %d\n",
+                   domain_id);
+       DLB2_HW_DBG(hw, "\tCQ depth:                  %d\n",
+                   args->cq_depth);
+       DLB2_HW_DBG(hw, "\tCQ base address:           0x%lx\n",
+                   cq_dma_base);
+}
+
+static struct dlb2_dir_pq_pair *
+dlb2_get_domain_used_dir_pq(struct dlb2_hw *hw,
+                           u32 id,
+                           bool vdev_req,
+                           struct dlb2_hw_domain *domain)
+{
+       struct dlb2_list_entry *iter;
+       struct dlb2_dir_pq_pair *port;
+       RTE_SET_USED(iter);
+
+       if (id >= DLB2_MAX_NUM_DIR_PORTS(hw->ver))
+               return NULL;
+
+       DLB2_DOM_LIST_FOR(domain->used_dir_pq_pairs, port, iter) {
+               if ((!vdev_req && port->id.phys_id == id) ||
+                   (vdev_req && port->id.virt_id == id))
+                       return port;
+       }
+
+       return NULL;
+}
+
+static int
+dlb2_verify_create_dir_port_args(struct dlb2_hw *hw,
+                                u32 domain_id,
+                                uintptr_t cq_dma_base,
+                                struct dlb2_create_dir_port_args *args,
+                                struct dlb2_cmd_response *resp,
+                                bool vdev_req,
+                                unsigned int vdev_id,
+                                struct dlb2_hw_domain **out_domain,
+                                struct dlb2_dir_pq_pair **out_port)
+{
+       struct dlb2_hw_domain *domain;
+       struct dlb2_dir_pq_pair *pq;
+
+       domain = dlb2_get_domain_from_id(hw, domain_id, vdev_req, vdev_id);
+
+       if (!domain) {
+               resp->status = DLB2_ST_INVALID_DOMAIN_ID;
+               return -EINVAL;
+       }
+
+       if (!domain->configured) {
+               resp->status = DLB2_ST_DOMAIN_NOT_CONFIGURED;
+               return -EINVAL;
+       }
+
+       if (domain->started) {
+               resp->status = DLB2_ST_DOMAIN_STARTED;
+               return -EINVAL;
+       }
+
+       if (args->queue_id != -1) {
+               /*
+                * If the user claims the queue is already configured, validate
+                * the queue ID, its domain, and whether the queue is
+                * configured.
+                */
+               pq = dlb2_get_domain_used_dir_pq(hw,
+                                                args->queue_id,
+                                                vdev_req,
+                                                domain);
+
+               if (!pq || pq->domain_id.phys_id != domain->id.phys_id ||
+                   !pq->queue_configured) {
+                       resp->status = DLB2_ST_INVALID_DIR_QUEUE_ID;
+                       return -EINVAL;
+               }
+       } else {
+               /*
+                * If the port's queue is not configured, validate that a free
+                * port-queue pair is available.
+                */
+               pq = DLB2_DOM_LIST_HEAD(domain->avail_dir_pq_pairs,
+                                       typeof(*pq));
+               if (!pq) {
+                       resp->status = DLB2_ST_DIR_PORTS_UNAVAILABLE;
+                       return -EINVAL;
+               }
+       }
+
+       /* Check cache-line alignment */
+       if ((cq_dma_base & 0x3F) != 0) {
+               resp->status = DLB2_ST_INVALID_CQ_VIRT_ADDR;
+               return -EINVAL;
+       }
+
+       if (!dlb2_cq_depth_is_valid(args->cq_depth)) {
+               resp->status = DLB2_ST_INVALID_CQ_DEPTH;
+               return -EINVAL;
+       }
+
+       *out_domain = domain;
+       *out_port = pq;
+
+       return 0;
+}
+
+static void dlb2_dir_port_configure_pp(struct dlb2_hw *hw,
+                                      struct dlb2_hw_domain *domain,
+                                      struct dlb2_dir_pq_pair *port,
+                                      bool vdev_req,
+                                      unsigned int vdev_id)
+{
+       u32 reg = 0;
+
+       DLB2_BITS_SET(reg, domain->id.phys_id, DLB2_SYS_DIR_PP2VAS_VAS);
+       DLB2_CSR_WR(hw, DLB2_SYS_DIR_PP2VAS(port->id.phys_id), reg);
+
+       if (vdev_req) {
+               unsigned int offs;
+               u32 virt_id;
+
+               /*
+                * DLB uses producer port address bits 17:12 to determine the
+                * producer port ID. In Scalable IOV mode, PP accesses come
+                * through the PF MMIO window for the physical producer port,
+                * so for translation purposes the virtual and physical port
+                * IDs are equal.
+                */
+               if (hw->virt_mode == DLB2_VIRT_SRIOV)
+                       virt_id = port->id.virt_id;
+               else
+                       virt_id = port->id.phys_id;
+
+               reg = 0;
+               DLB2_BITS_SET(reg, port->id.phys_id, DLB2_SYS_VF_DIR_VPP2PP_PP);
+               offs = vdev_id * DLB2_MAX_NUM_DIR_PORTS(hw->ver) + virt_id;
+               DLB2_CSR_WR(hw, DLB2_SYS_VF_DIR_VPP2PP(offs), reg);
+
+               reg = 0;
+               DLB2_BITS_SET(reg, vdev_id, DLB2_SYS_DIR_PP2VDEV_VDEV);
+               DLB2_CSR_WR(hw, DLB2_SYS_DIR_PP2VDEV(port->id.phys_id), reg);
+
+               reg = 0;
+               DLB2_BIT_SET(reg, DLB2_SYS_VF_DIR_VPP_V_VPP_V);
+               DLB2_CSR_WR(hw, DLB2_SYS_VF_DIR_VPP_V(offs), reg);
+       }
+
+       reg = 0;
+       DLB2_BIT_SET(reg, DLB2_SYS_DIR_PP_V_PP_V);
+       DLB2_CSR_WR(hw, DLB2_SYS_DIR_PP_V(port->id.phys_id), reg);
+}
+
+static int dlb2_dir_port_configure_cq(struct dlb2_hw *hw,
+                                     struct dlb2_hw_domain *domain,
+                                     struct dlb2_dir_pq_pair *port,
+                                     uintptr_t cq_dma_base,
+                                     struct dlb2_create_dir_port_args *args,
+                                     bool vdev_req,
+                                     unsigned int vdev_id)
+{
+       u32 reg = 0;
+       u32 ds = 0;
+
+       /* The CQ address is 64B-aligned, and the DLB only wants bits [63:6] */
+       DLB2_BITS_SET(reg, cq_dma_base >> 6, DLB2_SYS_DIR_CQ_ADDR_L_ADDR_L);
+       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_ADDR_L(port->id.phys_id), reg);
+
+       reg = cq_dma_base >> 32;
+       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_ADDR_U(port->id.phys_id), reg);
+
+       /*
+        * 'ro' == relaxed ordering. This setting allows DLB2 to write
+        * cache lines out-of-order (but QEs within a cache line are always
+        * updated in-order).
+        */
+       reg = 0;
+       DLB2_BITS_SET(reg, vdev_id, DLB2_SYS_DIR_CQ2VF_PF_RO_VF);
+       DLB2_BITS_SET(reg, !vdev_req && (hw->virt_mode != DLB2_VIRT_SIOV),
+                DLB2_SYS_DIR_CQ2VF_PF_RO_IS_PF);
+       DLB2_BIT_SET(reg, DLB2_SYS_DIR_CQ2VF_PF_RO_RO);
+
+       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ2VF_PF_RO(port->id.phys_id), reg);
+
+       if (args->cq_depth <= 8) {
+               ds = 1;
+       } else if (args->cq_depth == 16) {
+               ds = 2;
+       } else if (args->cq_depth == 32) {
+               ds = 3;
+       } else if (args->cq_depth == 64) {
+               ds = 4;
+       } else if (args->cq_depth == 128) {
+               ds = 5;
+       } else if (args->cq_depth == 256) {
+               ds = 6;
+       } else if (args->cq_depth == 512) {
+               ds = 7;
+       } else if (args->cq_depth == 1024) {
+               ds = 8;
+       } else {
+               DLB2_HW_ERR(hw,
+                           "[%s():%d] Internal error: invalid CQ depth\n",
+                           __func__, __LINE__);
+               return -EFAULT;
+       }
+
+       reg = 0;
+       DLB2_BITS_SET(reg, ds,
+                     DLB2_CHP_DIR_CQ_TKN_DEPTH_SEL_TOKEN_DEPTH_SELECT);
+       DLB2_CSR_WR(hw,
+                   DLB2_CHP_DIR_CQ_TKN_DEPTH_SEL(hw->ver, port->id.phys_id),
+                   reg);
+
+       /*
+        * To support CQs with depth less than 8, program the token count
+        * register with a non-zero initial value. Operations such as domain
+        * reset must take this initial value into account when quiescing the
+        * CQ.
+        */
+       port->init_tkn_cnt = 0;
+
+       if (args->cq_depth < 8) {
+               reg = 0;
+               port->init_tkn_cnt = 8 - args->cq_depth;
+
+               DLB2_BITS_SET(reg, port->init_tkn_cnt,
+                             DLB2_LSP_CQ_DIR_TKN_CNT_COUNT);
+               DLB2_CSR_WR(hw,
+                           DLB2_LSP_CQ_DIR_TKN_CNT(hw->ver, port->id.phys_id),
+                           reg);
+       } else {
+               DLB2_CSR_WR(hw,
+                           DLB2_LSP_CQ_DIR_TKN_CNT(hw->ver, port->id.phys_id),
+                           DLB2_LSP_CQ_DIR_TKN_CNT_RST);
+       }
+
+       reg = 0;
+       DLB2_BITS_SET(reg, ds,
+                     DLB2_LSP_CQ_DIR_TKN_DEPTH_SEL_DSI_TOKEN_DEPTH_SELECT_V2);
+       DLB2_CSR_WR(hw,
+                   DLB2_LSP_CQ_DIR_TKN_DEPTH_SEL_DSI(hw->ver,
+                                                     port->id.phys_id),
+                   reg);
+
+       /* Reset the CQ write pointer */
+       DLB2_CSR_WR(hw,
+                   DLB2_CHP_DIR_CQ_WPTR(hw->ver, port->id.phys_id),
+                   DLB2_CHP_DIR_CQ_WPTR_RST);
+
+       /* Virtualize the PPID */
+       reg = 0;
+       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_FMT(port->id.phys_id), reg);
+
+       /*
+        * Address translation (AT) settings: 0: untranslated, 2: translated
+        * (see ATS spec regarding Address Type field for more details)
+        */
+       if (hw->ver == DLB2_HW_V2) {
+               reg = 0;
+               DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_AT(port->id.phys_id), reg);
+       }
+
+       if (vdev_req && hw->virt_mode == DLB2_VIRT_SIOV) {
+               DLB2_BITS_SET(reg, hw->pasid[vdev_id],
+                             DLB2_SYS_DIR_CQ_PASID_PASID);
+               DLB2_BIT_SET(reg, DLB2_SYS_DIR_CQ_PASID_FMT2);
+       }
+
+       DLB2_CSR_WR(hw, DLB2_SYS_DIR_CQ_PASID(hw->ver, port->id.phys_id), reg);
+
+       reg = 0;
+       DLB2_BITS_SET(reg, domain->id.phys_id, DLB2_CHP_DIR_CQ2VAS_CQ2VAS);
+       DLB2_CSR_WR(hw, DLB2_CHP_DIR_CQ2VAS(hw->ver, port->id.phys_id), reg);
+
+       return 0;
+}
+
+static int dlb2_configure_dir_port(struct dlb2_hw *hw,
+                                  struct dlb2_hw_domain *domain,
+                                  struct dlb2_dir_pq_pair *port,
+                                  uintptr_t cq_dma_base,
+                                  struct dlb2_create_dir_port_args *args,
+                                  bool vdev_req,
+                                  unsigned int vdev_id)
+{
+       int ret;
+
+       ret = dlb2_dir_port_configure_cq(hw,
+                                        domain,
+                                        port,
+                                        cq_dma_base,
+                                        args,
+                                        vdev_req,
+                                        vdev_id);
+
+       if (ret)
+               return ret;
+
+       dlb2_dir_port_configure_pp(hw,
+                                  domain,
+                                  port,
+                                  vdev_req,
+                                  vdev_id);
+
+       dlb2_dir_port_cq_enable(hw, port);
+
+       port->enabled = true;
+
+       port->port_configured = true;
+
+       return 0;
+}
+
+/**
+ * dlb2_hw_create_dir_port() - create a directed port
+ * @hw: dlb2_hw handle for a particular device.
+ * @domain_id: domain ID.
+ * @args: port creation arguments.
+ * @cq_dma_base: base address of the CQ memory. This can be a PA or an IOVA.
+ * @resp: response structure.
+ * @vdev_req: indicates whether this request came from a vdev.
+ * @vdev_id: If vdev_req is true, this contains the vdev's ID.
+ *
+ * This function creates a directed port.
+ *
+ * A vdev can be either an SR-IOV virtual function or a Scalable IOV virtual
+ * device.
+ *
+ * Return:
+ * Returns 0 upon success, < 0 otherwise. If an error occurs, resp->status is
+ * assigned a detailed error code from enum dlb2_error. If successful, resp->id
+ * contains the port ID.
+ *
+ * resp->id contains a virtual ID if vdev_req is true.
+ *
+ * Errors:
+ * EINVAL - A requested resource is unavailable, a credit setting is invalid, a
+ *         pointer address is not properly aligned, the domain is not
+ *         configured, or the domain has already been started.
+ * EFAULT - Internal error (resp->status not set).
+ */
+int dlb2_hw_create_dir_port(struct dlb2_hw *hw,
+                           u32 domain_id,
+                           struct dlb2_create_dir_port_args *args,
+                           uintptr_t cq_dma_base,
+                           struct dlb2_cmd_response *resp,
+                           bool vdev_req,
+                           unsigned int vdev_id)
+{
+       struct dlb2_dir_pq_pair *port;
+       struct dlb2_hw_domain *domain;
+       int ret;
+
+       dlb2_log_create_dir_port_args(hw,
+                                     domain_id,
+                                     cq_dma_base,
+                                     args,
+                                     vdev_req,
+                                     vdev_id);
+
+       /*
+        * Verify that hardware resources are available before attempting to
+        * satisfy the request. This simplifies the error unwinding code.
+        */
+       ret = dlb2_verify_create_dir_port_args(hw,
+                                              domain_id,
+                                              cq_dma_base,
+                                              args,
+                                              resp,
+                                              vdev_req,
+                                              vdev_id,
+                                              &domain,
+                                              &port);
+       if (ret)
+               return ret;
+
+       ret = dlb2_configure_dir_port(hw,
+                                     domain,
+                                     port,
+                                     cq_dma_base,
+                                     args,
+                                     vdev_req,
+                                     vdev_id);
+       if (ret)
+               return ret;
+
+       /*
+        * Configuration succeeded, so move the resource from the 'avail' to
+        * the 'used' list (if it's not already there).
+        */
+       if (args->queue_id == -1) {
+               dlb2_list_del(&domain->avail_dir_pq_pairs, &port->domain_list);
+
+               dlb2_list_add(&domain->used_dir_pq_pairs, &port->domain_list);
+       }
+
+       resp->status = 0;
+       resp->id = (vdev_req) ? port->id.virt_id : port->id.phys_id;
+
+       return 0;
+}