net/ice: support flow director counter
[dpdk.git] / drivers / net / ice / ice_fdir_filter.c
index 9d4875c..b327ead 100644 (file)
@@ -10,6 +10,8 @@
 #define ICE_FDIR_IPV6_TC_OFFSET                20
 #define ICE_IPV6_TC_MASK               (0xFF << ICE_FDIR_IPV6_TC_OFFSET)
 
+#define ICE_FDIR_MAX_QREGION_SIZE      128
+
 #define ICE_FDIR_INSET_ETH_IPV4 (\
        ICE_INSET_DMAC | \
        ICE_INSET_IPV4_SRC | ICE_INSET_IPV4_DST | ICE_INSET_IPV4_TOS | \
@@ -99,6 +101,177 @@ fail_mem:
        return -ENOMEM;
 }
 
+static int
+ice_fdir_counter_pool_add(__rte_unused struct ice_pf *pf,
+                         struct ice_fdir_counter_pool_container *container,
+                         uint32_t index_start,
+                         uint32_t len)
+{
+       struct ice_fdir_counter_pool *pool;
+       uint32_t i;
+       int ret = 0;
+
+       pool = rte_zmalloc("ice_fdir_counter_pool",
+                          sizeof(*pool) +
+                          sizeof(struct ice_fdir_counter) * len,
+                          0);
+       if (!pool) {
+               PMD_INIT_LOG(ERR,
+                            "Failed to allocate memory for fdir counter pool");
+               return -ENOMEM;
+       }
+
+       TAILQ_INIT(&pool->counter_list);
+       TAILQ_INSERT_TAIL(&container->pool_list, pool, next);
+
+       for (i = 0; i < len; i++) {
+               struct ice_fdir_counter *counter = &pool->counters[i];
+
+               counter->hw_index = index_start + i;
+               TAILQ_INSERT_TAIL(&pool->counter_list, counter, next);
+       }
+
+       if (container->index_free == ICE_FDIR_COUNTER_MAX_POOL_SIZE) {
+               PMD_INIT_LOG(ERR, "FDIR counter pool is full");
+               ret = -EINVAL;
+               goto free_pool;
+       }
+
+       container->pools[container->index_free++] = pool;
+       return 0;
+
+free_pool:
+       rte_free(pool);
+       return ret;
+}
+
+static int
+ice_fdir_counter_init(struct ice_pf *pf)
+{
+       struct ice_hw *hw = ICE_PF_TO_HW(pf);
+       struct ice_fdir_info *fdir_info = &pf->fdir;
+       struct ice_fdir_counter_pool_container *container =
+                               &fdir_info->counter;
+       uint32_t cnt_index, len;
+       int ret;
+
+       TAILQ_INIT(&container->pool_list);
+
+       cnt_index = ICE_FDIR_COUNTER_INDEX(hw->fd_ctr_base);
+       len = ICE_FDIR_COUNTERS_PER_BLOCK;
+
+       ret = ice_fdir_counter_pool_add(pf, container, cnt_index, len);
+       if (ret) {
+               PMD_INIT_LOG(ERR, "Failed to add fdir pool to container");
+               return ret;
+       }
+
+       return 0;
+}
+
+static int
+ice_fdir_counter_release(struct ice_pf *pf)
+{
+       struct ice_fdir_info *fdir_info = &pf->fdir;
+       struct ice_fdir_counter_pool_container *container =
+                               &fdir_info->counter;
+       uint8_t i;
+
+       for (i = 0; i < container->index_free; i++)
+               rte_free(container->pools[i]);
+
+       return 0;
+}
+
+static struct ice_fdir_counter *
+ice_fdir_counter_shared_search(struct ice_fdir_counter_pool_container
+                                       *container,
+                              uint32_t id)
+{
+       struct ice_fdir_counter_pool *pool;
+       struct ice_fdir_counter *counter;
+       int i;
+
+       TAILQ_FOREACH(pool, &container->pool_list, next) {
+               for (i = 0; i < ICE_FDIR_COUNTERS_PER_BLOCK; i++) {
+                       counter = &pool->counters[i];
+
+                       if (counter->shared &&
+                           counter->ref_cnt &&
+                           counter->id == id)
+                               return counter;
+               }
+       }
+
+       return NULL;
+}
+
+static struct ice_fdir_counter *
+ice_fdir_counter_alloc(struct ice_pf *pf, uint32_t shared, uint32_t id)
+{
+       struct ice_hw *hw = ICE_PF_TO_HW(pf);
+       struct ice_fdir_info *fdir_info = &pf->fdir;
+       struct ice_fdir_counter_pool_container *container =
+                               &fdir_info->counter;
+       struct ice_fdir_counter_pool *pool = NULL;
+       struct ice_fdir_counter *counter_free = NULL;
+
+       if (shared) {
+               counter_free = ice_fdir_counter_shared_search(container, id);
+               if (counter_free) {
+                       if (counter_free->ref_cnt + 1 == 0) {
+                               rte_errno = E2BIG;
+                               return NULL;
+                       }
+                       counter_free->ref_cnt++;
+                       return counter_free;
+               }
+       }
+
+       TAILQ_FOREACH(pool, &container->pool_list, next) {
+               counter_free = TAILQ_FIRST(&pool->counter_list);
+               if (counter_free)
+                       break;
+               counter_free = NULL;
+       }
+
+       if (!counter_free) {
+               PMD_DRV_LOG(ERR, "No free counter found\n");
+               return NULL;
+       }
+
+       counter_free->shared = shared;
+       counter_free->id = id;
+       counter_free->ref_cnt = 1;
+       counter_free->pool = pool;
+
+       /* reset statistic counter value */
+       ICE_WRITE_REG(hw, GLSTAT_FD_CNT0H(counter_free->hw_index), 0);
+       ICE_WRITE_REG(hw, GLSTAT_FD_CNT0L(counter_free->hw_index), 0);
+
+       TAILQ_REMOVE(&pool->counter_list, counter_free, next);
+       if (TAILQ_EMPTY(&pool->counter_list)) {
+               TAILQ_REMOVE(&container->pool_list, pool, next);
+               TAILQ_INSERT_TAIL(&container->pool_list, pool, next);
+       }
+
+       return counter_free;
+}
+
+static void
+ice_fdir_counter_free(__rte_unused struct ice_pf *pf,
+                     struct ice_fdir_counter *counter)
+{
+       if (!counter)
+               return;
+
+       if (--counter->ref_cnt == 0) {
+               struct ice_fdir_counter_pool *pool = counter->pool;
+
+               TAILQ_INSERT_TAIL(&pool->counter_list, counter, next);
+       }
+}
+
 /*
  * ice_fdir_setup - reserve and initialize the Flow Director resources
  * @pf: board private structure
@@ -136,6 +309,12 @@ ice_fdir_setup(struct ice_pf *pf)
        }
        pf->fdir.fdir_vsi = vsi;
 
+       err = ice_fdir_counter_init(pf);
+       if (err) {
+               PMD_DRV_LOG(ERR, "Failed to init FDIR counter.");
+               return -EINVAL;
+       }
+
        /*Fdir tx queue setup*/
        err = ice_fdir_setup_tx_resources(pf);
        if (err) {
@@ -287,6 +466,10 @@ ice_fdir_teardown(struct ice_pf *pf)
        if (err)
                PMD_DRV_LOG(ERR, "Failed to stop RX queue.");
 
+       err = ice_fdir_counter_release(pf);
+       if (err)
+               PMD_DRV_LOG(ERR, "Failed to release FDIR counter resource.");
+
        ice_tx_queue_release(pf->fdir.txq);
        pf->fdir.txq = NULL;
        ice_rx_queue_release(pf->fdir.rxq);
@@ -597,12 +780,28 @@ ice_fdir_create_filter(struct ice_adapter *ad,
                goto free_entry;
        }
 
+       /* alloc counter for FDIR */
+       if (filter->input.cnt_ena) {
+               struct rte_flow_action_count *act_count = &filter->act_count;
+
+               filter->counter = ice_fdir_counter_alloc(pf,
+                                                        act_count->shared,
+                                                        act_count->id);
+               if (!filter->counter) {
+                       rte_flow_error_set(error, EINVAL,
+                                       RTE_FLOW_ERROR_TYPE_ACTION, NULL,
+                                       "Failed to alloc FDIR counter.");
+                       goto free_entry;
+               }
+               filter->input.cnt_index = filter->counter->hw_index;
+       }
+
        ret = ice_fdir_add_del_filter(pf, filter, true);
        if (ret) {
                rte_flow_error_set(error, -ret,
                                   RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
                                   "Add filter rule failed.");
-               goto free_entry;
+               goto free_counter;
        }
 
        rte_memcpy(rule, filter, sizeof(*rule));
@@ -610,6 +809,12 @@ ice_fdir_create_filter(struct ice_adapter *ad,
        ice_fdir_cnt_update(pf, filter->input.flow_type, false, true);
        return 0;
 
+free_counter:
+       if (filter->counter) {
+               ice_fdir_counter_free(pf, filter->counter);
+               filter->counter = NULL;
+       }
+
 free_entry:
        rte_free(rule);
        return -rte_errno;
@@ -626,6 +831,11 @@ ice_fdir_destroy_filter(struct ice_adapter *ad,
 
        filter = (struct ice_fdir_filter_conf *)flow->rule;
 
+       if (filter->counter) {
+               ice_fdir_counter_free(pf, filter->counter);
+               filter->counter = NULL;
+       }
+
        ret = ice_fdir_add_del_filter(pf, filter, false);
        if (ret) {
                rte_flow_error_set(error, -ret,
@@ -642,14 +852,114 @@ ice_fdir_destroy_filter(struct ice_adapter *ad,
        return 0;
 }
 
+static int
+ice_fdir_query_count(struct ice_adapter *ad,
+                     struct rte_flow *flow,
+                     struct rte_flow_query_count *flow_stats,
+                     struct rte_flow_error *error)
+{
+       struct ice_pf *pf = &ad->pf;
+       struct ice_hw *hw = ICE_PF_TO_HW(pf);
+       struct ice_fdir_filter_conf *filter = flow->rule;
+       struct ice_fdir_counter *counter = filter->counter;
+       uint64_t hits_lo, hits_hi;
+
+       if (!counter) {
+               rte_flow_error_set(error, EINVAL,
+                                 RTE_FLOW_ERROR_TYPE_ACTION,
+                                 NULL,
+                                 "FDIR counters not available");
+               return -rte_errno;
+       }
+
+       /*
+        * Reading the low 32-bits latches the high 32-bits into a shadow
+        * register. Reading the high 32-bit returns the value in the
+        * shadow register.
+        */
+       hits_lo = ICE_READ_REG(hw, GLSTAT_FD_CNT0L(counter->hw_index));
+       hits_hi = ICE_READ_REG(hw, GLSTAT_FD_CNT0H(counter->hw_index));
+
+       flow_stats->hits_set = 1;
+       flow_stats->hits = hits_lo | (hits_hi << 32);
+       flow_stats->bytes_set = 0;
+       flow_stats->bytes = 0;
+
+       if (flow_stats->reset) {
+               /* reset statistic counter value */
+               ICE_WRITE_REG(hw, GLSTAT_FD_CNT0H(counter->hw_index), 0);
+               ICE_WRITE_REG(hw, GLSTAT_FD_CNT0L(counter->hw_index), 0);
+       }
+
+       return 0;
+}
+
 static struct ice_flow_engine ice_fdir_engine = {
        .init = ice_fdir_init,
        .uninit = ice_fdir_uninit,
        .create = ice_fdir_create_filter,
        .destroy = ice_fdir_destroy_filter,
+       .query_count = ice_fdir_query_count,
        .type = ICE_FLOW_ENGINE_FDIR,
 };
 
+static int
+ice_fdir_parse_action_qregion(struct ice_pf *pf,
+                             struct rte_flow_error *error,
+                             const struct rte_flow_action *act,
+                             struct ice_fdir_filter_conf *filter)
+{
+       const struct rte_flow_action_rss *rss = act->conf;
+       uint32_t i;
+
+       if (act->type != RTE_FLOW_ACTION_TYPE_RSS) {
+               rte_flow_error_set(error, EINVAL,
+                                  RTE_FLOW_ERROR_TYPE_ACTION, act,
+                                  "Invalid action.");
+               return -rte_errno;
+       }
+
+       if (rss->queue_num <= 1) {
+               rte_flow_error_set(error, EINVAL,
+                                  RTE_FLOW_ERROR_TYPE_ACTION, act,
+                                  "Queue region size can't be 0 or 1.");
+               return -rte_errno;
+       }
+
+       /* check if queue index for queue region is continuous */
+       for (i = 0; i < rss->queue_num - 1; i++) {
+               if (rss->queue[i + 1] != rss->queue[i] + 1) {
+                       rte_flow_error_set(error, EINVAL,
+                                          RTE_FLOW_ERROR_TYPE_ACTION, act,
+                                          "Discontinuous queue region");
+                       return -rte_errno;
+               }
+       }
+
+       if (rss->queue[rss->queue_num - 1] >= pf->dev_data->nb_rx_queues) {
+               rte_flow_error_set(error, EINVAL,
+                                  RTE_FLOW_ERROR_TYPE_ACTION, act,
+                                  "Invalid queue region indexes.");
+               return -rte_errno;
+       }
+
+       if (!(rte_is_power_of_2(rss->queue_num) &&
+            (rss->queue_num <= ICE_FDIR_MAX_QREGION_SIZE))) {
+               rte_flow_error_set(error, EINVAL,
+                                  RTE_FLOW_ERROR_TYPE_ACTION, act,
+                                  "The region size should be any of the following values:"
+                                  "1, 2, 4, 8, 16, 32, 64, 128 as long as the total number "
+                                  "of queues do not exceed the VSI allocation.");
+               return -rte_errno;
+       }
+
+       filter->input.q_index = rss->queue[0];
+       filter->input.q_region = rte_fls_u32(rss->queue_num) - 1;
+       filter->input.dest_ctl = ICE_FLTR_PRGM_DESC_DEST_DIRECT_PKT_QGROUP;
+
+       return 0;
+}
+
 static int
 ice_fdir_parse_action(struct ice_adapter *ad,
                      const struct rte_flow_action actions[],
@@ -659,8 +969,11 @@ ice_fdir_parse_action(struct ice_adapter *ad,
        struct ice_pf *pf = &ad->pf;
        const struct rte_flow_action_queue *act_q;
        const struct rte_flow_action_mark *mark_spec = NULL;
+       const struct rte_flow_action_count *act_count;
        uint32_t dest_num = 0;
        uint32_t mark_num = 0;
+       uint32_t counter_num = 0;
+       int ret;
 
        for (; actions->type != RTE_FLOW_ACTION_TYPE_END; actions++) {
                switch (actions->type) {
@@ -695,11 +1008,28 @@ ice_fdir_parse_action(struct ice_adapter *ad,
                                ICE_FLTR_PRGM_DESC_DEST_DIRECT_PKT_QINDEX;
                        filter->input.q_index = 0;
                        break;
+               case RTE_FLOW_ACTION_TYPE_RSS:
+                       dest_num++;
+
+                       ret = ice_fdir_parse_action_qregion(pf,
+                                               error, actions, filter);
+                       if (ret)
+                               return ret;
+                       break;
                case RTE_FLOW_ACTION_TYPE_MARK:
                        mark_num++;
 
                        mark_spec = actions->conf;
                        filter->input.fltr_id = mark_spec->id;
+                       break;
+               case RTE_FLOW_ACTION_TYPE_COUNT:
+                       counter_num++;
+
+                       act_count = actions->conf;
+                       filter->input.cnt_ena = ICE_FXD_FLTR_QW0_STAT_ENA_PKTS;
+                       rte_memcpy(&filter->act_count, act_count,
+                                               sizeof(filter->act_count));
+
                        break;
                default:
                        rte_flow_error_set(error, EINVAL,
@@ -723,6 +1053,13 @@ ice_fdir_parse_action(struct ice_adapter *ad,
                return -rte_errno;
        }
 
+       if (counter_num >= 2) {
+               rte_flow_error_set(error, EINVAL,
+                          RTE_FLOW_ERROR_TYPE_ACTION, actions,
+                          "Too many count actions");
+               return -rte_errno;
+       }
+
        return 0;
 }