drivers/net/ice/ice_fdir_filter.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2019 Intel Corporation
   3  */
   4
   5 #include <stdio.h>
   6 #include <rte_flow.h>
   7 #include <rte_hash.h>
   8 #include <rte_hash_crc.h>
   9 #include "base/ice_fdir.h"
  10 #include "base/ice_flow.h"
  11 #include "base/ice_type.h"
  12 #include "ice_ethdev.h"
  13 #include "ice_rxtx.h"
  14 #include "ice_generic_flow.h"
  15
  16 #define ICE_FDIR_IPV6_TC_OFFSET         20
  17 #define ICE_IPV6_TC_MASK                (0xFF << ICE_FDIR_IPV6_TC_OFFSET)
  18
  19 #define ICE_FDIR_MAX_QREGION_SIZE       128
  20
  21 #define ICE_FDIR_INSET_ETH_IPV4 (\
  22         ICE_INSET_DMAC | \
  23         ICE_INSET_IPV4_SRC | ICE_INSET_IPV4_DST | ICE_INSET_IPV4_TOS | \
  24         ICE_INSET_IPV4_TTL | ICE_INSET_IPV4_PROTO)
  25
  26 #define ICE_FDIR_INSET_ETH_IPV4_UDP (\
  27         ICE_FDIR_INSET_ETH_IPV4 | \
  28         ICE_INSET_UDP_SRC_PORT | ICE_INSET_UDP_DST_PORT)
  29
  30 #define ICE_FDIR_INSET_ETH_IPV4_TCP (\
  31         ICE_FDIR_INSET_ETH_IPV4 | \
  32         ICE_INSET_TCP_SRC_PORT | ICE_INSET_TCP_DST_PORT)
  33
  34 #define ICE_FDIR_INSET_ETH_IPV4_SCTP (\
  35         ICE_FDIR_INSET_ETH_IPV4 | \
  36         ICE_INSET_SCTP_SRC_PORT | ICE_INSET_SCTP_DST_PORT)
  37
  38 #define ICE_FDIR_INSET_ETH_IPV6 (\
  39         ICE_INSET_DMAC | \
  40         ICE_INSET_IPV6_SRC | ICE_INSET_IPV6_DST | ICE_INSET_IPV6_TC | \
  41         ICE_INSET_IPV6_HOP_LIMIT | ICE_INSET_IPV6_NEXT_HDR)
  42
  43 #define ICE_FDIR_INSET_ETH_IPV6_UDP (\
  44         ICE_FDIR_INSET_ETH_IPV6 | \
  45         ICE_INSET_UDP_SRC_PORT | ICE_INSET_UDP_DST_PORT)
  46
  47 #define ICE_FDIR_INSET_ETH_IPV6_TCP (\
  48         ICE_FDIR_INSET_ETH_IPV6 | \
  49         ICE_INSET_TCP_SRC_PORT | ICE_INSET_TCP_DST_PORT)
  50
  51 #define ICE_FDIR_INSET_ETH_IPV6_SCTP (\
  52         ICE_FDIR_INSET_ETH_IPV6 | \
  53         ICE_INSET_SCTP_SRC_PORT | ICE_INSET_SCTP_DST_PORT)
  54
  55 #define ICE_FDIR_INSET_VXLAN_IPV4 (\
  56         ICE_INSET_TUN_IPV4_SRC | ICE_INSET_TUN_IPV4_DST)
  57
  58 #define ICE_FDIR_INSET_VXLAN_IPV4_TCP (\
  59         ICE_FDIR_INSET_VXLAN_IPV4 | \
  60         ICE_INSET_TUN_TCP_SRC_PORT | ICE_INSET_TUN_TCP_DST_PORT)
  61
  62 #define ICE_FDIR_INSET_VXLAN_IPV4_UDP (\
  63         ICE_FDIR_INSET_VXLAN_IPV4 | \
  64         ICE_INSET_TUN_UDP_SRC_PORT | ICE_INSET_TUN_UDP_DST_PORT)
  65
  66 #define ICE_FDIR_INSET_VXLAN_IPV4_SCTP (\
  67         ICE_FDIR_INSET_VXLAN_IPV4 | \
  68         ICE_INSET_TUN_SCTP_SRC_PORT | ICE_INSET_TUN_SCTP_DST_PORT)
  69
  70 #define ICE_FDIR_INSET_GTPU (\
  71         ICE_INSET_IPV4_SRC | ICE_INSET_IPV4_DST | ICE_INSET_GTPU_TEID)
  72
  73 #define ICE_FDIR_INSET_GTPU_EH (\
  74         ICE_INSET_IPV4_SRC | ICE_INSET_IPV4_DST | \
  75         ICE_INSET_GTPU_TEID | ICE_INSET_GTPU_QFI)
  76
  77 static struct ice_pattern_match_item ice_fdir_pattern_os[] = {
  78         {pattern_eth_ipv4,             ICE_FDIR_INSET_ETH_IPV4,              ICE_INSET_NONE},
  79         {pattern_eth_ipv4_udp,         ICE_FDIR_INSET_ETH_IPV4_UDP,          ICE_INSET_NONE},
  80         {pattern_eth_ipv4_tcp,         ICE_FDIR_INSET_ETH_IPV4_TCP,          ICE_INSET_NONE},
  81         {pattern_eth_ipv4_sctp,        ICE_FDIR_INSET_ETH_IPV4_SCTP,         ICE_INSET_NONE},
  82         {pattern_eth_ipv6,             ICE_FDIR_INSET_ETH_IPV6,              ICE_INSET_NONE},
  83         {pattern_eth_ipv6_udp,         ICE_FDIR_INSET_ETH_IPV6_UDP,          ICE_INSET_NONE},
  84         {pattern_eth_ipv6_tcp,         ICE_FDIR_INSET_ETH_IPV6_TCP,          ICE_INSET_NONE},
  85         {pattern_eth_ipv6_sctp,        ICE_FDIR_INSET_ETH_IPV6_SCTP,         ICE_INSET_NONE},
  86         {pattern_eth_ipv4_udp_vxlan_ipv4,
  87                                        ICE_FDIR_INSET_VXLAN_IPV4,            ICE_INSET_NONE},
  88         {pattern_eth_ipv4_udp_vxlan_ipv4_udp,
  89                                        ICE_FDIR_INSET_VXLAN_IPV4_UDP,        ICE_INSET_NONE},
  90         {pattern_eth_ipv4_udp_vxlan_ipv4_tcp,
  91                                        ICE_FDIR_INSET_VXLAN_IPV4_TCP,        ICE_INSET_NONE},
  92         {pattern_eth_ipv4_udp_vxlan_ipv4_sctp,
  93                                        ICE_FDIR_INSET_VXLAN_IPV4_SCTP,       ICE_INSET_NONE},
  94         {pattern_eth_ipv4_udp_vxlan_eth_ipv4,
  95                                        ICE_FDIR_INSET_VXLAN_IPV4,            ICE_INSET_NONE},
  96         {pattern_eth_ipv4_udp_vxlan_eth_ipv4_udp,
  97                                        ICE_FDIR_INSET_VXLAN_IPV4_UDP,        ICE_INSET_NONE},
  98         {pattern_eth_ipv4_udp_vxlan_eth_ipv4_tcp,
  99                                        ICE_FDIR_INSET_VXLAN_IPV4_TCP,        ICE_INSET_NONE},
 100         {pattern_eth_ipv4_udp_vxlan_eth_ipv4_sctp,
 101                                        ICE_FDIR_INSET_VXLAN_IPV4_SCTP,       ICE_INSET_NONE},
 102 };
 103
 104 static struct ice_pattern_match_item ice_fdir_pattern_comms[] = {
 105         {pattern_eth_ipv4,             ICE_FDIR_INSET_ETH_IPV4,              ICE_INSET_NONE},
 106         {pattern_eth_ipv4_udp,         ICE_FDIR_INSET_ETH_IPV4_UDP,          ICE_INSET_NONE},
 107         {pattern_eth_ipv4_tcp,         ICE_FDIR_INSET_ETH_IPV4_TCP,          ICE_INSET_NONE},
 108         {pattern_eth_ipv4_sctp,        ICE_FDIR_INSET_ETH_IPV4_SCTP,         ICE_INSET_NONE},
 109         {pattern_eth_ipv6,             ICE_FDIR_INSET_ETH_IPV6,              ICE_INSET_NONE},
 110         {pattern_eth_ipv6_udp,         ICE_FDIR_INSET_ETH_IPV6_UDP,          ICE_INSET_NONE},
 111         {pattern_eth_ipv6_tcp,         ICE_FDIR_INSET_ETH_IPV6_TCP,          ICE_INSET_NONE},
 112         {pattern_eth_ipv6_sctp,        ICE_FDIR_INSET_ETH_IPV6_SCTP,         ICE_INSET_NONE},
 113         {pattern_eth_ipv4_udp_vxlan_ipv4,
 114                                        ICE_FDIR_INSET_VXLAN_IPV4,            ICE_INSET_NONE},
 115         {pattern_eth_ipv4_udp_vxlan_ipv4_udp,
 116                                        ICE_FDIR_INSET_VXLAN_IPV4_UDP,        ICE_INSET_NONE},
 117         {pattern_eth_ipv4_udp_vxlan_ipv4_tcp,
 118                                        ICE_FDIR_INSET_VXLAN_IPV4_TCP,        ICE_INSET_NONE},
 119         {pattern_eth_ipv4_udp_vxlan_ipv4_sctp,
 120                                        ICE_FDIR_INSET_VXLAN_IPV4_SCTP,       ICE_INSET_NONE},
 121         {pattern_eth_ipv4_udp_vxlan_eth_ipv4,
 122                                        ICE_FDIR_INSET_VXLAN_IPV4,            ICE_INSET_NONE},
 123         {pattern_eth_ipv4_udp_vxlan_eth_ipv4_udp,
 124                                        ICE_FDIR_INSET_VXLAN_IPV4_UDP,        ICE_INSET_NONE},
 125         {pattern_eth_ipv4_udp_vxlan_eth_ipv4_tcp,
 126                                        ICE_FDIR_INSET_VXLAN_IPV4_TCP,        ICE_INSET_NONE},
 127         {pattern_eth_ipv4_udp_vxlan_eth_ipv4_sctp,
 128                                        ICE_FDIR_INSET_VXLAN_IPV4_SCTP,       ICE_INSET_NONE},
 129         {pattern_eth_ipv4_gtpu,        ICE_FDIR_INSET_GTPU,                  ICE_INSET_NONE},
 130         {pattern_eth_ipv4_gtpu_eh,     ICE_FDIR_INSET_GTPU_EH,               ICE_INSET_NONE},
 131 };
 132
 133 static struct ice_flow_parser ice_fdir_parser_os;
 134 static struct ice_flow_parser ice_fdir_parser_comms;
 135
 136 static int
 137 ice_fdir_is_tunnel_profile(enum ice_fdir_tunnel_type tunnel_type);
 138
 139 static const struct rte_memzone *
 140 ice_memzone_reserve(const char *name, uint32_t len, int socket_id)
 141 {
 142         const struct rte_memzone *mz;
 143
 144         mz = rte_memzone_lookup(name);
 145         if (mz)
 146                 return mz;
 147
 148         return rte_memzone_reserve_aligned(name, len, socket_id,
 149                                            RTE_MEMZONE_IOVA_CONTIG,
 150                                            ICE_RING_BASE_ALIGN);
 151 }
 152
 153 #define ICE_FDIR_MZ_NAME        "FDIR_MEMZONE"
 154
 155 static int
 156 ice_fdir_prof_alloc(struct ice_hw *hw)
 157 {
 158         enum ice_fltr_ptype ptype, fltr_ptype;
 159
 160         if (!hw->fdir_prof) {
 161                 hw->fdir_prof = (struct ice_fd_hw_prof **)
 162                         ice_malloc(hw, ICE_FLTR_PTYPE_MAX *
 163                                    sizeof(*hw->fdir_prof));
 164                 if (!hw->fdir_prof)
 165                         return -ENOMEM;
 166         }
 167         for (ptype = ICE_FLTR_PTYPE_NONF_NONE + 1;
 168              ptype < ICE_FLTR_PTYPE_MAX;
 169              ptype++) {
 170                 if (!hw->fdir_prof[ptype]) {
 171                         hw->fdir_prof[ptype] = (struct ice_fd_hw_prof *)
 172                                 ice_malloc(hw, sizeof(**hw->fdir_prof));
 173                         if (!hw->fdir_prof[ptype])
 174                                 goto fail_mem;
 175                 }
 176         }
 177         return 0;
 178
 179 fail_mem:
 180         for (fltr_ptype = ICE_FLTR_PTYPE_NONF_NONE + 1;
 181              fltr_ptype < ptype;
 182              fltr_ptype++) {
 183                 rte_free(hw->fdir_prof[fltr_ptype]);
 184                 hw->fdir_prof[fltr_ptype] = NULL;
 185         }
 186
 187         rte_free(hw->fdir_prof);
 188         hw->fdir_prof = NULL;
 189
 190         return -ENOMEM;
 191 }
 192
 193 static int
 194 ice_fdir_counter_pool_add(__rte_unused struct ice_pf *pf,
 195                           struct ice_fdir_counter_pool_container *container,
 196                           uint32_t index_start,
 197                           uint32_t len)
 198 {
 199         struct ice_fdir_counter_pool *pool;
 200         uint32_t i;
 201         int ret = 0;
 202
 203         pool = rte_zmalloc("ice_fdir_counter_pool",
 204                            sizeof(*pool) +
 205                            sizeof(struct ice_fdir_counter) * len,
 206                            0);
 207         if (!pool) {
 208                 PMD_INIT_LOG(ERR,
 209                              "Failed to allocate memory for fdir counter pool");
 210                 return -ENOMEM;
 211         }
 212
 213         TAILQ_INIT(&pool->counter_list);
 214         TAILQ_INSERT_TAIL(&container->pool_list, pool, next);
 215
 216         for (i = 0; i < len; i++) {
 217                 struct ice_fdir_counter *counter = &pool->counters[i];
 218
 219                 counter->hw_index = index_start + i;
 220                 TAILQ_INSERT_TAIL(&pool->counter_list, counter, next);
 221         }
 222
 223         if (container->index_free == ICE_FDIR_COUNTER_MAX_POOL_SIZE) {
 224                 PMD_INIT_LOG(ERR, "FDIR counter pool is full");
 225                 ret = -EINVAL;
 226                 goto free_pool;
 227         }
 228
 229         container->pools[container->index_free++] = pool;
 230         return 0;
 231
 232 free_pool:
 233         rte_free(pool);
 234         return ret;
 235 }
 236
 237 static int
 238 ice_fdir_counter_init(struct ice_pf *pf)
 239 {
 240         struct ice_hw *hw = ICE_PF_TO_HW(pf);
 241         struct ice_fdir_info *fdir_info = &pf->fdir;
 242         struct ice_fdir_counter_pool_container *container =
 243                                 &fdir_info->counter;
 244         uint32_t cnt_index, len;
 245         int ret;
 246
 247         TAILQ_INIT(&container->pool_list);
 248
 249         cnt_index = ICE_FDIR_COUNTER_INDEX(hw->fd_ctr_base);
 250         len = ICE_FDIR_COUNTERS_PER_BLOCK;
 251
 252         ret = ice_fdir_counter_pool_add(pf, container, cnt_index, len);
 253         if (ret) {
 254                 PMD_INIT_LOG(ERR, "Failed to add fdir pool to container");
 255                 return ret;
 256         }
 257
 258         return 0;
 259 }
 260
 261 static int
 262 ice_fdir_counter_release(struct ice_pf *pf)
 263 {
 264         struct ice_fdir_info *fdir_info = &pf->fdir;
 265         struct ice_fdir_counter_pool_container *container =
 266                                 &fdir_info->counter;
 267         uint8_t i;
 268
 269         for (i = 0; i < container->index_free; i++) {
 270                 rte_free(container->pools[i]);
 271                 container->pools[i] = NULL;
 272         }
 273
 274         TAILQ_INIT(&container->pool_list);
 275         container->index_free = 0;
 276
 277         return 0;
 278 }
 279
 280 static struct ice_fdir_counter *
 281 ice_fdir_counter_shared_search(struct ice_fdir_counter_pool_container
 282                                         *container,
 283                                uint32_t id)
 284 {
 285         struct ice_fdir_counter_pool *pool;
 286         struct ice_fdir_counter *counter;
 287         int i;
 288
 289         TAILQ_FOREACH(pool, &container->pool_list, next) {
 290                 for (i = 0; i < ICE_FDIR_COUNTERS_PER_BLOCK; i++) {
 291                         counter = &pool->counters[i];
 292
 293                         if (counter->shared &&
 294                             counter->ref_cnt &&
 295                             counter->id == id)
 296                                 return counter;
 297                 }
 298         }
 299
 300         return NULL;
 301 }
 302
 303 static struct ice_fdir_counter *
 304 ice_fdir_counter_alloc(struct ice_pf *pf, uint32_t shared, uint32_t id)
 305 {
 306         struct ice_hw *hw = ICE_PF_TO_HW(pf);
 307         struct ice_fdir_info *fdir_info = &pf->fdir;
 308         struct ice_fdir_counter_pool_container *container =
 309                                 &fdir_info->counter;
 310         struct ice_fdir_counter_pool *pool = NULL;
 311         struct ice_fdir_counter *counter_free = NULL;
 312
 313         if (shared) {
 314                 counter_free = ice_fdir_counter_shared_search(container, id);
 315                 if (counter_free) {
 316                         if (counter_free->ref_cnt + 1 == 0) {
 317                                 rte_errno = E2BIG;
 318                                 return NULL;
 319                         }
 320                         counter_free->ref_cnt++;
 321                         return counter_free;
 322                 }
 323         }
 324
 325         TAILQ_FOREACH(pool, &container->pool_list, next) {
 326                 counter_free = TAILQ_FIRST(&pool->counter_list);
 327                 if (counter_free)
 328                         break;
 329                 counter_free = NULL;
 330         }
 331
 332         if (!counter_free) {
 333                 PMD_DRV_LOG(ERR, "No free counter found\n");
 334                 return NULL;
 335         }
 336
 337         counter_free->shared = shared;
 338         counter_free->id = id;
 339         counter_free->ref_cnt = 1;
 340         counter_free->pool = pool;
 341
 342         /* reset statistic counter value */
 343         ICE_WRITE_REG(hw, GLSTAT_FD_CNT0H(counter_free->hw_index), 0);
 344         ICE_WRITE_REG(hw, GLSTAT_FD_CNT0L(counter_free->hw_index), 0);
 345
 346         TAILQ_REMOVE(&pool->counter_list, counter_free, next);
 347         if (TAILQ_EMPTY(&pool->counter_list)) {
 348                 TAILQ_REMOVE(&container->pool_list, pool, next);
 349                 TAILQ_INSERT_TAIL(&container->pool_list, pool, next);
 350         }
 351
 352         return counter_free;
 353 }
 354
 355 static void
 356 ice_fdir_counter_free(__rte_unused struct ice_pf *pf,
 357                       struct ice_fdir_counter *counter)
 358 {
 359         if (!counter)
 360                 return;
 361
 362         if (--counter->ref_cnt == 0) {
 363                 struct ice_fdir_counter_pool *pool = counter->pool;
 364
 365                 TAILQ_INSERT_TAIL(&pool->counter_list, counter, next);
 366         }
 367 }
 368
 369 static int
 370 ice_fdir_init_filter_list(struct ice_pf *pf)
 371 {
 372         struct rte_eth_dev *dev = pf->adapter->eth_dev;
 373         struct ice_fdir_info *fdir_info = &pf->fdir;
 374         char fdir_hash_name[RTE_HASH_NAMESIZE];
 375         int ret;
 376
 377         struct rte_hash_parameters fdir_hash_params = {
 378                 .name = fdir_hash_name,
 379                 .entries = ICE_MAX_FDIR_FILTER_NUM,
 380                 .key_len = sizeof(struct ice_fdir_fltr_pattern),
 381                 .hash_func = rte_hash_crc,
 382                 .hash_func_init_val = 0,
 383                 .socket_id = rte_socket_id(),
 384                 .extra_flag = RTE_HASH_EXTRA_FLAGS_EXT_TABLE,
 385         };
 386
 387         /* Initialize hash */
 388         snprintf(fdir_hash_name, RTE_HASH_NAMESIZE,
 389                  "fdir_%s", dev->device->name);
 390         fdir_info->hash_table = rte_hash_create(&fdir_hash_params);
 391         if (!fdir_info->hash_table) {
 392                 PMD_INIT_LOG(ERR, "Failed to create fdir hash table!");
 393                 return -EINVAL;
 394         }
 395         fdir_info->hash_map = rte_zmalloc("ice_fdir_hash_map",
 396                                           sizeof(*fdir_info->hash_map) *
 397                                           ICE_MAX_FDIR_FILTER_NUM,
 398                                           0);
 399         if (!fdir_info->hash_map) {
 400                 PMD_INIT_LOG(ERR,
 401                              "Failed to allocate memory for fdir hash map!");
 402                 ret = -ENOMEM;
 403                 goto err_fdir_hash_map_alloc;
 404         }
 405         return 0;
 406
 407 err_fdir_hash_map_alloc:
 408         rte_hash_free(fdir_info->hash_table);
 409
 410         return ret;
 411 }
 412
 413 static void
 414 ice_fdir_release_filter_list(struct ice_pf *pf)
 415 {
 416         struct ice_fdir_info *fdir_info = &pf->fdir;
 417
 418         if (fdir_info->hash_map)
 419                 rte_free(fdir_info->hash_map);
 420         if (fdir_info->hash_table)
 421                 rte_hash_free(fdir_info->hash_table);
 422
 423         fdir_info->hash_map = NULL;
 424         fdir_info->hash_table = NULL;
 425 }
 426
 427 /*
 428  * ice_fdir_setup - reserve and initialize the Flow Director resources
 429  * @pf: board private structure
 430  */
 431 static int
 432 ice_fdir_setup(struct ice_pf *pf)
 433 {
 434         struct rte_eth_dev *eth_dev = pf->adapter->eth_dev;
 435         struct ice_hw *hw = ICE_PF_TO_HW(pf);
 436         const struct rte_memzone *mz = NULL;
 437         char z_name[RTE_MEMZONE_NAMESIZE];
 438         struct ice_vsi *vsi;
 439         int err = ICE_SUCCESS;
 440
 441         if ((pf->flags & ICE_FLAG_FDIR) == 0) {
 442                 PMD_INIT_LOG(ERR, "HW doesn't support FDIR");
 443                 return -ENOTSUP;
 444         }
 445
 446         PMD_DRV_LOG(INFO, "FDIR HW Capabilities: fd_fltr_guar = %u,"
 447                     " fd_fltr_best_effort = %u.",
 448                     hw->func_caps.fd_fltr_guar,
 449                     hw->func_caps.fd_fltr_best_effort);
 450
 451         if (pf->fdir.fdir_vsi) {
 452                 PMD_DRV_LOG(INFO, "FDIR initialization has been done.");
 453                 return ICE_SUCCESS;
 454         }
 455
 456         /* make new FDIR VSI */
 457         vsi = ice_setup_vsi(pf, ICE_VSI_CTRL);
 458         if (!vsi) {
 459                 PMD_DRV_LOG(ERR, "Couldn't create FDIR VSI.");
 460                 return -EINVAL;
 461         }
 462         pf->fdir.fdir_vsi = vsi;
 463
 464         err = ice_fdir_init_filter_list(pf);
 465         if (err) {
 466                 PMD_DRV_LOG(ERR, "Failed to init FDIR filter list.");
 467                 return -EINVAL;
 468         }
 469
 470         err = ice_fdir_counter_init(pf);
 471         if (err) {
 472                 PMD_DRV_LOG(ERR, "Failed to init FDIR counter.");
 473                 return -EINVAL;
 474         }
 475
 476         /*Fdir tx queue setup*/
 477         err = ice_fdir_setup_tx_resources(pf);
 478         if (err) {
 479                 PMD_DRV_LOG(ERR, "Failed to setup FDIR TX resources.");
 480                 goto fail_setup_tx;
 481         }
 482
 483         /*Fdir rx queue setup*/
 484         err = ice_fdir_setup_rx_resources(pf);
 485         if (err) {
 486                 PMD_DRV_LOG(ERR, "Failed to setup FDIR RX resources.");
 487                 goto fail_setup_rx;
 488         }
 489
 490         err = ice_fdir_tx_queue_start(eth_dev, pf->fdir.txq->queue_id);
 491         if (err) {
 492                 PMD_DRV_LOG(ERR, "Failed to start FDIR TX queue.");
 493                 goto fail_mem;
 494         }
 495
 496         err = ice_fdir_rx_queue_start(eth_dev, pf->fdir.rxq->queue_id);
 497         if (err) {
 498                 PMD_DRV_LOG(ERR, "Failed to start FDIR RX queue.");
 499                 goto fail_mem;
 500         }
 501
 502         /* Enable FDIR MSIX interrupt */
 503         vsi->nb_used_qps = 1;
 504         ice_vsi_queues_bind_intr(vsi);
 505         ice_vsi_enable_queues_intr(vsi);
 506
 507         /* reserve memory for the fdir programming packet */
 508         snprintf(z_name, sizeof(z_name), "ICE_%s_%d",
 509                  ICE_FDIR_MZ_NAME,
 510                  eth_dev->data->port_id);
 511         mz = ice_memzone_reserve(z_name, ICE_FDIR_PKT_LEN, SOCKET_ID_ANY);
 512         if (!mz) {
 513                 PMD_DRV_LOG(ERR, "Cannot init memzone for "
 514                             "flow director program packet.");
 515                 err = -ENOMEM;
 516                 goto fail_mem;
 517         }
 518         pf->fdir.prg_pkt = mz->addr;
 519         pf->fdir.dma_addr = mz->iova;
 520         pf->fdir.mz = mz;
 521
 522         err = ice_fdir_prof_alloc(hw);
 523         if (err) {
 524                 PMD_DRV_LOG(ERR, "Cannot allocate memory for "
 525                             "flow director profile.");
 526                 err = -ENOMEM;
 527                 goto fail_prof;
 528         }
 529
 530         PMD_DRV_LOG(INFO, "FDIR setup successfully, with programming queue %u.",
 531                     vsi->base_queue);
 532         return ICE_SUCCESS;
 533
 534 fail_prof:
 535         rte_memzone_free(pf->fdir.mz);
 536         pf->fdir.mz = NULL;
 537 fail_mem:
 538         ice_rx_queue_release(pf->fdir.rxq);
 539         pf->fdir.rxq = NULL;
 540 fail_setup_rx:
 541         ice_tx_queue_release(pf->fdir.txq);
 542         pf->fdir.txq = NULL;
 543 fail_setup_tx:
 544         ice_release_vsi(vsi);
 545         pf->fdir.fdir_vsi = NULL;
 546         return err;
 547 }
 548
 549 static void
 550 ice_fdir_prof_free(struct ice_hw *hw)
 551 {
 552         enum ice_fltr_ptype ptype;
 553
 554         for (ptype = ICE_FLTR_PTYPE_NONF_NONE + 1;
 555              ptype < ICE_FLTR_PTYPE_MAX;
 556              ptype++) {
 557                 rte_free(hw->fdir_prof[ptype]);
 558                 hw->fdir_prof[ptype] = NULL;
 559         }
 560
 561         rte_free(hw->fdir_prof);
 562         hw->fdir_prof = NULL;
 563 }
 564
 565 /* Remove a profile for some filter type */
 566 static void
 567 ice_fdir_prof_rm(struct ice_pf *pf, enum ice_fltr_ptype ptype, bool is_tunnel)
 568 {
 569         struct ice_hw *hw = ICE_PF_TO_HW(pf);
 570         struct ice_fd_hw_prof *hw_prof;
 571         uint64_t prof_id;
 572         uint16_t vsi_num;
 573         int i;
 574
 575         if (!hw->fdir_prof || !hw->fdir_prof[ptype])
 576                 return;
 577
 578         hw_prof = hw->fdir_prof[ptype];
 579
 580         prof_id = ptype + is_tunnel * ICE_FLTR_PTYPE_MAX;
 581         for (i = 0; i < pf->hw_prof_cnt[ptype][is_tunnel]; i++) {
 582                 if (hw_prof->entry_h[i][is_tunnel]) {
 583                         vsi_num = ice_get_hw_vsi_num(hw,
 584                                                      hw_prof->vsi_h[i]);
 585                         ice_rem_prof_id_flow(hw, ICE_BLK_FD,
 586                                              vsi_num, ptype);
 587                         ice_flow_rem_entry(hw,
 588                                            hw_prof->entry_h[i][is_tunnel]);
 589                         hw_prof->entry_h[i][is_tunnel] = 0;
 590                 }
 591         }
 592         ice_flow_rem_prof(hw, ICE_BLK_FD, prof_id);
 593         rte_free(hw_prof->fdir_seg[is_tunnel]);
 594         hw_prof->fdir_seg[is_tunnel] = NULL;
 595
 596         for (i = 0; i < hw_prof->cnt; i++)
 597                 hw_prof->vsi_h[i] = 0;
 598         pf->hw_prof_cnt[ptype][is_tunnel] = 0;
 599 }
 600
 601 /* Remove all created profiles */
 602 static void
 603 ice_fdir_prof_rm_all(struct ice_pf *pf)
 604 {
 605         enum ice_fltr_ptype ptype;
 606
 607         for (ptype = ICE_FLTR_PTYPE_NONF_NONE + 1;
 608              ptype < ICE_FLTR_PTYPE_MAX;
 609              ptype++) {
 610                 ice_fdir_prof_rm(pf, ptype, false);
 611                 ice_fdir_prof_rm(pf, ptype, true);
 612         }
 613 }
 614
 615 /*
 616  * ice_fdir_teardown - release the Flow Director resources
 617  * @pf: board private structure
 618  */
 619 static void
 620 ice_fdir_teardown(struct ice_pf *pf)
 621 {
 622         struct rte_eth_dev *eth_dev = pf->adapter->eth_dev;
 623         struct ice_hw *hw = ICE_PF_TO_HW(pf);
 624         struct ice_vsi *vsi;
 625         int err;
 626
 627         vsi = pf->fdir.fdir_vsi;
 628         if (!vsi)
 629                 return;
 630
 631         ice_vsi_disable_queues_intr(vsi);
 632
 633         err = ice_fdir_tx_queue_stop(eth_dev, pf->fdir.txq->queue_id);
 634         if (err)
 635                 PMD_DRV_LOG(ERR, "Failed to stop TX queue.");
 636
 637         err = ice_fdir_rx_queue_stop(eth_dev, pf->fdir.rxq->queue_id);
 638         if (err)
 639                 PMD_DRV_LOG(ERR, "Failed to stop RX queue.");
 640
 641         err = ice_fdir_counter_release(pf);
 642         if (err)
 643                 PMD_DRV_LOG(ERR, "Failed to release FDIR counter resource.");
 644
 645         ice_fdir_release_filter_list(pf);
 646
 647         ice_tx_queue_release(pf->fdir.txq);
 648         pf->fdir.txq = NULL;
 649         ice_rx_queue_release(pf->fdir.rxq);
 650         pf->fdir.rxq = NULL;
 651         ice_fdir_prof_rm_all(pf);
 652         ice_fdir_prof_free(hw);
 653         ice_release_vsi(vsi);
 654         pf->fdir.fdir_vsi = NULL;
 655
 656         if (pf->fdir.mz) {
 657                 err = rte_memzone_free(pf->fdir.mz);
 658                 pf->fdir.mz = NULL;
 659                 if (err)
 660                         PMD_DRV_LOG(ERR, "Failed to free FDIR memezone.");
 661         }
 662 }
 663
 664 static int
 665 ice_fdir_cur_prof_conflict(struct ice_pf *pf,
 666                            enum ice_fltr_ptype ptype,
 667                            struct ice_flow_seg_info *seg,
 668                            bool is_tunnel)
 669 {
 670         struct ice_hw *hw = ICE_PF_TO_HW(pf);
 671         struct ice_flow_seg_info *ori_seg;
 672         struct ice_fd_hw_prof *hw_prof;
 673
 674         hw_prof = hw->fdir_prof[ptype];
 675         ori_seg = hw_prof->fdir_seg[is_tunnel];
 676
 677         /* profile does not exist */
 678         if (!ori_seg)
 679                 return 0;
 680
 681         /* if no input set conflict, return -EEXIST */
 682         if ((!is_tunnel && !memcmp(ori_seg, seg, sizeof(*seg))) ||
 683             (is_tunnel && !memcmp(&ori_seg[1], &seg[1], sizeof(*seg)))) {
 684                 PMD_DRV_LOG(DEBUG, "Profile already exists for flow type %d.",
 685                             ptype);
 686                 return -EEXIST;
 687         }
 688
 689         /* a rule with input set conflict already exist, so give up */
 690         if (pf->fdir_fltr_cnt[ptype][is_tunnel]) {
 691                 PMD_DRV_LOG(DEBUG, "Failed to create profile for flow type %d due to conflict with existing rule.",
 692                             ptype);
 693                 return -EINVAL;
 694         }
 695
 696         /* it's safe to delete an empty profile */
 697         ice_fdir_prof_rm(pf, ptype, is_tunnel);
 698         return 0;
 699 }
 700
 701 static bool
 702 ice_fdir_prof_resolve_conflict(struct ice_pf *pf,
 703                                enum ice_fltr_ptype ptype,
 704                                bool is_tunnel)
 705 {
 706         struct ice_hw *hw = ICE_PF_TO_HW(pf);
 707         struct ice_fd_hw_prof *hw_prof;
 708         struct ice_flow_seg_info *seg;
 709
 710         hw_prof = hw->fdir_prof[ptype];
 711         seg = hw_prof->fdir_seg[is_tunnel];
 712
 713         /* profile does not exist */
 714         if (!seg)
 715                 return true;
 716
 717         /* profile exists and rule exists, fail to resolve the conflict */
 718         if (pf->fdir_fltr_cnt[ptype][is_tunnel] != 0)
 719                 return false;
 720
 721         /* it's safe to delete an empty profile */
 722         ice_fdir_prof_rm(pf, ptype, is_tunnel);
 723
 724         return true;
 725 }
 726
 727 static int
 728 ice_fdir_cross_prof_conflict(struct ice_pf *pf,
 729                              enum ice_fltr_ptype ptype,
 730                              bool is_tunnel)
 731 {
 732         enum ice_fltr_ptype cflct_ptype;
 733
 734         switch (ptype) {
 735         /* IPv4 */
 736         case ICE_FLTR_PTYPE_NONF_IPV4_UDP:
 737         case ICE_FLTR_PTYPE_NONF_IPV4_TCP:
 738         case ICE_FLTR_PTYPE_NONF_IPV4_SCTP:
 739                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV4_OTHER;
 740                 if (!ice_fdir_prof_resolve_conflict
 741                         (pf, cflct_ptype, is_tunnel))
 742                         goto err;
 743                 break;
 744         case ICE_FLTR_PTYPE_NONF_IPV4_OTHER:
 745                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV4_UDP;
 746                 if (!ice_fdir_prof_resolve_conflict
 747                         (pf, cflct_ptype, is_tunnel))
 748                         goto err;
 749                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV4_TCP;
 750                 if (!ice_fdir_prof_resolve_conflict
 751                         (pf, cflct_ptype, is_tunnel))
 752                         goto err;
 753                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV4_SCTP;
 754                 if (!ice_fdir_prof_resolve_conflict
 755                         (pf, cflct_ptype, is_tunnel))
 756                         goto err;
 757                 break;
 758         /* IPv4 GTPU */
 759         case ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_UDP:
 760         case ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_TCP:
 761         case ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_ICMP:
 762                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_OTHER;
 763                 if (!ice_fdir_prof_resolve_conflict
 764                         (pf, cflct_ptype, is_tunnel))
 765                         goto err;
 766                 break;
 767         case ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_OTHER:
 768                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_OTHER;
 769                 if (!ice_fdir_prof_resolve_conflict
 770                         (pf, cflct_ptype, is_tunnel))
 771                         goto err;
 772                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_OTHER;
 773                 if (!ice_fdir_prof_resolve_conflict
 774                         (pf, cflct_ptype, is_tunnel))
 775                         goto err;
 776                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_OTHER;
 777                 if (!ice_fdir_prof_resolve_conflict
 778                         (pf, cflct_ptype, is_tunnel))
 779                         goto err;
 780                 break;
 781         /* IPv6 */
 782         case ICE_FLTR_PTYPE_NONF_IPV6_UDP:
 783         case ICE_FLTR_PTYPE_NONF_IPV6_TCP:
 784         case ICE_FLTR_PTYPE_NONF_IPV6_SCTP:
 785                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV6_OTHER;
 786                 if (!ice_fdir_prof_resolve_conflict
 787                         (pf, cflct_ptype, is_tunnel))
 788                         goto err;
 789                 break;
 790         case ICE_FLTR_PTYPE_NONF_IPV6_OTHER:
 791                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV6_UDP;
 792                 if (!ice_fdir_prof_resolve_conflict
 793                         (pf, cflct_ptype, is_tunnel))
 794                         goto err;
 795                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV6_TCP;
 796                 if (!ice_fdir_prof_resolve_conflict
 797                         (pf, cflct_ptype, is_tunnel))
 798                         goto err;
 799                 cflct_ptype = ICE_FLTR_PTYPE_NONF_IPV6_SCTP;
 800                 if (!ice_fdir_prof_resolve_conflict
 801                         (pf, cflct_ptype, is_tunnel))
 802                         goto err;
 803                 break;
 804         default:
 805                 break;
 806         }
 807         return 0;
 808 err:
 809         PMD_DRV_LOG(DEBUG, "Failed to create profile for flow type %d due to conflict with existing rule of flow type %d.",
 810                     ptype, cflct_ptype);
 811         return -EINVAL;
 812 }
 813
 814 static int
 815 ice_fdir_hw_tbl_conf(struct ice_pf *pf, struct ice_vsi *vsi,
 816                      struct ice_vsi *ctrl_vsi,
 817                      struct ice_flow_seg_info *seg,
 818                      enum ice_fltr_ptype ptype,
 819                      bool is_tunnel)
 820 {
 821         struct ice_hw *hw = ICE_PF_TO_HW(pf);
 822         enum ice_flow_dir dir = ICE_FLOW_RX;
 823         struct ice_fd_hw_prof *hw_prof;
 824         struct ice_flow_prof *prof;
 825         uint64_t entry_1 = 0;
 826         uint64_t entry_2 = 0;
 827         uint16_t vsi_num;
 828         int ret;
 829         uint64_t prof_id;
 830
 831         /* check if have input set conflict on current profile. */
 832         ret = ice_fdir_cur_prof_conflict(pf, ptype, seg, is_tunnel);
 833         if (ret)
 834                 return ret;
 835
 836         /* check if the profile is conflict with other profile. */
 837         ret = ice_fdir_cross_prof_conflict(pf, ptype, is_tunnel);
 838         if (ret)
 839                 return ret;
 840
 841         prof_id = ptype + is_tunnel * ICE_FLTR_PTYPE_MAX;
 842         ret = ice_flow_add_prof(hw, ICE_BLK_FD, dir, prof_id, seg,
 843                                 (is_tunnel) ? 2 : 1, NULL, 0, &prof);
 844         if (ret)
 845                 return ret;
 846         ret = ice_flow_add_entry(hw, ICE_BLK_FD, prof_id, vsi->idx,
 847                                  vsi->idx, ICE_FLOW_PRIO_NORMAL,
 848                                  seg, NULL, 0, &entry_1);
 849         if (ret) {
 850                 PMD_DRV_LOG(ERR, "Failed to add main VSI flow entry for %d.",
 851                             ptype);
 852                 goto err_add_prof;
 853         }
 854         ret = ice_flow_add_entry(hw, ICE_BLK_FD, prof_id, vsi->idx,
 855                                  ctrl_vsi->idx, ICE_FLOW_PRIO_NORMAL,
 856                                  seg, NULL, 0, &entry_2);
 857         if (ret) {
 858                 PMD_DRV_LOG(ERR, "Failed to add control VSI flow entry for %d.",
 859                             ptype);
 860                 goto err_add_entry;
 861         }
 862
 863         hw_prof = hw->fdir_prof[ptype];
 864         pf->hw_prof_cnt[ptype][is_tunnel] = 0;
 865         hw_prof->cnt = 0;
 866         hw_prof->fdir_seg[is_tunnel] = seg;
 867         hw_prof->vsi_h[hw_prof->cnt] = vsi->idx;
 868         hw_prof->entry_h[hw_prof->cnt++][is_tunnel] = entry_1;
 869         pf->hw_prof_cnt[ptype][is_tunnel]++;
 870         hw_prof->vsi_h[hw_prof->cnt] = ctrl_vsi->idx;
 871         hw_prof->entry_h[hw_prof->cnt++][is_tunnel] = entry_2;
 872         pf->hw_prof_cnt[ptype][is_tunnel]++;
 873
 874         return ret;
 875
 876 err_add_entry:
 877         vsi_num = ice_get_hw_vsi_num(hw, vsi->idx);
 878         ice_rem_prof_id_flow(hw, ICE_BLK_FD, vsi_num, prof_id);
 879         ice_flow_rem_entry(hw, entry_1);
 880 err_add_prof:
 881         ice_flow_rem_prof(hw, ICE_BLK_FD, prof_id);
 882
 883         return ret;
 884 }
 885
 886 static void
 887 ice_fdir_input_set_parse(uint64_t inset, enum ice_flow_field *field)
 888 {
 889         uint32_t i, j;
 890
 891         struct ice_inset_map {
 892                 uint64_t inset;
 893                 enum ice_flow_field fld;
 894         };
 895         static const struct ice_inset_map ice_inset_map[] = {
 896                 {ICE_INSET_DMAC, ICE_FLOW_FIELD_IDX_ETH_DA},
 897                 {ICE_INSET_IPV4_SRC, ICE_FLOW_FIELD_IDX_IPV4_SA},
 898                 {ICE_INSET_IPV4_DST, ICE_FLOW_FIELD_IDX_IPV4_DA},
 899                 {ICE_INSET_IPV4_TOS, ICE_FLOW_FIELD_IDX_IPV4_DSCP},
 900                 {ICE_INSET_IPV4_TTL, ICE_FLOW_FIELD_IDX_IPV4_TTL},
 901                 {ICE_INSET_IPV4_PROTO, ICE_FLOW_FIELD_IDX_IPV4_PROT},
 902                 {ICE_INSET_IPV6_SRC, ICE_FLOW_FIELD_IDX_IPV6_SA},
 903                 {ICE_INSET_IPV6_DST, ICE_FLOW_FIELD_IDX_IPV6_DA},
 904                 {ICE_INSET_IPV6_TC, ICE_FLOW_FIELD_IDX_IPV6_DSCP},
 905                 {ICE_INSET_IPV6_NEXT_HDR, ICE_FLOW_FIELD_IDX_IPV6_PROT},
 906                 {ICE_INSET_IPV6_HOP_LIMIT, ICE_FLOW_FIELD_IDX_IPV6_TTL},
 907                 {ICE_INSET_TCP_SRC_PORT, ICE_FLOW_FIELD_IDX_TCP_SRC_PORT},
 908                 {ICE_INSET_TCP_DST_PORT, ICE_FLOW_FIELD_IDX_TCP_DST_PORT},
 909                 {ICE_INSET_UDP_SRC_PORT, ICE_FLOW_FIELD_IDX_UDP_SRC_PORT},
 910                 {ICE_INSET_UDP_DST_PORT, ICE_FLOW_FIELD_IDX_UDP_DST_PORT},
 911                 {ICE_INSET_SCTP_SRC_PORT, ICE_FLOW_FIELD_IDX_SCTP_SRC_PORT},
 912                 {ICE_INSET_SCTP_DST_PORT, ICE_FLOW_FIELD_IDX_SCTP_DST_PORT},
 913                 {ICE_INSET_TUN_IPV4_SRC, ICE_FLOW_FIELD_IDX_IPV4_SA},
 914                 {ICE_INSET_TUN_IPV4_DST, ICE_FLOW_FIELD_IDX_IPV4_DA},
 915                 {ICE_INSET_TUN_TCP_SRC_PORT, ICE_FLOW_FIELD_IDX_TCP_SRC_PORT},
 916                 {ICE_INSET_TUN_TCP_DST_PORT, ICE_FLOW_FIELD_IDX_TCP_DST_PORT},
 917                 {ICE_INSET_TUN_UDP_SRC_PORT, ICE_FLOW_FIELD_IDX_UDP_SRC_PORT},
 918                 {ICE_INSET_TUN_UDP_DST_PORT, ICE_FLOW_FIELD_IDX_UDP_DST_PORT},
 919                 {ICE_INSET_TUN_SCTP_SRC_PORT, ICE_FLOW_FIELD_IDX_SCTP_SRC_PORT},
 920                 {ICE_INSET_TUN_SCTP_DST_PORT, ICE_FLOW_FIELD_IDX_SCTP_DST_PORT},
 921                 {ICE_INSET_GTPU_TEID, ICE_FLOW_FIELD_IDX_GTPU_IP_TEID},
 922                 {ICE_INSET_GTPU_QFI, ICE_FLOW_FIELD_IDX_GTPU_EH_QFI},
 923         };
 924
 925         for (i = 0, j = 0; i < RTE_DIM(ice_inset_map); i++) {
 926                 if ((inset & ice_inset_map[i].inset) ==
 927                     ice_inset_map[i].inset)
 928                         field[j++] = ice_inset_map[i].fld;
 929         }
 930 }
 931
 932 static int
 933 ice_fdir_input_set_conf(struct ice_pf *pf, enum ice_fltr_ptype flow,
 934                         uint64_t input_set, enum ice_fdir_tunnel_type ttype)
 935 {
 936         struct ice_flow_seg_info *seg;
 937         struct ice_flow_seg_info *seg_tun = NULL;
 938         enum ice_flow_field field[ICE_FLOW_FIELD_IDX_MAX];
 939         bool is_tunnel;
 940         int i, ret;
 941
 942         if (!input_set)
 943                 return -EINVAL;
 944
 945         seg = (struct ice_flow_seg_info *)
 946                 ice_malloc(hw, sizeof(*seg));
 947         if (!seg) {
 948                 PMD_DRV_LOG(ERR, "No memory can be allocated");
 949                 return -ENOMEM;
 950         }
 951
 952         for (i = 0; i < ICE_FLOW_FIELD_IDX_MAX; i++)
 953                 field[i] = ICE_FLOW_FIELD_IDX_MAX;
 954         ice_fdir_input_set_parse(input_set, field);
 955
 956         switch (flow) {
 957         case ICE_FLTR_PTYPE_NONF_IPV4_UDP:
 958                 ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_UDP |
 959                                   ICE_FLOW_SEG_HDR_IPV4);
 960                 break;
 961         case ICE_FLTR_PTYPE_NONF_IPV4_TCP:
 962                 ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_TCP |
 963                                   ICE_FLOW_SEG_HDR_IPV4);
 964                 break;
 965         case ICE_FLTR_PTYPE_NONF_IPV4_SCTP:
 966                 ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_SCTP |
 967                                   ICE_FLOW_SEG_HDR_IPV4);
 968                 break;
 969         case ICE_FLTR_PTYPE_NONF_IPV4_OTHER:
 970                 ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_IPV4);
 971                 break;
 972         case ICE_FLTR_PTYPE_NONF_IPV6_UDP:
 973                 ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_UDP |
 974                                   ICE_FLOW_SEG_HDR_IPV6);
 975                 break;
 976         case ICE_FLTR_PTYPE_NONF_IPV6_TCP:
 977                 ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_TCP |
 978                                   ICE_FLOW_SEG_HDR_IPV6);
 979                 break;
 980         case ICE_FLTR_PTYPE_NONF_IPV6_SCTP:
 981                 ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_SCTP |
 982                                   ICE_FLOW_SEG_HDR_IPV6);
 983                 break;
 984         case ICE_FLTR_PTYPE_NONF_IPV6_OTHER:
 985                 ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_IPV6);
 986                 break;
 987         case ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_UDP:
 988         case ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_TCP:
 989         case ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_ICMP:
 990         case ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_OTHER:
 991                 if (ttype == ICE_FDIR_TUNNEL_TYPE_GTPU)
 992                         ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_GTPU_IP |
 993                                           ICE_FLOW_SEG_HDR_IPV4);
 994                 else if (ttype == ICE_FDIR_TUNNEL_TYPE_GTPU_EH)
 995                         ICE_FLOW_SET_HDRS(seg, ICE_FLOW_SEG_HDR_GTPU_EH |
 996                                           ICE_FLOW_SEG_HDR_GTPU_IP |
 997                                           ICE_FLOW_SEG_HDR_IPV4);
 998                 else
 999                         PMD_DRV_LOG(ERR, "not supported tunnel type.");
1000                 break;
1001         default:
1002                 PMD_DRV_LOG(ERR, "not supported filter type.");
1003                 break;
1004         }
1005
1006         for (i = 0; field[i] != ICE_FLOW_FIELD_IDX_MAX; i++) {
1007                 ice_flow_set_fld(seg, field[i],
1008                                  ICE_FLOW_FLD_OFF_INVAL,
1009                                  ICE_FLOW_FLD_OFF_INVAL,
1010                                  ICE_FLOW_FLD_OFF_INVAL, false);
1011         }
1012
1013         is_tunnel = ice_fdir_is_tunnel_profile(ttype);
1014         if (!is_tunnel) {
1015                 ret = ice_fdir_hw_tbl_conf(pf, pf->main_vsi, pf->fdir.fdir_vsi,
1016                                            seg, flow, false);
1017         } else {
1018                 seg_tun = (struct ice_flow_seg_info *)
1019                         ice_malloc(hw, sizeof(*seg) * ICE_FD_HW_SEG_MAX);
1020                 if (!seg_tun) {
1021                         PMD_DRV_LOG(ERR, "No memory can be allocated");
1022                         rte_free(seg);
1023                         return -ENOMEM;
1024                 }
1025                 rte_memcpy(&seg_tun[1], seg, sizeof(*seg));
1026                 ret = ice_fdir_hw_tbl_conf(pf, pf->main_vsi, pf->fdir.fdir_vsi,
1027                                            seg_tun, flow, true);
1028         }
1029
1030         if (!ret) {
1031                 return ret;
1032         } else if (ret < 0) {
1033                 rte_free(seg);
1034                 if (is_tunnel)
1035                         rte_free(seg_tun);
1036                 return (ret == -EEXIST) ? 0 : ret;
1037         } else {
1038                 return ret;
1039         }
1040 }
1041
1042 static void
1043 ice_fdir_cnt_update(struct ice_pf *pf, enum ice_fltr_ptype ptype,
1044                     bool is_tunnel, bool add)
1045 {
1046         struct ice_hw *hw = ICE_PF_TO_HW(pf);
1047         int cnt;
1048
1049         cnt = (add) ? 1 : -1;
1050         hw->fdir_active_fltr += cnt;
1051         if (ptype == ICE_FLTR_PTYPE_NONF_NONE || ptype >= ICE_FLTR_PTYPE_MAX)
1052                 PMD_DRV_LOG(ERR, "Unknown filter type %d", ptype);
1053         else
1054                 pf->fdir_fltr_cnt[ptype][is_tunnel] += cnt;
1055 }
1056
1057 static int
1058 ice_fdir_init(struct ice_adapter *ad)
1059 {
1060         struct ice_pf *pf = &ad->pf;
1061         struct ice_flow_parser *parser;
1062         int ret;
1063
1064         ret = ice_fdir_setup(pf);
1065         if (ret)
1066                 return ret;
1067
1068         if (ad->active_pkg_type == ICE_PKG_TYPE_COMMS)
1069                 parser = &ice_fdir_parser_comms;
1070         else if (ad->active_pkg_type == ICE_PKG_TYPE_OS_DEFAULT)
1071                 parser = &ice_fdir_parser_os;
1072         else
1073                 return -EINVAL;
1074
1075         return ice_register_parser(parser, ad);
1076 }
1077
1078 static void
1079 ice_fdir_uninit(struct ice_adapter *ad)
1080 {
1081         struct ice_pf *pf = &ad->pf;
1082         struct ice_flow_parser *parser;
1083
1084         if (ad->active_pkg_type == ICE_PKG_TYPE_COMMS)
1085                 parser = &ice_fdir_parser_comms;
1086         else
1087                 parser = &ice_fdir_parser_os;
1088
1089         ice_unregister_parser(parser, ad);
1090
1091         ice_fdir_teardown(pf);
1092 }
1093
1094 static int
1095 ice_fdir_is_tunnel_profile(enum ice_fdir_tunnel_type tunnel_type)
1096 {
1097         if (tunnel_type == ICE_FDIR_TUNNEL_TYPE_VXLAN)
1098                 return 1;
1099         else
1100                 return 0;
1101 }
1102
1103 static int
1104 ice_fdir_add_del_filter(struct ice_pf *pf,
1105                         struct ice_fdir_filter_conf *filter,
1106                         bool add)
1107 {
1108         struct ice_fltr_desc desc;
1109         struct ice_hw *hw = ICE_PF_TO_HW(pf);
1110         unsigned char *pkt = (unsigned char *)pf->fdir.prg_pkt;
1111         bool is_tun;
1112         int ret;
1113
1114         filter->input.dest_vsi = pf->main_vsi->idx;
1115
1116         memset(&desc, 0, sizeof(desc));
1117         ice_fdir_get_prgm_desc(hw, &filter->input, &desc, add);
1118
1119         is_tun = ice_fdir_is_tunnel_profile(filter->tunnel_type);
1120
1121         memset(pkt, 0, ICE_FDIR_PKT_LEN);
1122         ret = ice_fdir_get_gen_prgm_pkt(hw, &filter->input, pkt, false, is_tun);
1123         if (ret) {
1124                 PMD_DRV_LOG(ERR, "Generate dummy packet failed");
1125                 return -EINVAL;
1126         }
1127
1128         return ice_fdir_programming(pf, &desc);
1129 }
1130
1131 static void
1132 ice_fdir_extract_fltr_key(struct ice_fdir_fltr_pattern *key,
1133                           struct ice_fdir_filter_conf *filter)
1134 {
1135         struct ice_fdir_fltr *input = &filter->input;
1136         memset(key, 0, sizeof(*key));
1137
1138         key->flow_type = input->flow_type;
1139         rte_memcpy(&key->ip, &input->ip, sizeof(key->ip));
1140         rte_memcpy(&key->mask, &input->mask, sizeof(key->mask));
1141         rte_memcpy(&key->ext_data, &input->ext_data, sizeof(key->ext_data));
1142         rte_memcpy(&key->ext_mask, &input->ext_mask, sizeof(key->ext_mask));
1143
1144         rte_memcpy(&key->gtpu_data, &input->gtpu_data, sizeof(key->gtpu_data));
1145         rte_memcpy(&key->gtpu_mask, &input->gtpu_mask, sizeof(key->gtpu_mask));
1146
1147         key->tunnel_type = filter->tunnel_type;
1148 }
1149
1150 /* Check if there exists the flow director filter */
1151 static struct ice_fdir_filter_conf *
1152 ice_fdir_entry_lookup(struct ice_fdir_info *fdir_info,
1153                         const struct ice_fdir_fltr_pattern *key)
1154 {
1155         int ret;
1156
1157         ret = rte_hash_lookup(fdir_info->hash_table, key);
1158         if (ret < 0)
1159                 return NULL;
1160
1161         return fdir_info->hash_map[ret];
1162 }
1163
1164 /* Add a flow director entry into the SW list */
1165 static int
1166 ice_fdir_entry_insert(struct ice_pf *pf,
1167                       struct ice_fdir_filter_conf *entry,
1168                       struct ice_fdir_fltr_pattern *key)
1169 {
1170         struct ice_fdir_info *fdir_info = &pf->fdir;
1171         int ret;
1172
1173         ret = rte_hash_add_key(fdir_info->hash_table, key);
1174         if (ret < 0) {
1175                 PMD_DRV_LOG(ERR,
1176                             "Failed to insert fdir entry to hash table %d!",
1177                             ret);
1178                 return ret;
1179         }
1180         fdir_info->hash_map[ret] = entry;
1181
1182         return 0;
1183 }
1184
1185 /* Delete a flow director entry from the SW list */
1186 static int
1187 ice_fdir_entry_del(struct ice_pf *pf, struct ice_fdir_fltr_pattern *key)
1188 {
1189         struct ice_fdir_info *fdir_info = &pf->fdir;
1190         int ret;
1191
1192         ret = rte_hash_del_key(fdir_info->hash_table, key);
1193         if (ret < 0) {
1194                 PMD_DRV_LOG(ERR,
1195                             "Failed to delete fdir filter to hash table %d!",
1196                             ret);
1197                 return ret;
1198         }
1199         fdir_info->hash_map[ret] = NULL;
1200
1201         return 0;
1202 }
1203
1204 static int
1205 ice_fdir_create_filter(struct ice_adapter *ad,
1206                        struct rte_flow *flow,
1207                        void *meta,
1208                        struct rte_flow_error *error)
1209 {
1210         struct ice_pf *pf = &ad->pf;
1211         struct ice_fdir_filter_conf *filter = meta;
1212         struct ice_fdir_info *fdir_info = &pf->fdir;
1213         struct ice_fdir_filter_conf *entry, *node;
1214         struct ice_fdir_fltr_pattern key;
1215         bool is_tun;
1216         int ret;
1217
1218         ice_fdir_extract_fltr_key(&key, filter);
1219         node = ice_fdir_entry_lookup(fdir_info, &key);
1220         if (node) {
1221                 rte_flow_error_set(error, EEXIST,
1222                                    RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
1223                                    "Rule already exists!");
1224                 return -rte_errno;
1225         }
1226
1227         entry = rte_zmalloc("fdir_entry", sizeof(*entry), 0);
1228         if (!entry) {
1229                 rte_flow_error_set(error, ENOMEM,
1230                                    RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
1231                                    "Failed to allocate memory");
1232                 return -rte_errno;
1233         }
1234
1235         is_tun = ice_fdir_is_tunnel_profile(filter->tunnel_type);
1236
1237         ret = ice_fdir_input_set_conf(pf, filter->input.flow_type,
1238                         filter->input_set, filter->tunnel_type);
1239         if (ret) {
1240                 rte_flow_error_set(error, -ret,
1241                                    RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
1242                                    "Profile configure failed.");
1243                 goto free_entry;
1244         }
1245
1246         /* alloc counter for FDIR */
1247         if (filter->input.cnt_ena) {
1248                 struct rte_flow_action_count *act_count = &filter->act_count;
1249
1250                 filter->counter = ice_fdir_counter_alloc(pf,
1251                                                          act_count->shared,
1252                                                          act_count->id);
1253                 if (!filter->counter) {
1254                         rte_flow_error_set(error, EINVAL,
1255                                         RTE_FLOW_ERROR_TYPE_ACTION, NULL,
1256                                         "Failed to alloc FDIR counter.");
1257                         goto free_entry;
1258                 }
1259                 filter->input.cnt_index = filter->counter->hw_index;
1260         }
1261
1262         ret = ice_fdir_add_del_filter(pf, filter, true);
1263         if (ret) {
1264                 rte_flow_error_set(error, -ret,
1265                                    RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
1266                                    "Add filter rule failed.");
1267                 goto free_counter;
1268         }
1269
1270         rte_memcpy(entry, filter, sizeof(*entry));
1271         ret = ice_fdir_entry_insert(pf, entry, &key);
1272         if (ret) {
1273                 rte_flow_error_set(error, -ret,
1274                                    RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
1275                                    "Insert entry to table failed.");
1276                 goto free_entry;
1277         }
1278
1279         flow->rule = entry;
1280         ice_fdir_cnt_update(pf, filter->input.flow_type, is_tun, true);
1281
1282         return 0;
1283
1284 free_counter:
1285         if (filter->counter) {
1286                 ice_fdir_counter_free(pf, filter->counter);
1287                 filter->counter = NULL;
1288         }
1289
1290 free_entry:
1291         rte_free(entry);
1292         return -rte_errno;
1293 }
1294
1295 static int
1296 ice_fdir_destroy_filter(struct ice_adapter *ad,
1297                         struct rte_flow *flow,
1298                         struct rte_flow_error *error)
1299 {
1300         struct ice_pf *pf = &ad->pf;
1301         struct ice_fdir_info *fdir_info = &pf->fdir;
1302         struct ice_fdir_filter_conf *filter, *entry;
1303         struct ice_fdir_fltr_pattern key;
1304         bool is_tun;
1305         int ret;
1306
1307         filter = (struct ice_fdir_filter_conf *)flow->rule;
1308
1309         is_tun = ice_fdir_is_tunnel_profile(filter->tunnel_type);
1310
1311         if (filter->counter) {
1312                 ice_fdir_counter_free(pf, filter->counter);
1313                 filter->counter = NULL;
1314         }
1315
1316         ice_fdir_extract_fltr_key(&key, filter);
1317         entry = ice_fdir_entry_lookup(fdir_info, &key);
1318         if (!entry) {
1319                 rte_flow_error_set(error, ENOENT,
1320                                    RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
1321                                    "Can't find entry.");
1322                 return -rte_errno;
1323         }
1324
1325         ret = ice_fdir_add_del_filter(pf, filter, false);
1326         if (ret) {
1327                 rte_flow_error_set(error, -ret,
1328                                    RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
1329                                    "Del filter rule failed.");
1330                 return -rte_errno;
1331         }
1332
1333         ret = ice_fdir_entry_del(pf, &key);
1334         if (ret) {
1335                 rte_flow_error_set(error, -ret,
1336                                    RTE_FLOW_ERROR_TYPE_HANDLE, NULL,
1337                                    "Remove entry from table failed.");
1338                 return -rte_errno;
1339         }
1340
1341         ice_fdir_cnt_update(pf, filter->input.flow_type, is_tun, false);
1342         flow->rule = NULL;
1343
1344         rte_free(filter);
1345
1346         return 0;
1347 }
1348
1349 static int
1350 ice_fdir_query_count(struct ice_adapter *ad,
1351                       struct rte_flow *flow,
1352                       struct rte_flow_query_count *flow_stats,
1353                       struct rte_flow_error *error)
1354 {
1355         struct ice_pf *pf = &ad->pf;
1356         struct ice_hw *hw = ICE_PF_TO_HW(pf);
1357         struct ice_fdir_filter_conf *filter = flow->rule;
1358         struct ice_fdir_counter *counter = filter->counter;
1359         uint64_t hits_lo, hits_hi;
1360
1361         if (!counter) {
1362                 rte_flow_error_set(error, EINVAL,
1363                                   RTE_FLOW_ERROR_TYPE_ACTION,
1364                                   NULL,
1365                                   "FDIR counters not available");
1366                 return -rte_errno;
1367         }
1368
1369         /*
1370          * Reading the low 32-bits latches the high 32-bits into a shadow
1371          * register. Reading the high 32-bit returns the value in the
1372          * shadow register.
1373          */
1374         hits_lo = ICE_READ_REG(hw, GLSTAT_FD_CNT0L(counter->hw_index));
1375         hits_hi = ICE_READ_REG(hw, GLSTAT_FD_CNT0H(counter->hw_index));
1376
1377         flow_stats->hits_set = 1;
1378         flow_stats->hits = hits_lo | (hits_hi << 32);
1379         flow_stats->bytes_set = 0;
1380         flow_stats->bytes = 0;
1381
1382         if (flow_stats->reset) {
1383                 /* reset statistic counter value */
1384                 ICE_WRITE_REG(hw, GLSTAT_FD_CNT0H(counter->hw_index), 0);
1385                 ICE_WRITE_REG(hw, GLSTAT_FD_CNT0L(counter->hw_index), 0);
1386         }
1387
1388         return 0;
1389 }
1390
1391 static struct ice_flow_engine ice_fdir_engine = {
1392         .init = ice_fdir_init,
1393         .uninit = ice_fdir_uninit,
1394         .create = ice_fdir_create_filter,
1395         .destroy = ice_fdir_destroy_filter,
1396         .query_count = ice_fdir_query_count,
1397         .type = ICE_FLOW_ENGINE_FDIR,
1398 };
1399
1400 static int
1401 ice_fdir_parse_action_qregion(struct ice_pf *pf,
1402                               struct rte_flow_error *error,
1403                               const struct rte_flow_action *act,
1404                               struct ice_fdir_filter_conf *filter)
1405 {
1406         const struct rte_flow_action_rss *rss = act->conf;
1407         uint32_t i;
1408
1409         if (act->type != RTE_FLOW_ACTION_TYPE_RSS) {
1410                 rte_flow_error_set(error, EINVAL,
1411                                    RTE_FLOW_ERROR_TYPE_ACTION, act,
1412                                    "Invalid action.");
1413                 return -rte_errno;
1414         }
1415
1416         if (rss->queue_num <= 1) {
1417                 rte_flow_error_set(error, EINVAL,
1418                                    RTE_FLOW_ERROR_TYPE_ACTION, act,
1419                                    "Queue region size can't be 0 or 1.");
1420                 return -rte_errno;
1421         }
1422
1423         /* check if queue index for queue region is continuous */
1424         for (i = 0; i < rss->queue_num - 1; i++) {
1425                 if (rss->queue[i + 1] != rss->queue[i] + 1) {
1426                         rte_flow_error_set(error, EINVAL,
1427                                            RTE_FLOW_ERROR_TYPE_ACTION, act,
1428                                            "Discontinuous queue region");
1429                         return -rte_errno;
1430                 }
1431         }
1432
1433         if (rss->queue[rss->queue_num - 1] >= pf->dev_data->nb_rx_queues) {
1434                 rte_flow_error_set(error, EINVAL,
1435                                    RTE_FLOW_ERROR_TYPE_ACTION, act,
1436                                    "Invalid queue region indexes.");
1437                 return -rte_errno;
1438         }
1439
1440         if (!(rte_is_power_of_2(rss->queue_num) &&
1441              (rss->queue_num <= ICE_FDIR_MAX_QREGION_SIZE))) {
1442                 rte_flow_error_set(error, EINVAL,
1443                                    RTE_FLOW_ERROR_TYPE_ACTION, act,
1444                                    "The region size should be any of the following values:"
1445                                    "1, 2, 4, 8, 16, 32, 64, 128 as long as the total number "
1446                                    "of queues do not exceed the VSI allocation.");
1447                 return -rte_errno;
1448         }
1449
1450         filter->input.q_index = rss->queue[0];
1451         filter->input.q_region = rte_fls_u32(rss->queue_num) - 1;
1452         filter->input.dest_ctl = ICE_FLTR_PRGM_DESC_DEST_DIRECT_PKT_QGROUP;
1453
1454         return 0;
1455 }
1456
1457 static int
1458 ice_fdir_parse_action(struct ice_adapter *ad,
1459                       const struct rte_flow_action actions[],
1460                       struct rte_flow_error *error,
1461                       struct ice_fdir_filter_conf *filter)
1462 {
1463         struct ice_pf *pf = &ad->pf;
1464         const struct rte_flow_action_queue *act_q;
1465         const struct rte_flow_action_mark *mark_spec = NULL;
1466         const struct rte_flow_action_count *act_count;
1467         uint32_t dest_num = 0;
1468         uint32_t mark_num = 0;
1469         uint32_t counter_num = 0;
1470         int ret;
1471
1472         for (; actions->type != RTE_FLOW_ACTION_TYPE_END; actions++) {
1473                 switch (actions->type) {
1474                 case RTE_FLOW_ACTION_TYPE_VOID:
1475                         break;
1476                 case RTE_FLOW_ACTION_TYPE_QUEUE:
1477                         dest_num++;
1478
1479                         act_q = actions->conf;
1480                         filter->input.q_index = act_q->index;
1481                         if (filter->input.q_index >=
1482                                         pf->dev_data->nb_rx_queues) {
1483                                 rte_flow_error_set(error, EINVAL,
1484                                                    RTE_FLOW_ERROR_TYPE_ACTION,
1485                                                    actions,
1486                                                    "Invalid queue for FDIR.");
1487                                 return -rte_errno;
1488                         }
1489                         filter->input.dest_ctl =
1490                                 ICE_FLTR_PRGM_DESC_DEST_DIRECT_PKT_QINDEX;
1491                         break;
1492                 case RTE_FLOW_ACTION_TYPE_DROP:
1493                         dest_num++;
1494
1495                         filter->input.dest_ctl =
1496                                 ICE_FLTR_PRGM_DESC_DEST_DROP_PKT;
1497                         break;
1498                 case RTE_FLOW_ACTION_TYPE_PASSTHRU:
1499                         dest_num++;
1500
1501                         filter->input.dest_ctl =
1502                                 ICE_FLTR_PRGM_DESC_DEST_DIRECT_PKT_OTHER;
1503                         break;
1504                 case RTE_FLOW_ACTION_TYPE_RSS:
1505                         dest_num++;
1506
1507                         ret = ice_fdir_parse_action_qregion(pf,
1508                                                 error, actions, filter);
1509                         if (ret)
1510                                 return ret;
1511                         break;
1512                 case RTE_FLOW_ACTION_TYPE_MARK:
1513                         mark_num++;
1514
1515                         mark_spec = actions->conf;
1516                         filter->input.fltr_id = mark_spec->id;
1517                         filter->input.fdid_prio = ICE_FXD_FLTR_QW1_FDID_PRI_ONE;
1518                         break;
1519                 case RTE_FLOW_ACTION_TYPE_COUNT:
1520                         counter_num++;
1521
1522                         act_count = actions->conf;
1523                         filter->input.cnt_ena = ICE_FXD_FLTR_QW0_STAT_ENA_PKTS;
1524                         rte_memcpy(&filter->act_count, act_count,
1525                                                 sizeof(filter->act_count));
1526
1527                         break;
1528                 default:
1529                         rte_flow_error_set(error, EINVAL,
1530                                    RTE_FLOW_ERROR_TYPE_ACTION, actions,
1531                                    "Invalid action.");
1532                         return -rte_errno;
1533                 }
1534         }
1535
1536         if (dest_num == 0 || dest_num >= 2) {
1537                 rte_flow_error_set(error, EINVAL,
1538                            RTE_FLOW_ERROR_TYPE_ACTION, actions,
1539                            "Unsupported action combination");
1540                 return -rte_errno;
1541         }
1542
1543         if (mark_num >= 2) {
1544                 rte_flow_error_set(error, EINVAL,
1545                            RTE_FLOW_ERROR_TYPE_ACTION, actions,
1546                            "Too many mark actions");
1547                 return -rte_errno;
1548         }
1549
1550         if (counter_num >= 2) {
1551                 rte_flow_error_set(error, EINVAL,
1552                            RTE_FLOW_ERROR_TYPE_ACTION, actions,
1553                            "Too many count actions");
1554                 return -rte_errno;
1555         }
1556
1557         return 0;
1558 }
1559
1560 static int
1561 ice_fdir_parse_pattern(__rte_unused struct ice_adapter *ad,
1562                        const struct rte_flow_item pattern[],
1563                        struct rte_flow_error *error,
1564                        struct ice_fdir_filter_conf *filter)
1565 {
1566         const struct rte_flow_item *item = pattern;
1567         enum rte_flow_item_type item_type;
1568         enum rte_flow_item_type l3 = RTE_FLOW_ITEM_TYPE_END;
1569         enum ice_fdir_tunnel_type tunnel_type = ICE_FDIR_TUNNEL_TYPE_NONE;
1570         const struct rte_flow_item_eth *eth_spec, *eth_mask;
1571         const struct rte_flow_item_ipv4 *ipv4_spec, *ipv4_mask;
1572         const struct rte_flow_item_ipv6 *ipv6_spec, *ipv6_mask;
1573         const struct rte_flow_item_tcp *tcp_spec, *tcp_mask;
1574         const struct rte_flow_item_udp *udp_spec, *udp_mask;
1575         const struct rte_flow_item_sctp *sctp_spec, *sctp_mask;
1576         const struct rte_flow_item_vxlan *vxlan_spec, *vxlan_mask;
1577         const struct rte_flow_item_gtp *gtp_spec, *gtp_mask;
1578         const struct rte_flow_item_gtp_psc *gtp_psc_spec, *gtp_psc_mask;
1579         uint64_t input_set = ICE_INSET_NONE;
1580         uint8_t flow_type = ICE_FLTR_PTYPE_NONF_NONE;
1581         uint8_t  ipv6_addr_mask[16] = {
1582                 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
1583                 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF
1584         };
1585         uint32_t vtc_flow_cpu;
1586
1587
1588         for (item = pattern; item->type != RTE_FLOW_ITEM_TYPE_END; item++) {
1589                 if (item->last) {
1590                         rte_flow_error_set(error, EINVAL,
1591                                         RTE_FLOW_ERROR_TYPE_ITEM,
1592                                         item,
1593                                         "Not support range");
1594                         return -rte_errno;
1595                 }
1596                 item_type = item->type;
1597
1598                 switch (item_type) {
1599                 case RTE_FLOW_ITEM_TYPE_ETH:
1600                         eth_spec = item->spec;
1601                         eth_mask = item->mask;
1602
1603                         if (eth_spec && eth_mask) {
1604                                 if (!rte_is_zero_ether_addr(&eth_spec->src) ||
1605                                     !rte_is_zero_ether_addr(&eth_mask->src)) {
1606                                         rte_flow_error_set(error, EINVAL,
1607                                                 RTE_FLOW_ERROR_TYPE_ITEM,
1608                                                 item,
1609                                                 "Src mac not support");
1610                                         return -rte_errno;
1611                                 }
1612
1613                                 if (!rte_is_broadcast_ether_addr(&eth_mask->dst)) {
1614                                         rte_flow_error_set(error, EINVAL,
1615                                                 RTE_FLOW_ERROR_TYPE_ITEM,
1616                                                 item,
1617                                                 "Invalid mac addr mask");
1618                                         return -rte_errno;
1619                                 }
1620
1621                                 input_set |= ICE_INSET_DMAC;
1622                                 rte_memcpy(&filter->input.ext_data.dst_mac,
1623                                            &eth_spec->dst,
1624                                            RTE_ETHER_ADDR_LEN);
1625                         }
1626                         break;
1627                 case RTE_FLOW_ITEM_TYPE_IPV4:
1628                         l3 = RTE_FLOW_ITEM_TYPE_IPV4;
1629                         ipv4_spec = item->spec;
1630                         ipv4_mask = item->mask;
1631
1632                         if (ipv4_spec && ipv4_mask) {
1633                                 /* Check IPv4 mask and update input set */
1634                                 if (ipv4_mask->hdr.version_ihl ||
1635                                     ipv4_mask->hdr.total_length ||
1636                                     ipv4_mask->hdr.packet_id ||
1637                                     ipv4_mask->hdr.fragment_offset ||
1638                                     ipv4_mask->hdr.hdr_checksum) {
1639                                         rte_flow_error_set(error, EINVAL,
1640                                                    RTE_FLOW_ERROR_TYPE_ITEM,
1641                                                    item,
1642                                                    "Invalid IPv4 mask.");
1643                                         return -rte_errno;
1644                                 }
1645                                 if (ipv4_mask->hdr.src_addr == UINT32_MAX)
1646                                         input_set |= tunnel_type ?
1647                                                      ICE_INSET_TUN_IPV4_SRC :
1648                                                      ICE_INSET_IPV4_SRC;
1649                                 if (ipv4_mask->hdr.dst_addr == UINT32_MAX)
1650                                         input_set |= tunnel_type ?
1651                                                      ICE_INSET_TUN_IPV4_DST :
1652                                                      ICE_INSET_IPV4_DST;
1653                                 if (ipv4_mask->hdr.type_of_service == UINT8_MAX)
1654                                         input_set |= ICE_INSET_IPV4_TOS;
1655                                 if (ipv4_mask->hdr.time_to_live == UINT8_MAX)
1656                                         input_set |= ICE_INSET_IPV4_TTL;
1657                                 if (ipv4_mask->hdr.next_proto_id == UINT8_MAX)
1658                                         input_set |= ICE_INSET_IPV4_PROTO;
1659
1660                                 filter->input.ip.v4.dst_ip =
1661                                         ipv4_spec->hdr.src_addr;
1662                                 filter->input.ip.v4.src_ip =
1663                                         ipv4_spec->hdr.dst_addr;
1664                                 filter->input.ip.v4.tos =
1665                                         ipv4_spec->hdr.type_of_service;
1666                                 filter->input.ip.v4.ttl =
1667                                         ipv4_spec->hdr.time_to_live;
1668                                 filter->input.ip.v4.proto =
1669                                         ipv4_spec->hdr.next_proto_id;
1670                         }
1671
1672                         flow_type = ICE_FLTR_PTYPE_NONF_IPV4_OTHER;
1673                         break;
1674                 case RTE_FLOW_ITEM_TYPE_IPV6:
1675                         l3 = RTE_FLOW_ITEM_TYPE_IPV6;
1676                         ipv6_spec = item->spec;
1677                         ipv6_mask = item->mask;
1678
1679                         if (ipv6_spec && ipv6_mask) {
1680                                 /* Check IPv6 mask and update input set */
1681                                 if (ipv6_mask->hdr.payload_len) {
1682                                         rte_flow_error_set(error, EINVAL,
1683                                                    RTE_FLOW_ERROR_TYPE_ITEM,
1684                                                    item,
1685                                                    "Invalid IPv6 mask");
1686                                         return -rte_errno;
1687                                 }
1688
1689                                 if (!memcmp(ipv6_mask->hdr.src_addr,
1690                                             ipv6_addr_mask,
1691                                             RTE_DIM(ipv6_mask->hdr.src_addr)))
1692                                         input_set |= ICE_INSET_IPV6_SRC;
1693                                 if (!memcmp(ipv6_mask->hdr.dst_addr,
1694                                             ipv6_addr_mask,
1695                                             RTE_DIM(ipv6_mask->hdr.dst_addr)))
1696                                         input_set |= ICE_INSET_IPV6_DST;
1697
1698                                 if ((ipv6_mask->hdr.vtc_flow &
1699                                      rte_cpu_to_be_32(ICE_IPV6_TC_MASK))
1700                                     == rte_cpu_to_be_32(ICE_IPV6_TC_MASK))
1701                                         input_set |= ICE_INSET_IPV6_TC;
1702                                 if (ipv6_mask->hdr.proto == UINT8_MAX)
1703                                         input_set |= ICE_INSET_IPV6_NEXT_HDR;
1704                                 if (ipv6_mask->hdr.hop_limits == UINT8_MAX)
1705                                         input_set |= ICE_INSET_IPV6_HOP_LIMIT;
1706
1707                                 rte_memcpy(filter->input.ip.v6.dst_ip,
1708                                            ipv6_spec->hdr.src_addr, 16);
1709                                 rte_memcpy(filter->input.ip.v6.src_ip,
1710                                            ipv6_spec->hdr.dst_addr, 16);
1711
1712                                 vtc_flow_cpu =
1713                                       rte_be_to_cpu_32(ipv6_spec->hdr.vtc_flow);
1714                                 filter->input.ip.v6.tc =
1715                                         (uint8_t)(vtc_flow_cpu >>
1716                                                   ICE_FDIR_IPV6_TC_OFFSET);
1717                                 filter->input.ip.v6.proto =
1718                                         ipv6_spec->hdr.proto;
1719                                 filter->input.ip.v6.hlim =
1720                                         ipv6_spec->hdr.hop_limits;
1721                         }
1722
1723                         flow_type = ICE_FLTR_PTYPE_NONF_IPV6_OTHER;
1724                         break;
1725                 case RTE_FLOW_ITEM_TYPE_TCP:
1726                         tcp_spec = item->spec;
1727                         tcp_mask = item->mask;
1728
1729                         if (l3 == RTE_FLOW_ITEM_TYPE_IPV4)
1730                                 flow_type = ICE_FLTR_PTYPE_NONF_IPV4_TCP;
1731                         else if (l3 == RTE_FLOW_ITEM_TYPE_IPV6)
1732                                 flow_type = ICE_FLTR_PTYPE_NONF_IPV6_TCP;
1733
1734                         if (tcp_spec && tcp_mask) {
1735                                 /* Check TCP mask and update input set */
1736                                 if (tcp_mask->hdr.sent_seq ||
1737                                     tcp_mask->hdr.recv_ack ||
1738                                     tcp_mask->hdr.data_off ||
1739                                     tcp_mask->hdr.tcp_flags ||
1740                                     tcp_mask->hdr.rx_win ||
1741                                     tcp_mask->hdr.cksum ||
1742                                     tcp_mask->hdr.tcp_urp) {
1743                                         rte_flow_error_set(error, EINVAL,
1744                                                    RTE_FLOW_ERROR_TYPE_ITEM,
1745                                                    item,
1746                                                    "Invalid TCP mask");
1747                                         return -rte_errno;
1748                                 }
1749
1750                                 if (tcp_mask->hdr.src_port == UINT16_MAX)
1751                                         input_set |= tunnel_type ?
1752                                                      ICE_INSET_TUN_TCP_SRC_PORT :
1753                                                      ICE_INSET_TCP_SRC_PORT;
1754                                 if (tcp_mask->hdr.dst_port == UINT16_MAX)
1755                                         input_set |= tunnel_type ?
1756                                                      ICE_INSET_TUN_TCP_DST_PORT :
1757                                                      ICE_INSET_TCP_DST_PORT;
1758
1759                                 /* Get filter info */
1760                                 if (l3 == RTE_FLOW_ITEM_TYPE_IPV4) {
1761                                         filter->input.ip.v4.dst_port =
1762                                                 tcp_spec->hdr.src_port;
1763                                         filter->input.ip.v4.src_port =
1764                                                 tcp_spec->hdr.dst_port;
1765                                 } else if (l3 == RTE_FLOW_ITEM_TYPE_IPV6) {
1766                                         filter->input.ip.v6.dst_port =
1767                                                 tcp_spec->hdr.src_port;
1768                                         filter->input.ip.v6.src_port =
1769                                                 tcp_spec->hdr.dst_port;
1770                                 }
1771                         }
1772                         break;
1773                 case RTE_FLOW_ITEM_TYPE_UDP:
1774                         udp_spec = item->spec;
1775                         udp_mask = item->mask;
1776
1777                         if (l3 == RTE_FLOW_ITEM_TYPE_IPV4)
1778                                 flow_type = ICE_FLTR_PTYPE_NONF_IPV4_UDP;
1779                         else if (l3 == RTE_FLOW_ITEM_TYPE_IPV6)
1780                                 flow_type = ICE_FLTR_PTYPE_NONF_IPV6_UDP;
1781
1782                         if (udp_spec && udp_mask) {
1783                                 /* Check UDP mask and update input set*/
1784                                 if (udp_mask->hdr.dgram_len ||
1785                                     udp_mask->hdr.dgram_cksum) {
1786                                         rte_flow_error_set(error, EINVAL,
1787                                                    RTE_FLOW_ERROR_TYPE_ITEM,
1788                                                    item,
1789                                                    "Invalid UDP mask");
1790                                         return -rte_errno;
1791                                 }
1792
1793                                 if (udp_mask->hdr.src_port == UINT16_MAX)
1794                                         input_set |= tunnel_type ?
1795                                                      ICE_INSET_TUN_UDP_SRC_PORT :
1796                                                      ICE_INSET_UDP_SRC_PORT;
1797                                 if (udp_mask->hdr.dst_port == UINT16_MAX)
1798                                         input_set |= tunnel_type ?
1799                                                      ICE_INSET_TUN_UDP_DST_PORT :
1800                                                      ICE_INSET_UDP_DST_PORT;
1801
1802                                 /* Get filter info */
1803                                 if (l3 == RTE_FLOW_ITEM_TYPE_IPV4) {
1804                                         filter->input.ip.v4.dst_port =
1805                                                 udp_spec->hdr.src_port;
1806                                         filter->input.ip.v4.src_port =
1807                                                 udp_spec->hdr.dst_port;
1808                                 } else if (l3 == RTE_FLOW_ITEM_TYPE_IPV6) {
1809                                         filter->input.ip.v6.src_port =
1810                                                 udp_spec->hdr.dst_port;
1811                                         filter->input.ip.v6.dst_port =
1812                                                 udp_spec->hdr.src_port;
1813                                 }
1814                         }
1815                         break;
1816                 case RTE_FLOW_ITEM_TYPE_SCTP:
1817                         sctp_spec = item->spec;
1818                         sctp_mask = item->mask;
1819
1820                         if (l3 == RTE_FLOW_ITEM_TYPE_IPV4)
1821                                 flow_type = ICE_FLTR_PTYPE_NONF_IPV4_SCTP;
1822                         else if (l3 == RTE_FLOW_ITEM_TYPE_IPV6)
1823                                 flow_type = ICE_FLTR_PTYPE_NONF_IPV6_SCTP;
1824
1825                         if (sctp_spec && sctp_mask) {
1826                                 /* Check SCTP mask and update input set */
1827                                 if (sctp_mask->hdr.cksum) {
1828                                         rte_flow_error_set(error, EINVAL,
1829                                                    RTE_FLOW_ERROR_TYPE_ITEM,
1830                                                    item,
1831                                                    "Invalid UDP mask");
1832                                         return -rte_errno;
1833                                 }
1834
1835                                 if (sctp_mask->hdr.src_port == UINT16_MAX)
1836                                         input_set |= tunnel_type ?
1837                                                      ICE_INSET_TUN_SCTP_SRC_PORT :
1838                                                      ICE_INSET_SCTP_SRC_PORT;
1839                                 if (sctp_mask->hdr.dst_port == UINT16_MAX)
1840                                         input_set |= tunnel_type ?
1841                                                      ICE_INSET_TUN_SCTP_DST_PORT :
1842                                                      ICE_INSET_SCTP_DST_PORT;
1843
1844                                 /* Get filter info */
1845                                 if (l3 == RTE_FLOW_ITEM_TYPE_IPV4) {
1846                                         filter->input.ip.v4.dst_port =
1847                                                 sctp_spec->hdr.src_port;
1848                                         filter->input.ip.v4.src_port =
1849                                                 sctp_spec->hdr.dst_port;
1850                                 } else if (l3 == RTE_FLOW_ITEM_TYPE_IPV6) {
1851                                         filter->input.ip.v6.dst_port =
1852                                                 sctp_spec->hdr.src_port;
1853                                         filter->input.ip.v6.src_port =
1854                                                 sctp_spec->hdr.dst_port;
1855                                 }
1856                         }
1857                         break;
1858                 case RTE_FLOW_ITEM_TYPE_VOID:
1859                         break;
1860                 case RTE_FLOW_ITEM_TYPE_VXLAN:
1861                         l3 = RTE_FLOW_ITEM_TYPE_END;
1862                         vxlan_spec = item->spec;
1863                         vxlan_mask = item->mask;
1864
1865                         if (vxlan_spec || vxlan_mask) {
1866                                 rte_flow_error_set(error, EINVAL,
1867                                                    RTE_FLOW_ERROR_TYPE_ITEM,
1868                                                    item,
1869                                                    "Invalid vxlan field");
1870                                 return -rte_errno;
1871                         }
1872
1873                         tunnel_type = ICE_FDIR_TUNNEL_TYPE_VXLAN;
1874                         break;
1875                 case RTE_FLOW_ITEM_TYPE_GTPU:
1876                         l3 = RTE_FLOW_ITEM_TYPE_END;
1877                         gtp_spec = item->spec;
1878                         gtp_mask = item->mask;
1879
1880                         if (gtp_spec && gtp_mask) {
1881                                 if (gtp_mask->v_pt_rsv_flags ||
1882                                     gtp_mask->msg_type ||
1883                                     gtp_mask->msg_len) {
1884                                         rte_flow_error_set(error, EINVAL,
1885                                                    RTE_FLOW_ERROR_TYPE_ITEM,
1886                                                    item,
1887                                                    "Invalid GTP mask");
1888                                         return -rte_errno;
1889                                 }
1890
1891                                 if (gtp_mask->teid == UINT32_MAX)
1892                                         input_set |= ICE_INSET_GTPU_TEID;
1893
1894                                 filter->input.gtpu_data.teid = gtp_spec->teid;
1895                         }
1896
1897                         tunnel_type = ICE_FDIR_TUNNEL_TYPE_GTPU;
1898                         break;
1899                 case RTE_FLOW_ITEM_TYPE_GTP_PSC:
1900                         gtp_psc_spec = item->spec;
1901                         gtp_psc_mask = item->mask;
1902
1903                         if (gtp_psc_spec && gtp_psc_mask) {
1904                                 if (gtp_psc_mask->qfi == UINT8_MAX)
1905                                         input_set |= ICE_INSET_GTPU_QFI;
1906
1907                                 filter->input.gtpu_data.qfi =
1908                                         gtp_psc_spec->qfi;
1909                         }
1910                         tunnel_type = ICE_FDIR_TUNNEL_TYPE_GTPU_EH;
1911                         break;
1912                 default:
1913                         rte_flow_error_set(error, EINVAL,
1914                                    RTE_FLOW_ERROR_TYPE_ITEM,
1915                                    item,
1916                                    "Invalid pattern item.");
1917                         return -rte_errno;
1918                 }
1919         }
1920
1921         if (tunnel_type == ICE_FDIR_TUNNEL_TYPE_GTPU ||
1922             tunnel_type == ICE_FDIR_TUNNEL_TYPE_GTPU_EH)
1923                 flow_type = ICE_FLTR_PTYPE_NONF_IPV4_GTPU_IPV4_OTHER;
1924
1925         filter->tunnel_type = tunnel_type;
1926         filter->input.flow_type = flow_type;
1927         filter->input_set = input_set;
1928
1929         return 0;
1930 }
1931
1932 static int
1933 ice_fdir_parse(struct ice_adapter *ad,
1934                struct ice_pattern_match_item *array,
1935                uint32_t array_len,
1936                const struct rte_flow_item pattern[],
1937                const struct rte_flow_action actions[],
1938                void **meta,
1939                struct rte_flow_error *error)
1940 {
1941         struct ice_pf *pf = &ad->pf;
1942         struct ice_fdir_filter_conf *filter = &pf->fdir.conf;
1943         struct ice_pattern_match_item *item = NULL;
1944         uint64_t input_set;
1945         int ret;
1946
1947         memset(filter, 0, sizeof(*filter));
1948         item = ice_search_pattern_match_item(pattern, array, array_len, error);
1949         if (!item)
1950                 return -rte_errno;
1951
1952         ret = ice_fdir_parse_pattern(ad, pattern, error, filter);
1953         if (ret)
1954                 goto error;
1955         input_set = filter->input_set;
1956         if (!input_set || input_set & ~item->input_set_mask) {
1957                 rte_flow_error_set(error, EINVAL,
1958                                    RTE_FLOW_ERROR_TYPE_ITEM_SPEC,
1959                                    pattern,
1960                                    "Invalid input set");
1961                 ret = -rte_errno;
1962                 goto error;
1963         }
1964
1965         ret = ice_fdir_parse_action(ad, actions, error, filter);
1966         if (ret)
1967                 goto error;
1968
1969         *meta = filter;
1970 error:
1971         rte_free(item);
1972         return ret;
1973 }
1974
1975 static struct ice_flow_parser ice_fdir_parser_os = {
1976         .engine = &ice_fdir_engine,
1977         .array = ice_fdir_pattern_os,
1978         .array_len = RTE_DIM(ice_fdir_pattern_os),
1979         .parse_pattern_action = ice_fdir_parse,
1980         .stage = ICE_FLOW_STAGE_DISTRIBUTOR,
1981 };
1982
1983 static struct ice_flow_parser ice_fdir_parser_comms = {
1984         .engine = &ice_fdir_engine,
1985         .array = ice_fdir_pattern_comms,
1986         .array_len = RTE_DIM(ice_fdir_pattern_comms),
1987         .parse_pattern_action = ice_fdir_parse,
1988         .stage = ICE_FLOW_STAGE_DISTRIBUTOR,
1989 };
1990
1991 RTE_INIT(ice_fdir_engine_register)
1992 {
1993         ice_register_flow_engine(&ice_fdir_engine);
1994 }