ice: Create framework for VSI queue context

This patch introduces a framework to store queue specific information
in VSI queue contexts. Currently VSI queue context (represented by
struct ice_q_ctx) only has q_handle as a member. In future patches,
this structure will be updated to hold queue specific information.

Signed-off-by: Anirudh Venkataramanan <anirudh.venkataramanan@intel.com>
Tested-by: Andrew Bowers <andrewx.bowers@intel.com>
Signed-off-by: Jeff Kirsher <jeffrey.t.kirsher@intel.com>

1 files changed, 49 insertions, 5 deletions

diff --git a/drivers/net/ethernet/intel/ice/ice_sched.c b/drivers/net/ethernet/intel/ice/ice_sched.c
index 124feaf0e730..8d49f83be7a5 100644
--- a/drivers/net/ethernet/intel/ice/ice_sched.c
+++ b/drivers/net/ethernet/intel/ice/ice_sched.c
@@ -533,6 +533,50 @@ ice_sched_suspend_resume_elems(struct ice_hw *hw, u8 num_nodes, u32 *node_teids,
 }
 
 /**
+ * ice_alloc_lan_q_ctx - allocate LAN queue contexts for the given VSI and TC
+ * @hw: pointer to the HW struct
+ * @vsi_handle: VSI handle
+ * @tc: TC number
+ * @new_numqs: number of queues
+ */
+static enum ice_status
+ice_alloc_lan_q_ctx(struct ice_hw *hw, u16 vsi_handle, u8 tc, u16 new_numqs)
+{
+        struct ice_vsi_ctx *vsi_ctx;
+        struct ice_q_ctx *q_ctx;
+
+        vsi_ctx = ice_get_vsi_ctx(hw, vsi_handle);
+        if (!vsi_ctx)
+                return ICE_ERR_PARAM;
+        /* allocate LAN queue contexts */
+        if (!vsi_ctx->lan_q_ctx[tc]) {
+                vsi_ctx->lan_q_ctx[tc] = devm_kcalloc(ice_hw_to_dev(hw),
+                                                      new_numqs,
+                                                      sizeof(*q_ctx),
+                                                      GFP_KERNEL);
+                if (!vsi_ctx->lan_q_ctx[tc])
+                        return ICE_ERR_NO_MEMORY;
+                vsi_ctx->num_lan_q_entries[tc] = new_numqs;
+                return 0;
+        }
+        /* num queues are increased, update the queue contexts */
+        if (new_numqs > vsi_ctx->num_lan_q_entries[tc]) {
+                u16 prev_num = vsi_ctx->num_lan_q_entries[tc];
+
+                q_ctx = devm_kcalloc(ice_hw_to_dev(hw), new_numqs,
+                                     sizeof(*q_ctx), GFP_KERNEL);
+                if (!q_ctx)
+                        return ICE_ERR_NO_MEMORY;
+                memcpy(q_ctx, vsi_ctx->lan_q_ctx[tc],
+                       prev_num * sizeof(*q_ctx));
+                devm_kfree(ice_hw_to_dev(hw), vsi_ctx->lan_q_ctx[tc]);
+                vsi_ctx->lan_q_ctx[tc] = q_ctx;
+                vsi_ctx->num_lan_q_entries[tc] = new_numqs;
+        }
+        return 0;
+}
+
+/**
  * ice_sched_clear_agg - clears the aggregator related information
  * @hw: pointer to the hardware structure
  *
@@ -1403,14 +1447,14 @@ ice_sched_update_vsi_child_nodes(struct ice_port_info *pi, u16 vsi_handle,
         if (!vsi_ctx)
                 return ICE_ERR_PARAM;
 
-        if (owner == ICE_SCHED_NODE_OWNER_LAN)
-                prev_numqs = vsi_ctx->sched.max_lanq[tc];
-        else
-                return ICE_ERR_PARAM;
-
+        prev_numqs = vsi_ctx->sched.max_lanq[tc];
         /* num queues are not changed or less than the previous number */
         if (new_numqs <= prev_numqs)
                 return status;
+        status = ice_alloc_lan_q_ctx(hw, vsi_handle, tc, new_numqs);
+        if (status)
+                return status;
+
         if (new_numqs)
                 ice_sched_calc_vsi_child_nodes(hw, new_numqs, new_num_nodes);
         /* Keep the max number of queue configuration all the time. Update the