drivers/net/ethernet/qlogic/qede/qede_filter.c

   1 /* QLogic qede NIC Driver
   2  * Copyright (c) 2015-2017  QLogic Corporation
   3  *
   4  * This software is available to you under a choice of one of two
   5  * licenses.  You may choose to be licensed under the terms of the GNU
   6  * General Public License (GPL) Version 2, available from the file
   7  * COPYING in the main directory of this source tree, or the
   8  * OpenIB.org BSD license below:
   9  *
  10  *     Redistribution and use in source and binary forms, with or
  11  *     without modification, are permitted provided that the following
  12  *     conditions are met:
  13  *
  14  *      - Redistributions of source code must retain the above
  15  *        copyright notice, this list of conditions and the following
  16  *        disclaimer.
  17  *
  18  *      - Redistributions in binary form must reproduce the above
  19  *        copyright notice, this list of conditions and the following
  20  *        disclaimer in the documentation and /or other materials
  21  *        provided with the distribution.
  22  *
  23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30  * SOFTWARE.
  31  */
  32 #include <linux/netdevice.h>
  33 #include <linux/etherdevice.h>
  34 #include <net/udp_tunnel.h>
  35 #include <linux/bitops.h>
  36 #include <linux/vmalloc.h>
  37
  38 #include <linux/qed/qed_if.h>
  39 #include "qede.h"
  40
  41 #define QEDE_FILTER_PRINT_MAX_LEN       (64)
  42 struct qede_arfs_tuple {
  43         union {
  44                 __be32 src_ipv4;
  45                 struct in6_addr src_ipv6;
  46         };
  47         union {
  48                 __be32 dst_ipv4;
  49                 struct in6_addr dst_ipv6;
  50         };
  51         __be16  src_port;
  52         __be16  dst_port;
  53         __be16  eth_proto;
  54         u8      ip_proto;
  55
  56         /* Describe filtering mode needed for this kind of filter */
  57         enum qed_filter_config_mode mode;
  58
  59         /* Used to compare new/old filters. Return true if IPs match */
  60         bool (*ip_comp)(struct qede_arfs_tuple *a, struct qede_arfs_tuple *b);
  61
  62         /* Given an address into ethhdr build a header from tuple info */
  63         void (*build_hdr)(struct qede_arfs_tuple *t, void *header);
  64
  65         /* Stringify the tuple for a print into the provided buffer */
  66         void (*stringify)(struct qede_arfs_tuple *t, void *buffer);
  67 };
  68
  69 struct qede_arfs_fltr_node {
  70 #define QEDE_FLTR_VALID  0
  71         unsigned long state;
  72
  73         /* pointer to aRFS packet buffer */
  74         void *data;
  75
  76         /* dma map address of aRFS packet buffer */
  77         dma_addr_t mapping;
  78
  79         /* length of aRFS packet buffer */
  80         int buf_len;
  81
  82         /* tuples to hold from aRFS packet buffer */
  83         struct qede_arfs_tuple tuple;
  84
  85         u32 flow_id;
  86         u64 sw_id;
  87         u16 rxq_id;
  88         u16 next_rxq_id;
  89         u8 vfid;
  90         bool filter_op;
  91         bool used;
  92         u8 fw_rc;
  93         bool b_is_drop;
  94         struct hlist_node node;
  95 };
  96
  97 struct qede_arfs {
  98 #define QEDE_ARFS_BUCKET_HEAD(edev, idx) (&(edev)->arfs->arfs_hl_head[idx])
  99 #define QEDE_ARFS_POLL_COUNT    100
 100 #define QEDE_RFS_FLW_BITSHIFT   (4)
 101 #define QEDE_RFS_FLW_MASK       ((1 << QEDE_RFS_FLW_BITSHIFT) - 1)
 102         struct hlist_head       arfs_hl_head[1 << QEDE_RFS_FLW_BITSHIFT];
 103
 104         /* lock for filter list access */
 105         spinlock_t              arfs_list_lock;
 106         unsigned long           *arfs_fltr_bmap;
 107         int                     filter_count;
 108
 109         /* Currently configured filtering mode */
 110         enum qed_filter_config_mode mode;
 111 };
 112
 113 static void qede_configure_arfs_fltr(struct qede_dev *edev,
 114                                      struct qede_arfs_fltr_node *n,
 115                                      u16 rxq_id, bool add_fltr)
 116 {
 117         const struct qed_eth_ops *op = edev->ops;
 118         struct qed_ntuple_filter_params params;
 119
 120         if (n->used)
 121                 return;
 122
 123         memset(&params, 0, sizeof(params));
 124
 125         params.addr = n->mapping;
 126         params.length = n->buf_len;
 127         params.qid = rxq_id;
 128         params.b_is_add = add_fltr;
 129         params.b_is_drop = n->b_is_drop;
 130
 131         if (n->vfid) {
 132                 params.b_is_vf = true;
 133                 params.vf_id = n->vfid - 1;
 134         }
 135
 136         if (n->tuple.stringify) {
 137                 char tuple_buffer[QEDE_FILTER_PRINT_MAX_LEN];
 138
 139                 n->tuple.stringify(&n->tuple, tuple_buffer);
 140                 DP_VERBOSE(edev, NETIF_MSG_RX_STATUS,
 141                            "%s sw_id[0x%llx]: %s [vf %u queue %d]\n",
 142                            add_fltr ? "Adding" : "Deleting",
 143                            n->sw_id, tuple_buffer, n->vfid, rxq_id);
 144         }
 145
 146         n->used = true;
 147         n->filter_op = add_fltr;
 148         op->ntuple_filter_config(edev->cdev, n, &params);
 149 }
 150
 151 static void
 152 qede_free_arfs_filter(struct qede_dev *edev,  struct qede_arfs_fltr_node *fltr)
 153 {
 154         kfree(fltr->data);
 155
 156         if (fltr->sw_id < QEDE_RFS_MAX_FLTR)
 157                 clear_bit(fltr->sw_id, edev->arfs->arfs_fltr_bmap);
 158
 159         kfree(fltr);
 160 }
 161
 162 static int
 163 qede_enqueue_fltr_and_config_searcher(struct qede_dev *edev,
 164                                       struct qede_arfs_fltr_node *fltr,
 165                                       u16 bucket_idx)
 166 {
 167         fltr->mapping = dma_map_single(&edev->pdev->dev, fltr->data,
 168                                        fltr->buf_len, DMA_TO_DEVICE);
 169         if (dma_mapping_error(&edev->pdev->dev, fltr->mapping)) {
 170                 DP_NOTICE(edev, "Failed to map DMA memory for rule\n");
 171                 qede_free_arfs_filter(edev, fltr);
 172                 return -ENOMEM;
 173         }
 174
 175         INIT_HLIST_NODE(&fltr->node);
 176         hlist_add_head(&fltr->node,
 177                        QEDE_ARFS_BUCKET_HEAD(edev, bucket_idx));
 178
 179         edev->arfs->filter_count++;
 180         if (edev->arfs->filter_count == 1 &&
 181             edev->arfs->mode == QED_FILTER_CONFIG_MODE_DISABLE) {
 182                 edev->ops->configure_arfs_searcher(edev->cdev,
 183                                                    fltr->tuple.mode);
 184                 edev->arfs->mode = fltr->tuple.mode;
 185         }
 186
 187         return 0;
 188 }
 189
 190 static void
 191 qede_dequeue_fltr_and_config_searcher(struct qede_dev *edev,
 192                                       struct qede_arfs_fltr_node *fltr)
 193 {
 194         hlist_del(&fltr->node);
 195         dma_unmap_single(&edev->pdev->dev, fltr->mapping,
 196                          fltr->buf_len, DMA_TO_DEVICE);
 197
 198         qede_free_arfs_filter(edev, fltr);
 199
 200         edev->arfs->filter_count--;
 201         if (!edev->arfs->filter_count &&
 202             edev->arfs->mode != QED_FILTER_CONFIG_MODE_DISABLE) {
 203                 enum qed_filter_config_mode mode;
 204
 205                 mode = QED_FILTER_CONFIG_MODE_DISABLE;
 206                 edev->ops->configure_arfs_searcher(edev->cdev, mode);
 207                 edev->arfs->mode = QED_FILTER_CONFIG_MODE_DISABLE;
 208         }
 209 }
 210
 211 void qede_arfs_filter_op(void *dev, void *filter, u8 fw_rc)
 212 {
 213         struct qede_arfs_fltr_node *fltr = filter;
 214         struct qede_dev *edev = dev;
 215
 216         fltr->fw_rc = fw_rc;
 217
 218         if (fw_rc) {
 219                 DP_NOTICE(edev,
 220                           "Failed arfs filter configuration fw_rc=%d, flow_id=%d, sw_id=0x%llx, src_port=%d, dst_port=%d, rxq=%d\n",
 221                           fw_rc, fltr->flow_id, fltr->sw_id,
 222                           ntohs(fltr->tuple.src_port),
 223                           ntohs(fltr->tuple.dst_port), fltr->rxq_id);
 224
 225                 spin_lock_bh(&edev->arfs->arfs_list_lock);
 226
 227                 fltr->used = false;
 228                 clear_bit(QEDE_FLTR_VALID, &fltr->state);
 229
 230                 spin_unlock_bh(&edev->arfs->arfs_list_lock);
 231                 return;
 232         }
 233
 234         spin_lock_bh(&edev->arfs->arfs_list_lock);
 235
 236         fltr->used = false;
 237
 238         if (fltr->filter_op) {
 239                 set_bit(QEDE_FLTR_VALID, &fltr->state);
 240                 if (fltr->rxq_id != fltr->next_rxq_id)
 241                         qede_configure_arfs_fltr(edev, fltr, fltr->rxq_id,
 242                                                  false);
 243         } else {
 244                 clear_bit(QEDE_FLTR_VALID, &fltr->state);
 245                 if (fltr->rxq_id != fltr->next_rxq_id) {
 246                         fltr->rxq_id = fltr->next_rxq_id;
 247                         qede_configure_arfs_fltr(edev, fltr,
 248                                                  fltr->rxq_id, true);
 249                 }
 250         }
 251
 252         spin_unlock_bh(&edev->arfs->arfs_list_lock);
 253 }
 254
 255 /* Should be called while qede_lock is held */
 256 void qede_process_arfs_filters(struct qede_dev *edev, bool free_fltr)
 257 {
 258         int i;
 259
 260         for (i = 0; i <= QEDE_RFS_FLW_MASK; i++) {
 261                 struct hlist_node *temp;
 262                 struct hlist_head *head;
 263                 struct qede_arfs_fltr_node *fltr;
 264
 265                 head = &edev->arfs->arfs_hl_head[i];
 266
 267                 hlist_for_each_entry_safe(fltr, temp, head, node) {
 268                         bool del = false;
 269
 270                         if (edev->state != QEDE_STATE_OPEN)
 271                                 del = true;
 272
 273                         spin_lock_bh(&edev->arfs->arfs_list_lock);
 274
 275                         if ((!test_bit(QEDE_FLTR_VALID, &fltr->state) &&
 276                              !fltr->used) || free_fltr) {
 277                                 qede_dequeue_fltr_and_config_searcher(edev,
 278                                                                       fltr);
 279                         } else {
 280                                 bool flow_exp = false;
 281 #ifdef CONFIG_RFS_ACCEL
 282                                 flow_exp = rps_may_expire_flow(edev->ndev,
 283                                                                fltr->rxq_id,
 284                                                                fltr->flow_id,
 285                                                                fltr->sw_id);
 286 #endif
 287                                 if ((flow_exp || del) && !free_fltr)
 288                                         qede_configure_arfs_fltr(edev, fltr,
 289                                                                  fltr->rxq_id,
 290                                                                  false);
 291                         }
 292
 293                         spin_unlock_bh(&edev->arfs->arfs_list_lock);
 294                 }
 295         }
 296
 297 #ifdef CONFIG_RFS_ACCEL
 298         spin_lock_bh(&edev->arfs->arfs_list_lock);
 299
 300         if (edev->arfs->filter_count) {
 301                 set_bit(QEDE_SP_ARFS_CONFIG, &edev->sp_flags);
 302                 schedule_delayed_work(&edev->sp_task,
 303                                       QEDE_SP_TASK_POLL_DELAY);
 304         }
 305
 306         spin_unlock_bh(&edev->arfs->arfs_list_lock);
 307 #endif
 308 }
 309
 310 /* This function waits until all aRFS filters get deleted and freed.
 311  * On timeout it frees all filters forcefully.
 312  */
 313 void qede_poll_for_freeing_arfs_filters(struct qede_dev *edev)
 314 {
 315         int count = QEDE_ARFS_POLL_COUNT;
 316
 317         while (count) {
 318                 qede_process_arfs_filters(edev, false);
 319
 320                 if (!edev->arfs->filter_count)
 321                         break;
 322
 323                 msleep(100);
 324                 count--;
 325         }
 326
 327         if (!count) {
 328                 DP_NOTICE(edev, "Timeout in polling for arfs filter free\n");
 329
 330                 /* Something is terribly wrong, free forcefully */
 331                 qede_process_arfs_filters(edev, true);
 332         }
 333 }
 334
 335 int qede_alloc_arfs(struct qede_dev *edev)
 336 {
 337         int i;
 338
 339         edev->arfs = vzalloc(sizeof(*edev->arfs));
 340         if (!edev->arfs)
 341                 return -ENOMEM;
 342
 343         spin_lock_init(&edev->arfs->arfs_list_lock);
 344
 345         for (i = 0; i <= QEDE_RFS_FLW_MASK; i++)
 346                 INIT_HLIST_HEAD(QEDE_ARFS_BUCKET_HEAD(edev, i));
 347
 348         edev->arfs->arfs_fltr_bmap =
 349                 vzalloc(array_size(sizeof(long),
 350                                    BITS_TO_LONGS(QEDE_RFS_MAX_FLTR)));
 351         if (!edev->arfs->arfs_fltr_bmap) {
 352                 vfree(edev->arfs);
 353                 edev->arfs = NULL;
 354                 return -ENOMEM;
 355         }
 356
 357 #ifdef CONFIG_RFS_ACCEL
 358         edev->ndev->rx_cpu_rmap = alloc_irq_cpu_rmap(QEDE_RSS_COUNT(edev));
 359         if (!edev->ndev->rx_cpu_rmap) {
 360                 vfree(edev->arfs->arfs_fltr_bmap);
 361                 edev->arfs->arfs_fltr_bmap = NULL;
 362                 vfree(edev->arfs);
 363                 edev->arfs = NULL;
 364                 return -ENOMEM;
 365         }
 366 #endif
 367         return 0;
 368 }
 369
 370 void qede_free_arfs(struct qede_dev *edev)
 371 {
 372         if (!edev->arfs)
 373                 return;
 374
 375 #ifdef CONFIG_RFS_ACCEL
 376         if (edev->ndev->rx_cpu_rmap)
 377                 free_irq_cpu_rmap(edev->ndev->rx_cpu_rmap);
 378
 379         edev->ndev->rx_cpu_rmap = NULL;
 380 #endif
 381         vfree(edev->arfs->arfs_fltr_bmap);
 382         edev->arfs->arfs_fltr_bmap = NULL;
 383         vfree(edev->arfs);
 384         edev->arfs = NULL;
 385 }
 386
 387 #ifdef CONFIG_RFS_ACCEL
 388 static bool qede_compare_ip_addr(struct qede_arfs_fltr_node *tpos,
 389                                  const struct sk_buff *skb)
 390 {
 391         if (skb->protocol == htons(ETH_P_IP)) {
 392                 if (tpos->tuple.src_ipv4 == ip_hdr(skb)->saddr &&
 393                     tpos->tuple.dst_ipv4 == ip_hdr(skb)->daddr)
 394                         return true;
 395                 else
 396                         return false;
 397         } else {
 398                 struct in6_addr *src = &tpos->tuple.src_ipv6;
 399                 u8 size = sizeof(struct in6_addr);
 400
 401                 if (!memcmp(src, &ipv6_hdr(skb)->saddr, size) &&
 402                     !memcmp(&tpos->tuple.dst_ipv6, &ipv6_hdr(skb)->daddr, size))
 403                         return true;
 404                 else
 405                         return false;
 406         }
 407 }
 408
 409 static struct qede_arfs_fltr_node *
 410 qede_arfs_htbl_key_search(struct hlist_head *h, const struct sk_buff *skb,
 411                           __be16 src_port, __be16 dst_port, u8 ip_proto)
 412 {
 413         struct qede_arfs_fltr_node *tpos;
 414
 415         hlist_for_each_entry(tpos, h, node)
 416                 if (tpos->tuple.ip_proto == ip_proto &&
 417                     tpos->tuple.eth_proto == skb->protocol &&
 418                     qede_compare_ip_addr(tpos, skb) &&
 419                     tpos->tuple.src_port == src_port &&
 420                     tpos->tuple.dst_port == dst_port)
 421                         return tpos;
 422
 423         return NULL;
 424 }
 425
 426 static struct qede_arfs_fltr_node *
 427 qede_alloc_filter(struct qede_dev *edev, int min_hlen)
 428 {
 429         struct qede_arfs_fltr_node *n;
 430         int bit_id;
 431
 432         bit_id = find_first_zero_bit(edev->arfs->arfs_fltr_bmap,
 433                                      QEDE_RFS_MAX_FLTR);
 434
 435         if (bit_id >= QEDE_RFS_MAX_FLTR)
 436                 return NULL;
 437
 438         n = kzalloc(sizeof(*n), GFP_ATOMIC);
 439         if (!n)
 440                 return NULL;
 441
 442         n->data = kzalloc(min_hlen, GFP_ATOMIC);
 443         if (!n->data) {
 444                 kfree(n);
 445                 return NULL;
 446         }
 447
 448         n->sw_id = (u16)bit_id;
 449         set_bit(bit_id, edev->arfs->arfs_fltr_bmap);
 450         return n;
 451 }
 452
 453 int qede_rx_flow_steer(struct net_device *dev, const struct sk_buff *skb,
 454                        u16 rxq_index, u32 flow_id)
 455 {
 456         struct qede_dev *edev = netdev_priv(dev);
 457         struct qede_arfs_fltr_node *n;
 458         int min_hlen, rc, tp_offset;
 459         struct ethhdr *eth;
 460         __be16 *ports;
 461         u16 tbl_idx;
 462         u8 ip_proto;
 463
 464         if (skb->encapsulation)
 465                 return -EPROTONOSUPPORT;
 466
 467         if (skb->protocol != htons(ETH_P_IP) &&
 468             skb->protocol != htons(ETH_P_IPV6))
 469                 return -EPROTONOSUPPORT;
 470
 471         if (skb->protocol == htons(ETH_P_IP)) {
 472                 ip_proto = ip_hdr(skb)->protocol;
 473                 tp_offset = sizeof(struct iphdr);
 474         } else {
 475                 ip_proto = ipv6_hdr(skb)->nexthdr;
 476                 tp_offset = sizeof(struct ipv6hdr);
 477         }
 478
 479         if (ip_proto != IPPROTO_TCP && ip_proto != IPPROTO_UDP)
 480                 return -EPROTONOSUPPORT;
 481
 482         ports = (__be16 *)(skb->data + tp_offset);
 483         tbl_idx = skb_get_hash_raw(skb) & QEDE_RFS_FLW_MASK;
 484
 485         spin_lock_bh(&edev->arfs->arfs_list_lock);
 486
 487         n = qede_arfs_htbl_key_search(QEDE_ARFS_BUCKET_HEAD(edev, tbl_idx),
 488                                       skb, ports[0], ports[1], ip_proto);
 489         if (n) {
 490                 /* Filter match */
 491                 n->next_rxq_id = rxq_index;
 492
 493                 if (test_bit(QEDE_FLTR_VALID, &n->state)) {
 494                         if (n->rxq_id != rxq_index)
 495                                 qede_configure_arfs_fltr(edev, n, n->rxq_id,
 496                                                          false);
 497                 } else {
 498                         if (!n->used) {
 499                                 n->rxq_id = rxq_index;
 500                                 qede_configure_arfs_fltr(edev, n, n->rxq_id,
 501                                                          true);
 502                         }
 503                 }
 504
 505                 rc = n->sw_id;
 506                 goto ret_unlock;
 507         }
 508
 509         min_hlen = ETH_HLEN + skb_headlen(skb);
 510
 511         n = qede_alloc_filter(edev, min_hlen);
 512         if (!n) {
 513                 rc = -ENOMEM;
 514                 goto ret_unlock;
 515         }
 516
 517         n->buf_len = min_hlen;
 518         n->rxq_id = rxq_index;
 519         n->next_rxq_id = rxq_index;
 520         n->tuple.src_port = ports[0];
 521         n->tuple.dst_port = ports[1];
 522         n->flow_id = flow_id;
 523
 524         if (skb->protocol == htons(ETH_P_IP)) {
 525                 n->tuple.src_ipv4 = ip_hdr(skb)->saddr;
 526                 n->tuple.dst_ipv4 = ip_hdr(skb)->daddr;
 527         } else {
 528                 memcpy(&n->tuple.src_ipv6, &ipv6_hdr(skb)->saddr,
 529                        sizeof(struct in6_addr));
 530                 memcpy(&n->tuple.dst_ipv6, &ipv6_hdr(skb)->daddr,
 531                        sizeof(struct in6_addr));
 532         }
 533
 534         eth = (struct ethhdr *)n->data;
 535         eth->h_proto = skb->protocol;
 536         n->tuple.eth_proto = skb->protocol;
 537         n->tuple.ip_proto = ip_proto;
 538         n->tuple.mode = QED_FILTER_CONFIG_MODE_5_TUPLE;
 539         memcpy(n->data + ETH_HLEN, skb->data, skb_headlen(skb));
 540
 541         rc = qede_enqueue_fltr_and_config_searcher(edev, n, tbl_idx);
 542         if (rc)
 543                 goto ret_unlock;
 544
 545         qede_configure_arfs_fltr(edev, n, n->rxq_id, true);
 546
 547         spin_unlock_bh(&edev->arfs->arfs_list_lock);
 548
 549         set_bit(QEDE_SP_ARFS_CONFIG, &edev->sp_flags);
 550         schedule_delayed_work(&edev->sp_task, 0);
 551
 552         return n->sw_id;
 553
 554 ret_unlock:
 555         spin_unlock_bh(&edev->arfs->arfs_list_lock);
 556         return rc;
 557 }
 558 #endif
 559
 560 void qede_udp_ports_update(void *dev, u16 vxlan_port, u16 geneve_port)
 561 {
 562         struct qede_dev *edev = dev;
 563
 564         if (edev->vxlan_dst_port != vxlan_port)
 565                 edev->vxlan_dst_port = 0;
 566
 567         if (edev->geneve_dst_port != geneve_port)
 568                 edev->geneve_dst_port = 0;
 569 }
 570
 571 void qede_force_mac(void *dev, u8 *mac, bool forced)
 572 {
 573         struct qede_dev *edev = dev;
 574
 575         __qede_lock(edev);
 576
 577         if (!is_valid_ether_addr(mac)) {
 578                 __qede_unlock(edev);
 579                 return;
 580         }
 581
 582         ether_addr_copy(edev->ndev->dev_addr, mac);
 583         __qede_unlock(edev);
 584 }
 585
 586 void qede_fill_rss_params(struct qede_dev *edev,
 587                           struct qed_update_vport_rss_params *rss, u8 *update)
 588 {
 589         bool need_reset = false;
 590         int i;
 591
 592         if (QEDE_RSS_COUNT(edev) <= 1) {
 593                 memset(rss, 0, sizeof(*rss));
 594                 *update = 0;
 595                 return;
 596         }
 597
 598         /* Need to validate current RSS config uses valid entries */
 599         for (i = 0; i < QED_RSS_IND_TABLE_SIZE; i++) {
 600                 if (edev->rss_ind_table[i] >= QEDE_RSS_COUNT(edev)) {
 601                         need_reset = true;
 602                         break;
 603                 }
 604         }
 605
 606         if (!(edev->rss_params_inited & QEDE_RSS_INDIR_INITED) || need_reset) {
 607                 for (i = 0; i < QED_RSS_IND_TABLE_SIZE; i++) {
 608                         u16 indir_val, val;
 609
 610                         val = QEDE_RSS_COUNT(edev);
 611                         indir_val = ethtool_rxfh_indir_default(i, val);
 612                         edev->rss_ind_table[i] = indir_val;
 613                 }
 614                 edev->rss_params_inited |= QEDE_RSS_INDIR_INITED;
 615         }
 616
 617         /* Now that we have the queue-indirection, prepare the handles */
 618         for (i = 0; i < QED_RSS_IND_TABLE_SIZE; i++) {
 619                 u16 idx = QEDE_RX_QUEUE_IDX(edev, edev->rss_ind_table[i]);
 620
 621                 rss->rss_ind_table[i] = edev->fp_array[idx].rxq->handle;
 622         }
 623
 624         if (!(edev->rss_params_inited & QEDE_RSS_KEY_INITED)) {
 625                 netdev_rss_key_fill(edev->rss_key, sizeof(edev->rss_key));
 626                 edev->rss_params_inited |= QEDE_RSS_KEY_INITED;
 627         }
 628         memcpy(rss->rss_key, edev->rss_key, sizeof(rss->rss_key));
 629
 630         if (!(edev->rss_params_inited & QEDE_RSS_CAPS_INITED)) {
 631                 edev->rss_caps = QED_RSS_IPV4 | QED_RSS_IPV6 |
 632                     QED_RSS_IPV4_TCP | QED_RSS_IPV6_TCP;
 633                 edev->rss_params_inited |= QEDE_RSS_CAPS_INITED;
 634         }
 635         rss->rss_caps = edev->rss_caps;
 636
 637         *update = 1;
 638 }
 639
 640 static int qede_set_ucast_rx_mac(struct qede_dev *edev,
 641                                  enum qed_filter_xcast_params_type opcode,
 642                                  unsigned char mac[ETH_ALEN])
 643 {
 644         struct qed_filter_params filter_cmd;
 645
 646         memset(&filter_cmd, 0, sizeof(filter_cmd));
 647         filter_cmd.type = QED_FILTER_TYPE_UCAST;
 648         filter_cmd.filter.ucast.type = opcode;
 649         filter_cmd.filter.ucast.mac_valid = 1;
 650         ether_addr_copy(filter_cmd.filter.ucast.mac, mac);
 651
 652         return edev->ops->filter_config(edev->cdev, &filter_cmd);
 653 }
 654
 655 static int qede_set_ucast_rx_vlan(struct qede_dev *edev,
 656                                   enum qed_filter_xcast_params_type opcode,
 657                                   u16 vid)
 658 {
 659         struct qed_filter_params filter_cmd;
 660
 661         memset(&filter_cmd, 0, sizeof(filter_cmd));
 662         filter_cmd.type = QED_FILTER_TYPE_UCAST;
 663         filter_cmd.filter.ucast.type = opcode;
 664         filter_cmd.filter.ucast.vlan_valid = 1;
 665         filter_cmd.filter.ucast.vlan = vid;
 666
 667         return edev->ops->filter_config(edev->cdev, &filter_cmd);
 668 }
 669
 670 static int qede_config_accept_any_vlan(struct qede_dev *edev, bool action)
 671 {
 672         struct qed_update_vport_params *params;
 673         int rc;
 674
 675         /* Proceed only if action actually needs to be performed */
 676         if (edev->accept_any_vlan == action)
 677                 return 0;
 678
 679         params = vzalloc(sizeof(*params));
 680         if (!params)
 681                 return -ENOMEM;
 682
 683         params->vport_id = 0;
 684         params->accept_any_vlan = action;
 685         params->update_accept_any_vlan_flg = 1;
 686
 687         rc = edev->ops->vport_update(edev->cdev, params);
 688         if (rc) {
 689                 DP_ERR(edev, "Failed to %s accept-any-vlan\n",
 690                        action ? "enable" : "disable");
 691         } else {
 692                 DP_INFO(edev, "%s accept-any-vlan\n",
 693                         action ? "enabled" : "disabled");
 694                 edev->accept_any_vlan = action;
 695         }
 696
 697         vfree(params);
 698         return 0;
 699 }
 700
 701 int qede_vlan_rx_add_vid(struct net_device *dev, __be16 proto, u16 vid)
 702 {
 703         struct qede_dev *edev = netdev_priv(dev);
 704         struct qede_vlan *vlan, *tmp;
 705         int rc = 0;
 706
 707         DP_VERBOSE(edev, NETIF_MSG_IFUP, "Adding vlan 0x%04x\n", vid);
 708
 709         vlan = kzalloc(sizeof(*vlan), GFP_KERNEL);
 710         if (!vlan) {
 711                 DP_INFO(edev, "Failed to allocate struct for vlan\n");
 712                 return -ENOMEM;
 713         }
 714         INIT_LIST_HEAD(&vlan->list);
 715         vlan->vid = vid;
 716         vlan->configured = false;
 717
 718         /* Verify vlan isn't already configured */
 719         list_for_each_entry(tmp, &edev->vlan_list, list) {
 720                 if (tmp->vid == vlan->vid) {
 721                         DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 722                                    "vlan already configured\n");
 723                         kfree(vlan);
 724                         return -EEXIST;
 725                 }
 726         }
 727
 728         /* If interface is down, cache this VLAN ID and return */
 729         __qede_lock(edev);
 730         if (edev->state != QEDE_STATE_OPEN) {
 731                 DP_VERBOSE(edev, NETIF_MSG_IFDOWN,
 732                            "Interface is down, VLAN %d will be configured when interface is up\n",
 733                            vid);
 734                 if (vid != 0)
 735                         edev->non_configured_vlans++;
 736                 list_add(&vlan->list, &edev->vlan_list);
 737                 goto out;
 738         }
 739
 740         /* Check for the filter limit.
 741          * Note - vlan0 has a reserved filter and can be added without
 742          * worrying about quota
 743          */
 744         if ((edev->configured_vlans < edev->dev_info.num_vlan_filters) ||
 745             (vlan->vid == 0)) {
 746                 rc = qede_set_ucast_rx_vlan(edev,
 747                                             QED_FILTER_XCAST_TYPE_ADD,
 748                                             vlan->vid);
 749                 if (rc) {
 750                         DP_ERR(edev, "Failed to configure VLAN %d\n",
 751                                vlan->vid);
 752                         kfree(vlan);
 753                         goto out;
 754                 }
 755                 vlan->configured = true;
 756
 757                 /* vlan0 filter isn't consuming out of our quota */
 758                 if (vlan->vid != 0)
 759                         edev->configured_vlans++;
 760         } else {
 761                 /* Out of quota; Activate accept-any-VLAN mode */
 762                 if (!edev->non_configured_vlans) {
 763                         rc = qede_config_accept_any_vlan(edev, true);
 764                         if (rc) {
 765                                 kfree(vlan);
 766                                 goto out;
 767                         }
 768                 }
 769
 770                 edev->non_configured_vlans++;
 771         }
 772
 773         list_add(&vlan->list, &edev->vlan_list);
 774
 775 out:
 776         __qede_unlock(edev);
 777         return rc;
 778 }
 779
 780 static void qede_del_vlan_from_list(struct qede_dev *edev,
 781                                     struct qede_vlan *vlan)
 782 {
 783         /* vlan0 filter isn't consuming out of our quota */
 784         if (vlan->vid != 0) {
 785                 if (vlan->configured)
 786                         edev->configured_vlans--;
 787                 else
 788                         edev->non_configured_vlans--;
 789         }
 790
 791         list_del(&vlan->list);
 792         kfree(vlan);
 793 }
 794
 795 int qede_configure_vlan_filters(struct qede_dev *edev)
 796 {
 797         int rc = 0, real_rc = 0, accept_any_vlan = 0;
 798         struct qed_dev_eth_info *dev_info;
 799         struct qede_vlan *vlan = NULL;
 800
 801         if (list_empty(&edev->vlan_list))
 802                 return 0;
 803
 804         dev_info = &edev->dev_info;
 805
 806         /* Configure non-configured vlans */
 807         list_for_each_entry(vlan, &edev->vlan_list, list) {
 808                 if (vlan->configured)
 809                         continue;
 810
 811                 /* We have used all our credits, now enable accept_any_vlan */
 812                 if ((vlan->vid != 0) &&
 813                     (edev->configured_vlans == dev_info->num_vlan_filters)) {
 814                         accept_any_vlan = 1;
 815                         continue;
 816                 }
 817
 818                 DP_VERBOSE(edev, NETIF_MSG_IFUP, "Adding vlan %d\n", vlan->vid);
 819
 820                 rc = qede_set_ucast_rx_vlan(edev, QED_FILTER_XCAST_TYPE_ADD,
 821                                             vlan->vid);
 822                 if (rc) {
 823                         DP_ERR(edev, "Failed to configure VLAN %u\n",
 824                                vlan->vid);
 825                         real_rc = rc;
 826                         continue;
 827                 }
 828
 829                 vlan->configured = true;
 830                 /* vlan0 filter doesn't consume our VLAN filter's quota */
 831                 if (vlan->vid != 0) {
 832                         edev->non_configured_vlans--;
 833                         edev->configured_vlans++;
 834                 }
 835         }
 836
 837         /* enable accept_any_vlan mode if we have more VLANs than credits,
 838          * or remove accept_any_vlan mode if we've actually removed
 839          * a non-configured vlan, and all remaining vlans are truly configured.
 840          */
 841
 842         if (accept_any_vlan)
 843                 rc = qede_config_accept_any_vlan(edev, true);
 844         else if (!edev->non_configured_vlans)
 845                 rc = qede_config_accept_any_vlan(edev, false);
 846
 847         if (rc && !real_rc)
 848                 real_rc = rc;
 849
 850         return real_rc;
 851 }
 852
 853 int qede_vlan_rx_kill_vid(struct net_device *dev, __be16 proto, u16 vid)
 854 {
 855         struct qede_dev *edev = netdev_priv(dev);
 856         struct qede_vlan *vlan = NULL;
 857         int rc = 0;
 858
 859         DP_VERBOSE(edev, NETIF_MSG_IFDOWN, "Removing vlan 0x%04x\n", vid);
 860
 861         /* Find whether entry exists */
 862         __qede_lock(edev);
 863         list_for_each_entry(vlan, &edev->vlan_list, list)
 864                 if (vlan->vid == vid)
 865                         break;
 866
 867         if (!vlan || (vlan->vid != vid)) {
 868                 DP_VERBOSE(edev, (NETIF_MSG_IFUP | NETIF_MSG_IFDOWN),
 869                            "Vlan isn't configured\n");
 870                 goto out;
 871         }
 872
 873         if (edev->state != QEDE_STATE_OPEN) {
 874                 /* As interface is already down, we don't have a VPORT
 875                  * instance to remove vlan filter. So just update vlan list
 876                  */
 877                 DP_VERBOSE(edev, NETIF_MSG_IFDOWN,
 878                            "Interface is down, removing VLAN from list only\n");
 879                 qede_del_vlan_from_list(edev, vlan);
 880                 goto out;
 881         }
 882
 883         /* Remove vlan */
 884         if (vlan->configured) {
 885                 rc = qede_set_ucast_rx_vlan(edev, QED_FILTER_XCAST_TYPE_DEL,
 886                                             vid);
 887                 if (rc) {
 888                         DP_ERR(edev, "Failed to remove VLAN %d\n", vid);
 889                         goto out;
 890                 }
 891         }
 892
 893         qede_del_vlan_from_list(edev, vlan);
 894
 895         /* We have removed a VLAN - try to see if we can
 896          * configure non-configured VLAN from the list.
 897          */
 898         rc = qede_configure_vlan_filters(edev);
 899
 900 out:
 901         __qede_unlock(edev);
 902         return rc;
 903 }
 904
 905 void qede_vlan_mark_nonconfigured(struct qede_dev *edev)
 906 {
 907         struct qede_vlan *vlan = NULL;
 908
 909         if (list_empty(&edev->vlan_list))
 910                 return;
 911
 912         list_for_each_entry(vlan, &edev->vlan_list, list) {
 913                 if (!vlan->configured)
 914                         continue;
 915
 916                 vlan->configured = false;
 917
 918                 /* vlan0 filter isn't consuming out of our quota */
 919                 if (vlan->vid != 0) {
 920                         edev->non_configured_vlans++;
 921                         edev->configured_vlans--;
 922                 }
 923
 924                 DP_VERBOSE(edev, NETIF_MSG_IFDOWN,
 925                            "marked vlan %d as non-configured\n", vlan->vid);
 926         }
 927
 928         edev->accept_any_vlan = false;
 929 }
 930
 931 static void qede_set_features_reload(struct qede_dev *edev,
 932                                      struct qede_reload_args *args)
 933 {
 934         edev->ndev->features = args->u.features;
 935 }
 936
 937 netdev_features_t qede_fix_features(struct net_device *dev,
 938                                     netdev_features_t features)
 939 {
 940         struct qede_dev *edev = netdev_priv(dev);
 941
 942         if (edev->xdp_prog || edev->ndev->mtu > PAGE_SIZE ||
 943             !(features & NETIF_F_GRO))
 944                 features &= ~NETIF_F_GRO_HW;
 945
 946         return features;
 947 }
 948
 949 int qede_set_features(struct net_device *dev, netdev_features_t features)
 950 {
 951         struct qede_dev *edev = netdev_priv(dev);
 952         netdev_features_t changes = features ^ dev->features;
 953         bool need_reload = false;
 954
 955         if (changes & NETIF_F_GRO_HW)
 956                 need_reload = true;
 957
 958         if (need_reload) {
 959                 struct qede_reload_args args;
 960
 961                 args.u.features = features;
 962                 args.func = &qede_set_features_reload;
 963
 964                 /* Make sure that we definitely need to reload.
 965                  * In case of an eBPF attached program, there will be no FW
 966                  * aggregations, so no need to actually reload.
 967                  */
 968                 __qede_lock(edev);
 969                 if (edev->xdp_prog)
 970                         args.func(edev, &args);
 971                 else
 972                         qede_reload(edev, &args, true);
 973                 __qede_unlock(edev);
 974
 975                 return 1;
 976         }
 977
 978         return 0;
 979 }
 980
 981 void qede_udp_tunnel_add(struct net_device *dev, struct udp_tunnel_info *ti)
 982 {
 983         struct qede_dev *edev = netdev_priv(dev);
 984         struct qed_tunn_params tunn_params;
 985         u16 t_port = ntohs(ti->port);
 986         int rc;
 987
 988         memset(&tunn_params, 0, sizeof(tunn_params));
 989
 990         switch (ti->type) {
 991         case UDP_TUNNEL_TYPE_VXLAN:
 992                 if (!edev->dev_info.common.vxlan_enable)
 993                         return;
 994
 995                 if (edev->vxlan_dst_port)
 996                         return;
 997
 998                 tunn_params.update_vxlan_port = 1;
 999                 tunn_params.vxlan_port = t_port;
1000
1001                 __qede_lock(edev);
1002                 rc = edev->ops->tunn_config(edev->cdev, &tunn_params);
1003                 __qede_unlock(edev);
1004
1005                 if (!rc) {
1006                         edev->vxlan_dst_port = t_port;
1007                         DP_VERBOSE(edev, QED_MSG_DEBUG, "Added vxlan port=%d\n",
1008                                    t_port);
1009                 } else {
1010                         DP_NOTICE(edev, "Failed to add vxlan UDP port=%d\n",
1011                                   t_port);
1012                 }
1013
1014                 break;
1015         case UDP_TUNNEL_TYPE_GENEVE:
1016                 if (!edev->dev_info.common.geneve_enable)
1017                         return;
1018
1019                 if (edev->geneve_dst_port)
1020                         return;
1021
1022                 tunn_params.update_geneve_port = 1;
1023                 tunn_params.geneve_port = t_port;
1024
1025                 __qede_lock(edev);
1026                 rc = edev->ops->tunn_config(edev->cdev, &tunn_params);
1027                 __qede_unlock(edev);
1028
1029                 if (!rc) {
1030                         edev->geneve_dst_port = t_port;
1031                         DP_VERBOSE(edev, QED_MSG_DEBUG,
1032                                    "Added geneve port=%d\n", t_port);
1033                 } else {
1034                         DP_NOTICE(edev, "Failed to add geneve UDP port=%d\n",
1035                                   t_port);
1036                 }
1037
1038                 break;
1039         default:
1040                 return;
1041         }
1042 }
1043
1044 void qede_udp_tunnel_del(struct net_device *dev,
1045                          struct udp_tunnel_info *ti)
1046 {
1047         struct qede_dev *edev = netdev_priv(dev);
1048         struct qed_tunn_params tunn_params;
1049         u16 t_port = ntohs(ti->port);
1050
1051         memset(&tunn_params, 0, sizeof(tunn_params));
1052
1053         switch (ti->type) {
1054         case UDP_TUNNEL_TYPE_VXLAN:
1055                 if (t_port != edev->vxlan_dst_port)
1056                         return;
1057
1058                 tunn_params.update_vxlan_port = 1;
1059                 tunn_params.vxlan_port = 0;
1060
1061                 __qede_lock(edev);
1062                 edev->ops->tunn_config(edev->cdev, &tunn_params);
1063                 __qede_unlock(edev);
1064
1065                 edev->vxlan_dst_port = 0;
1066
1067                 DP_VERBOSE(edev, QED_MSG_DEBUG, "Deleted vxlan port=%d\n",
1068                            t_port);
1069
1070                 break;
1071         case UDP_TUNNEL_TYPE_GENEVE:
1072                 if (t_port != edev->geneve_dst_port)
1073                         return;
1074
1075                 tunn_params.update_geneve_port = 1;
1076                 tunn_params.geneve_port = 0;
1077
1078                 __qede_lock(edev);
1079                 edev->ops->tunn_config(edev->cdev, &tunn_params);
1080                 __qede_unlock(edev);
1081
1082                 edev->geneve_dst_port = 0;
1083
1084                 DP_VERBOSE(edev, QED_MSG_DEBUG, "Deleted geneve port=%d\n",
1085                            t_port);
1086                 break;
1087         default:
1088                 return;
1089         }
1090 }
1091
1092 static void qede_xdp_reload_func(struct qede_dev *edev,
1093                                  struct qede_reload_args *args)
1094 {
1095         struct bpf_prog *old;
1096
1097         old = xchg(&edev->xdp_prog, args->u.new_prog);
1098         if (old)
1099                 bpf_prog_put(old);
1100 }
1101
1102 static int qede_xdp_set(struct qede_dev *edev, struct bpf_prog *prog)
1103 {
1104         struct qede_reload_args args;
1105
1106         /* If we're called, there was already a bpf reference increment */
1107         args.func = &qede_xdp_reload_func;
1108         args.u.new_prog = prog;
1109         qede_reload(edev, &args, false);
1110
1111         return 0;
1112 }
1113
1114 int qede_xdp(struct net_device *dev, struct netdev_bpf *xdp)
1115 {
1116         struct qede_dev *edev = netdev_priv(dev);
1117
1118         switch (xdp->command) {
1119         case XDP_SETUP_PROG:
1120                 return qede_xdp_set(edev, xdp->prog);
1121         case XDP_QUERY_PROG:
1122                 xdp->prog_id = edev->xdp_prog ? edev->xdp_prog->aux->id : 0;
1123                 return 0;
1124         default:
1125                 return -EINVAL;
1126         }
1127 }
1128
1129 static int qede_set_mcast_rx_mac(struct qede_dev *edev,
1130                                  enum qed_filter_xcast_params_type opcode,
1131                                  unsigned char *mac, int num_macs)
1132 {
1133         struct qed_filter_params filter_cmd;
1134         int i;
1135
1136         memset(&filter_cmd, 0, sizeof(filter_cmd));
1137         filter_cmd.type = QED_FILTER_TYPE_MCAST;
1138         filter_cmd.filter.mcast.type = opcode;
1139         filter_cmd.filter.mcast.num = num_macs;
1140
1141         for (i = 0; i < num_macs; i++, mac += ETH_ALEN)
1142                 ether_addr_copy(filter_cmd.filter.mcast.mac[i], mac);
1143
1144         return edev->ops->filter_config(edev->cdev, &filter_cmd);
1145 }
1146
1147 int qede_set_mac_addr(struct net_device *ndev, void *p)
1148 {
1149         struct qede_dev *edev = netdev_priv(ndev);
1150         struct sockaddr *addr = p;
1151         int rc = 0;
1152
1153         /* Make sure the state doesn't transition while changing the MAC.
1154          * Also, all flows accessing the dev_addr field are doing that under
1155          * this lock.
1156          */
1157         __qede_lock(edev);
1158
1159         if (!is_valid_ether_addr(addr->sa_data)) {
1160                 DP_NOTICE(edev, "The MAC address is not valid\n");
1161                 rc = -EFAULT;
1162                 goto out;
1163         }
1164
1165         if (!edev->ops->check_mac(edev->cdev, addr->sa_data)) {
1166                 DP_NOTICE(edev, "qed prevents setting MAC %pM\n",
1167                           addr->sa_data);
1168                 rc = -EINVAL;
1169                 goto out;
1170         }
1171
1172         if (edev->state == QEDE_STATE_OPEN) {
1173                 /* Remove the previous primary mac */
1174                 rc = qede_set_ucast_rx_mac(edev, QED_FILTER_XCAST_TYPE_DEL,
1175                                            ndev->dev_addr);
1176                 if (rc)
1177                         goto out;
1178         }
1179
1180         ether_addr_copy(ndev->dev_addr, addr->sa_data);
1181         DP_INFO(edev, "Setting device MAC to %pM\n", addr->sa_data);
1182
1183         if (edev->state != QEDE_STATE_OPEN) {
1184                 DP_VERBOSE(edev, NETIF_MSG_IFDOWN,
1185                            "The device is currently down\n");
1186                 /* Ask PF to explicitly update a copy in bulletin board */
1187                 if (IS_VF(edev) && edev->ops->req_bulletin_update_mac)
1188                         edev->ops->req_bulletin_update_mac(edev->cdev,
1189                                                            ndev->dev_addr);
1190                 goto out;
1191         }
1192
1193         edev->ops->common->update_mac(edev->cdev, ndev->dev_addr);
1194
1195         rc = qede_set_ucast_rx_mac(edev, QED_FILTER_XCAST_TYPE_ADD,
1196                                    ndev->dev_addr);
1197 out:
1198         __qede_unlock(edev);
1199         return rc;
1200 }
1201
1202 static int
1203 qede_configure_mcast_filtering(struct net_device *ndev,
1204                                enum qed_filter_rx_mode_type *accept_flags)
1205 {
1206         struct qede_dev *edev = netdev_priv(ndev);
1207         unsigned char *mc_macs, *temp;
1208         struct netdev_hw_addr *ha;
1209         int rc = 0, mc_count;
1210         size_t size;
1211
1212         size = 64 * ETH_ALEN;
1213
1214         mc_macs = kzalloc(size, GFP_KERNEL);
1215         if (!mc_macs) {
1216                 DP_NOTICE(edev,
1217                           "Failed to allocate memory for multicast MACs\n");
1218                 rc = -ENOMEM;
1219                 goto exit;
1220         }
1221
1222         temp = mc_macs;
1223
1224         /* Remove all previously configured MAC filters */
1225         rc = qede_set_mcast_rx_mac(edev, QED_FILTER_XCAST_TYPE_DEL,
1226                                    mc_macs, 1);
1227         if (rc)
1228                 goto exit;
1229
1230         netif_addr_lock_bh(ndev);
1231
1232         mc_count = netdev_mc_count(ndev);
1233         if (mc_count < 64) {
1234                 netdev_for_each_mc_addr(ha, ndev) {
1235                         ether_addr_copy(temp, ha->addr);
1236                         temp += ETH_ALEN;
1237                 }
1238         }
1239
1240         netif_addr_unlock_bh(ndev);
1241
1242         /* Check for all multicast @@@TBD resource allocation */
1243         if ((ndev->flags & IFF_ALLMULTI) || (mc_count > 64)) {
1244                 if (*accept_flags == QED_FILTER_RX_MODE_TYPE_REGULAR)
1245                         *accept_flags = QED_FILTER_RX_MODE_TYPE_MULTI_PROMISC;
1246         } else {
1247                 /* Add all multicast MAC filters */
1248                 rc = qede_set_mcast_rx_mac(edev, QED_FILTER_XCAST_TYPE_ADD,
1249                                            mc_macs, mc_count);
1250         }
1251
1252 exit:
1253         kfree(mc_macs);
1254         return rc;
1255 }
1256
1257 void qede_set_rx_mode(struct net_device *ndev)
1258 {
1259         struct qede_dev *edev = netdev_priv(ndev);
1260
1261         set_bit(QEDE_SP_RX_MODE, &edev->sp_flags);
1262         schedule_delayed_work(&edev->sp_task, 0);
1263 }
1264
1265 /* Must be called with qede_lock held */
1266 void qede_config_rx_mode(struct net_device *ndev)
1267 {
1268         enum qed_filter_rx_mode_type accept_flags;
1269         struct qede_dev *edev = netdev_priv(ndev);
1270         struct qed_filter_params rx_mode;
1271         unsigned char *uc_macs, *temp;
1272         struct netdev_hw_addr *ha;
1273         int rc, uc_count;
1274         size_t size;
1275
1276         netif_addr_lock_bh(ndev);
1277
1278         uc_count = netdev_uc_count(ndev);
1279         size = uc_count * ETH_ALEN;
1280
1281         uc_macs = kzalloc(size, GFP_ATOMIC);
1282         if (!uc_macs) {
1283                 DP_NOTICE(edev, "Failed to allocate memory for unicast MACs\n");
1284                 netif_addr_unlock_bh(ndev);
1285                 return;
1286         }
1287
1288         temp = uc_macs;
1289         netdev_for_each_uc_addr(ha, ndev) {
1290                 ether_addr_copy(temp, ha->addr);
1291                 temp += ETH_ALEN;
1292         }
1293
1294         netif_addr_unlock_bh(ndev);
1295
1296         /* Configure the struct for the Rx mode */
1297         memset(&rx_mode, 0, sizeof(struct qed_filter_params));
1298         rx_mode.type = QED_FILTER_TYPE_RX_MODE;
1299
1300         /* Remove all previous unicast secondary macs and multicast macs
1301          * (configrue / leave the primary mac)
1302          */
1303         rc = qede_set_ucast_rx_mac(edev, QED_FILTER_XCAST_TYPE_REPLACE,
1304                                    edev->ndev->dev_addr);
1305         if (rc)
1306                 goto out;
1307
1308         /* Check for promiscuous */
1309         if (ndev->flags & IFF_PROMISC)
1310                 accept_flags = QED_FILTER_RX_MODE_TYPE_PROMISC;
1311         else
1312                 accept_flags = QED_FILTER_RX_MODE_TYPE_REGULAR;
1313
1314         /* Configure all filters regardless, in case promisc is rejected */
1315         if (uc_count < edev->dev_info.num_mac_filters) {
1316                 int i;
1317
1318                 temp = uc_macs;
1319                 for (i = 0; i < uc_count; i++) {
1320                         rc = qede_set_ucast_rx_mac(edev,
1321                                                    QED_FILTER_XCAST_TYPE_ADD,
1322                                                    temp);
1323                         if (rc)
1324                                 goto out;
1325
1326                         temp += ETH_ALEN;
1327                 }
1328         } else {
1329                 accept_flags = QED_FILTER_RX_MODE_TYPE_PROMISC;
1330         }
1331
1332         rc = qede_configure_mcast_filtering(ndev, &accept_flags);
1333         if (rc)
1334                 goto out;
1335
1336         /* take care of VLAN mode */
1337         if (ndev->flags & IFF_PROMISC) {
1338                 qede_config_accept_any_vlan(edev, true);
1339         } else if (!edev->non_configured_vlans) {
1340                 /* It's possible that accept_any_vlan mode is set due to a
1341                  * previous setting of IFF_PROMISC. If vlan credits are
1342                  * sufficient, disable accept_any_vlan.
1343                  */
1344                 qede_config_accept_any_vlan(edev, false);
1345         }
1346
1347         rx_mode.filter.accept_flags = accept_flags;
1348         edev->ops->filter_config(edev->cdev, &rx_mode);
1349 out:
1350         kfree(uc_macs);
1351 }
1352
1353 static struct qede_arfs_fltr_node *
1354 qede_get_arfs_fltr_by_loc(struct hlist_head *head, u64 location)
1355 {
1356         struct qede_arfs_fltr_node *fltr;
1357
1358         hlist_for_each_entry(fltr, head, node)
1359                 if (location == fltr->sw_id)
1360                         return fltr;
1361
1362         return NULL;
1363 }
1364
1365 int qede_get_cls_rule_all(struct qede_dev *edev, struct ethtool_rxnfc *info,
1366                           u32 *rule_locs)
1367 {
1368         struct qede_arfs_fltr_node *fltr;
1369         struct hlist_head *head;
1370         int cnt = 0, rc = 0;
1371
1372         info->data = QEDE_RFS_MAX_FLTR;
1373
1374         __qede_lock(edev);
1375
1376         if (!edev->arfs) {
1377                 rc = -EPERM;
1378                 goto unlock;
1379         }
1380
1381         head = QEDE_ARFS_BUCKET_HEAD(edev, 0);
1382
1383         hlist_for_each_entry(fltr, head, node) {
1384                 if (cnt == info->rule_cnt) {
1385                         rc = -EMSGSIZE;
1386                         goto unlock;
1387                 }
1388
1389                 rule_locs[cnt] = fltr->sw_id;
1390                 cnt++;
1391         }
1392
1393         info->rule_cnt = cnt;
1394
1395 unlock:
1396         __qede_unlock(edev);
1397         return rc;
1398 }
1399
1400 int qede_get_cls_rule_entry(struct qede_dev *edev, struct ethtool_rxnfc *cmd)
1401 {
1402         struct ethtool_rx_flow_spec *fsp = &cmd->fs;
1403         struct qede_arfs_fltr_node *fltr = NULL;
1404         int rc = 0;
1405
1406         cmd->data = QEDE_RFS_MAX_FLTR;
1407
1408         __qede_lock(edev);
1409
1410         if (!edev->arfs) {
1411                 rc = -EPERM;
1412                 goto unlock;
1413         }
1414
1415         fltr = qede_get_arfs_fltr_by_loc(QEDE_ARFS_BUCKET_HEAD(edev, 0),
1416                                          fsp->location);
1417         if (!fltr) {
1418                 DP_NOTICE(edev, "Rule not found - location=0x%x\n",
1419                           fsp->location);
1420                 rc = -EINVAL;
1421                 goto unlock;
1422         }
1423
1424         if (fltr->tuple.eth_proto == htons(ETH_P_IP)) {
1425                 if (fltr->tuple.ip_proto == IPPROTO_TCP)
1426                         fsp->flow_type = TCP_V4_FLOW;
1427                 else
1428                         fsp->flow_type = UDP_V4_FLOW;
1429
1430                 fsp->h_u.tcp_ip4_spec.psrc = fltr->tuple.src_port;
1431                 fsp->h_u.tcp_ip4_spec.pdst = fltr->tuple.dst_port;
1432                 fsp->h_u.tcp_ip4_spec.ip4src = fltr->tuple.src_ipv4;
1433                 fsp->h_u.tcp_ip4_spec.ip4dst = fltr->tuple.dst_ipv4;
1434         } else {
1435                 if (fltr->tuple.ip_proto == IPPROTO_TCP)
1436                         fsp->flow_type = TCP_V6_FLOW;
1437                 else
1438                         fsp->flow_type = UDP_V6_FLOW;
1439                 fsp->h_u.tcp_ip6_spec.psrc = fltr->tuple.src_port;
1440                 fsp->h_u.tcp_ip6_spec.pdst = fltr->tuple.dst_port;
1441                 memcpy(&fsp->h_u.tcp_ip6_spec.ip6src,
1442                        &fltr->tuple.src_ipv6, sizeof(struct in6_addr));
1443                 memcpy(&fsp->h_u.tcp_ip6_spec.ip6dst,
1444                        &fltr->tuple.dst_ipv6, sizeof(struct in6_addr));
1445         }
1446
1447         fsp->ring_cookie = fltr->rxq_id;
1448
1449         if (fltr->vfid) {
1450                 fsp->ring_cookie |= ((u64)fltr->vfid) <<
1451                                         ETHTOOL_RX_FLOW_SPEC_RING_VF_OFF;
1452         }
1453
1454         if (fltr->b_is_drop)
1455                 fsp->ring_cookie = RX_CLS_FLOW_DISC;
1456 unlock:
1457         __qede_unlock(edev);
1458         return rc;
1459 }
1460
1461 static int
1462 qede_poll_arfs_filter_config(struct qede_dev *edev,
1463                              struct qede_arfs_fltr_node *fltr)
1464 {
1465         int count = QEDE_ARFS_POLL_COUNT;
1466
1467         while (fltr->used && count) {
1468                 msleep(20);
1469                 count--;
1470         }
1471
1472         if (count == 0 || fltr->fw_rc) {
1473                 DP_NOTICE(edev, "Timeout in polling filter config\n");
1474                 qede_dequeue_fltr_and_config_searcher(edev, fltr);
1475                 return -EIO;
1476         }
1477
1478         return fltr->fw_rc;
1479 }
1480
1481 static int qede_flow_get_min_header_size(struct qede_arfs_tuple *t)
1482 {
1483         int size = ETH_HLEN;
1484
1485         if (t->eth_proto == htons(ETH_P_IP))
1486                 size += sizeof(struct iphdr);
1487         else
1488                 size += sizeof(struct ipv6hdr);
1489
1490         if (t->ip_proto == IPPROTO_TCP)
1491                 size += sizeof(struct tcphdr);
1492         else
1493                 size += sizeof(struct udphdr);
1494
1495         return size;
1496 }
1497
1498 static bool qede_flow_spec_ipv4_cmp(struct qede_arfs_tuple *a,
1499                                     struct qede_arfs_tuple *b)
1500 {
1501         if (a->eth_proto != htons(ETH_P_IP) ||
1502             b->eth_proto != htons(ETH_P_IP))
1503                 return false;
1504
1505         return (a->src_ipv4 == b->src_ipv4) &&
1506                (a->dst_ipv4 == b->dst_ipv4);
1507 }
1508
1509 static void qede_flow_build_ipv4_hdr(struct qede_arfs_tuple *t,
1510                                      void *header)
1511 {
1512         __be16 *ports = (__be16 *)(header + ETH_HLEN + sizeof(struct iphdr));
1513         struct iphdr *ip = (struct iphdr *)(header + ETH_HLEN);
1514         struct ethhdr *eth = (struct ethhdr *)header;
1515
1516         eth->h_proto = t->eth_proto;
1517         ip->saddr = t->src_ipv4;
1518         ip->daddr = t->dst_ipv4;
1519         ip->version = 0x4;
1520         ip->ihl = 0x5;
1521         ip->protocol = t->ip_proto;
1522         ip->tot_len = cpu_to_be16(qede_flow_get_min_header_size(t) - ETH_HLEN);
1523
1524         /* ports is weakly typed to suit both TCP and UDP ports */
1525         ports[0] = t->src_port;
1526         ports[1] = t->dst_port;
1527 }
1528
1529 static void qede_flow_stringify_ipv4_hdr(struct qede_arfs_tuple *t,
1530                                          void *buffer)
1531 {
1532         const char *prefix = t->ip_proto == IPPROTO_TCP ? "TCP" : "UDP";
1533
1534         snprintf(buffer, QEDE_FILTER_PRINT_MAX_LEN,
1535                  "%s %pI4 (%04x) -> %pI4 (%04x)",
1536                  prefix, &t->src_ipv4, t->src_port,
1537                  &t->dst_ipv4, t->dst_port);
1538 }
1539
1540 static bool qede_flow_spec_ipv6_cmp(struct qede_arfs_tuple *a,
1541                                     struct qede_arfs_tuple *b)
1542 {
1543         if (a->eth_proto != htons(ETH_P_IPV6) ||
1544             b->eth_proto != htons(ETH_P_IPV6))
1545                 return false;
1546
1547         if (memcmp(&a->src_ipv6, &b->src_ipv6, sizeof(struct in6_addr)))
1548                 return false;
1549
1550         if (memcmp(&a->dst_ipv6, &b->dst_ipv6, sizeof(struct in6_addr)))
1551                 return false;
1552
1553         return true;
1554 }
1555
1556 static void qede_flow_build_ipv6_hdr(struct qede_arfs_tuple *t,
1557                                      void *header)
1558 {
1559         __be16 *ports = (__be16 *)(header + ETH_HLEN + sizeof(struct ipv6hdr));
1560         struct ipv6hdr *ip6 = (struct ipv6hdr *)(header + ETH_HLEN);
1561         struct ethhdr *eth = (struct ethhdr *)header;
1562
1563         eth->h_proto = t->eth_proto;
1564         memcpy(&ip6->saddr, &t->src_ipv6, sizeof(struct in6_addr));
1565         memcpy(&ip6->daddr, &t->dst_ipv6, sizeof(struct in6_addr));
1566         ip6->version = 0x6;
1567
1568         if (t->ip_proto == IPPROTO_TCP) {
1569                 ip6->nexthdr = NEXTHDR_TCP;
1570                 ip6->payload_len = cpu_to_be16(sizeof(struct tcphdr));
1571         } else {
1572                 ip6->nexthdr = NEXTHDR_UDP;
1573                 ip6->payload_len = cpu_to_be16(sizeof(struct udphdr));
1574         }
1575
1576         /* ports is weakly typed to suit both TCP and UDP ports */
1577         ports[0] = t->src_port;
1578         ports[1] = t->dst_port;
1579 }
1580
1581 /* Validate fields which are set and not accepted by the driver */
1582 static int qede_flow_spec_validate_unused(struct qede_dev *edev,
1583                                           struct ethtool_rx_flow_spec *fs)
1584 {
1585         if (fs->flow_type & FLOW_MAC_EXT) {
1586                 DP_INFO(edev, "Don't support MAC extensions\n");
1587                 return -EOPNOTSUPP;
1588         }
1589
1590         if ((fs->flow_type & FLOW_EXT) &&
1591             (fs->h_ext.vlan_etype || fs->h_ext.vlan_tci)) {
1592                 DP_INFO(edev, "Don't support vlan-based classification\n");
1593                 return -EOPNOTSUPP;
1594         }
1595
1596         if ((fs->flow_type & FLOW_EXT) &&
1597             (fs->h_ext.data[0] || fs->h_ext.data[1])) {
1598                 DP_INFO(edev, "Don't support user defined data\n");
1599                 return -EOPNOTSUPP;
1600         }
1601
1602         return 0;
1603 }
1604
1605 static int qede_set_v4_tuple_to_profile(struct qede_dev *edev,
1606                                         struct qede_arfs_tuple *t)
1607 {
1608         /* We must have Only 4-tuples/l4 port/src ip/dst ip
1609          * as an input.
1610          */
1611         if (t->src_port && t->dst_port && t->src_ipv4 && t->dst_ipv4) {
1612                 t->mode = QED_FILTER_CONFIG_MODE_5_TUPLE;
1613         } else if (!t->src_port && t->dst_port &&
1614                    !t->src_ipv4 && !t->dst_ipv4) {
1615                 t->mode = QED_FILTER_CONFIG_MODE_L4_PORT;
1616         } else if (!t->src_port && !t->dst_port &&
1617                    !t->dst_ipv4 && t->src_ipv4) {
1618                 t->mode = QED_FILTER_CONFIG_MODE_IP_SRC;
1619         } else if (!t->src_port && !t->dst_port &&
1620                    t->dst_ipv4 && !t->src_ipv4) {
1621                 t->mode = QED_FILTER_CONFIG_MODE_IP_DEST;
1622         } else {
1623                 DP_INFO(edev, "Invalid N-tuple\n");
1624                 return -EOPNOTSUPP;
1625         }
1626
1627         t->ip_comp = qede_flow_spec_ipv4_cmp;
1628         t->build_hdr = qede_flow_build_ipv4_hdr;
1629         t->stringify = qede_flow_stringify_ipv4_hdr;
1630
1631         return 0;
1632 }
1633
1634 static int qede_set_v6_tuple_to_profile(struct qede_dev *edev,
1635                                         struct qede_arfs_tuple *t,
1636                                         struct in6_addr *zaddr)
1637 {
1638         /* We must have Only 4-tuples/l4 port/src ip/dst ip
1639          * as an input.
1640          */
1641         if (t->src_port && t->dst_port &&
1642             memcmp(&t->src_ipv6, zaddr, sizeof(struct in6_addr)) &&
1643             memcmp(&t->dst_ipv6, zaddr, sizeof(struct in6_addr))) {
1644                 t->mode = QED_FILTER_CONFIG_MODE_5_TUPLE;
1645         } else if (!t->src_port && t->dst_port &&
1646                    !memcmp(&t->src_ipv6, zaddr, sizeof(struct in6_addr)) &&
1647                    !memcmp(&t->dst_ipv6, zaddr, sizeof(struct in6_addr))) {
1648                 t->mode = QED_FILTER_CONFIG_MODE_L4_PORT;
1649         } else if (!t->src_port && !t->dst_port &&
1650                    !memcmp(&t->dst_ipv6, zaddr, sizeof(struct in6_addr)) &&
1651                    memcmp(&t->src_ipv6, zaddr, sizeof(struct in6_addr))) {
1652                 t->mode = QED_FILTER_CONFIG_MODE_IP_SRC;
1653         } else if (!t->src_port && !t->dst_port &&
1654                    memcmp(&t->dst_ipv6, zaddr, sizeof(struct in6_addr)) &&
1655                    !memcmp(&t->src_ipv6, zaddr, sizeof(struct in6_addr))) {
1656                 t->mode = QED_FILTER_CONFIG_MODE_IP_DEST;
1657         } else {
1658                 DP_INFO(edev, "Invalid N-tuple\n");
1659                 return -EOPNOTSUPP;
1660         }
1661
1662         t->ip_comp = qede_flow_spec_ipv6_cmp;
1663         t->build_hdr = qede_flow_build_ipv6_hdr;
1664
1665         return 0;
1666 }
1667
1668 /* Must be called while qede lock is held */
1669 static struct qede_arfs_fltr_node *
1670 qede_flow_find_fltr(struct qede_dev *edev, struct qede_arfs_tuple *t)
1671 {
1672         struct qede_arfs_fltr_node *fltr;
1673         struct hlist_node *temp;
1674         struct hlist_head *head;
1675
1676         head = QEDE_ARFS_BUCKET_HEAD(edev, 0);
1677
1678         hlist_for_each_entry_safe(fltr, temp, head, node) {
1679                 if (fltr->tuple.ip_proto == t->ip_proto &&
1680                     fltr->tuple.src_port == t->src_port &&
1681                     fltr->tuple.dst_port == t->dst_port &&
1682                     t->ip_comp(&fltr->tuple, t))
1683                         return fltr;
1684         }
1685
1686         return NULL;
1687 }
1688
1689 static void qede_flow_set_destination(struct qede_dev *edev,
1690                                       struct qede_arfs_fltr_node *n,
1691                                       struct ethtool_rx_flow_spec *fs)
1692 {
1693         if (fs->ring_cookie == RX_CLS_FLOW_DISC) {
1694                 n->b_is_drop = true;
1695                 return;
1696         }
1697
1698         n->vfid = ethtool_get_flow_spec_ring_vf(fs->ring_cookie);
1699         n->rxq_id = ethtool_get_flow_spec_ring(fs->ring_cookie);
1700         n->next_rxq_id = n->rxq_id;
1701
1702         if (n->vfid)
1703                 DP_VERBOSE(edev, QED_MSG_SP,
1704                            "Configuring N-tuple for VF 0x%02x\n", n->vfid - 1);
1705 }
1706
1707 int qede_delete_flow_filter(struct qede_dev *edev, u64 cookie)
1708 {
1709         struct qede_arfs_fltr_node *fltr = NULL;
1710         int rc = -EPERM;
1711
1712         __qede_lock(edev);
1713         if (!edev->arfs)
1714                 goto unlock;
1715
1716         fltr = qede_get_arfs_fltr_by_loc(QEDE_ARFS_BUCKET_HEAD(edev, 0),
1717                                          cookie);
1718         if (!fltr)
1719                 goto unlock;
1720
1721         qede_configure_arfs_fltr(edev, fltr, fltr->rxq_id, false);
1722
1723         rc = qede_poll_arfs_filter_config(edev, fltr);
1724         if (rc == 0)
1725                 qede_dequeue_fltr_and_config_searcher(edev, fltr);
1726
1727 unlock:
1728         __qede_unlock(edev);
1729         return rc;
1730 }
1731
1732 int qede_get_arfs_filter_count(struct qede_dev *edev)
1733 {
1734         int count = 0;
1735
1736         __qede_lock(edev);
1737
1738         if (!edev->arfs)
1739                 goto unlock;
1740
1741         count = edev->arfs->filter_count;
1742
1743 unlock:
1744         __qede_unlock(edev);
1745         return count;
1746 }
1747
1748 static int qede_parse_actions(struct qede_dev *edev,
1749                               struct flow_action *flow_action)
1750 {
1751         const struct flow_action_entry *act;
1752         int i;
1753
1754         if (!flow_action_has_entries(flow_action)) {
1755                 DP_NOTICE(edev, "No actions received\n");
1756                 return -EINVAL;
1757         }
1758
1759         flow_action_for_each(i, act, flow_action) {
1760                 switch (act->id) {
1761                 case FLOW_ACTION_DROP:
1762                         break;
1763                 case FLOW_ACTION_QUEUE:
1764                         if (act->queue.vf)
1765                                 break;
1766
1767                         if (act->queue.index >= QEDE_RSS_COUNT(edev)) {
1768                                 DP_INFO(edev, "Queue out-of-bounds\n");
1769                                 return -EINVAL;
1770                         }
1771                         break;
1772                 default:
1773                         return -EINVAL;
1774                 }
1775         }
1776
1777         return 0;
1778 }
1779
1780 static int
1781 qede_flow_parse_ports(struct qede_dev *edev, struct flow_rule *rule,
1782                       struct qede_arfs_tuple *t)
1783 {
1784         if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) {
1785                 struct flow_match_ports match;
1786
1787                 flow_rule_match_ports(rule, &match);
1788                 if ((match.key->src && match.mask->src != U16_MAX) ||
1789                     (match.key->dst && match.mask->dst != U16_MAX)) {
1790                         DP_NOTICE(edev, "Do not support ports masks\n");
1791                         return -EINVAL;
1792                 }
1793
1794                 t->src_port = match.key->src;
1795                 t->dst_port = match.key->dst;
1796         }
1797
1798         return 0;
1799 }
1800
1801 static int
1802 qede_flow_parse_v6_common(struct qede_dev *edev, struct flow_rule *rule,
1803                           struct qede_arfs_tuple *t)
1804 {
1805         struct in6_addr zero_addr, addr;
1806
1807         memset(&zero_addr, 0, sizeof(addr));
1808         memset(&addr, 0xff, sizeof(addr));
1809
1810         if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IPV6_ADDRS)) {
1811                 struct flow_match_ipv6_addrs match;
1812
1813                 flow_rule_match_ipv6_addrs(rule, &match);
1814                 if ((memcmp(&match.key->src, &zero_addr, sizeof(addr)) &&
1815                      memcmp(&match.mask->src, &addr, sizeof(addr))) ||
1816                     (memcmp(&match.key->dst, &zero_addr, sizeof(addr)) &&
1817                      memcmp(&match.mask->dst, &addr, sizeof(addr)))) {
1818                         DP_NOTICE(edev,
1819                                   "Do not support IPv6 address prefix/mask\n");
1820                         return -EINVAL;
1821                 }
1822
1823                 memcpy(&t->src_ipv6, &match.key->src, sizeof(addr));
1824                 memcpy(&t->dst_ipv6, &match.key->dst, sizeof(addr));
1825         }
1826
1827         if (qede_flow_parse_ports(edev, rule, t))
1828                 return -EINVAL;
1829
1830         return qede_set_v6_tuple_to_profile(edev, t, &zero_addr);
1831 }
1832
1833 static int
1834 qede_flow_parse_v4_common(struct qede_dev *edev, struct flow_rule *rule,
1835                         struct qede_arfs_tuple *t)
1836 {
1837         if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IPV4_ADDRS)) {
1838                 struct flow_match_ipv4_addrs match;
1839
1840                 flow_rule_match_ipv4_addrs(rule, &match);
1841                 if ((match.key->src && match.mask->src != U32_MAX) ||
1842                     (match.key->dst && match.mask->dst != U32_MAX)) {
1843                         DP_NOTICE(edev, "Do not support ipv4 prefix/masks\n");
1844                         return -EINVAL;
1845                 }
1846
1847                 t->src_ipv4 = match.key->src;
1848                 t->dst_ipv4 = match.key->dst;
1849         }
1850
1851         if (qede_flow_parse_ports(edev, rule, t))
1852                 return -EINVAL;
1853
1854         return qede_set_v4_tuple_to_profile(edev, t);
1855 }
1856
1857 static int
1858 qede_flow_parse_tcp_v6(struct qede_dev *edev, struct flow_rule *rule,
1859                      struct qede_arfs_tuple *tuple)
1860 {
1861         tuple->ip_proto = IPPROTO_TCP;
1862         tuple->eth_proto = htons(ETH_P_IPV6);
1863
1864         return qede_flow_parse_v6_common(edev, rule, tuple);
1865 }
1866
1867 static int
1868 qede_flow_parse_tcp_v4(struct qede_dev *edev, struct flow_rule *rule,
1869                      struct qede_arfs_tuple *tuple)
1870 {
1871         tuple->ip_proto = IPPROTO_TCP;
1872         tuple->eth_proto = htons(ETH_P_IP);
1873
1874         return qede_flow_parse_v4_common(edev, rule, tuple);
1875 }
1876
1877 static int
1878 qede_flow_parse_udp_v6(struct qede_dev *edev, struct flow_rule *rule,
1879                      struct qede_arfs_tuple *tuple)
1880 {
1881         tuple->ip_proto = IPPROTO_UDP;
1882         tuple->eth_proto = htons(ETH_P_IPV6);
1883
1884         return qede_flow_parse_v6_common(edev, rule, tuple);
1885 }
1886
1887 static int
1888 qede_flow_parse_udp_v4(struct qede_dev *edev, struct flow_rule *rule,
1889                      struct qede_arfs_tuple *tuple)
1890 {
1891         tuple->ip_proto = IPPROTO_UDP;
1892         tuple->eth_proto = htons(ETH_P_IP);
1893
1894         return qede_flow_parse_v4_common(edev, rule, tuple);
1895 }
1896
1897 static int
1898 qede_parse_flow_attr(struct qede_dev *edev, __be16 proto,
1899                      struct flow_rule *rule, struct qede_arfs_tuple *tuple)
1900 {
1901         struct flow_dissector *dissector = rule->match.dissector;
1902         int rc = -EINVAL;
1903         u8 ip_proto = 0;
1904
1905         memset(tuple, 0, sizeof(*tuple));
1906
1907         if (dissector->used_keys &
1908             ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) |
1909               BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) |
1910               BIT(FLOW_DISSECTOR_KEY_BASIC) |
1911               BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) |
1912               BIT(FLOW_DISSECTOR_KEY_PORTS))) {
1913                 DP_NOTICE(edev, "Unsupported key set:0x%x\n",
1914                           dissector->used_keys);
1915                 return -EOPNOTSUPP;
1916         }
1917
1918         if (proto != htons(ETH_P_IP) &&
1919             proto != htons(ETH_P_IPV6)) {
1920                 DP_NOTICE(edev, "Unsupported proto=0x%x\n", proto);
1921                 return -EPROTONOSUPPORT;
1922         }
1923
1924         if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
1925                 struct flow_match_basic match;
1926
1927                 flow_rule_match_basic(rule, &match);
1928                 ip_proto = match.key->ip_proto;
1929         }
1930
1931         if (ip_proto == IPPROTO_TCP && proto == htons(ETH_P_IP))
1932                 rc = qede_flow_parse_tcp_v4(edev, rule, tuple);
1933         else if (ip_proto == IPPROTO_TCP && proto == htons(ETH_P_IPV6))
1934                 rc = qede_flow_parse_tcp_v6(edev, rule, tuple);
1935         else if (ip_proto == IPPROTO_UDP && proto == htons(ETH_P_IP))
1936                 rc = qede_flow_parse_udp_v4(edev, rule, tuple);
1937         else if (ip_proto == IPPROTO_UDP && proto == htons(ETH_P_IPV6))
1938                 rc = qede_flow_parse_udp_v6(edev, rule, tuple);
1939         else
1940                 DP_NOTICE(edev, "Invalid protocol request\n");
1941
1942         return rc;
1943 }
1944
1945 int qede_add_tc_flower_fltr(struct qede_dev *edev, __be16 proto,
1946                             struct tc_cls_flower_offload *f)
1947 {
1948         struct qede_arfs_fltr_node *n;
1949         int min_hlen, rc = -EINVAL;
1950         struct qede_arfs_tuple t;
1951
1952         __qede_lock(edev);
1953
1954         if (!edev->arfs) {
1955                 rc = -EPERM;
1956                 goto unlock;
1957         }
1958
1959         /* parse flower attribute and prepare filter */
1960         if (qede_parse_flow_attr(edev, proto, f->rule, &t))
1961                 goto unlock;
1962
1963         /* Validate profile mode and number of filters */
1964         if ((edev->arfs->filter_count && edev->arfs->mode != t.mode) ||
1965             edev->arfs->filter_count == QEDE_RFS_MAX_FLTR) {
1966                 DP_NOTICE(edev,
1967                           "Filter configuration invalidated, filter mode=0x%x, configured mode=0x%x, filter count=0x%x\n",
1968                           t.mode, edev->arfs->mode, edev->arfs->filter_count);
1969                 goto unlock;
1970         }
1971
1972         /* parse tc actions and get the vf_id */
1973         if (qede_parse_actions(edev, &f->rule->action))
1974                 goto unlock;
1975
1976         if (qede_flow_find_fltr(edev, &t)) {
1977                 rc = -EEXIST;
1978                 goto unlock;
1979         }
1980
1981         n = kzalloc(sizeof(*n), GFP_KERNEL);
1982         if (!n) {
1983                 rc = -ENOMEM;
1984                 goto unlock;
1985         }
1986
1987         min_hlen = qede_flow_get_min_header_size(&t);
1988
1989         n->data = kzalloc(min_hlen, GFP_KERNEL);
1990         if (!n->data) {
1991                 kfree(n);
1992                 rc = -ENOMEM;
1993                 goto unlock;
1994         }
1995
1996         memcpy(&n->tuple, &t, sizeof(n->tuple));
1997
1998         n->buf_len = min_hlen;
1999         n->b_is_drop = true;
2000         n->sw_id = f->cookie;
2001
2002         n->tuple.build_hdr(&n->tuple, n->data);
2003
2004         rc = qede_enqueue_fltr_and_config_searcher(edev, n, 0);
2005         if (rc)
2006                 goto unlock;
2007
2008         qede_configure_arfs_fltr(edev, n, n->rxq_id, true);
2009         rc = qede_poll_arfs_filter_config(edev, n);
2010
2011 unlock:
2012         __qede_unlock(edev);
2013         return rc;
2014 }
2015
2016 static int qede_flow_spec_validate(struct qede_dev *edev,
2017                                    struct flow_action *flow_action,
2018                                    struct qede_arfs_tuple *t,
2019                                    __u32 location)
2020 {
2021         if (location >= QEDE_RFS_MAX_FLTR) {
2022                 DP_INFO(edev, "Location out-of-bounds\n");
2023                 return -EINVAL;
2024         }
2025
2026         /* Check location isn't already in use */
2027         if (test_bit(location, edev->arfs->arfs_fltr_bmap)) {
2028                 DP_INFO(edev, "Location already in use\n");
2029                 return -EINVAL;
2030         }
2031
2032         /* Check if the filtering-mode could support the filter */
2033         if (edev->arfs->filter_count &&
2034             edev->arfs->mode != t->mode) {
2035                 DP_INFO(edev,
2036                         "flow_spec would require filtering mode %08x, but %08x is configured\n",
2037                         t->mode, edev->arfs->filter_count);
2038                 return -EINVAL;
2039         }
2040
2041         if (qede_parse_actions(edev, flow_action))
2042                 return -EINVAL;
2043
2044         return 0;
2045 }
2046
2047 static int qede_flow_spec_to_rule(struct qede_dev *edev,
2048                                   struct qede_arfs_tuple *t,
2049                                   struct ethtool_rx_flow_spec *fs)
2050 {
2051         struct ethtool_rx_flow_spec_input input = {};
2052         struct ethtool_rx_flow_rule *flow;
2053         __be16 proto;
2054         int err = 0;
2055
2056         if (qede_flow_spec_validate_unused(edev, fs))
2057                 return -EOPNOTSUPP;
2058
2059         switch ((fs->flow_type & ~FLOW_EXT)) {
2060         case TCP_V4_FLOW:
2061         case UDP_V4_FLOW:
2062                 proto = htons(ETH_P_IP);
2063                 break;
2064         case TCP_V6_FLOW:
2065         case UDP_V6_FLOW:
2066                 proto = htons(ETH_P_IPV6);
2067                 break;
2068         default:
2069                 DP_VERBOSE(edev, NETIF_MSG_IFUP,
2070                            "Can't support flow of type %08x\n", fs->flow_type);
2071                 return -EOPNOTSUPP;
2072         }
2073
2074         input.fs = fs;
2075         flow = ethtool_rx_flow_rule_create(&input);
2076         if (IS_ERR(flow))
2077                 return PTR_ERR(flow);
2078
2079         if (qede_parse_flow_attr(edev, proto, flow->rule, t)) {
2080                 err = -EINVAL;
2081                 goto err_out;
2082         }
2083
2084         /* Make sure location is valid and filter isn't already set */
2085         err = qede_flow_spec_validate(edev, &flow->rule->action, t,
2086                                       fs->location);
2087 err_out:
2088         ethtool_rx_flow_rule_destroy(flow);
2089         return err;
2090
2091 }
2092
2093 int qede_add_cls_rule(struct qede_dev *edev, struct ethtool_rxnfc *info)
2094 {
2095         struct ethtool_rx_flow_spec *fsp = &info->fs;
2096         struct qede_arfs_fltr_node *n;
2097         struct qede_arfs_tuple t;
2098         int min_hlen, rc;
2099
2100         __qede_lock(edev);
2101
2102         if (!edev->arfs) {
2103                 rc = -EPERM;
2104                 goto unlock;
2105         }
2106
2107         /* Translate the flow specification into something fittign our DB */
2108         rc = qede_flow_spec_to_rule(edev, &t, fsp);
2109         if (rc)
2110                 goto unlock;
2111
2112         if (qede_flow_find_fltr(edev, &t)) {
2113                 rc = -EINVAL;
2114                 goto unlock;
2115         }
2116
2117         n = kzalloc(sizeof(*n), GFP_KERNEL);
2118         if (!n) {
2119                 rc = -ENOMEM;
2120                 goto unlock;
2121         }
2122
2123         min_hlen = qede_flow_get_min_header_size(&t);
2124         n->data = kzalloc(min_hlen, GFP_KERNEL);
2125         if (!n->data) {
2126                 kfree(n);
2127                 rc = -ENOMEM;
2128                 goto unlock;
2129         }
2130
2131         n->sw_id = fsp->location;
2132         set_bit(n->sw_id, edev->arfs->arfs_fltr_bmap);
2133         n->buf_len = min_hlen;
2134
2135         memcpy(&n->tuple, &t, sizeof(n->tuple));
2136
2137         qede_flow_set_destination(edev, n, fsp);
2138
2139         /* Build a minimal header according to the flow */
2140         n->tuple.build_hdr(&n->tuple, n->data);
2141
2142         rc = qede_enqueue_fltr_and_config_searcher(edev, n, 0);
2143         if (rc)
2144                 goto unlock;
2145
2146         qede_configure_arfs_fltr(edev, n, n->rxq_id, true);
2147         rc = qede_poll_arfs_filter_config(edev, n);
2148 unlock:
2149         __qede_unlock(edev);
2150
2151         return rc;
2152 }