drivers/net/ice/ice_fdir_filter.c

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