1e8f887acSAmir Vadai /* 2e8f887acSAmir Vadai * Copyright (c) 2016, Mellanox Technologies. All rights reserved. 3e8f887acSAmir Vadai * 4e8f887acSAmir Vadai * This software is available to you under a choice of one of two 5e8f887acSAmir Vadai * licenses. You may choose to be licensed under the terms of the GNU 6e8f887acSAmir Vadai * General Public License (GPL) Version 2, available from the file 7e8f887acSAmir Vadai * COPYING in the main directory of this source tree, or the 8e8f887acSAmir Vadai * OpenIB.org BSD license below: 9e8f887acSAmir Vadai * 10e8f887acSAmir Vadai * Redistribution and use in source and binary forms, with or 11e8f887acSAmir Vadai * without modification, are permitted provided that the following 12e8f887acSAmir Vadai * conditions are met: 13e8f887acSAmir Vadai * 14e8f887acSAmir Vadai * - Redistributions of source code must retain the above 15e8f887acSAmir Vadai * copyright notice, this list of conditions and the following 16e8f887acSAmir Vadai * disclaimer. 17e8f887acSAmir Vadai * 18e8f887acSAmir Vadai * - Redistributions in binary form must reproduce the above 19e8f887acSAmir Vadai * copyright notice, this list of conditions and the following 20e8f887acSAmir Vadai * disclaimer in the documentation and/or other materials 21e8f887acSAmir Vadai * provided with the distribution. 22e8f887acSAmir Vadai * 23e8f887acSAmir Vadai * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 24e8f887acSAmir Vadai * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 25e8f887acSAmir Vadai * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 26e8f887acSAmir Vadai * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 27e8f887acSAmir Vadai * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 28e8f887acSAmir Vadai * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 29e8f887acSAmir Vadai * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 30e8f887acSAmir Vadai * SOFTWARE. 31e8f887acSAmir Vadai */ 32e8f887acSAmir Vadai 33e3a2b7edSAmir Vadai #include <net/flow_dissector.h> 343f7d0eb4SOr Gerlitz #include <net/sch_generic.h> 35e3a2b7edSAmir Vadai #include <net/pkt_cls.h> 36e3a2b7edSAmir Vadai #include <net/tc_act/tc_gact.h> 3712185a9fSAmir Vadai #include <net/tc_act/tc_skbedit.h> 38e8f887acSAmir Vadai #include <linux/mlx5/fs.h> 39e8f887acSAmir Vadai #include <linux/mlx5/device.h> 40e8f887acSAmir Vadai #include <linux/rhashtable.h> 415a7e5bcbSVlad Buslov #include <linux/refcount.h> 42db76ca24SVlad Buslov #include <linux/completion.h> 4303a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h> 44776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h> 45bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h> 46d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h> 4726c02749SOr Gerlitz #include <net/tc_act/tc_csum.h> 48f6dfb4c3SHadar Hen Zion #include <net/arp.h> 493616d08bSDavid Ahern #include <net/ipv6_stubs.h> 50e8f887acSAmir Vadai #include "en.h" 511d447a39SSaeed Mahameed #include "en_rep.h" 52232c0013SHadar Hen Zion #include "en_tc.h" 5303a9d11eSOr Gerlitz #include "eswitch.h" 543f6d08d1SOr Gerlitz #include "fs_core.h" 552c81bfd5SHuy Nguyen #include "en/port.h" 56101f4de9SOz Shlomo #include "en/tc_tun.h" 5704de7ddaSRoi Dayan #include "lib/devcom.h" 589272e3dfSYevgeny Kliteynik #include "lib/geneve.h" 597a978759SDmytro Linkin #include "diag/en_tc_tracepoint.h" 60e8f887acSAmir Vadai 613bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr { 623bc4b7bfSOr Gerlitz u32 action; 633bc4b7bfSOr Gerlitz u32 flow_tag; 642b688ea5SMaor Gottlieb struct mlx5_modify_hdr *modify_hdr; 655c65c564SOr Gerlitz u32 hairpin_tirn; 6638aa51c1SOr Gerlitz u8 match_level; 673f6d08d1SOr Gerlitz struct mlx5_flow_table *hairpin_ft; 68b8aee822SMark Bloch struct mlx5_fc *counter; 693bc4b7bfSOr Gerlitz }; 703bc4b7bfSOr Gerlitz 71226f2ca3SVlad Buslov #define MLX5E_TC_FLOW_BASE (MLX5E_TC_FLAG_LAST_EXPORTED_BIT + 1) 7260bd4af8SOr Gerlitz 7365ba8fb7SOr Gerlitz enum { 74226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_INGRESS = MLX5E_TC_FLAG_INGRESS_BIT, 75226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_EGRESS = MLX5E_TC_FLAG_EGRESS_BIT, 76226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_ESWITCH = MLX5E_TC_FLAG_ESW_OFFLOAD_BIT, 7784179981SPaul Blakey MLX5E_TC_FLOW_FLAG_FT = MLX5E_TC_FLAG_FT_OFFLOAD_BIT, 78226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_NIC = MLX5E_TC_FLAG_NIC_OFFLOAD_BIT, 79226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_OFFLOADED = MLX5E_TC_FLOW_BASE, 80226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_HAIRPIN = MLX5E_TC_FLOW_BASE + 1, 81226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_HAIRPIN_RSS = MLX5E_TC_FLOW_BASE + 2, 82226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_SLOW = MLX5E_TC_FLOW_BASE + 3, 83226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_DUP = MLX5E_TC_FLOW_BASE + 4, 84226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_NOT_READY = MLX5E_TC_FLOW_BASE + 5, 85c5d326b2SVlad Buslov MLX5E_TC_FLOW_FLAG_DELETED = MLX5E_TC_FLOW_BASE + 6, 8665ba8fb7SOr Gerlitz }; 8765ba8fb7SOr Gerlitz 88e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1 89e4ad91f2SChris Mi 9079baaec7SEli Britstein /* Helper struct for accessing a struct containing list_head array. 9179baaec7SEli Britstein * Containing struct 9279baaec7SEli Britstein * |- Helper array 9379baaec7SEli Britstein * [0] Helper item 0 9479baaec7SEli Britstein * |- list_head item 0 9579baaec7SEli Britstein * |- index (0) 9679baaec7SEli Britstein * [1] Helper item 1 9779baaec7SEli Britstein * |- list_head item 1 9879baaec7SEli Britstein * |- index (1) 9979baaec7SEli Britstein * To access the containing struct from one of the list_head items: 10079baaec7SEli Britstein * 1. Get the helper item from the list_head item using 10179baaec7SEli Britstein * helper item = 10279baaec7SEli Britstein * container_of(list_head item, helper struct type, list_head field) 10379baaec7SEli Britstein * 2. Get the contining struct from the helper item and its index in the array: 10479baaec7SEli Britstein * containing struct = 10579baaec7SEli Britstein * container_of(helper item, containing struct type, helper field[index]) 10679baaec7SEli Britstein */ 10779baaec7SEli Britstein struct encap_flow_item { 108948993f2SVlad Buslov struct mlx5e_encap_entry *e; /* attached encap instance */ 10979baaec7SEli Britstein struct list_head list; 11079baaec7SEli Britstein int index; 11179baaec7SEli Britstein }; 11279baaec7SEli Britstein 113e8f887acSAmir Vadai struct mlx5e_tc_flow { 114e8f887acSAmir Vadai struct rhash_head node; 115655dc3d2SOr Gerlitz struct mlx5e_priv *priv; 116e8f887acSAmir Vadai u64 cookie; 117226f2ca3SVlad Buslov unsigned long flags; 118e4ad91f2SChris Mi struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1]; 11979baaec7SEli Britstein /* Flow can be associated with multiple encap IDs. 12079baaec7SEli Britstein * The number of encaps is bounded by the number of supported 12179baaec7SEli Britstein * destinations. 12279baaec7SEli Britstein */ 12379baaec7SEli Britstein struct encap_flow_item encaps[MLX5_MAX_FLOW_FWD_VPORTS]; 12404de7ddaSRoi Dayan struct mlx5e_tc_flow *peer_flow; 125dd58edc3SVlad Buslov struct mlx5e_mod_hdr_entry *mh; /* attached mod header instance */ 12611c9c548SOr Gerlitz struct list_head mod_hdr; /* flows sharing the same mod hdr ID */ 127e4f9abbdSVlad Buslov struct mlx5e_hairpin_entry *hpe; /* attached hairpin instance */ 1285c65c564SOr Gerlitz struct list_head hairpin; /* flows sharing the same hairpin */ 12904de7ddaSRoi Dayan struct list_head peer; /* flows with peer flow */ 130b4a23329SRoi Dayan struct list_head unready; /* flows not ready to be offloaded (e.g due to missing route) */ 1312a1f1768SVlad Buslov int tmp_efi_index; 1326a06c2f7SVlad Buslov struct list_head tmp_list; /* temporary flow list used by neigh update */ 1335a7e5bcbSVlad Buslov refcount_t refcnt; 134c5d326b2SVlad Buslov struct rcu_head rcu_head; 13595435ad7SVlad Buslov struct completion init_done; 1363bc4b7bfSOr Gerlitz union { 137ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr esw_attr[0]; 1383bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr nic_attr[0]; 1393bc4b7bfSOr Gerlitz }; 140e8f887acSAmir Vadai }; 141e8f887acSAmir Vadai 14217091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr { 1431f6da306SYevgeny Kliteynik const struct ip_tunnel_info *tun_info[MLX5_MAX_FLOW_FWD_VPORTS]; 144d11afc26SOz Shlomo struct net_device *filter_dev; 14517091853SOr Gerlitz struct mlx5_flow_spec spec; 146d79b6df6SOr Gerlitz int num_mod_hdr_actions; 147218d05ceSTonghao Zhang int max_mod_hdr_actions; 148d79b6df6SOr Gerlitz void *mod_hdr_actions; 14998b66cb1SEli Britstein int mirred_ifindex[MLX5_MAX_FLOW_FWD_VPORTS]; 15017091853SOr Gerlitz }; 15117091853SOr Gerlitz 152acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4 153b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16) 154e8f887acSAmir Vadai 15577ab67b7SOr Gerlitz struct mlx5e_hairpin { 15677ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 15777ab67b7SOr Gerlitz 15877ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev; 1593f6d08d1SOr Gerlitz struct mlx5e_priv *func_priv; 16077ab67b7SOr Gerlitz u32 tdn; 16177ab67b7SOr Gerlitz u32 tirn; 1623f6d08d1SOr Gerlitz 1633f6d08d1SOr Gerlitz int num_channels; 1643f6d08d1SOr Gerlitz struct mlx5e_rqt indir_rqt; 1653f6d08d1SOr Gerlitz u32 indir_tirn[MLX5E_NUM_INDIR_TIRS]; 1663f6d08d1SOr Gerlitz struct mlx5e_ttc_table ttc; 16777ab67b7SOr Gerlitz }; 16877ab67b7SOr Gerlitz 1695c65c564SOr Gerlitz struct mlx5e_hairpin_entry { 1705c65c564SOr Gerlitz /* a node of a hash table which keeps all the hairpin entries */ 1715c65c564SOr Gerlitz struct hlist_node hairpin_hlist; 1725c65c564SOr Gerlitz 17373edca73SVlad Buslov /* protects flows list */ 17473edca73SVlad Buslov spinlock_t flows_lock; 1755c65c564SOr Gerlitz /* flows sharing the same hairpin */ 1765c65c564SOr Gerlitz struct list_head flows; 177db76ca24SVlad Buslov /* hpe's that were not fully initialized when dead peer update event 178db76ca24SVlad Buslov * function traversed them. 179db76ca24SVlad Buslov */ 180db76ca24SVlad Buslov struct list_head dead_peer_wait_list; 1815c65c564SOr Gerlitz 182d8822868SOr Gerlitz u16 peer_vhca_id; 183106be53bSOr Gerlitz u8 prio; 1845c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 185e4f9abbdSVlad Buslov refcount_t refcnt; 186db76ca24SVlad Buslov struct completion res_ready; 1875c65c564SOr Gerlitz }; 1885c65c564SOr Gerlitz 18911c9c548SOr Gerlitz struct mod_hdr_key { 19011c9c548SOr Gerlitz int num_actions; 19111c9c548SOr Gerlitz void *actions; 19211c9c548SOr Gerlitz }; 19311c9c548SOr Gerlitz 19411c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry { 19511c9c548SOr Gerlitz /* a node of a hash table which keeps all the mod_hdr entries */ 19611c9c548SOr Gerlitz struct hlist_node mod_hdr_hlist; 19711c9c548SOr Gerlitz 19883a52f0dSVlad Buslov /* protects flows list */ 19983a52f0dSVlad Buslov spinlock_t flows_lock; 20011c9c548SOr Gerlitz /* flows sharing the same mod_hdr entry */ 20111c9c548SOr Gerlitz struct list_head flows; 20211c9c548SOr Gerlitz 20311c9c548SOr Gerlitz struct mod_hdr_key key; 20411c9c548SOr Gerlitz 2052b688ea5SMaor Gottlieb struct mlx5_modify_hdr *modify_hdr; 206dd58edc3SVlad Buslov 207dd58edc3SVlad Buslov refcount_t refcnt; 208a734d007SVlad Buslov struct completion res_ready; 209a734d007SVlad Buslov int compl_result; 21011c9c548SOr Gerlitz }; 21111c9c548SOr Gerlitz 21211c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto) 21311c9c548SOr Gerlitz 2145a7e5bcbSVlad Buslov static void mlx5e_tc_del_flow(struct mlx5e_priv *priv, 2155a7e5bcbSVlad Buslov struct mlx5e_tc_flow *flow); 2165a7e5bcbSVlad Buslov 2175a7e5bcbSVlad Buslov static struct mlx5e_tc_flow *mlx5e_flow_get(struct mlx5e_tc_flow *flow) 2185a7e5bcbSVlad Buslov { 2195a7e5bcbSVlad Buslov if (!flow || !refcount_inc_not_zero(&flow->refcnt)) 2205a7e5bcbSVlad Buslov return ERR_PTR(-EINVAL); 2215a7e5bcbSVlad Buslov return flow; 2225a7e5bcbSVlad Buslov } 2235a7e5bcbSVlad Buslov 2245a7e5bcbSVlad Buslov static void mlx5e_flow_put(struct mlx5e_priv *priv, 2255a7e5bcbSVlad Buslov struct mlx5e_tc_flow *flow) 2265a7e5bcbSVlad Buslov { 2275a7e5bcbSVlad Buslov if (refcount_dec_and_test(&flow->refcnt)) { 2285a7e5bcbSVlad Buslov mlx5e_tc_del_flow(priv, flow); 229c5d326b2SVlad Buslov kfree_rcu(flow, rcu_head); 2305a7e5bcbSVlad Buslov } 2315a7e5bcbSVlad Buslov } 2325a7e5bcbSVlad Buslov 233226f2ca3SVlad Buslov static void __flow_flag_set(struct mlx5e_tc_flow *flow, unsigned long flag) 234226f2ca3SVlad Buslov { 235226f2ca3SVlad Buslov /* Complete all memory stores before setting bit. */ 236226f2ca3SVlad Buslov smp_mb__before_atomic(); 237226f2ca3SVlad Buslov set_bit(flag, &flow->flags); 238226f2ca3SVlad Buslov } 239226f2ca3SVlad Buslov 240226f2ca3SVlad Buslov #define flow_flag_set(flow, flag) __flow_flag_set(flow, MLX5E_TC_FLOW_FLAG_##flag) 241226f2ca3SVlad Buslov 242c5d326b2SVlad Buslov static bool __flow_flag_test_and_set(struct mlx5e_tc_flow *flow, 243c5d326b2SVlad Buslov unsigned long flag) 244c5d326b2SVlad Buslov { 245c5d326b2SVlad Buslov /* test_and_set_bit() provides all necessary barriers */ 246c5d326b2SVlad Buslov return test_and_set_bit(flag, &flow->flags); 247c5d326b2SVlad Buslov } 248c5d326b2SVlad Buslov 249c5d326b2SVlad Buslov #define flow_flag_test_and_set(flow, flag) \ 250c5d326b2SVlad Buslov __flow_flag_test_and_set(flow, \ 251c5d326b2SVlad Buslov MLX5E_TC_FLOW_FLAG_##flag) 252c5d326b2SVlad Buslov 253226f2ca3SVlad Buslov static void __flow_flag_clear(struct mlx5e_tc_flow *flow, unsigned long flag) 254226f2ca3SVlad Buslov { 255226f2ca3SVlad Buslov /* Complete all memory stores before clearing bit. */ 256226f2ca3SVlad Buslov smp_mb__before_atomic(); 257226f2ca3SVlad Buslov clear_bit(flag, &flow->flags); 258226f2ca3SVlad Buslov } 259226f2ca3SVlad Buslov 260226f2ca3SVlad Buslov #define flow_flag_clear(flow, flag) __flow_flag_clear(flow, \ 261226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_##flag) 262226f2ca3SVlad Buslov 263226f2ca3SVlad Buslov static bool __flow_flag_test(struct mlx5e_tc_flow *flow, unsigned long flag) 264226f2ca3SVlad Buslov { 265226f2ca3SVlad Buslov bool ret = test_bit(flag, &flow->flags); 266226f2ca3SVlad Buslov 267226f2ca3SVlad Buslov /* Read fields of flow structure only after checking flags. */ 268226f2ca3SVlad Buslov smp_mb__after_atomic(); 269226f2ca3SVlad Buslov return ret; 270226f2ca3SVlad Buslov } 271226f2ca3SVlad Buslov 272226f2ca3SVlad Buslov #define flow_flag_test(flow, flag) __flow_flag_test(flow, \ 273226f2ca3SVlad Buslov MLX5E_TC_FLOW_FLAG_##flag) 274226f2ca3SVlad Buslov 275226f2ca3SVlad Buslov static bool mlx5e_is_eswitch_flow(struct mlx5e_tc_flow *flow) 276226f2ca3SVlad Buslov { 277226f2ca3SVlad Buslov return flow_flag_test(flow, ESWITCH); 278226f2ca3SVlad Buslov } 279226f2ca3SVlad Buslov 28084179981SPaul Blakey static bool mlx5e_is_ft_flow(struct mlx5e_tc_flow *flow) 28184179981SPaul Blakey { 28284179981SPaul Blakey return flow_flag_test(flow, FT); 28384179981SPaul Blakey } 28484179981SPaul Blakey 285226f2ca3SVlad Buslov static bool mlx5e_is_offloaded_flow(struct mlx5e_tc_flow *flow) 286226f2ca3SVlad Buslov { 287226f2ca3SVlad Buslov return flow_flag_test(flow, OFFLOADED); 288226f2ca3SVlad Buslov } 289226f2ca3SVlad Buslov 29011c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key) 29111c9c548SOr Gerlitz { 29211c9c548SOr Gerlitz return jhash(key->actions, 29311c9c548SOr Gerlitz key->num_actions * MLX5_MH_ACT_SZ, 0); 29411c9c548SOr Gerlitz } 29511c9c548SOr Gerlitz 29611c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a, 29711c9c548SOr Gerlitz struct mod_hdr_key *b) 29811c9c548SOr Gerlitz { 29911c9c548SOr Gerlitz if (a->num_actions != b->num_actions) 30011c9c548SOr Gerlitz return 1; 30111c9c548SOr Gerlitz 30211c9c548SOr Gerlitz return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ); 30311c9c548SOr Gerlitz } 30411c9c548SOr Gerlitz 305dd58edc3SVlad Buslov static struct mod_hdr_tbl * 306dd58edc3SVlad Buslov get_mod_hdr_table(struct mlx5e_priv *priv, int namespace) 307dd58edc3SVlad Buslov { 308dd58edc3SVlad Buslov struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 309dd58edc3SVlad Buslov 310dd58edc3SVlad Buslov return namespace == MLX5_FLOW_NAMESPACE_FDB ? &esw->offloads.mod_hdr : 311dd58edc3SVlad Buslov &priv->fs.tc.mod_hdr; 312dd58edc3SVlad Buslov } 313dd58edc3SVlad Buslov 314dd58edc3SVlad Buslov static struct mlx5e_mod_hdr_entry * 315dd58edc3SVlad Buslov mlx5e_mod_hdr_get(struct mod_hdr_tbl *tbl, struct mod_hdr_key *key, u32 hash_key) 316dd58edc3SVlad Buslov { 317dd58edc3SVlad Buslov struct mlx5e_mod_hdr_entry *mh, *found = NULL; 318dd58edc3SVlad Buslov 319dd58edc3SVlad Buslov hash_for_each_possible(tbl->hlist, mh, mod_hdr_hlist, hash_key) { 320dd58edc3SVlad Buslov if (!cmp_mod_hdr_info(&mh->key, key)) { 321dd58edc3SVlad Buslov refcount_inc(&mh->refcnt); 322dd58edc3SVlad Buslov found = mh; 323dd58edc3SVlad Buslov break; 324dd58edc3SVlad Buslov } 325dd58edc3SVlad Buslov } 326dd58edc3SVlad Buslov 327dd58edc3SVlad Buslov return found; 328dd58edc3SVlad Buslov } 329dd58edc3SVlad Buslov 330dd58edc3SVlad Buslov static void mlx5e_mod_hdr_put(struct mlx5e_priv *priv, 331d2faae25SVlad Buslov struct mlx5e_mod_hdr_entry *mh, 332d2faae25SVlad Buslov int namespace) 333dd58edc3SVlad Buslov { 334d2faae25SVlad Buslov struct mod_hdr_tbl *tbl = get_mod_hdr_table(priv, namespace); 335d2faae25SVlad Buslov 336d2faae25SVlad Buslov if (!refcount_dec_and_mutex_lock(&mh->refcnt, &tbl->lock)) 337dd58edc3SVlad Buslov return; 338d2faae25SVlad Buslov hash_del(&mh->mod_hdr_hlist); 339d2faae25SVlad Buslov mutex_unlock(&tbl->lock); 340dd58edc3SVlad Buslov 341dd58edc3SVlad Buslov WARN_ON(!list_empty(&mh->flows)); 342a734d007SVlad Buslov if (mh->compl_result > 0) 3432b688ea5SMaor Gottlieb mlx5_modify_header_dealloc(priv->mdev, mh->modify_hdr); 344d2faae25SVlad Buslov 345dd58edc3SVlad Buslov kfree(mh); 346dd58edc3SVlad Buslov } 347dd58edc3SVlad Buslov 348d2faae25SVlad Buslov static int get_flow_name_space(struct mlx5e_tc_flow *flow) 349d2faae25SVlad Buslov { 350d2faae25SVlad Buslov return mlx5e_is_eswitch_flow(flow) ? 351d2faae25SVlad Buslov MLX5_FLOW_NAMESPACE_FDB : MLX5_FLOW_NAMESPACE_KERNEL; 352d2faae25SVlad Buslov } 35311c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv, 35411c9c548SOr Gerlitz struct mlx5e_tc_flow *flow, 35511c9c548SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 35611c9c548SOr Gerlitz { 35711c9c548SOr Gerlitz int num_actions, actions_size, namespace, err; 35811c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 359dd58edc3SVlad Buslov struct mod_hdr_tbl *tbl; 36011c9c548SOr Gerlitz struct mod_hdr_key key; 36111c9c548SOr Gerlitz u32 hash_key; 36211c9c548SOr Gerlitz 36311c9c548SOr Gerlitz num_actions = parse_attr->num_mod_hdr_actions; 36411c9c548SOr Gerlitz actions_size = MLX5_MH_ACT_SZ * num_actions; 36511c9c548SOr Gerlitz 36611c9c548SOr Gerlitz key.actions = parse_attr->mod_hdr_actions; 36711c9c548SOr Gerlitz key.num_actions = num_actions; 36811c9c548SOr Gerlitz 36911c9c548SOr Gerlitz hash_key = hash_mod_hdr_info(&key); 37011c9c548SOr Gerlitz 371d2faae25SVlad Buslov namespace = get_flow_name_space(flow); 372dd58edc3SVlad Buslov tbl = get_mod_hdr_table(priv, namespace); 37311c9c548SOr Gerlitz 374d2faae25SVlad Buslov mutex_lock(&tbl->lock); 375dd58edc3SVlad Buslov mh = mlx5e_mod_hdr_get(tbl, &key, hash_key); 376a734d007SVlad Buslov if (mh) { 377a734d007SVlad Buslov mutex_unlock(&tbl->lock); 378a734d007SVlad Buslov wait_for_completion(&mh->res_ready); 379a734d007SVlad Buslov 380a734d007SVlad Buslov if (mh->compl_result < 0) { 381a734d007SVlad Buslov err = -EREMOTEIO; 382a734d007SVlad Buslov goto attach_header_err; 383a734d007SVlad Buslov } 38411c9c548SOr Gerlitz goto attach_flow; 385a734d007SVlad Buslov } 38611c9c548SOr Gerlitz 38711c9c548SOr Gerlitz mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL); 388d2faae25SVlad Buslov if (!mh) { 389a734d007SVlad Buslov mutex_unlock(&tbl->lock); 390a734d007SVlad Buslov return -ENOMEM; 391d2faae25SVlad Buslov } 39211c9c548SOr Gerlitz 39311c9c548SOr Gerlitz mh->key.actions = (void *)mh + sizeof(*mh); 39411c9c548SOr Gerlitz memcpy(mh->key.actions, key.actions, actions_size); 39511c9c548SOr Gerlitz mh->key.num_actions = num_actions; 39683a52f0dSVlad Buslov spin_lock_init(&mh->flows_lock); 39711c9c548SOr Gerlitz INIT_LIST_HEAD(&mh->flows); 398dd58edc3SVlad Buslov refcount_set(&mh->refcnt, 1); 399a734d007SVlad Buslov init_completion(&mh->res_ready); 400a734d007SVlad Buslov 401a734d007SVlad Buslov hash_add(tbl->hlist, &mh->mod_hdr_hlist, hash_key); 402a734d007SVlad Buslov mutex_unlock(&tbl->lock); 40311c9c548SOr Gerlitz 4042b688ea5SMaor Gottlieb mh->modify_hdr = mlx5_modify_header_alloc(priv->mdev, namespace, 40511c9c548SOr Gerlitz mh->key.num_actions, 4062b688ea5SMaor Gottlieb mh->key.actions); 4072b688ea5SMaor Gottlieb if (IS_ERR(mh->modify_hdr)) { 4082b688ea5SMaor Gottlieb err = PTR_ERR(mh->modify_hdr); 409a734d007SVlad Buslov mh->compl_result = err; 410a734d007SVlad Buslov goto alloc_header_err; 411a734d007SVlad Buslov } 412a734d007SVlad Buslov mh->compl_result = 1; 413a734d007SVlad Buslov complete_all(&mh->res_ready); 41411c9c548SOr Gerlitz 41511c9c548SOr Gerlitz attach_flow: 416dd58edc3SVlad Buslov flow->mh = mh; 41783a52f0dSVlad Buslov spin_lock(&mh->flows_lock); 41811c9c548SOr Gerlitz list_add(&flow->mod_hdr, &mh->flows); 41983a52f0dSVlad Buslov spin_unlock(&mh->flows_lock); 420d2faae25SVlad Buslov if (mlx5e_is_eswitch_flow(flow)) 4212b688ea5SMaor Gottlieb flow->esw_attr->modify_hdr = mh->modify_hdr; 42211c9c548SOr Gerlitz else 4232b688ea5SMaor Gottlieb flow->nic_attr->modify_hdr = mh->modify_hdr; 42411c9c548SOr Gerlitz 42511c9c548SOr Gerlitz return 0; 42611c9c548SOr Gerlitz 427a734d007SVlad Buslov alloc_header_err: 428a734d007SVlad Buslov complete_all(&mh->res_ready); 429a734d007SVlad Buslov attach_header_err: 430a734d007SVlad Buslov mlx5e_mod_hdr_put(priv, mh, namespace); 43111c9c548SOr Gerlitz return err; 43211c9c548SOr Gerlitz } 43311c9c548SOr Gerlitz 43411c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv, 43511c9c548SOr Gerlitz struct mlx5e_tc_flow *flow) 43611c9c548SOr Gerlitz { 4375a7e5bcbSVlad Buslov /* flow wasn't fully initialized */ 438dd58edc3SVlad Buslov if (!flow->mh) 4395a7e5bcbSVlad Buslov return; 4405a7e5bcbSVlad Buslov 44183a52f0dSVlad Buslov spin_lock(&flow->mh->flows_lock); 44211c9c548SOr Gerlitz list_del(&flow->mod_hdr); 44383a52f0dSVlad Buslov spin_unlock(&flow->mh->flows_lock); 44411c9c548SOr Gerlitz 445d2faae25SVlad Buslov mlx5e_mod_hdr_put(priv, flow->mh, get_flow_name_space(flow)); 446dd58edc3SVlad Buslov flow->mh = NULL; 44711c9c548SOr Gerlitz } 44811c9c548SOr Gerlitz 44977ab67b7SOr Gerlitz static 45077ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex) 45177ab67b7SOr Gerlitz { 45277ab67b7SOr Gerlitz struct net_device *netdev; 45377ab67b7SOr Gerlitz struct mlx5e_priv *priv; 45477ab67b7SOr Gerlitz 45577ab67b7SOr Gerlitz netdev = __dev_get_by_index(net, ifindex); 45677ab67b7SOr Gerlitz priv = netdev_priv(netdev); 45777ab67b7SOr Gerlitz return priv->mdev; 45877ab67b7SOr Gerlitz } 45977ab67b7SOr Gerlitz 46077ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp) 46177ab67b7SOr Gerlitz { 46277ab67b7SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0}; 46377ab67b7SOr Gerlitz void *tirc; 46477ab67b7SOr Gerlitz int err; 46577ab67b7SOr Gerlitz 46677ab67b7SOr Gerlitz err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn); 46777ab67b7SOr Gerlitz if (err) 46877ab67b7SOr Gerlitz goto alloc_tdn_err; 46977ab67b7SOr Gerlitz 47077ab67b7SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 47177ab67b7SOr Gerlitz 47277ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT); 473ddae74acSOr Gerlitz MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]); 47477ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 47577ab67b7SOr Gerlitz 47677ab67b7SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn); 47777ab67b7SOr Gerlitz if (err) 47877ab67b7SOr Gerlitz goto create_tir_err; 47977ab67b7SOr Gerlitz 48077ab67b7SOr Gerlitz return 0; 48177ab67b7SOr Gerlitz 48277ab67b7SOr Gerlitz create_tir_err: 48377ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 48477ab67b7SOr Gerlitz alloc_tdn_err: 48577ab67b7SOr Gerlitz return err; 48677ab67b7SOr Gerlitz } 48777ab67b7SOr Gerlitz 48877ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp) 48977ab67b7SOr Gerlitz { 49077ab67b7SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->tirn); 49177ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 49277ab67b7SOr Gerlitz } 49377ab67b7SOr Gerlitz 4943f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc) 4953f6d08d1SOr Gerlitz { 4963f6d08d1SOr Gerlitz u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn; 4973f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4983f6d08d1SOr Gerlitz int i, ix, sz = MLX5E_INDIR_RQT_SIZE; 4993f6d08d1SOr Gerlitz 5003f6d08d1SOr Gerlitz mlx5e_build_default_indir_rqt(indirection_rqt, sz, 5013f6d08d1SOr Gerlitz hp->num_channels); 5023f6d08d1SOr Gerlitz 5033f6d08d1SOr Gerlitz for (i = 0; i < sz; i++) { 5043f6d08d1SOr Gerlitz ix = i; 505bbeb53b8SAya Levin if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR) 5063f6d08d1SOr Gerlitz ix = mlx5e_bits_invert(i, ilog2(sz)); 5073f6d08d1SOr Gerlitz ix = indirection_rqt[ix]; 5083f6d08d1SOr Gerlitz rqn = hp->pair->rqn[ix]; 5093f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rq_num[i], rqn); 5103f6d08d1SOr Gerlitz } 5113f6d08d1SOr Gerlitz } 5123f6d08d1SOr Gerlitz 5133f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp) 5143f6d08d1SOr Gerlitz { 5153f6d08d1SOr Gerlitz int inlen, err, sz = MLX5E_INDIR_RQT_SIZE; 5163f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 5173f6d08d1SOr Gerlitz struct mlx5_core_dev *mdev = priv->mdev; 5183f6d08d1SOr Gerlitz void *rqtc; 5193f6d08d1SOr Gerlitz u32 *in; 5203f6d08d1SOr Gerlitz 5213f6d08d1SOr Gerlitz inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz; 5223f6d08d1SOr Gerlitz in = kvzalloc(inlen, GFP_KERNEL); 5233f6d08d1SOr Gerlitz if (!in) 5243f6d08d1SOr Gerlitz return -ENOMEM; 5253f6d08d1SOr Gerlitz 5263f6d08d1SOr Gerlitz rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context); 5273f6d08d1SOr Gerlitz 5283f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_actual_size, sz); 5293f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_max_size, sz); 5303f6d08d1SOr Gerlitz 5313f6d08d1SOr Gerlitz mlx5e_hairpin_fill_rqt_rqns(hp, rqtc); 5323f6d08d1SOr Gerlitz 5333f6d08d1SOr Gerlitz err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn); 5343f6d08d1SOr Gerlitz if (!err) 5353f6d08d1SOr Gerlitz hp->indir_rqt.enabled = true; 5363f6d08d1SOr Gerlitz 5373f6d08d1SOr Gerlitz kvfree(in); 5383f6d08d1SOr Gerlitz return err; 5393f6d08d1SOr Gerlitz } 5403f6d08d1SOr Gerlitz 5413f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp) 5423f6d08d1SOr Gerlitz { 5433f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 5443f6d08d1SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)]; 5453f6d08d1SOr Gerlitz int tt, i, err; 5463f6d08d1SOr Gerlitz void *tirc; 5473f6d08d1SOr Gerlitz 5483f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) { 549d930ac79SAya Levin struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt); 550d930ac79SAya Levin 5513f6d08d1SOr Gerlitz memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in)); 5523f6d08d1SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 5533f6d08d1SOr Gerlitz 5543f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 5553f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT); 5563f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn); 557bbeb53b8SAya Levin mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false); 558bbeb53b8SAya Levin 5593f6d08d1SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, 5603f6d08d1SOr Gerlitz MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]); 5613f6d08d1SOr Gerlitz if (err) { 5623f6d08d1SOr Gerlitz mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err); 5633f6d08d1SOr Gerlitz goto err_destroy_tirs; 5643f6d08d1SOr Gerlitz } 5653f6d08d1SOr Gerlitz } 5663f6d08d1SOr Gerlitz return 0; 5673f6d08d1SOr Gerlitz 5683f6d08d1SOr Gerlitz err_destroy_tirs: 5693f6d08d1SOr Gerlitz for (i = 0; i < tt; i++) 5703f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]); 5713f6d08d1SOr Gerlitz return err; 5723f6d08d1SOr Gerlitz } 5733f6d08d1SOr Gerlitz 5743f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp) 5753f6d08d1SOr Gerlitz { 5763f6d08d1SOr Gerlitz int tt; 5773f6d08d1SOr Gerlitz 5783f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 5793f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]); 5803f6d08d1SOr Gerlitz } 5813f6d08d1SOr Gerlitz 5823f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp, 5833f6d08d1SOr Gerlitz struct ttc_params *ttc_params) 5843f6d08d1SOr Gerlitz { 5853f6d08d1SOr Gerlitz struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr; 5863f6d08d1SOr Gerlitz int tt; 5873f6d08d1SOr Gerlitz 5883f6d08d1SOr Gerlitz memset(ttc_params, 0, sizeof(*ttc_params)); 5893f6d08d1SOr Gerlitz 5903f6d08d1SOr Gerlitz ttc_params->any_tt_tirn = hp->tirn; 5913f6d08d1SOr Gerlitz 5923f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 5933f6d08d1SOr Gerlitz ttc_params->indir_tirn[tt] = hp->indir_tirn[tt]; 5943f6d08d1SOr Gerlitz 5953f6d08d1SOr Gerlitz ft_attr->max_fte = MLX5E_NUM_TT; 5963f6d08d1SOr Gerlitz ft_attr->level = MLX5E_TC_TTC_FT_LEVEL; 5973f6d08d1SOr Gerlitz ft_attr->prio = MLX5E_TC_PRIO; 5983f6d08d1SOr Gerlitz } 5993f6d08d1SOr Gerlitz 6003f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp) 6013f6d08d1SOr Gerlitz { 6023f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 6033f6d08d1SOr Gerlitz struct ttc_params ttc_params; 6043f6d08d1SOr Gerlitz int err; 6053f6d08d1SOr Gerlitz 6063f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_rqt(hp); 6073f6d08d1SOr Gerlitz if (err) 6083f6d08d1SOr Gerlitz return err; 6093f6d08d1SOr Gerlitz 6103f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_tirs(hp); 6113f6d08d1SOr Gerlitz if (err) 6123f6d08d1SOr Gerlitz goto err_create_indirect_tirs; 6133f6d08d1SOr Gerlitz 6143f6d08d1SOr Gerlitz mlx5e_hairpin_set_ttc_params(hp, &ttc_params); 6153f6d08d1SOr Gerlitz err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc); 6163f6d08d1SOr Gerlitz if (err) 6173f6d08d1SOr Gerlitz goto err_create_ttc_table; 6183f6d08d1SOr Gerlitz 6193f6d08d1SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n", 6203f6d08d1SOr Gerlitz hp->num_channels, hp->ttc.ft.t->id); 6213f6d08d1SOr Gerlitz 6223f6d08d1SOr Gerlitz return 0; 6233f6d08d1SOr Gerlitz 6243f6d08d1SOr Gerlitz err_create_ttc_table: 6253f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 6263f6d08d1SOr Gerlitz err_create_indirect_tirs: 6273f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 6283f6d08d1SOr Gerlitz 6293f6d08d1SOr Gerlitz return err; 6303f6d08d1SOr Gerlitz } 6313f6d08d1SOr Gerlitz 6323f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp) 6333f6d08d1SOr Gerlitz { 6343f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 6353f6d08d1SOr Gerlitz 6363f6d08d1SOr Gerlitz mlx5e_destroy_ttc_table(priv, &hp->ttc); 6373f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 6383f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 6393f6d08d1SOr Gerlitz } 6403f6d08d1SOr Gerlitz 64177ab67b7SOr Gerlitz static struct mlx5e_hairpin * 64277ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params, 64377ab67b7SOr Gerlitz int peer_ifindex) 64477ab67b7SOr Gerlitz { 64577ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev, *peer_mdev; 64677ab67b7SOr Gerlitz struct mlx5e_hairpin *hp; 64777ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 64877ab67b7SOr Gerlitz int err; 64977ab67b7SOr Gerlitz 65077ab67b7SOr Gerlitz hp = kzalloc(sizeof(*hp), GFP_KERNEL); 65177ab67b7SOr Gerlitz if (!hp) 65277ab67b7SOr Gerlitz return ERR_PTR(-ENOMEM); 65377ab67b7SOr Gerlitz 65477ab67b7SOr Gerlitz func_mdev = priv->mdev; 65577ab67b7SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 65677ab67b7SOr Gerlitz 65777ab67b7SOr Gerlitz pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params); 65877ab67b7SOr Gerlitz if (IS_ERR(pair)) { 65977ab67b7SOr Gerlitz err = PTR_ERR(pair); 66077ab67b7SOr Gerlitz goto create_pair_err; 66177ab67b7SOr Gerlitz } 66277ab67b7SOr Gerlitz hp->pair = pair; 66377ab67b7SOr Gerlitz hp->func_mdev = func_mdev; 6643f6d08d1SOr Gerlitz hp->func_priv = priv; 6653f6d08d1SOr Gerlitz hp->num_channels = params->num_channels; 66677ab67b7SOr Gerlitz 66777ab67b7SOr Gerlitz err = mlx5e_hairpin_create_transport(hp); 66877ab67b7SOr Gerlitz if (err) 66977ab67b7SOr Gerlitz goto create_transport_err; 67077ab67b7SOr Gerlitz 6713f6d08d1SOr Gerlitz if (hp->num_channels > 1) { 6723f6d08d1SOr Gerlitz err = mlx5e_hairpin_rss_init(hp); 6733f6d08d1SOr Gerlitz if (err) 6743f6d08d1SOr Gerlitz goto rss_init_err; 6753f6d08d1SOr Gerlitz } 6763f6d08d1SOr Gerlitz 67777ab67b7SOr Gerlitz return hp; 67877ab67b7SOr Gerlitz 6793f6d08d1SOr Gerlitz rss_init_err: 6803f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 68177ab67b7SOr Gerlitz create_transport_err: 68277ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 68377ab67b7SOr Gerlitz create_pair_err: 68477ab67b7SOr Gerlitz kfree(hp); 68577ab67b7SOr Gerlitz return ERR_PTR(err); 68677ab67b7SOr Gerlitz } 68777ab67b7SOr Gerlitz 68877ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp) 68977ab67b7SOr Gerlitz { 6903f6d08d1SOr Gerlitz if (hp->num_channels > 1) 6913f6d08d1SOr Gerlitz mlx5e_hairpin_rss_cleanup(hp); 69277ab67b7SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 69377ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 69477ab67b7SOr Gerlitz kvfree(hp); 69577ab67b7SOr Gerlitz } 69677ab67b7SOr Gerlitz 697106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio) 698106be53bSOr Gerlitz { 699106be53bSOr Gerlitz return (peer_vhca_id << 16 | prio); 700106be53bSOr Gerlitz } 701106be53bSOr Gerlitz 7025c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv, 703106be53bSOr Gerlitz u16 peer_vhca_id, u8 prio) 7045c65c564SOr Gerlitz { 7055c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 706106be53bSOr Gerlitz u32 hash_key = hash_hairpin_info(peer_vhca_id, prio); 7075c65c564SOr Gerlitz 7085c65c564SOr Gerlitz hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe, 709106be53bSOr Gerlitz hairpin_hlist, hash_key) { 710e4f9abbdSVlad Buslov if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio) { 711e4f9abbdSVlad Buslov refcount_inc(&hpe->refcnt); 7125c65c564SOr Gerlitz return hpe; 7135c65c564SOr Gerlitz } 714e4f9abbdSVlad Buslov } 7155c65c564SOr Gerlitz 7165c65c564SOr Gerlitz return NULL; 7175c65c564SOr Gerlitz } 7185c65c564SOr Gerlitz 719e4f9abbdSVlad Buslov static void mlx5e_hairpin_put(struct mlx5e_priv *priv, 720e4f9abbdSVlad Buslov struct mlx5e_hairpin_entry *hpe) 721e4f9abbdSVlad Buslov { 722e4f9abbdSVlad Buslov /* no more hairpin flows for us, release the hairpin pair */ 723b32accdaSVlad Buslov if (!refcount_dec_and_mutex_lock(&hpe->refcnt, &priv->fs.tc.hairpin_tbl_lock)) 724e4f9abbdSVlad Buslov return; 725b32accdaSVlad Buslov hash_del(&hpe->hairpin_hlist); 726b32accdaSVlad Buslov mutex_unlock(&priv->fs.tc.hairpin_tbl_lock); 727e4f9abbdSVlad Buslov 728db76ca24SVlad Buslov if (!IS_ERR_OR_NULL(hpe->hp)) { 729e4f9abbdSVlad Buslov netdev_dbg(priv->netdev, "del hairpin: peer %s\n", 730e4f9abbdSVlad Buslov dev_name(hpe->hp->pair->peer_mdev->device)); 731e4f9abbdSVlad Buslov 732e4f9abbdSVlad Buslov mlx5e_hairpin_destroy(hpe->hp); 733db76ca24SVlad Buslov } 734db76ca24SVlad Buslov 735db76ca24SVlad Buslov WARN_ON(!list_empty(&hpe->flows)); 736e4f9abbdSVlad Buslov kfree(hpe); 737e4f9abbdSVlad Buslov } 738e4f9abbdSVlad Buslov 739106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8 740106be53bSOr Gerlitz 741106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv, 742e98bedf5SEli Britstein struct mlx5_flow_spec *spec, u8 *match_prio, 743e98bedf5SEli Britstein struct netlink_ext_ack *extack) 744106be53bSOr Gerlitz { 745106be53bSOr Gerlitz void *headers_c, *headers_v; 746106be53bSOr Gerlitz u8 prio_val, prio_mask = 0; 747106be53bSOr Gerlitz bool vlan_present; 748106be53bSOr Gerlitz 749106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB 750106be53bSOr Gerlitz if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) { 751e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 752e98bedf5SEli Britstein "only PCP trust state supported for hairpin"); 753106be53bSOr Gerlitz return -EOPNOTSUPP; 754106be53bSOr Gerlitz } 755106be53bSOr Gerlitz #endif 756106be53bSOr Gerlitz headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers); 757106be53bSOr Gerlitz headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers); 758106be53bSOr Gerlitz 759106be53bSOr Gerlitz vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag); 760106be53bSOr Gerlitz if (vlan_present) { 761106be53bSOr Gerlitz prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 762106be53bSOr Gerlitz prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 763106be53bSOr Gerlitz } 764106be53bSOr Gerlitz 765106be53bSOr Gerlitz if (!vlan_present || !prio_mask) { 766106be53bSOr Gerlitz prio_val = UNKNOWN_MATCH_PRIO; 767106be53bSOr Gerlitz } else if (prio_mask != 0x7) { 768e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 769e98bedf5SEli Britstein "masked priority match not supported for hairpin"); 770106be53bSOr Gerlitz return -EOPNOTSUPP; 771106be53bSOr Gerlitz } 772106be53bSOr Gerlitz 773106be53bSOr Gerlitz *match_prio = prio_val; 774106be53bSOr Gerlitz return 0; 775106be53bSOr Gerlitz } 776106be53bSOr Gerlitz 7775c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv, 7785c65c564SOr Gerlitz struct mlx5e_tc_flow *flow, 779e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 780e98bedf5SEli Britstein struct netlink_ext_ack *extack) 7815c65c564SOr Gerlitz { 78298b66cb1SEli Britstein int peer_ifindex = parse_attr->mirred_ifindex[0]; 7835c65c564SOr Gerlitz struct mlx5_hairpin_params params; 784d8822868SOr Gerlitz struct mlx5_core_dev *peer_mdev; 7855c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 7865c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 7873f6d08d1SOr Gerlitz u64 link_speed64; 7883f6d08d1SOr Gerlitz u32 link_speed; 789106be53bSOr Gerlitz u8 match_prio; 790d8822868SOr Gerlitz u16 peer_id; 7915c65c564SOr Gerlitz int err; 7925c65c564SOr Gerlitz 793d8822868SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 794d8822868SOr Gerlitz if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) { 795e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported"); 7965c65c564SOr Gerlitz return -EOPNOTSUPP; 7975c65c564SOr Gerlitz } 7985c65c564SOr Gerlitz 799d8822868SOr Gerlitz peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 800e98bedf5SEli Britstein err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio, 801e98bedf5SEli Britstein extack); 802106be53bSOr Gerlitz if (err) 803106be53bSOr Gerlitz return err; 804b32accdaSVlad Buslov 805b32accdaSVlad Buslov mutex_lock(&priv->fs.tc.hairpin_tbl_lock); 806106be53bSOr Gerlitz hpe = mlx5e_hairpin_get(priv, peer_id, match_prio); 807db76ca24SVlad Buslov if (hpe) { 808db76ca24SVlad Buslov mutex_unlock(&priv->fs.tc.hairpin_tbl_lock); 809db76ca24SVlad Buslov wait_for_completion(&hpe->res_ready); 810db76ca24SVlad Buslov 811db76ca24SVlad Buslov if (IS_ERR(hpe->hp)) { 812db76ca24SVlad Buslov err = -EREMOTEIO; 813db76ca24SVlad Buslov goto out_err; 814db76ca24SVlad Buslov } 8155c65c564SOr Gerlitz goto attach_flow; 816db76ca24SVlad Buslov } 8175c65c564SOr Gerlitz 8185c65c564SOr Gerlitz hpe = kzalloc(sizeof(*hpe), GFP_KERNEL); 819b32accdaSVlad Buslov if (!hpe) { 820db76ca24SVlad Buslov mutex_unlock(&priv->fs.tc.hairpin_tbl_lock); 821db76ca24SVlad Buslov return -ENOMEM; 822b32accdaSVlad Buslov } 8235c65c564SOr Gerlitz 82473edca73SVlad Buslov spin_lock_init(&hpe->flows_lock); 8255c65c564SOr Gerlitz INIT_LIST_HEAD(&hpe->flows); 826db76ca24SVlad Buslov INIT_LIST_HEAD(&hpe->dead_peer_wait_list); 827d8822868SOr Gerlitz hpe->peer_vhca_id = peer_id; 828106be53bSOr Gerlitz hpe->prio = match_prio; 829e4f9abbdSVlad Buslov refcount_set(&hpe->refcnt, 1); 830db76ca24SVlad Buslov init_completion(&hpe->res_ready); 831db76ca24SVlad Buslov 832db76ca24SVlad Buslov hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist, 833db76ca24SVlad Buslov hash_hairpin_info(peer_id, match_prio)); 834db76ca24SVlad Buslov mutex_unlock(&priv->fs.tc.hairpin_tbl_lock); 8355c65c564SOr Gerlitz 8365c65c564SOr Gerlitz params.log_data_size = 15; 8375c65c564SOr Gerlitz params.log_data_size = min_t(u8, params.log_data_size, 8385c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz)); 8395c65c564SOr Gerlitz params.log_data_size = max_t(u8, params.log_data_size, 8405c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz)); 8415c65c564SOr Gerlitz 842eb9180f7SOr Gerlitz params.log_num_packets = params.log_data_size - 843eb9180f7SOr Gerlitz MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev); 844eb9180f7SOr Gerlitz params.log_num_packets = min_t(u8, params.log_num_packets, 845eb9180f7SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets)); 846eb9180f7SOr Gerlitz 847eb9180f7SOr Gerlitz params.q_counter = priv->q_counter; 8483f6d08d1SOr Gerlitz /* set hairpin pair per each 50Gbs share of the link */ 8492c81bfd5SHuy Nguyen mlx5e_port_max_linkspeed(priv->mdev, &link_speed); 8503f6d08d1SOr Gerlitz link_speed = max_t(u32, link_speed, 50000); 8513f6d08d1SOr Gerlitz link_speed64 = link_speed; 8523f6d08d1SOr Gerlitz do_div(link_speed64, 50000); 8533f6d08d1SOr Gerlitz params.num_channels = link_speed64; 8543f6d08d1SOr Gerlitz 8555c65c564SOr Gerlitz hp = mlx5e_hairpin_create(priv, ¶ms, peer_ifindex); 856db76ca24SVlad Buslov hpe->hp = hp; 857db76ca24SVlad Buslov complete_all(&hpe->res_ready); 8585c65c564SOr Gerlitz if (IS_ERR(hp)) { 8595c65c564SOr Gerlitz err = PTR_ERR(hp); 860db76ca24SVlad Buslov goto out_err; 8615c65c564SOr Gerlitz } 8625c65c564SOr Gerlitz 863eb9180f7SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n", 86427b942fbSParav Pandit hp->tirn, hp->pair->rqn[0], 86527b942fbSParav Pandit dev_name(hp->pair->peer_mdev->device), 866eb9180f7SOr Gerlitz hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets); 8675c65c564SOr Gerlitz 8685c65c564SOr Gerlitz attach_flow: 8693f6d08d1SOr Gerlitz if (hpe->hp->num_channels > 1) { 870226f2ca3SVlad Buslov flow_flag_set(flow, HAIRPIN_RSS); 8713f6d08d1SOr Gerlitz flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t; 8723f6d08d1SOr Gerlitz } else { 8735c65c564SOr Gerlitz flow->nic_attr->hairpin_tirn = hpe->hp->tirn; 8743f6d08d1SOr Gerlitz } 875b32accdaSVlad Buslov 876e4f9abbdSVlad Buslov flow->hpe = hpe; 87773edca73SVlad Buslov spin_lock(&hpe->flows_lock); 8785c65c564SOr Gerlitz list_add(&flow->hairpin, &hpe->flows); 87973edca73SVlad Buslov spin_unlock(&hpe->flows_lock); 8803f6d08d1SOr Gerlitz 8815c65c564SOr Gerlitz return 0; 8825c65c564SOr Gerlitz 883db76ca24SVlad Buslov out_err: 884db76ca24SVlad Buslov mlx5e_hairpin_put(priv, hpe); 8855c65c564SOr Gerlitz return err; 8865c65c564SOr Gerlitz } 8875c65c564SOr Gerlitz 8885c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv, 8895c65c564SOr Gerlitz struct mlx5e_tc_flow *flow) 8905c65c564SOr Gerlitz { 8915a7e5bcbSVlad Buslov /* flow wasn't fully initialized */ 892e4f9abbdSVlad Buslov if (!flow->hpe) 8935a7e5bcbSVlad Buslov return; 8945a7e5bcbSVlad Buslov 89573edca73SVlad Buslov spin_lock(&flow->hpe->flows_lock); 8965c65c564SOr Gerlitz list_del(&flow->hairpin); 89773edca73SVlad Buslov spin_unlock(&flow->hpe->flows_lock); 89873edca73SVlad Buslov 899e4f9abbdSVlad Buslov mlx5e_hairpin_put(priv, flow->hpe); 900e4f9abbdSVlad Buslov flow->hpe = NULL; 9015c65c564SOr Gerlitz } 9025c65c564SOr Gerlitz 903c83954abSRabie Loulou static int 90474491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv, 90517091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 906e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 907e98bedf5SEli Britstein struct netlink_ext_ack *extack) 908e8f887acSAmir Vadai { 909bb0ee7dcSJianbo Liu struct mlx5_flow_context *flow_context = &parse_attr->spec.flow_context; 910aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 911aad7e08dSAmir Vadai struct mlx5_core_dev *dev = priv->mdev; 9125c65c564SOr Gerlitz struct mlx5_flow_destination dest[2] = {}; 91366958ed9SHadar Hen Zion struct mlx5_flow_act flow_act = { 9143bc4b7bfSOr Gerlitz .action = attr->action, 915bb0ee7dcSJianbo Liu .flags = FLOW_ACT_NO_APPEND, 91666958ed9SHadar Hen Zion }; 917aad7e08dSAmir Vadai struct mlx5_fc *counter = NULL; 9185c65c564SOr Gerlitz int err, dest_ix = 0; 919e8f887acSAmir Vadai 920bb0ee7dcSJianbo Liu flow_context->flags |= FLOW_CONTEXT_HAS_TAG; 921bb0ee7dcSJianbo Liu flow_context->flow_tag = attr->flow_tag; 922bb0ee7dcSJianbo Liu 923226f2ca3SVlad Buslov if (flow_flag_test(flow, HAIRPIN)) { 924e98bedf5SEli Britstein err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack); 9255a7e5bcbSVlad Buslov if (err) 9265a7e5bcbSVlad Buslov return err; 9275a7e5bcbSVlad Buslov 928226f2ca3SVlad Buslov if (flow_flag_test(flow, HAIRPIN_RSS)) { 9293f6d08d1SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 9303f6d08d1SOr Gerlitz dest[dest_ix].ft = attr->hairpin_ft; 9313f6d08d1SOr Gerlitz } else { 9325c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR; 9335c65c564SOr Gerlitz dest[dest_ix].tir_num = attr->hairpin_tirn; 9343f6d08d1SOr Gerlitz } 9353f6d08d1SOr Gerlitz dest_ix++; 9363f6d08d1SOr Gerlitz } else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 9375c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 9385c65c564SOr Gerlitz dest[dest_ix].ft = priv->fs.vlan.ft.t; 9395c65c564SOr Gerlitz dest_ix++; 9405c65c564SOr Gerlitz } 941aad7e08dSAmir Vadai 9425c65c564SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 9435c65c564SOr Gerlitz counter = mlx5_fc_create(dev, true); 9445a7e5bcbSVlad Buslov if (IS_ERR(counter)) 9455a7e5bcbSVlad Buslov return PTR_ERR(counter); 9465a7e5bcbSVlad Buslov 9475c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER; 948171c7625SMark Bloch dest[dest_ix].counter_id = mlx5_fc_id(counter); 9495c65c564SOr Gerlitz dest_ix++; 950b8aee822SMark Bloch attr->counter = counter; 951aad7e08dSAmir Vadai } 952aad7e08dSAmir Vadai 9532f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 9543099eb5aSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 9552b688ea5SMaor Gottlieb flow_act.modify_hdr = attr->modify_hdr; 9562f4fe4caSOr Gerlitz kfree(parse_attr->mod_hdr_actions); 957c83954abSRabie Loulou if (err) 9585a7e5bcbSVlad Buslov return err; 9592f4fe4caSOr Gerlitz } 9602f4fe4caSOr Gerlitz 961b6fac0b4SVlad Buslov mutex_lock(&priv->fs.tc.t_lock); 962acff797cSMaor Gottlieb if (IS_ERR_OR_NULL(priv->fs.tc.t)) { 96321b9c144SOr Gerlitz int tc_grp_size, tc_tbl_size; 96421b9c144SOr Gerlitz u32 max_flow_counter; 96521b9c144SOr Gerlitz 96621b9c144SOr Gerlitz max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) | 96721b9c144SOr Gerlitz MLX5_CAP_GEN(dev, max_flow_counter_15_0); 96821b9c144SOr Gerlitz 96921b9c144SOr Gerlitz tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE); 97021b9c144SOr Gerlitz 97121b9c144SOr Gerlitz tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS, 97221b9c144SOr Gerlitz BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size))); 97321b9c144SOr Gerlitz 974acff797cSMaor Gottlieb priv->fs.tc.t = 975acff797cSMaor Gottlieb mlx5_create_auto_grouped_flow_table(priv->fs.ns, 976acff797cSMaor Gottlieb MLX5E_TC_PRIO, 97721b9c144SOr Gerlitz tc_tbl_size, 978acff797cSMaor Gottlieb MLX5E_TC_TABLE_NUM_GROUPS, 9793f6d08d1SOr Gerlitz MLX5E_TC_FT_LEVEL, 0); 980acff797cSMaor Gottlieb if (IS_ERR(priv->fs.tc.t)) { 981b6fac0b4SVlad Buslov mutex_unlock(&priv->fs.tc.t_lock); 982e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 983e98bedf5SEli Britstein "Failed to create tc offload table\n"); 984e8f887acSAmir Vadai netdev_err(priv->netdev, 985e8f887acSAmir Vadai "Failed to create tc offload table\n"); 9865a7e5bcbSVlad Buslov return PTR_ERR(priv->fs.tc.t); 987e8f887acSAmir Vadai } 988e8f887acSAmir Vadai } 989e8f887acSAmir Vadai 99038aa51c1SOr Gerlitz if (attr->match_level != MLX5_MATCH_NONE) 991d4a18e16SYevgeny Kliteynik parse_attr->spec.match_criteria_enable |= MLX5_MATCH_OUTER_HEADERS; 99238aa51c1SOr Gerlitz 993c83954abSRabie Loulou flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec, 9945c65c564SOr Gerlitz &flow_act, dest, dest_ix); 995b6fac0b4SVlad Buslov mutex_unlock(&priv->fs.tc.t_lock); 996e8f887acSAmir Vadai 997a2b7189bSzhong jiang return PTR_ERR_OR_ZERO(flow->rule[0]); 998e8f887acSAmir Vadai } 999e8f887acSAmir Vadai 1000d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv, 1001d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 1002d85cdccbSOr Gerlitz { 1003513f8f7fSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 1004d85cdccbSOr Gerlitz struct mlx5_fc *counter = NULL; 1005d85cdccbSOr Gerlitz 1006b8aee822SMark Bloch counter = attr->counter; 10075a7e5bcbSVlad Buslov if (!IS_ERR_OR_NULL(flow->rule[0])) 1008e4ad91f2SChris Mi mlx5_del_flow_rules(flow->rule[0]); 1009d85cdccbSOr Gerlitz mlx5_fc_destroy(priv->mdev, counter); 1010d85cdccbSOr Gerlitz 1011b6fac0b4SVlad Buslov mutex_lock(&priv->fs.tc.t_lock); 1012226f2ca3SVlad Buslov if (!mlx5e_tc_num_filters(priv, MLX5_TC_FLAG(NIC_OFFLOAD)) && priv->fs.tc.t) { 1013d85cdccbSOr Gerlitz mlx5_destroy_flow_table(priv->fs.tc.t); 1014d85cdccbSOr Gerlitz priv->fs.tc.t = NULL; 1015d85cdccbSOr Gerlitz } 1016b6fac0b4SVlad Buslov mutex_unlock(&priv->fs.tc.t_lock); 10172f4fe4caSOr Gerlitz 1018513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 10193099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 10205c65c564SOr Gerlitz 1021226f2ca3SVlad Buslov if (flow_flag_test(flow, HAIRPIN)) 10225c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 1023d85cdccbSOr Gerlitz } 1024d85cdccbSOr Gerlitz 1025aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 10268c4dc42bSEli Britstein struct mlx5e_tc_flow *flow, int out_index); 1027aa0cbbaeSOr Gerlitz 10283c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv, 1029e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 1030733d4f36SRoi Dayan struct net_device *mirred_dev, 1031733d4f36SRoi Dayan int out_index, 10328c4dc42bSEli Britstein struct netlink_ext_ack *extack, 10330ad060eeSRoi Dayan struct net_device **encap_dev, 10340ad060eeSRoi Dayan bool *encap_valid); 10353c37745eSOr Gerlitz 10366d2a3ed0SOr Gerlitz static struct mlx5_flow_handle * 10376d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw, 10386d2a3ed0SOr Gerlitz struct mlx5e_tc_flow *flow, 10396d2a3ed0SOr Gerlitz struct mlx5_flow_spec *spec, 10406d2a3ed0SOr Gerlitz struct mlx5_esw_flow_attr *attr) 10416d2a3ed0SOr Gerlitz { 10426d2a3ed0SOr Gerlitz struct mlx5_flow_handle *rule; 10436d2a3ed0SOr Gerlitz 10446d2a3ed0SOr Gerlitz rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr); 10456d2a3ed0SOr Gerlitz if (IS_ERR(rule)) 10466d2a3ed0SOr Gerlitz return rule; 10476d2a3ed0SOr Gerlitz 1048e85e02baSEli Britstein if (attr->split_count) { 10496d2a3ed0SOr Gerlitz flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr); 10506d2a3ed0SOr Gerlitz if (IS_ERR(flow->rule[1])) { 10516d2a3ed0SOr Gerlitz mlx5_eswitch_del_offloaded_rule(esw, rule, attr); 10526d2a3ed0SOr Gerlitz return flow->rule[1]; 10536d2a3ed0SOr Gerlitz } 10546d2a3ed0SOr Gerlitz } 10556d2a3ed0SOr Gerlitz 10566d2a3ed0SOr Gerlitz return rule; 10576d2a3ed0SOr Gerlitz } 10586d2a3ed0SOr Gerlitz 10596d2a3ed0SOr Gerlitz static void 10606d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw, 10616d2a3ed0SOr Gerlitz struct mlx5e_tc_flow *flow, 10626d2a3ed0SOr Gerlitz struct mlx5_esw_flow_attr *attr) 10636d2a3ed0SOr Gerlitz { 1064226f2ca3SVlad Buslov flow_flag_clear(flow, OFFLOADED); 10656d2a3ed0SOr Gerlitz 1066e85e02baSEli Britstein if (attr->split_count) 10676d2a3ed0SOr Gerlitz mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr); 10686d2a3ed0SOr Gerlitz 10696d2a3ed0SOr Gerlitz mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr); 10706d2a3ed0SOr Gerlitz } 10716d2a3ed0SOr Gerlitz 10725dbe906fSPaul Blakey static struct mlx5_flow_handle * 10735dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw, 10745dbe906fSPaul Blakey struct mlx5e_tc_flow *flow, 10755dbe906fSPaul Blakey struct mlx5_flow_spec *spec, 10765dbe906fSPaul Blakey struct mlx5_esw_flow_attr *slow_attr) 10775dbe906fSPaul Blakey { 10785dbe906fSPaul Blakey struct mlx5_flow_handle *rule; 10795dbe906fSPaul Blakey 10805dbe906fSPaul Blakey memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr)); 1081154e62abSOr Gerlitz slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 10822be09de7SDavid S. Miller slow_attr->split_count = 0; 10832cf2954bSPaul Blakey slow_attr->dest_chain = FDB_TC_SLOW_PATH_CHAIN; 10845dbe906fSPaul Blakey 10855dbe906fSPaul Blakey rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr); 10865dbe906fSPaul Blakey if (!IS_ERR(rule)) 1087226f2ca3SVlad Buslov flow_flag_set(flow, SLOW); 10885dbe906fSPaul Blakey 10895dbe906fSPaul Blakey return rule; 10905dbe906fSPaul Blakey } 10915dbe906fSPaul Blakey 10925dbe906fSPaul Blakey static void 10935dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw, 10945dbe906fSPaul Blakey struct mlx5e_tc_flow *flow, 10955dbe906fSPaul Blakey struct mlx5_esw_flow_attr *slow_attr) 10965dbe906fSPaul Blakey { 10975dbe906fSPaul Blakey memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr)); 1098154e62abSOr Gerlitz slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 10992be09de7SDavid S. Miller slow_attr->split_count = 0; 11002cf2954bSPaul Blakey slow_attr->dest_chain = FDB_TC_SLOW_PATH_CHAIN; 11015dbe906fSPaul Blakey mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr); 1102226f2ca3SVlad Buslov flow_flag_clear(flow, SLOW); 11035dbe906fSPaul Blakey } 11045dbe906fSPaul Blakey 1105ad86755bSVlad Buslov /* Caller must obtain uplink_priv->unready_flows_lock mutex before calling this 1106ad86755bSVlad Buslov * function. 1107ad86755bSVlad Buslov */ 1108ad86755bSVlad Buslov static void unready_flow_add(struct mlx5e_tc_flow *flow, 1109ad86755bSVlad Buslov struct list_head *unready_flows) 1110ad86755bSVlad Buslov { 1111ad86755bSVlad Buslov flow_flag_set(flow, NOT_READY); 1112ad86755bSVlad Buslov list_add_tail(&flow->unready, unready_flows); 1113ad86755bSVlad Buslov } 1114ad86755bSVlad Buslov 1115ad86755bSVlad Buslov /* Caller must obtain uplink_priv->unready_flows_lock mutex before calling this 1116ad86755bSVlad Buslov * function. 1117ad86755bSVlad Buslov */ 1118ad86755bSVlad Buslov static void unready_flow_del(struct mlx5e_tc_flow *flow) 1119ad86755bSVlad Buslov { 1120ad86755bSVlad Buslov list_del(&flow->unready); 1121ad86755bSVlad Buslov flow_flag_clear(flow, NOT_READY); 1122ad86755bSVlad Buslov } 1123ad86755bSVlad Buslov 1124b4a23329SRoi Dayan static void add_unready_flow(struct mlx5e_tc_flow *flow) 1125b4a23329SRoi Dayan { 1126b4a23329SRoi Dayan struct mlx5_rep_uplink_priv *uplink_priv; 1127b4a23329SRoi Dayan struct mlx5e_rep_priv *rpriv; 1128b4a23329SRoi Dayan struct mlx5_eswitch *esw; 1129b4a23329SRoi Dayan 1130b4a23329SRoi Dayan esw = flow->priv->mdev->priv.eswitch; 1131b4a23329SRoi Dayan rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 1132b4a23329SRoi Dayan uplink_priv = &rpriv->uplink_priv; 1133b4a23329SRoi Dayan 1134ad86755bSVlad Buslov mutex_lock(&uplink_priv->unready_flows_lock); 1135ad86755bSVlad Buslov unready_flow_add(flow, &uplink_priv->unready_flows); 1136ad86755bSVlad Buslov mutex_unlock(&uplink_priv->unready_flows_lock); 1137b4a23329SRoi Dayan } 1138b4a23329SRoi Dayan 1139b4a23329SRoi Dayan static void remove_unready_flow(struct mlx5e_tc_flow *flow) 1140b4a23329SRoi Dayan { 1141ad86755bSVlad Buslov struct mlx5_rep_uplink_priv *uplink_priv; 1142ad86755bSVlad Buslov struct mlx5e_rep_priv *rpriv; 1143ad86755bSVlad Buslov struct mlx5_eswitch *esw; 1144ad86755bSVlad Buslov 1145ad86755bSVlad Buslov esw = flow->priv->mdev->priv.eswitch; 1146ad86755bSVlad Buslov rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 1147ad86755bSVlad Buslov uplink_priv = &rpriv->uplink_priv; 1148ad86755bSVlad Buslov 1149ad86755bSVlad Buslov mutex_lock(&uplink_priv->unready_flows_lock); 1150ad86755bSVlad Buslov unready_flow_del(flow); 1151ad86755bSVlad Buslov mutex_unlock(&uplink_priv->unready_flows_lock); 1152b4a23329SRoi Dayan } 1153b4a23329SRoi Dayan 1154c83954abSRabie Loulou static int 115574491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv, 1156e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 1157e98bedf5SEli Britstein struct netlink_ext_ack *extack) 1158adb4c123SOr Gerlitz { 1159adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 1160bf07aa73SPaul Blakey u32 max_chain = mlx5_eswitch_get_chain_range(esw); 1161aa0cbbaeSOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 11627040632dSTonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr; 1163bf07aa73SPaul Blakey u16 max_prio = mlx5_eswitch_get_prio_range(esw); 11643c37745eSOr Gerlitz struct net_device *out_dev, *encap_dev = NULL; 1165b8aee822SMark Bloch struct mlx5_fc *counter = NULL; 11663c37745eSOr Gerlitz struct mlx5e_rep_priv *rpriv; 11673c37745eSOr Gerlitz struct mlx5e_priv *out_priv; 11680ad060eeSRoi Dayan bool encap_valid = true; 11690ad060eeSRoi Dayan int err = 0; 1170f493f155SEli Britstein int out_index; 11718b32580dSOr Gerlitz 1172d14f6f2aSOr Gerlitz if (!mlx5_eswitch_prios_supported(esw) && attr->prio != 1) { 1173d14f6f2aSOr Gerlitz NL_SET_ERR_MSG(extack, "E-switch priorities unsupported, upgrade FW"); 1174d14f6f2aSOr Gerlitz return -EOPNOTSUPP; 1175d14f6f2aSOr Gerlitz } 1176e52c2802SPaul Blakey 117784179981SPaul Blakey /* We check chain range only for tc flows. 117884179981SPaul Blakey * For ft flows, we checked attr->chain was originally 0 and set it to 117984179981SPaul Blakey * FDB_FT_CHAIN which is outside tc range. 118084179981SPaul Blakey * See mlx5e_rep_setup_ft_cb(). 118184179981SPaul Blakey */ 118284179981SPaul Blakey if (!mlx5e_is_ft_flow(flow) && attr->chain > max_chain) { 1183bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested chain is out of supported range"); 11845a7e5bcbSVlad Buslov return -EOPNOTSUPP; 1185bf07aa73SPaul Blakey } 1186bf07aa73SPaul Blakey 1187bf07aa73SPaul Blakey if (attr->prio > max_prio) { 1188bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested priority is out of supported range"); 11895a7e5bcbSVlad Buslov return -EOPNOTSUPP; 1190bf07aa73SPaul Blakey } 1191bf07aa73SPaul Blakey 1192f493f155SEli Britstein for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) { 11938c4dc42bSEli Britstein int mirred_ifindex; 11948c4dc42bSEli Britstein 1195f493f155SEli Britstein if (!(attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)) 1196f493f155SEli Britstein continue; 1197f493f155SEli Britstein 11987040632dSTonghao Zhang mirred_ifindex = parse_attr->mirred_ifindex[out_index]; 11993c37745eSOr Gerlitz out_dev = __dev_get_by_index(dev_net(priv->netdev), 12008c4dc42bSEli Britstein mirred_ifindex); 1201733d4f36SRoi Dayan err = mlx5e_attach_encap(priv, flow, out_dev, out_index, 12020ad060eeSRoi Dayan extack, &encap_dev, &encap_valid); 12030ad060eeSRoi Dayan if (err) 12045a7e5bcbSVlad Buslov return err; 12050ad060eeSRoi Dayan 12063c37745eSOr Gerlitz out_priv = netdev_priv(encap_dev); 12073c37745eSOr Gerlitz rpriv = out_priv->ppriv; 12081cc26d74SEli Britstein attr->dests[out_index].rep = rpriv->rep; 12091cc26d74SEli Britstein attr->dests[out_index].mdev = out_priv->mdev; 12103c37745eSOr Gerlitz } 12113c37745eSOr Gerlitz 12128b32580dSOr Gerlitz err = mlx5_eswitch_add_vlan_action(esw, attr); 1213c83954abSRabie Loulou if (err) 12145a7e5bcbSVlad Buslov return err; 1215adb4c123SOr Gerlitz 1216d7e75a32SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 12171a9527bbSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 1218d7e75a32SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 1219c83954abSRabie Loulou if (err) 12205a7e5bcbSVlad Buslov return err; 1221d7e75a32SOr Gerlitz } 1222d7e75a32SOr Gerlitz 1223b8aee822SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 1224f9392795SShahar Klein counter = mlx5_fc_create(attr->counter_dev, true); 12255a7e5bcbSVlad Buslov if (IS_ERR(counter)) 12265a7e5bcbSVlad Buslov return PTR_ERR(counter); 1227b8aee822SMark Bloch 1228b8aee822SMark Bloch attr->counter = counter; 1229b8aee822SMark Bloch } 1230b8aee822SMark Bloch 12310ad060eeSRoi Dayan /* we get here if one of the following takes place: 12320ad060eeSRoi Dayan * (1) there's no error 12330ad060eeSRoi Dayan * (2) there's an encap action and we don't have valid neigh 12343c37745eSOr Gerlitz */ 12350ad060eeSRoi Dayan if (!encap_valid) { 12365dbe906fSPaul Blakey /* continue with goto slow path rule instead */ 12375dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 12385dbe906fSPaul Blakey 12395dbe906fSPaul Blakey flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec, &slow_attr); 12405dbe906fSPaul Blakey } else { 12416d2a3ed0SOr Gerlitz flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr); 12425dbe906fSPaul Blakey } 12435dbe906fSPaul Blakey 12445a7e5bcbSVlad Buslov if (IS_ERR(flow->rule[0])) 12455a7e5bcbSVlad Buslov return PTR_ERR(flow->rule[0]); 1246226f2ca3SVlad Buslov else 1247226f2ca3SVlad Buslov flow_flag_set(flow, OFFLOADED); 1248c83954abSRabie Loulou 12495dbe906fSPaul Blakey return 0; 1250aa0cbbaeSOr Gerlitz } 1251d85cdccbSOr Gerlitz 12529272e3dfSYevgeny Kliteynik static bool mlx5_flow_has_geneve_opt(struct mlx5e_tc_flow *flow) 12539272e3dfSYevgeny Kliteynik { 12549272e3dfSYevgeny Kliteynik struct mlx5_flow_spec *spec = &flow->esw_attr->parse_attr->spec; 12559272e3dfSYevgeny Kliteynik void *headers_v = MLX5_ADDR_OF(fte_match_param, 12569272e3dfSYevgeny Kliteynik spec->match_value, 12579272e3dfSYevgeny Kliteynik misc_parameters_3); 12589272e3dfSYevgeny Kliteynik u32 geneve_tlv_opt_0_data = MLX5_GET(fte_match_set_misc3, 12599272e3dfSYevgeny Kliteynik headers_v, 12609272e3dfSYevgeny Kliteynik geneve_tlv_option_0_data); 12619272e3dfSYevgeny Kliteynik 12629272e3dfSYevgeny Kliteynik return !!geneve_tlv_opt_0_data; 12639272e3dfSYevgeny Kliteynik } 12649272e3dfSYevgeny Kliteynik 1265d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv, 1266d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 1267d85cdccbSOr Gerlitz { 1268d85cdccbSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 1269d7e75a32SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 12705dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 1271f493f155SEli Britstein int out_index; 1272d85cdccbSOr Gerlitz 1273226f2ca3SVlad Buslov if (flow_flag_test(flow, NOT_READY)) { 1274b4a23329SRoi Dayan remove_unready_flow(flow); 1275ef06c9eeSRoi Dayan kvfree(attr->parse_attr); 1276ef06c9eeSRoi Dayan return; 1277ef06c9eeSRoi Dayan } 1278ef06c9eeSRoi Dayan 1279226f2ca3SVlad Buslov if (mlx5e_is_offloaded_flow(flow)) { 1280226f2ca3SVlad Buslov if (flow_flag_test(flow, SLOW)) 12815dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr); 12825dbe906fSPaul Blakey else 12835dbe906fSPaul Blakey mlx5e_tc_unoffload_fdb_rules(esw, flow, attr); 12845dbe906fSPaul Blakey } 1285d85cdccbSOr Gerlitz 12869272e3dfSYevgeny Kliteynik if (mlx5_flow_has_geneve_opt(flow)) 12879272e3dfSYevgeny Kliteynik mlx5_geneve_tlv_option_del(priv->mdev->geneve); 12889272e3dfSYevgeny Kliteynik 1289513f8f7fSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 1290d85cdccbSOr Gerlitz 1291f493f155SEli Britstein for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) 12922a4b6526SVlad Buslov if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP) { 12938c4dc42bSEli Britstein mlx5e_detach_encap(priv, flow, out_index); 12942a4b6526SVlad Buslov kfree(attr->parse_attr->tun_info[out_index]); 12952a4b6526SVlad Buslov } 1296f493f155SEli Britstein kvfree(attr->parse_attr); 1297d7e75a32SOr Gerlitz 1298513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 12991a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 1300b8aee822SMark Bloch 1301b8aee822SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) 1302f9392795SShahar Klein mlx5_fc_destroy(attr->counter_dev, attr->counter); 1303d85cdccbSOr Gerlitz } 1304d85cdccbSOr Gerlitz 1305232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv, 13062a1f1768SVlad Buslov struct mlx5e_encap_entry *e, 13072a1f1768SVlad Buslov struct list_head *flow_list) 1308232c0013SHadar Hen Zion { 13093c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 13105dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr, *esw_attr; 13116d2a3ed0SOr Gerlitz struct mlx5_flow_handle *rule; 13126d2a3ed0SOr Gerlitz struct mlx5_flow_spec *spec; 1313232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 1314232c0013SHadar Hen Zion int err; 1315232c0013SHadar Hen Zion 13162b688ea5SMaor Gottlieb e->pkt_reformat = mlx5_packet_reformat_alloc(priv->mdev, 131754c177caSOz Shlomo e->reformat_type, 1318232c0013SHadar Hen Zion e->encap_size, e->encap_header, 13192b688ea5SMaor Gottlieb MLX5_FLOW_NAMESPACE_FDB); 13202b688ea5SMaor Gottlieb if (IS_ERR(e->pkt_reformat)) { 13212b688ea5SMaor Gottlieb mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %lu\n", 13222b688ea5SMaor Gottlieb PTR_ERR(e->pkt_reformat)); 1323232c0013SHadar Hen Zion return; 1324232c0013SHadar Hen Zion } 1325232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 1326f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(priv); 1327232c0013SHadar Hen Zion 13282a1f1768SVlad Buslov list_for_each_entry(flow, flow_list, tmp_list) { 13298c4dc42bSEli Britstein bool all_flow_encaps_valid = true; 13308c4dc42bSEli Britstein int i; 13318c4dc42bSEli Britstein 133295435ad7SVlad Buslov if (!mlx5e_is_offloaded_flow(flow)) 133395435ad7SVlad Buslov continue; 13343c37745eSOr Gerlitz esw_attr = flow->esw_attr; 13356d2a3ed0SOr Gerlitz spec = &esw_attr->parse_attr->spec; 13366d2a3ed0SOr Gerlitz 13372b688ea5SMaor Gottlieb esw_attr->dests[flow->tmp_efi_index].pkt_reformat = e->pkt_reformat; 13382a1f1768SVlad Buslov esw_attr->dests[flow->tmp_efi_index].flags |= MLX5_ESW_DEST_ENCAP_VALID; 13398c4dc42bSEli Britstein /* Flow can be associated with multiple encap entries. 13408c4dc42bSEli Britstein * Before offloading the flow verify that all of them have 13418c4dc42bSEli Britstein * a valid neighbour. 13428c4dc42bSEli Britstein */ 13438c4dc42bSEli Britstein for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) { 13448c4dc42bSEli Britstein if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP)) 13458c4dc42bSEli Britstein continue; 13468c4dc42bSEli Britstein if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP_VALID)) { 13478c4dc42bSEli Britstein all_flow_encaps_valid = false; 13488c4dc42bSEli Britstein break; 13498c4dc42bSEli Britstein } 13508c4dc42bSEli Britstein } 13518c4dc42bSEli Britstein /* Do not offload flows with unresolved neighbors */ 13528c4dc42bSEli Britstein if (!all_flow_encaps_valid) 13532a1f1768SVlad Buslov continue; 13545dbe906fSPaul Blakey /* update from slow path rule to encap rule */ 13556d2a3ed0SOr Gerlitz rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, esw_attr); 13566d2a3ed0SOr Gerlitz if (IS_ERR(rule)) { 13576d2a3ed0SOr Gerlitz err = PTR_ERR(rule); 1358232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n", 1359232c0013SHadar Hen Zion err); 13602a1f1768SVlad Buslov continue; 1361232c0013SHadar Hen Zion } 13625dbe906fSPaul Blakey 13635dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr); 13646d2a3ed0SOr Gerlitz flow->rule[0] = rule; 1365226f2ca3SVlad Buslov /* was unset when slow path rule removed */ 1366226f2ca3SVlad Buslov flow_flag_set(flow, OFFLOADED); 1367232c0013SHadar Hen Zion } 1368232c0013SHadar Hen Zion } 1369232c0013SHadar Hen Zion 1370232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv, 13712a1f1768SVlad Buslov struct mlx5e_encap_entry *e, 13722a1f1768SVlad Buslov struct list_head *flow_list) 1373232c0013SHadar Hen Zion { 13743c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 13755dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 13765dbe906fSPaul Blakey struct mlx5_flow_handle *rule; 13775dbe906fSPaul Blakey struct mlx5_flow_spec *spec; 1378232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 13795dbe906fSPaul Blakey int err; 1380232c0013SHadar Hen Zion 13812a1f1768SVlad Buslov list_for_each_entry(flow, flow_list, tmp_list) { 138295435ad7SVlad Buslov if (!mlx5e_is_offloaded_flow(flow)) 138395435ad7SVlad Buslov continue; 13845dbe906fSPaul Blakey spec = &flow->esw_attr->parse_attr->spec; 13855dbe906fSPaul Blakey 13865dbe906fSPaul Blakey /* update from encap rule to slow path rule */ 13875dbe906fSPaul Blakey rule = mlx5e_tc_offload_to_slow_path(esw, flow, spec, &slow_attr); 13888c4dc42bSEli Britstein /* mark the flow's encap dest as non-valid */ 13892a1f1768SVlad Buslov flow->esw_attr->dests[flow->tmp_efi_index].flags &= ~MLX5_ESW_DEST_ENCAP_VALID; 13905dbe906fSPaul Blakey 13915dbe906fSPaul Blakey if (IS_ERR(rule)) { 13925dbe906fSPaul Blakey err = PTR_ERR(rule); 13935dbe906fSPaul Blakey mlx5_core_warn(priv->mdev, "Failed to update slow path (encap) flow, %d\n", 13945dbe906fSPaul Blakey err); 13952a1f1768SVlad Buslov continue; 13965dbe906fSPaul Blakey } 13975dbe906fSPaul Blakey 13986d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(esw, flow, flow->esw_attr); 13995dbe906fSPaul Blakey flow->rule[0] = rule; 1400226f2ca3SVlad Buslov /* was unset when fast path rule removed */ 1401226f2ca3SVlad Buslov flow_flag_set(flow, OFFLOADED); 1402232c0013SHadar Hen Zion } 1403232c0013SHadar Hen Zion 140461c806daSOr Gerlitz /* we know that the encap is valid */ 1405232c0013SHadar Hen Zion e->flags &= ~MLX5_ENCAP_ENTRY_VALID; 14062b688ea5SMaor Gottlieb mlx5_packet_reformat_dealloc(priv->mdev, e->pkt_reformat); 1407232c0013SHadar Hen Zion } 1408232c0013SHadar Hen Zion 1409b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow) 1410b8aee822SMark Bloch { 1411226f2ca3SVlad Buslov if (mlx5e_is_eswitch_flow(flow)) 1412b8aee822SMark Bloch return flow->esw_attr->counter; 1413b8aee822SMark Bloch else 1414b8aee822SMark Bloch return flow->nic_attr->counter; 1415b8aee822SMark Bloch } 1416b8aee822SMark Bloch 14172a1f1768SVlad Buslov /* Takes reference to all flows attached to encap and adds the flows to 14182a1f1768SVlad Buslov * flow_list using 'tmp_list' list_head in mlx5e_tc_flow. 14192a1f1768SVlad Buslov */ 14202a1f1768SVlad Buslov void mlx5e_take_all_encap_flows(struct mlx5e_encap_entry *e, struct list_head *flow_list) 14212a1f1768SVlad Buslov { 14222a1f1768SVlad Buslov struct encap_flow_item *efi; 14232a1f1768SVlad Buslov struct mlx5e_tc_flow *flow; 14242a1f1768SVlad Buslov 14252a1f1768SVlad Buslov list_for_each_entry(efi, &e->flows, list) { 14262a1f1768SVlad Buslov flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]); 14272a1f1768SVlad Buslov if (IS_ERR(mlx5e_flow_get(flow))) 14282a1f1768SVlad Buslov continue; 142995435ad7SVlad Buslov wait_for_completion(&flow->init_done); 14302a1f1768SVlad Buslov 14312a1f1768SVlad Buslov flow->tmp_efi_index = efi->index; 14322a1f1768SVlad Buslov list_add(&flow->tmp_list, flow_list); 14332a1f1768SVlad Buslov } 14342a1f1768SVlad Buslov } 14352a1f1768SVlad Buslov 14366a06c2f7SVlad Buslov /* Iterate over tmp_list of flows attached to flow_list head. */ 14372a1f1768SVlad Buslov void mlx5e_put_encap_flow_list(struct mlx5e_priv *priv, struct list_head *flow_list) 14386a06c2f7SVlad Buslov { 14396a06c2f7SVlad Buslov struct mlx5e_tc_flow *flow, *tmp; 14406a06c2f7SVlad Buslov 14416a06c2f7SVlad Buslov list_for_each_entry_safe(flow, tmp, flow_list, tmp_list) 14426a06c2f7SVlad Buslov mlx5e_flow_put(priv, flow); 14436a06c2f7SVlad Buslov } 14446a06c2f7SVlad Buslov 1445ac0d9176SVlad Buslov static struct mlx5e_encap_entry * 1446ac0d9176SVlad Buslov mlx5e_get_next_valid_encap(struct mlx5e_neigh_hash_entry *nhe, 1447ac0d9176SVlad Buslov struct mlx5e_encap_entry *e) 1448ac0d9176SVlad Buslov { 1449ac0d9176SVlad Buslov struct mlx5e_encap_entry *next = NULL; 1450ac0d9176SVlad Buslov 1451ac0d9176SVlad Buslov retry: 1452ac0d9176SVlad Buslov rcu_read_lock(); 1453ac0d9176SVlad Buslov 1454ac0d9176SVlad Buslov /* find encap with non-zero reference counter value */ 1455ac0d9176SVlad Buslov for (next = e ? 1456ac0d9176SVlad Buslov list_next_or_null_rcu(&nhe->encap_list, 1457ac0d9176SVlad Buslov &e->encap_list, 1458ac0d9176SVlad Buslov struct mlx5e_encap_entry, 1459ac0d9176SVlad Buslov encap_list) : 1460ac0d9176SVlad Buslov list_first_or_null_rcu(&nhe->encap_list, 1461ac0d9176SVlad Buslov struct mlx5e_encap_entry, 1462ac0d9176SVlad Buslov encap_list); 1463ac0d9176SVlad Buslov next; 1464ac0d9176SVlad Buslov next = list_next_or_null_rcu(&nhe->encap_list, 1465ac0d9176SVlad Buslov &next->encap_list, 1466ac0d9176SVlad Buslov struct mlx5e_encap_entry, 1467ac0d9176SVlad Buslov encap_list)) 1468ac0d9176SVlad Buslov if (mlx5e_encap_take(next)) 1469ac0d9176SVlad Buslov break; 1470ac0d9176SVlad Buslov 1471ac0d9176SVlad Buslov rcu_read_unlock(); 1472ac0d9176SVlad Buslov 1473ac0d9176SVlad Buslov /* release starting encap */ 1474ac0d9176SVlad Buslov if (e) 1475ac0d9176SVlad Buslov mlx5e_encap_put(netdev_priv(e->out_dev), e); 1476ac0d9176SVlad Buslov if (!next) 1477ac0d9176SVlad Buslov return next; 1478ac0d9176SVlad Buslov 1479ac0d9176SVlad Buslov /* wait for encap to be fully initialized */ 1480ac0d9176SVlad Buslov wait_for_completion(&next->res_ready); 1481ac0d9176SVlad Buslov /* continue searching if encap entry is not in valid state after completion */ 1482ac0d9176SVlad Buslov if (!(next->flags & MLX5_ENCAP_ENTRY_VALID)) { 1483ac0d9176SVlad Buslov e = next; 1484ac0d9176SVlad Buslov goto retry; 1485ac0d9176SVlad Buslov } 1486ac0d9176SVlad Buslov 1487ac0d9176SVlad Buslov return next; 1488ac0d9176SVlad Buslov } 1489ac0d9176SVlad Buslov 1490f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe) 1491f6dfb4c3SHadar Hen Zion { 1492f6dfb4c3SHadar Hen Zion struct mlx5e_neigh *m_neigh = &nhe->m_neigh; 1493ac0d9176SVlad Buslov struct mlx5e_encap_entry *e = NULL; 1494f6dfb4c3SHadar Hen Zion struct mlx5e_tc_flow *flow; 1495f6dfb4c3SHadar Hen Zion struct mlx5_fc *counter; 1496f6dfb4c3SHadar Hen Zion struct neigh_table *tbl; 1497f6dfb4c3SHadar Hen Zion bool neigh_used = false; 1498f6dfb4c3SHadar Hen Zion struct neighbour *n; 149990bb7692SAriel Levkovich u64 lastuse; 1500f6dfb4c3SHadar Hen Zion 1501f6dfb4c3SHadar Hen Zion if (m_neigh->family == AF_INET) 1502f6dfb4c3SHadar Hen Zion tbl = &arp_tbl; 1503f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6) 1504f6dfb4c3SHadar Hen Zion else if (m_neigh->family == AF_INET6) 15055cc3a8c6SSaeed Mahameed tbl = ipv6_stub->nd_tbl; 1506f6dfb4c3SHadar Hen Zion #endif 1507f6dfb4c3SHadar Hen Zion else 1508f6dfb4c3SHadar Hen Zion return; 1509f6dfb4c3SHadar Hen Zion 1510ac0d9176SVlad Buslov /* mlx5e_get_next_valid_encap() releases previous encap before returning 1511ac0d9176SVlad Buslov * next one. 1512ac0d9176SVlad Buslov */ 1513ac0d9176SVlad Buslov while ((e = mlx5e_get_next_valid_encap(nhe, e)) != NULL) { 15146a06c2f7SVlad Buslov struct mlx5e_priv *priv = netdev_priv(e->out_dev); 15155a7e5bcbSVlad Buslov struct encap_flow_item *efi, *tmp; 15166a06c2f7SVlad Buslov struct mlx5_eswitch *esw; 15176a06c2f7SVlad Buslov LIST_HEAD(flow_list); 1518948993f2SVlad Buslov 15196a06c2f7SVlad Buslov esw = priv->mdev->priv.eswitch; 15206a06c2f7SVlad Buslov mutex_lock(&esw->offloads.encap_tbl_lock); 15215a7e5bcbSVlad Buslov list_for_each_entry_safe(efi, tmp, &e->flows, list) { 152279baaec7SEli Britstein flow = container_of(efi, struct mlx5e_tc_flow, 152379baaec7SEli Britstein encaps[efi->index]); 15245a7e5bcbSVlad Buslov if (IS_ERR(mlx5e_flow_get(flow))) 15255a7e5bcbSVlad Buslov continue; 15266a06c2f7SVlad Buslov list_add(&flow->tmp_list, &flow_list); 15275a7e5bcbSVlad Buslov 1528226f2ca3SVlad Buslov if (mlx5e_is_offloaded_flow(flow)) { 1529b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 153090bb7692SAriel Levkovich lastuse = mlx5_fc_query_lastuse(counter); 1531f6dfb4c3SHadar Hen Zion if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) { 1532f6dfb4c3SHadar Hen Zion neigh_used = true; 1533f6dfb4c3SHadar Hen Zion break; 1534f6dfb4c3SHadar Hen Zion } 1535f6dfb4c3SHadar Hen Zion } 1536f6dfb4c3SHadar Hen Zion } 15376a06c2f7SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 1538948993f2SVlad Buslov 15396a06c2f7SVlad Buslov mlx5e_put_encap_flow_list(priv, &flow_list); 1540ac0d9176SVlad Buslov if (neigh_used) { 1541ac0d9176SVlad Buslov /* release current encap before breaking the loop */ 15426a06c2f7SVlad Buslov mlx5e_encap_put(priv, e); 1543e36d4810SRoi Dayan break; 1544f6dfb4c3SHadar Hen Zion } 1545ac0d9176SVlad Buslov } 1546f6dfb4c3SHadar Hen Zion 1547c786fe59SVlad Buslov trace_mlx5e_tc_update_neigh_used_value(nhe, neigh_used); 1548c786fe59SVlad Buslov 1549f6dfb4c3SHadar Hen Zion if (neigh_used) { 1550f6dfb4c3SHadar Hen Zion nhe->reported_lastuse = jiffies; 1551f6dfb4c3SHadar Hen Zion 1552f6dfb4c3SHadar Hen Zion /* find the relevant neigh according to the cached device and 1553f6dfb4c3SHadar Hen Zion * dst ip pair 1554f6dfb4c3SHadar Hen Zion */ 1555f6dfb4c3SHadar Hen Zion n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev); 1556c7f7ba8dSRoi Dayan if (!n) 1557f6dfb4c3SHadar Hen Zion return; 1558f6dfb4c3SHadar Hen Zion 1559f6dfb4c3SHadar Hen Zion neigh_event_send(n, NULL); 1560f6dfb4c3SHadar Hen Zion neigh_release(n); 1561f6dfb4c3SHadar Hen Zion } 1562f6dfb4c3SHadar Hen Zion } 1563f6dfb4c3SHadar Hen Zion 156461086f39SVlad Buslov static void mlx5e_encap_dealloc(struct mlx5e_priv *priv, struct mlx5e_encap_entry *e) 1565d85cdccbSOr Gerlitz { 1566948993f2SVlad Buslov WARN_ON(!list_empty(&e->flows)); 15673c140dd5SVlad Buslov 15683c140dd5SVlad Buslov if (e->compl_result > 0) { 1569232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 1570232c0013SHadar Hen Zion 1571232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 15722b688ea5SMaor Gottlieb mlx5_packet_reformat_dealloc(priv->mdev, e->pkt_reformat); 15733c140dd5SVlad Buslov } 1574232c0013SHadar Hen Zion 15752a4b6526SVlad Buslov kfree(e->tun_info); 1576232c0013SHadar Hen Zion kfree(e->encap_header); 1577ac0d9176SVlad Buslov kfree_rcu(e, rcu); 15785067b602SRoi Dayan } 1579948993f2SVlad Buslov 158061086f39SVlad Buslov void mlx5e_encap_put(struct mlx5e_priv *priv, struct mlx5e_encap_entry *e) 158161086f39SVlad Buslov { 158261086f39SVlad Buslov struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 158361086f39SVlad Buslov 158461086f39SVlad Buslov if (!refcount_dec_and_mutex_lock(&e->refcnt, &esw->offloads.encap_tbl_lock)) 158561086f39SVlad Buslov return; 158661086f39SVlad Buslov hash_del_rcu(&e->encap_hlist); 158761086f39SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 158861086f39SVlad Buslov 158961086f39SVlad Buslov mlx5e_encap_dealloc(priv, e); 159061086f39SVlad Buslov } 159161086f39SVlad Buslov 1592948993f2SVlad Buslov static void mlx5e_detach_encap(struct mlx5e_priv *priv, 1593948993f2SVlad Buslov struct mlx5e_tc_flow *flow, int out_index) 1594948993f2SVlad Buslov { 159561086f39SVlad Buslov struct mlx5e_encap_entry *e = flow->encaps[out_index].e; 159661086f39SVlad Buslov struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 159761086f39SVlad Buslov 1598948993f2SVlad Buslov /* flow wasn't fully initialized */ 159961086f39SVlad Buslov if (!e) 1600948993f2SVlad Buslov return; 1601948993f2SVlad Buslov 160261086f39SVlad Buslov mutex_lock(&esw->offloads.encap_tbl_lock); 1603948993f2SVlad Buslov list_del(&flow->encaps[out_index].list); 1604948993f2SVlad Buslov flow->encaps[out_index].e = NULL; 160561086f39SVlad Buslov if (!refcount_dec_and_test(&e->refcnt)) { 160661086f39SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 160761086f39SVlad Buslov return; 160861086f39SVlad Buslov } 160961086f39SVlad Buslov hash_del_rcu(&e->encap_hlist); 161061086f39SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 161161086f39SVlad Buslov 161261086f39SVlad Buslov mlx5e_encap_dealloc(priv, e); 16135067b602SRoi Dayan } 16145067b602SRoi Dayan 161504de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow) 161604de7ddaSRoi Dayan { 161704de7ddaSRoi Dayan struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch; 161804de7ddaSRoi Dayan 1619226f2ca3SVlad Buslov if (!flow_flag_test(flow, ESWITCH) || 1620226f2ca3SVlad Buslov !flow_flag_test(flow, DUP)) 162104de7ddaSRoi Dayan return; 162204de7ddaSRoi Dayan 162304de7ddaSRoi Dayan mutex_lock(&esw->offloads.peer_mutex); 162404de7ddaSRoi Dayan list_del(&flow->peer); 162504de7ddaSRoi Dayan mutex_unlock(&esw->offloads.peer_mutex); 162604de7ddaSRoi Dayan 1627226f2ca3SVlad Buslov flow_flag_clear(flow, DUP); 162804de7ddaSRoi Dayan 162904de7ddaSRoi Dayan mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow); 163004de7ddaSRoi Dayan kvfree(flow->peer_flow); 163104de7ddaSRoi Dayan flow->peer_flow = NULL; 163204de7ddaSRoi Dayan } 163304de7ddaSRoi Dayan 163404de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow) 163504de7ddaSRoi Dayan { 163604de7ddaSRoi Dayan struct mlx5_core_dev *dev = flow->priv->mdev; 163704de7ddaSRoi Dayan struct mlx5_devcom *devcom = dev->priv.devcom; 163804de7ddaSRoi Dayan struct mlx5_eswitch *peer_esw; 163904de7ddaSRoi Dayan 164004de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 164104de7ddaSRoi Dayan if (!peer_esw) 164204de7ddaSRoi Dayan return; 164304de7ddaSRoi Dayan 164404de7ddaSRoi Dayan __mlx5e_tc_del_fdb_peer_flow(flow); 164504de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 164604de7ddaSRoi Dayan } 164704de7ddaSRoi Dayan 1648e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv, 1649961e8979SRoi Dayan struct mlx5e_tc_flow *flow) 1650e8f887acSAmir Vadai { 1651226f2ca3SVlad Buslov if (mlx5e_is_eswitch_flow(flow)) { 165204de7ddaSRoi Dayan mlx5e_tc_del_fdb_peer_flow(flow); 1653d85cdccbSOr Gerlitz mlx5e_tc_del_fdb_flow(priv, flow); 165404de7ddaSRoi Dayan } else { 1655d85cdccbSOr Gerlitz mlx5e_tc_del_nic_flow(priv, flow); 1656e8f887acSAmir Vadai } 165704de7ddaSRoi Dayan } 1658e8f887acSAmir Vadai 1659bbd00f7eSHadar Hen Zion 1660bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv, 1661bbd00f7eSHadar Hen Zion struct mlx5_flow_spec *spec, 1662f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 16636363651dSOr Gerlitz struct net_device *filter_dev, u8 *match_level) 1664bbd00f7eSHadar Hen Zion { 1665e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1666bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1667bbd00f7eSHadar Hen Zion outer_headers); 1668bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1669bbd00f7eSHadar Hen Zion outer_headers); 1670f9e30088SPablo Neira Ayuso struct flow_rule *rule = flow_cls_offload_flow_rule(f); 16718f256622SPablo Neira Ayuso int err; 1672bbd00f7eSHadar Hen Zion 1673101f4de9SOz Shlomo err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f, 16746363651dSOr Gerlitz headers_c, headers_v, match_level); 167554c177caSOz Shlomo if (err) { 167654c177caSOz Shlomo NL_SET_ERR_MSG_MOD(extack, 167754c177caSOz Shlomo "failed to parse tunnel attributes"); 1678101f4de9SOz Shlomo return err; 1679bbd00f7eSHadar Hen Zion } 1680bbd00f7eSHadar Hen Zion 1681fe1587a7SDmytro Linkin if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL)) { 1682fe1587a7SDmytro Linkin struct flow_match_control match; 1683fe1587a7SDmytro Linkin u16 addr_type; 1684fe1587a7SDmytro Linkin 1685fe1587a7SDmytro Linkin flow_rule_match_enc_control(rule, &match); 1686fe1587a7SDmytro Linkin addr_type = match.key->addr_type; 1687fe1587a7SDmytro Linkin 1688fe1587a7SDmytro Linkin /* For tunnel addr_type used same key id`s as for non-tunnel */ 1689fe1587a7SDmytro Linkin if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 16908f256622SPablo Neira Ayuso struct flow_match_ipv4_addrs match; 16918f256622SPablo Neira Ayuso 16928f256622SPablo Neira Ayuso flow_rule_match_enc_ipv4_addrs(rule, &match); 1693bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1694bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 16958f256622SPablo Neira Ayuso ntohl(match.mask->src)); 1696bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1697bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 16988f256622SPablo Neira Ayuso ntohl(match.key->src)); 1699bbd00f7eSHadar Hen Zion 1700bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1701bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 17028f256622SPablo Neira Ayuso ntohl(match.mask->dst)); 1703bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1704bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 17058f256622SPablo Neira Ayuso ntohl(match.key->dst)); 1706bbd00f7eSHadar Hen Zion 1707fe1587a7SDmytro Linkin MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, 1708fe1587a7SDmytro Linkin ethertype); 1709fe1587a7SDmytro Linkin MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 1710fe1587a7SDmytro Linkin ETH_P_IP); 1711fe1587a7SDmytro Linkin } else if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 17128f256622SPablo Neira Ayuso struct flow_match_ipv6_addrs match; 171319f44401SOr Gerlitz 17148f256622SPablo Neira Ayuso flow_rule_match_enc_ipv6_addrs(rule, &match); 171519f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 171619f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 1717fe1587a7SDmytro Linkin &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, 1718fe1587a7SDmytro Linkin ipv6)); 171919f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 172019f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 1721fe1587a7SDmytro Linkin &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, 1722fe1587a7SDmytro Linkin ipv6)); 172319f44401SOr Gerlitz 172419f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 172519f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 1726fe1587a7SDmytro Linkin &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, 1727fe1587a7SDmytro Linkin ipv6)); 172819f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 172919f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 1730fe1587a7SDmytro Linkin &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, 1731fe1587a7SDmytro Linkin ipv6)); 173219f44401SOr Gerlitz 1733fe1587a7SDmytro Linkin MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, 1734fe1587a7SDmytro Linkin ethertype); 1735fe1587a7SDmytro Linkin MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 1736fe1587a7SDmytro Linkin ETH_P_IPV6); 1737fe1587a7SDmytro Linkin } 17382e72eb43SOr Gerlitz } 1739bbd00f7eSHadar Hen Zion 17408f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) { 17418f256622SPablo Neira Ayuso struct flow_match_ip match; 1742bcef735cSOr Gerlitz 17438f256622SPablo Neira Ayuso flow_rule_match_enc_ip(rule, &match); 17448f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, 17458f256622SPablo Neira Ayuso match.mask->tos & 0x3); 17468f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, 17478f256622SPablo Neira Ayuso match.key->tos & 0x3); 1748bcef735cSOr Gerlitz 17498f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, 17508f256622SPablo Neira Ayuso match.mask->tos >> 2); 17518f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, 17528f256622SPablo Neira Ayuso match.key->tos >> 2); 1753bcef735cSOr Gerlitz 17548f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, 17558f256622SPablo Neira Ayuso match.mask->ttl); 17568f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, 17578f256622SPablo Neira Ayuso match.key->ttl); 1758e98bedf5SEli Britstein 17598f256622SPablo Neira Ayuso if (match.mask->ttl && 1760e98bedf5SEli Britstein !MLX5_CAP_ESW_FLOWTABLE_FDB 1761e98bedf5SEli Britstein (priv->mdev, 1762e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 1763e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1764e98bedf5SEli Britstein "Matching on TTL is not supported"); 1765e98bedf5SEli Britstein return -EOPNOTSUPP; 1766e98bedf5SEli Britstein } 1767e98bedf5SEli Britstein 1768bcef735cSOr Gerlitz } 1769bcef735cSOr Gerlitz 1770bbd00f7eSHadar Hen Zion /* Enforce DMAC when offloading incoming tunneled flows. 1771bbd00f7eSHadar Hen Zion * Flow counters require a match on the DMAC. 1772bbd00f7eSHadar Hen Zion */ 1773bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16); 1774bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0); 1775bbd00f7eSHadar Hen Zion ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1776bbd00f7eSHadar Hen Zion dmac_47_16), priv->netdev->dev_addr); 1777bbd00f7eSHadar Hen Zion 1778bbd00f7eSHadar Hen Zion /* let software handle IP fragments */ 1779bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 1780bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0); 1781bbd00f7eSHadar Hen Zion 1782bbd00f7eSHadar Hen Zion return 0; 1783bbd00f7eSHadar Hen Zion } 1784bbd00f7eSHadar Hen Zion 17858377629eSEli Britstein static void *get_match_headers_criteria(u32 flags, 17868377629eSEli Britstein struct mlx5_flow_spec *spec) 17878377629eSEli Britstein { 17888377629eSEli Britstein return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ? 17898377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 17908377629eSEli Britstein inner_headers) : 17918377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 17928377629eSEli Britstein outer_headers); 17938377629eSEli Britstein } 17948377629eSEli Britstein 17958377629eSEli Britstein static void *get_match_headers_value(u32 flags, 17968377629eSEli Britstein struct mlx5_flow_spec *spec) 17978377629eSEli Britstein { 17988377629eSEli Britstein return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ? 17998377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_value, 18008377629eSEli Britstein inner_headers) : 18018377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_value, 18028377629eSEli Britstein outer_headers); 18038377629eSEli Britstein } 18048377629eSEli Britstein 1805de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv, 1806de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 1807f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 180854c177caSOz Shlomo struct net_device *filter_dev, 180993b3586eSHuy Nguyen u8 *inner_match_level, u8 *outer_match_level) 1810e3a2b7edSAmir Vadai { 1811e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1812c5bb1730SMaor Gottlieb void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1813c5bb1730SMaor Gottlieb outer_headers); 1814c5bb1730SMaor Gottlieb void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1815c5bb1730SMaor Gottlieb outer_headers); 1816699e96ddSJianbo Liu void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1817699e96ddSJianbo Liu misc_parameters); 1818699e96ddSJianbo Liu void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1819699e96ddSJianbo Liu misc_parameters); 1820f9e30088SPablo Neira Ayuso struct flow_rule *rule = flow_cls_offload_flow_rule(f); 18218f256622SPablo Neira Ayuso struct flow_dissector *dissector = rule->match.dissector; 1822e3a2b7edSAmir Vadai u16 addr_type = 0; 1823e3a2b7edSAmir Vadai u8 ip_proto = 0; 182493b3586eSHuy Nguyen u8 *match_level; 1825e3a2b7edSAmir Vadai 182693b3586eSHuy Nguyen match_level = outer_match_level; 1827de0af0bfSRoi Dayan 18288f256622SPablo Neira Ayuso if (dissector->used_keys & 18293d144578SVlad Buslov ~(BIT(FLOW_DISSECTOR_KEY_META) | 18303d144578SVlad Buslov BIT(FLOW_DISSECTOR_KEY_CONTROL) | 1831e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_BASIC) | 1832e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) | 1833095b6cfdSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_VLAN) | 1834699e96ddSJianbo Liu BIT(FLOW_DISSECTOR_KEY_CVLAN) | 1835e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) | 1836e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) | 1837bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_PORTS) | 1838bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) | 1839bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) | 1840bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) | 1841bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_PORTS) | 1842e77834ecSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) | 1843fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_TCP) | 1844bcef735cSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_IP) | 18459272e3dfSYevgeny Kliteynik BIT(FLOW_DISSECTOR_KEY_ENC_IP) | 18469272e3dfSYevgeny Kliteynik BIT(FLOW_DISSECTOR_KEY_ENC_OPTS))) { 1847e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "Unsupported key"); 1848e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n", 18498f256622SPablo Neira Ayuso dissector->used_keys); 1850e3a2b7edSAmir Vadai return -EOPNOTSUPP; 1851e3a2b7edSAmir Vadai } 1852e3a2b7edSAmir Vadai 1853075973c7SVlad Buslov if (mlx5e_get_tc_tun(filter_dev)) { 185493b3586eSHuy Nguyen if (parse_tunnel_attr(priv, spec, f, filter_dev, 185593b3586eSHuy Nguyen outer_match_level)) 1856bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1857bbd00f7eSHadar Hen Zion 185893b3586eSHuy Nguyen /* At this point, header pointers should point to the inner 1859bbd00f7eSHadar Hen Zion * headers, outer header were already set by parse_tunnel_attr 1860bbd00f7eSHadar Hen Zion */ 186193b3586eSHuy Nguyen match_level = inner_match_level; 18628377629eSEli Britstein headers_c = get_match_headers_criteria(MLX5_FLOW_CONTEXT_ACTION_DECAP, 18638377629eSEli Britstein spec); 18648377629eSEli Britstein headers_v = get_match_headers_value(MLX5_FLOW_CONTEXT_ACTION_DECAP, 18658377629eSEli Britstein spec); 1866bbd00f7eSHadar Hen Zion } 1867bbd00f7eSHadar Hen Zion 18688f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { 18698f256622SPablo Neira Ayuso struct flow_match_basic match; 1870e3a2b7edSAmir Vadai 18718f256622SPablo Neira Ayuso flow_rule_match_basic(rule, &match); 18728f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype, 18738f256622SPablo Neira Ayuso ntohs(match.mask->n_proto)); 18748f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 18758f256622SPablo Neira Ayuso ntohs(match.key->n_proto)); 18768f256622SPablo Neira Ayuso 18778f256622SPablo Neira Ayuso if (match.mask->n_proto) 1878d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1879e3a2b7edSAmir Vadai } 188035a605dbSEli Britstein if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN) || 188135a605dbSEli Britstein is_vlan_dev(filter_dev)) { 188235a605dbSEli Britstein struct flow_dissector_key_vlan filter_dev_mask; 188335a605dbSEli Britstein struct flow_dissector_key_vlan filter_dev_key; 18848f256622SPablo Neira Ayuso struct flow_match_vlan match; 18858f256622SPablo Neira Ayuso 188635a605dbSEli Britstein if (is_vlan_dev(filter_dev)) { 188735a605dbSEli Britstein match.key = &filter_dev_key; 188835a605dbSEli Britstein match.key->vlan_id = vlan_dev_vlan_id(filter_dev); 188935a605dbSEli Britstein match.key->vlan_tpid = vlan_dev_vlan_proto(filter_dev); 189035a605dbSEli Britstein match.key->vlan_priority = 0; 189135a605dbSEli Britstein match.mask = &filter_dev_mask; 189235a605dbSEli Britstein memset(match.mask, 0xff, sizeof(*match.mask)); 189335a605dbSEli Britstein match.mask->vlan_priority = 0; 189435a605dbSEli Britstein } else { 18958f256622SPablo Neira Ayuso flow_rule_match_vlan(rule, &match); 189635a605dbSEli Britstein } 18978f256622SPablo Neira Ayuso if (match.mask->vlan_id || 18988f256622SPablo Neira Ayuso match.mask->vlan_priority || 18998f256622SPablo Neira Ayuso match.mask->vlan_tpid) { 19008f256622SPablo Neira Ayuso if (match.key->vlan_tpid == htons(ETH_P_8021AD)) { 1901699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1902699e96ddSJianbo Liu svlan_tag, 1); 1903699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1904699e96ddSJianbo Liu svlan_tag, 1); 1905699e96ddSJianbo Liu } else { 1906699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1907699e96ddSJianbo Liu cvlan_tag, 1); 1908699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1909699e96ddSJianbo Liu cvlan_tag, 1); 1910699e96ddSJianbo Liu } 1911095b6cfdSOr Gerlitz 19128f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid, 19138f256622SPablo Neira Ayuso match.mask->vlan_id); 19148f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid, 19158f256622SPablo Neira Ayuso match.key->vlan_id); 1916358d79a4SOr Gerlitz 19178f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio, 19188f256622SPablo Neira Ayuso match.mask->vlan_priority); 19198f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio, 19208f256622SPablo Neira Ayuso match.key->vlan_priority); 192154782900SOr Gerlitz 1922d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1923095b6cfdSOr Gerlitz } 1924d3a80bb5SOr Gerlitz } else if (*match_level != MLX5_MATCH_NONE) { 1925fc603294SMark Bloch /* cvlan_tag enabled in match criteria and 1926fc603294SMark Bloch * disabled in match value means both S & C tags 1927fc603294SMark Bloch * don't exist (untagged of both) 1928fc603294SMark Bloch */ 1929cee26487SJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1); 1930d3a80bb5SOr Gerlitz *match_level = MLX5_MATCH_L2; 1931095b6cfdSOr Gerlitz } 1932095b6cfdSOr Gerlitz 19338f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) { 19348f256622SPablo Neira Ayuso struct flow_match_vlan match; 19358f256622SPablo Neira Ayuso 193612d5cbf8SJianbo Liu flow_rule_match_cvlan(rule, &match); 19378f256622SPablo Neira Ayuso if (match.mask->vlan_id || 19388f256622SPablo Neira Ayuso match.mask->vlan_priority || 19398f256622SPablo Neira Ayuso match.mask->vlan_tpid) { 19408f256622SPablo Neira Ayuso if (match.key->vlan_tpid == htons(ETH_P_8021AD)) { 1941699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1942699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1943699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1944699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1945699e96ddSJianbo Liu } else { 1946699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1947699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1948699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1949699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1950699e96ddSJianbo Liu } 1951699e96ddSJianbo Liu 1952699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid, 19538f256622SPablo Neira Ayuso match.mask->vlan_id); 1954699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid, 19558f256622SPablo Neira Ayuso match.key->vlan_id); 1956699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio, 19578f256622SPablo Neira Ayuso match.mask->vlan_priority); 1958699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio, 19598f256622SPablo Neira Ayuso match.key->vlan_priority); 1960699e96ddSJianbo Liu 1961699e96ddSJianbo Liu *match_level = MLX5_MATCH_L2; 1962699e96ddSJianbo Liu } 1963699e96ddSJianbo Liu } 1964699e96ddSJianbo Liu 19658f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) { 19668f256622SPablo Neira Ayuso struct flow_match_eth_addrs match; 196754782900SOr Gerlitz 19688f256622SPablo Neira Ayuso flow_rule_match_eth_addrs(rule, &match); 1969d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1970d3a80bb5SOr Gerlitz dmac_47_16), 19718f256622SPablo Neira Ayuso match.mask->dst); 1972d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1973d3a80bb5SOr Gerlitz dmac_47_16), 19748f256622SPablo Neira Ayuso match.key->dst); 1975d3a80bb5SOr Gerlitz 1976d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1977d3a80bb5SOr Gerlitz smac_47_16), 19788f256622SPablo Neira Ayuso match.mask->src); 1979d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1980d3a80bb5SOr Gerlitz smac_47_16), 19818f256622SPablo Neira Ayuso match.key->src); 1982d3a80bb5SOr Gerlitz 19838f256622SPablo Neira Ayuso if (!is_zero_ether_addr(match.mask->src) || 19848f256622SPablo Neira Ayuso !is_zero_ether_addr(match.mask->dst)) 1985d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 198654782900SOr Gerlitz } 198754782900SOr Gerlitz 19888f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) { 19898f256622SPablo Neira Ayuso struct flow_match_control match; 199054782900SOr Gerlitz 19918f256622SPablo Neira Ayuso flow_rule_match_control(rule, &match); 19928f256622SPablo Neira Ayuso addr_type = match.key->addr_type; 199354782900SOr Gerlitz 199454782900SOr Gerlitz /* the HW doesn't support frag first/later */ 19958f256622SPablo Neira Ayuso if (match.mask->flags & FLOW_DIS_FIRST_FRAG) 199654782900SOr Gerlitz return -EOPNOTSUPP; 199754782900SOr Gerlitz 19988f256622SPablo Neira Ayuso if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) { 199954782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 200054782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 20018f256622SPablo Neira Ayuso match.key->flags & FLOW_DIS_IS_FRAGMENT); 200254782900SOr Gerlitz 200354782900SOr Gerlitz /* the HW doesn't need L3 inline to match on frag=no */ 20048f256622SPablo Neira Ayuso if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT)) 200583621b7dSOr Gerlitz *match_level = MLX5_MATCH_L2; 200654782900SOr Gerlitz /* *** L2 attributes parsing up to here *** */ 200754782900SOr Gerlitz else 200883621b7dSOr Gerlitz *match_level = MLX5_MATCH_L3; 200954782900SOr Gerlitz } 201054782900SOr Gerlitz } 201154782900SOr Gerlitz 20128f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { 20138f256622SPablo Neira Ayuso struct flow_match_basic match; 20148f256622SPablo Neira Ayuso 20158f256622SPablo Neira Ayuso flow_rule_match_basic(rule, &match); 20168f256622SPablo Neira Ayuso ip_proto = match.key->ip_proto; 201754782900SOr Gerlitz 201854782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol, 20198f256622SPablo Neira Ayuso match.mask->ip_proto); 202054782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, 20218f256622SPablo Neira Ayuso match.key->ip_proto); 202254782900SOr Gerlitz 20238f256622SPablo Neira Ayuso if (match.mask->ip_proto) 2024d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 202554782900SOr Gerlitz } 202654782900SOr Gerlitz 2027e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 20288f256622SPablo Neira Ayuso struct flow_match_ipv4_addrs match; 2029e3a2b7edSAmir Vadai 20308f256622SPablo Neira Ayuso flow_rule_match_ipv4_addrs(rule, &match); 2031e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 2032e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 20338f256622SPablo Neira Ayuso &match.mask->src, sizeof(match.mask->src)); 2034e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 2035e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 20368f256622SPablo Neira Ayuso &match.key->src, sizeof(match.key->src)); 2037e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 2038e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 20398f256622SPablo Neira Ayuso &match.mask->dst, sizeof(match.mask->dst)); 2040e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 2041e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 20428f256622SPablo Neira Ayuso &match.key->dst, sizeof(match.key->dst)); 2043de0af0bfSRoi Dayan 20448f256622SPablo Neira Ayuso if (match.mask->src || match.mask->dst) 2045d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 2046e3a2b7edSAmir Vadai } 2047e3a2b7edSAmir Vadai 2048e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 20498f256622SPablo Neira Ayuso struct flow_match_ipv6_addrs match; 2050e3a2b7edSAmir Vadai 20518f256622SPablo Neira Ayuso flow_rule_match_ipv6_addrs(rule, &match); 2052e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 2053e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 20548f256622SPablo Neira Ayuso &match.mask->src, sizeof(match.mask->src)); 2055e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 2056e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 20578f256622SPablo Neira Ayuso &match.key->src, sizeof(match.key->src)); 2058e3a2b7edSAmir Vadai 2059e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 2060e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 20618f256622SPablo Neira Ayuso &match.mask->dst, sizeof(match.mask->dst)); 2062e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 2063e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 20648f256622SPablo Neira Ayuso &match.key->dst, sizeof(match.key->dst)); 2065de0af0bfSRoi Dayan 20668f256622SPablo Neira Ayuso if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY || 20678f256622SPablo Neira Ayuso ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY) 2068d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 2069e3a2b7edSAmir Vadai } 2070e3a2b7edSAmir Vadai 20718f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) { 20728f256622SPablo Neira Ayuso struct flow_match_ip match; 20731f97a526SOr Gerlitz 20748f256622SPablo Neira Ayuso flow_rule_match_ip(rule, &match); 20758f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, 20768f256622SPablo Neira Ayuso match.mask->tos & 0x3); 20778f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, 20788f256622SPablo Neira Ayuso match.key->tos & 0x3); 20791f97a526SOr Gerlitz 20808f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, 20818f256622SPablo Neira Ayuso match.mask->tos >> 2); 20828f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, 20838f256622SPablo Neira Ayuso match.key->tos >> 2); 20841f97a526SOr Gerlitz 20858f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, 20868f256622SPablo Neira Ayuso match.mask->ttl); 20878f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, 20888f256622SPablo Neira Ayuso match.key->ttl); 20891f97a526SOr Gerlitz 20908f256622SPablo Neira Ayuso if (match.mask->ttl && 2091a8ade55fSOr Gerlitz !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, 2092e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 2093e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2094e98bedf5SEli Britstein "Matching on TTL is not supported"); 20951f97a526SOr Gerlitz return -EOPNOTSUPP; 2096e98bedf5SEli Britstein } 2097a8ade55fSOr Gerlitz 20988f256622SPablo Neira Ayuso if (match.mask->tos || match.mask->ttl) 2099d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 21001f97a526SOr Gerlitz } 21011f97a526SOr Gerlitz 210254782900SOr Gerlitz /* *** L3 attributes parsing up to here *** */ 210354782900SOr Gerlitz 21048f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) { 21058f256622SPablo Neira Ayuso struct flow_match_ports match; 21068f256622SPablo Neira Ayuso 21078f256622SPablo Neira Ayuso flow_rule_match_ports(rule, &match); 2108e3a2b7edSAmir Vadai switch (ip_proto) { 2109e3a2b7edSAmir Vadai case IPPROTO_TCP: 2110e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 21118f256622SPablo Neira Ayuso tcp_sport, ntohs(match.mask->src)); 2112e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 21138f256622SPablo Neira Ayuso tcp_sport, ntohs(match.key->src)); 2114e3a2b7edSAmir Vadai 2115e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 21168f256622SPablo Neira Ayuso tcp_dport, ntohs(match.mask->dst)); 2117e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 21188f256622SPablo Neira Ayuso tcp_dport, ntohs(match.key->dst)); 2119e3a2b7edSAmir Vadai break; 2120e3a2b7edSAmir Vadai 2121e3a2b7edSAmir Vadai case IPPROTO_UDP: 2122e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 21238f256622SPablo Neira Ayuso udp_sport, ntohs(match.mask->src)); 2124e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 21258f256622SPablo Neira Ayuso udp_sport, ntohs(match.key->src)); 2126e3a2b7edSAmir Vadai 2127e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 21288f256622SPablo Neira Ayuso udp_dport, ntohs(match.mask->dst)); 2129e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 21308f256622SPablo Neira Ayuso udp_dport, ntohs(match.key->dst)); 2131e3a2b7edSAmir Vadai break; 2132e3a2b7edSAmir Vadai default: 2133e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2134e98bedf5SEli Britstein "Only UDP and TCP transports are supported for L4 matching"); 2135e3a2b7edSAmir Vadai netdev_err(priv->netdev, 2136e3a2b7edSAmir Vadai "Only UDP and TCP transport are supported\n"); 2137e3a2b7edSAmir Vadai return -EINVAL; 2138e3a2b7edSAmir Vadai } 2139de0af0bfSRoi Dayan 21408f256622SPablo Neira Ayuso if (match.mask->src || match.mask->dst) 2141d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 2142e3a2b7edSAmir Vadai } 2143e3a2b7edSAmir Vadai 21448f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) { 21458f256622SPablo Neira Ayuso struct flow_match_tcp match; 2146e77834ecSOr Gerlitz 21478f256622SPablo Neira Ayuso flow_rule_match_tcp(rule, &match); 2148e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags, 21498f256622SPablo Neira Ayuso ntohs(match.mask->flags)); 2150e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags, 21518f256622SPablo Neira Ayuso ntohs(match.key->flags)); 2152e77834ecSOr Gerlitz 21538f256622SPablo Neira Ayuso if (match.mask->flags) 2154d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 2155e77834ecSOr Gerlitz } 2156e77834ecSOr Gerlitz 2157e3a2b7edSAmir Vadai return 0; 2158e3a2b7edSAmir Vadai } 2159e3a2b7edSAmir Vadai 2160de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv, 216165ba8fb7SOr Gerlitz struct mlx5e_tc_flow *flow, 2162de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 2163f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 216454c177caSOz Shlomo struct net_device *filter_dev) 2165de0af0bfSRoi Dayan { 216693b3586eSHuy Nguyen u8 inner_match_level, outer_match_level, non_tunnel_match_level; 2167e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 2168de0af0bfSRoi Dayan struct mlx5_core_dev *dev = priv->mdev; 2169de0af0bfSRoi Dayan struct mlx5_eswitch *esw = dev->priv.eswitch; 21701d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 21711d447a39SSaeed Mahameed struct mlx5_eswitch_rep *rep; 2172226f2ca3SVlad Buslov bool is_eswitch_flow; 2173de0af0bfSRoi Dayan int err; 2174de0af0bfSRoi Dayan 217593b3586eSHuy Nguyen inner_match_level = MLX5_MATCH_NONE; 217693b3586eSHuy Nguyen outer_match_level = MLX5_MATCH_NONE; 217793b3586eSHuy Nguyen 217893b3586eSHuy Nguyen err = __parse_cls_flower(priv, spec, f, filter_dev, &inner_match_level, 217993b3586eSHuy Nguyen &outer_match_level); 218093b3586eSHuy Nguyen non_tunnel_match_level = (inner_match_level == MLX5_MATCH_NONE) ? 218193b3586eSHuy Nguyen outer_match_level : inner_match_level; 2182de0af0bfSRoi Dayan 2183226f2ca3SVlad Buslov is_eswitch_flow = mlx5e_is_eswitch_flow(flow); 2184226f2ca3SVlad Buslov if (!err && is_eswitch_flow) { 21851d447a39SSaeed Mahameed rep = rpriv->rep; 2186b05af6aaSBodong Wang if (rep->vport != MLX5_VPORT_UPLINK && 21871d447a39SSaeed Mahameed (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE && 218893b3586eSHuy Nguyen esw->offloads.inline_mode < non_tunnel_match_level)) { 2189e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2190e98bedf5SEli Britstein "Flow is not offloaded due to min inline setting"); 2191de0af0bfSRoi Dayan netdev_warn(priv->netdev, 2192de0af0bfSRoi Dayan "Flow is not offloaded due to min inline setting, required %d actual %d\n", 219393b3586eSHuy Nguyen non_tunnel_match_level, esw->offloads.inline_mode); 2194de0af0bfSRoi Dayan return -EOPNOTSUPP; 2195de0af0bfSRoi Dayan } 2196de0af0bfSRoi Dayan } 2197de0af0bfSRoi Dayan 2198226f2ca3SVlad Buslov if (is_eswitch_flow) { 219993b3586eSHuy Nguyen flow->esw_attr->inner_match_level = inner_match_level; 220093b3586eSHuy Nguyen flow->esw_attr->outer_match_level = outer_match_level; 22016363651dSOr Gerlitz } else { 220293b3586eSHuy Nguyen flow->nic_attr->match_level = non_tunnel_match_level; 22036363651dSOr Gerlitz } 220438aa51c1SOr Gerlitz 2205de0af0bfSRoi Dayan return err; 2206de0af0bfSRoi Dayan } 2207de0af0bfSRoi Dayan 2208d79b6df6SOr Gerlitz struct pedit_headers { 2209d79b6df6SOr Gerlitz struct ethhdr eth; 22100eb69bb9SEli Britstein struct vlan_hdr vlan; 2211d79b6df6SOr Gerlitz struct iphdr ip4; 2212d79b6df6SOr Gerlitz struct ipv6hdr ip6; 2213d79b6df6SOr Gerlitz struct tcphdr tcp; 2214d79b6df6SOr Gerlitz struct udphdr udp; 2215d79b6df6SOr Gerlitz }; 2216d79b6df6SOr Gerlitz 2217c500c86bSPablo Neira Ayuso struct pedit_headers_action { 2218c500c86bSPablo Neira Ayuso struct pedit_headers vals; 2219c500c86bSPablo Neira Ayuso struct pedit_headers masks; 2220c500c86bSPablo Neira Ayuso u32 pedits; 2221c500c86bSPablo Neira Ayuso }; 2222c500c86bSPablo Neira Ayuso 2223d79b6df6SOr Gerlitz static int pedit_header_offsets[] = { 222473867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth), 222573867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4), 222673867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6), 222773867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp), 222873867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp), 2229d79b6df6SOr Gerlitz }; 2230d79b6df6SOr Gerlitz 2231d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype]) 2232d79b6df6SOr Gerlitz 2233d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset, 2234c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs) 2235d79b6df6SOr Gerlitz { 2236d79b6df6SOr Gerlitz u32 *curr_pmask, *curr_pval; 2237d79b6df6SOr Gerlitz 2238c500c86bSPablo Neira Ayuso curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset); 2239c500c86bSPablo Neira Ayuso curr_pval = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset); 2240d79b6df6SOr Gerlitz 2241d79b6df6SOr Gerlitz if (*curr_pmask & mask) /* disallow acting twice on the same location */ 2242d79b6df6SOr Gerlitz goto out_err; 2243d79b6df6SOr Gerlitz 2244d79b6df6SOr Gerlitz *curr_pmask |= mask; 2245d79b6df6SOr Gerlitz *curr_pval |= (val & mask); 2246d79b6df6SOr Gerlitz 2247d79b6df6SOr Gerlitz return 0; 2248d79b6df6SOr Gerlitz 2249d79b6df6SOr Gerlitz out_err: 2250d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2251d79b6df6SOr Gerlitz } 2252d79b6df6SOr Gerlitz 2253d79b6df6SOr Gerlitz struct mlx5_fields { 2254d79b6df6SOr Gerlitz u8 field; 225588f30bbcSDmytro Linkin u8 field_bsize; 225688f30bbcSDmytro Linkin u32 field_mask; 2257d79b6df6SOr Gerlitz u32 offset; 225827c11b6bSEli Britstein u32 match_offset; 2259d79b6df6SOr Gerlitz }; 2260d79b6df6SOr Gerlitz 226188f30bbcSDmytro Linkin #define OFFLOAD(fw_field, field_bsize, field_mask, field, off, match_field) \ 226288f30bbcSDmytro Linkin {MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, field_bsize, field_mask, \ 226327c11b6bSEli Britstein offsetof(struct pedit_headers, field) + (off), \ 226427c11b6bSEli Britstein MLX5_BYTE_OFF(fte_match_set_lyr_2_4, match_field)} 226527c11b6bSEli Britstein 22662ef86872SEli Britstein /* masked values are the same and there are no rewrites that do not have a 22672ef86872SEli Britstein * match. 22682ef86872SEli Britstein */ 22692ef86872SEli Britstein #define SAME_VAL_MASK(type, valp, maskp, matchvalp, matchmaskp) ({ \ 22702ef86872SEli Britstein type matchmaskx = *(type *)(matchmaskp); \ 22712ef86872SEli Britstein type matchvalx = *(type *)(matchvalp); \ 22722ef86872SEli Britstein type maskx = *(type *)(maskp); \ 22732ef86872SEli Britstein type valx = *(type *)(valp); \ 22742ef86872SEli Britstein \ 22752ef86872SEli Britstein (valx & maskx) == (matchvalx & matchmaskx) && !(maskx & (maskx ^ \ 22762ef86872SEli Britstein matchmaskx)); \ 22772ef86872SEli Britstein }) 22782ef86872SEli Britstein 227927c11b6bSEli Britstein static bool cmp_val_mask(void *valp, void *maskp, void *matchvalp, 228088f30bbcSDmytro Linkin void *matchmaskp, u8 bsize) 228127c11b6bSEli Britstein { 228227c11b6bSEli Britstein bool same = false; 228327c11b6bSEli Britstein 228488f30bbcSDmytro Linkin switch (bsize) { 228588f30bbcSDmytro Linkin case 8: 22862ef86872SEli Britstein same = SAME_VAL_MASK(u8, valp, maskp, matchvalp, matchmaskp); 228727c11b6bSEli Britstein break; 228888f30bbcSDmytro Linkin case 16: 22892ef86872SEli Britstein same = SAME_VAL_MASK(u16, valp, maskp, matchvalp, matchmaskp); 229027c11b6bSEli Britstein break; 229188f30bbcSDmytro Linkin case 32: 22922ef86872SEli Britstein same = SAME_VAL_MASK(u32, valp, maskp, matchvalp, matchmaskp); 229327c11b6bSEli Britstein break; 229427c11b6bSEli Britstein } 229527c11b6bSEli Britstein 229627c11b6bSEli Britstein return same; 229727c11b6bSEli Britstein } 2298a8e4f0c4SOr Gerlitz 2299d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = { 230088f30bbcSDmytro Linkin OFFLOAD(DMAC_47_16, 32, U32_MAX, eth.h_dest[0], 0, dmac_47_16), 230188f30bbcSDmytro Linkin OFFLOAD(DMAC_15_0, 16, U16_MAX, eth.h_dest[4], 0, dmac_15_0), 230288f30bbcSDmytro Linkin OFFLOAD(SMAC_47_16, 32, U32_MAX, eth.h_source[0], 0, smac_47_16), 230388f30bbcSDmytro Linkin OFFLOAD(SMAC_15_0, 16, U16_MAX, eth.h_source[4], 0, smac_15_0), 230488f30bbcSDmytro Linkin OFFLOAD(ETHERTYPE, 16, U16_MAX, eth.h_proto, 0, ethertype), 230588f30bbcSDmytro Linkin OFFLOAD(FIRST_VID, 16, U16_MAX, vlan.h_vlan_TCI, 0, first_vid), 2306d79b6df6SOr Gerlitz 2307ab9341b5SDmytro Linkin OFFLOAD(IP_DSCP, 8, 0xfc, ip4.tos, 0, ip_dscp), 230888f30bbcSDmytro Linkin OFFLOAD(IP_TTL, 8, U8_MAX, ip4.ttl, 0, ttl_hoplimit), 230988f30bbcSDmytro Linkin OFFLOAD(SIPV4, 32, U32_MAX, ip4.saddr, 0, src_ipv4_src_ipv6.ipv4_layout.ipv4), 231088f30bbcSDmytro Linkin OFFLOAD(DIPV4, 32, U32_MAX, ip4.daddr, 0, dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 2311d79b6df6SOr Gerlitz 231288f30bbcSDmytro Linkin OFFLOAD(SIPV6_127_96, 32, U32_MAX, ip6.saddr.s6_addr32[0], 0, 231327c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[0]), 231488f30bbcSDmytro Linkin OFFLOAD(SIPV6_95_64, 32, U32_MAX, ip6.saddr.s6_addr32[1], 0, 231527c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[4]), 231688f30bbcSDmytro Linkin OFFLOAD(SIPV6_63_32, 32, U32_MAX, ip6.saddr.s6_addr32[2], 0, 231727c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[8]), 231888f30bbcSDmytro Linkin OFFLOAD(SIPV6_31_0, 32, U32_MAX, ip6.saddr.s6_addr32[3], 0, 231927c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[12]), 232088f30bbcSDmytro Linkin OFFLOAD(DIPV6_127_96, 32, U32_MAX, ip6.daddr.s6_addr32[0], 0, 232127c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[0]), 232288f30bbcSDmytro Linkin OFFLOAD(DIPV6_95_64, 32, U32_MAX, ip6.daddr.s6_addr32[1], 0, 232327c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[4]), 232488f30bbcSDmytro Linkin OFFLOAD(DIPV6_63_32, 32, U32_MAX, ip6.daddr.s6_addr32[2], 0, 232527c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[8]), 232688f30bbcSDmytro Linkin OFFLOAD(DIPV6_31_0, 32, U32_MAX, ip6.daddr.s6_addr32[3], 0, 232727c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[12]), 232888f30bbcSDmytro Linkin OFFLOAD(IPV6_HOPLIMIT, 8, U8_MAX, ip6.hop_limit, 0, ttl_hoplimit), 2329d79b6df6SOr Gerlitz 233088f30bbcSDmytro Linkin OFFLOAD(TCP_SPORT, 16, U16_MAX, tcp.source, 0, tcp_sport), 233188f30bbcSDmytro Linkin OFFLOAD(TCP_DPORT, 16, U16_MAX, tcp.dest, 0, tcp_dport), 233288f30bbcSDmytro Linkin /* in linux iphdr tcp_flags is 8 bits long */ 233388f30bbcSDmytro Linkin OFFLOAD(TCP_FLAGS, 8, U8_MAX, tcp.ack_seq, 5, tcp_flags), 2334d79b6df6SOr Gerlitz 233588f30bbcSDmytro Linkin OFFLOAD(UDP_SPORT, 16, U16_MAX, udp.source, 0, udp_sport), 233688f30bbcSDmytro Linkin OFFLOAD(UDP_DPORT, 16, U16_MAX, udp.dest, 0, udp_dport), 2337d79b6df6SOr Gerlitz }; 2338d79b6df6SOr Gerlitz 2339218d05ceSTonghao Zhang /* On input attr->max_mod_hdr_actions tells how many HW actions can be parsed at 2340218d05ceSTonghao Zhang * max from the SW pedit action. On success, attr->num_mod_hdr_actions 2341218d05ceSTonghao Zhang * says how many HW actions were actually parsed. 2342d79b6df6SOr Gerlitz */ 2343c500c86bSPablo Neira Ayuso static int offload_pedit_fields(struct pedit_headers_action *hdrs, 2344e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 234527c11b6bSEli Britstein u32 *action_flags, 2346e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2347d79b6df6SOr Gerlitz { 2348d79b6df6SOr Gerlitz struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals; 23492b64bebaSOr Gerlitz int i, action_size, nactions, max_actions, first, last, next_z; 235088f30bbcSDmytro Linkin void *headers_c, *headers_v, *action, *vals_p; 235188f30bbcSDmytro Linkin u32 *s_masks_p, *a_masks_p, s_mask, a_mask; 2352d79b6df6SOr Gerlitz struct mlx5_fields *f; 2353d79b6df6SOr Gerlitz unsigned long mask; 23542b64bebaSOr Gerlitz __be32 mask_be32; 23552b64bebaSOr Gerlitz __be16 mask_be16; 235688f30bbcSDmytro Linkin u8 cmd; 235788f30bbcSDmytro Linkin 235888f30bbcSDmytro Linkin headers_c = get_match_headers_criteria(*action_flags, &parse_attr->spec); 235988f30bbcSDmytro Linkin headers_v = get_match_headers_value(*action_flags, &parse_attr->spec); 2360d79b6df6SOr Gerlitz 236173867881SPablo Neira Ayuso set_masks = &hdrs[0].masks; 236273867881SPablo Neira Ayuso add_masks = &hdrs[1].masks; 236373867881SPablo Neira Ayuso set_vals = &hdrs[0].vals; 236473867881SPablo Neira Ayuso add_vals = &hdrs[1].vals; 2365d79b6df6SOr Gerlitz 2366d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 2367218d05ceSTonghao Zhang action = parse_attr->mod_hdr_actions + 2368218d05ceSTonghao Zhang parse_attr->num_mod_hdr_actions * action_size; 2369218d05ceSTonghao Zhang 2370218d05ceSTonghao Zhang max_actions = parse_attr->max_mod_hdr_actions; 2371218d05ceSTonghao Zhang nactions = parse_attr->num_mod_hdr_actions; 2372d79b6df6SOr Gerlitz 2373d79b6df6SOr Gerlitz for (i = 0; i < ARRAY_SIZE(fields); i++) { 237427c11b6bSEli Britstein bool skip; 237527c11b6bSEli Britstein 2376d79b6df6SOr Gerlitz f = &fields[i]; 2377d79b6df6SOr Gerlitz /* avoid seeing bits set from previous iterations */ 2378e3ca4e05SOr Gerlitz s_mask = 0; 2379e3ca4e05SOr Gerlitz a_mask = 0; 2380d79b6df6SOr Gerlitz 2381d79b6df6SOr Gerlitz s_masks_p = (void *)set_masks + f->offset; 2382d79b6df6SOr Gerlitz a_masks_p = (void *)add_masks + f->offset; 2383d79b6df6SOr Gerlitz 238488f30bbcSDmytro Linkin s_mask = *s_masks_p & f->field_mask; 238588f30bbcSDmytro Linkin a_mask = *a_masks_p & f->field_mask; 2386d79b6df6SOr Gerlitz 2387d79b6df6SOr Gerlitz if (!s_mask && !a_mask) /* nothing to offload here */ 2388d79b6df6SOr Gerlitz continue; 2389d79b6df6SOr Gerlitz 2390d79b6df6SOr Gerlitz if (s_mask && a_mask) { 2391e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2392e98bedf5SEli Britstein "can't set and add to the same HW field"); 2393d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field); 2394d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2395d79b6df6SOr Gerlitz } 2396d79b6df6SOr Gerlitz 2397d79b6df6SOr Gerlitz if (nactions == max_actions) { 2398e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2399e98bedf5SEli Britstein "too many pedit actions, can't offload"); 2400d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions); 2401d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2402d79b6df6SOr Gerlitz } 2403d79b6df6SOr Gerlitz 240427c11b6bSEli Britstein skip = false; 2405d79b6df6SOr Gerlitz if (s_mask) { 240627c11b6bSEli Britstein void *match_mask = headers_c + f->match_offset; 240727c11b6bSEli Britstein void *match_val = headers_v + f->match_offset; 240827c11b6bSEli Britstein 2409d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_SET; 2410d79b6df6SOr Gerlitz mask = s_mask; 2411d79b6df6SOr Gerlitz vals_p = (void *)set_vals + f->offset; 241227c11b6bSEli Britstein /* don't rewrite if we have a match on the same value */ 241327c11b6bSEli Britstein if (cmp_val_mask(vals_p, s_masks_p, match_val, 241488f30bbcSDmytro Linkin match_mask, f->field_bsize)) 241527c11b6bSEli Britstein skip = true; 2416d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 241788f30bbcSDmytro Linkin *s_masks_p &= ~f->field_mask; 2418d79b6df6SOr Gerlitz } else { 2419d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_ADD; 2420d79b6df6SOr Gerlitz mask = a_mask; 2421d79b6df6SOr Gerlitz vals_p = (void *)add_vals + f->offset; 242227c11b6bSEli Britstein /* add 0 is no change */ 242388f30bbcSDmytro Linkin if ((*(u32 *)vals_p & f->field_mask) == 0) 242427c11b6bSEli Britstein skip = true; 2425d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 242688f30bbcSDmytro Linkin *a_masks_p &= ~f->field_mask; 2427d79b6df6SOr Gerlitz } 242827c11b6bSEli Britstein if (skip) 242927c11b6bSEli Britstein continue; 2430d79b6df6SOr Gerlitz 243188f30bbcSDmytro Linkin if (f->field_bsize == 32) { 24322b64bebaSOr Gerlitz mask_be32 = *(__be32 *)&mask; 24332b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32)); 243488f30bbcSDmytro Linkin } else if (f->field_bsize == 16) { 24352b64bebaSOr Gerlitz mask_be16 = *(__be16 *)&mask; 24362b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16)); 24372b64bebaSOr Gerlitz } 24382b64bebaSOr Gerlitz 243988f30bbcSDmytro Linkin first = find_first_bit(&mask, f->field_bsize); 244088f30bbcSDmytro Linkin next_z = find_next_zero_bit(&mask, f->field_bsize, first); 244188f30bbcSDmytro Linkin last = find_last_bit(&mask, f->field_bsize); 24422b64bebaSOr Gerlitz if (first < next_z && next_z < last) { 2443e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2444e98bedf5SEli Britstein "rewrite of few sub-fields isn't supported"); 24452b64bebaSOr Gerlitz printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n", 2446d79b6df6SOr Gerlitz mask); 2447d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2448d79b6df6SOr Gerlitz } 2449d79b6df6SOr Gerlitz 2450d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, action_type, cmd); 2451d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, field, f->field); 2452d79b6df6SOr Gerlitz 2453d79b6df6SOr Gerlitz if (cmd == MLX5_ACTION_TYPE_SET) { 245488f30bbcSDmytro Linkin int start; 245588f30bbcSDmytro Linkin 245688f30bbcSDmytro Linkin /* if field is bit sized it can start not from first bit */ 245788f30bbcSDmytro Linkin start = find_first_bit((unsigned long *)&f->field_mask, 245888f30bbcSDmytro Linkin f->field_bsize); 245988f30bbcSDmytro Linkin 246088f30bbcSDmytro Linkin MLX5_SET(set_action_in, action, offset, first - start); 2461d79b6df6SOr Gerlitz /* length is num of bits to be written, zero means length of 32 */ 24622b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, length, (last - first + 1)); 2463d79b6df6SOr Gerlitz } 2464d79b6df6SOr Gerlitz 246588f30bbcSDmytro Linkin if (f->field_bsize == 32) 24662b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first); 246788f30bbcSDmytro Linkin else if (f->field_bsize == 16) 24682b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first); 246988f30bbcSDmytro Linkin else if (f->field_bsize == 8) 24702b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first); 2471d79b6df6SOr Gerlitz 2472d79b6df6SOr Gerlitz action += action_size; 2473d79b6df6SOr Gerlitz nactions++; 2474d79b6df6SOr Gerlitz } 2475d79b6df6SOr Gerlitz 2476d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = nactions; 2477d79b6df6SOr Gerlitz return 0; 2478d79b6df6SOr Gerlitz } 2479d79b6df6SOr Gerlitz 24802cc1cb1dSTonghao Zhang static int mlx5e_flow_namespace_max_modify_action(struct mlx5_core_dev *mdev, 24812cc1cb1dSTonghao Zhang int namespace) 24822cc1cb1dSTonghao Zhang { 24832cc1cb1dSTonghao Zhang if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */ 24842cc1cb1dSTonghao Zhang return MLX5_CAP_ESW_FLOWTABLE_FDB(mdev, max_modify_header_actions); 24852cc1cb1dSTonghao Zhang else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */ 24862cc1cb1dSTonghao Zhang return MLX5_CAP_FLOWTABLE_NIC_RX(mdev, max_modify_header_actions); 24872cc1cb1dSTonghao Zhang } 24882cc1cb1dSTonghao Zhang 2489d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv, 2490c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 2491c500c86bSPablo Neira Ayuso int namespace, 2492d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 2493d79b6df6SOr Gerlitz { 2494d79b6df6SOr Gerlitz int nkeys, action_size, max_actions; 2495d79b6df6SOr Gerlitz 2496c500c86bSPablo Neira Ayuso nkeys = hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits + 2497c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits; 2498d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 2499d79b6df6SOr Gerlitz 25002cc1cb1dSTonghao Zhang max_actions = mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace); 2501d79b6df6SOr Gerlitz /* can get up to crazingly 16 HW actions in 32 bits pedit SW key */ 2502d79b6df6SOr Gerlitz max_actions = min(max_actions, nkeys * 16); 2503d79b6df6SOr Gerlitz 2504d79b6df6SOr Gerlitz parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL); 2505d79b6df6SOr Gerlitz if (!parse_attr->mod_hdr_actions) 2506d79b6df6SOr Gerlitz return -ENOMEM; 2507d79b6df6SOr Gerlitz 2508218d05ceSTonghao Zhang parse_attr->max_mod_hdr_actions = max_actions; 2509d79b6df6SOr Gerlitz return 0; 2510d79b6df6SOr Gerlitz } 2511d79b6df6SOr Gerlitz 2512d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {}; 2513d79b6df6SOr Gerlitz 2514d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv, 251573867881SPablo Neira Ayuso const struct flow_action_entry *act, int namespace, 2516e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 2517c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 2518e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2519d79b6df6SOr Gerlitz { 252073867881SPablo Neira Ayuso u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1; 252173867881SPablo Neira Ayuso int err = -EOPNOTSUPP; 2522d79b6df6SOr Gerlitz u32 mask, val, offset; 252373867881SPablo Neira Ayuso u8 htype; 2524d79b6df6SOr Gerlitz 252573867881SPablo Neira Ayuso htype = act->mangle.htype; 2526d79b6df6SOr Gerlitz err = -EOPNOTSUPP; /* can't be all optimistic */ 2527d79b6df6SOr Gerlitz 252873867881SPablo Neira Ayuso if (htype == FLOW_ACT_MANGLE_UNSPEC) { 252973867881SPablo Neira Ayuso NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded"); 2530d79b6df6SOr Gerlitz goto out_err; 2531d79b6df6SOr Gerlitz } 2532d79b6df6SOr Gerlitz 25332cc1cb1dSTonghao Zhang if (!mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace)) { 25342cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, 25352cc1cb1dSTonghao Zhang "The pedit offload action is not supported"); 25362cc1cb1dSTonghao Zhang goto out_err; 25372cc1cb1dSTonghao Zhang } 25382cc1cb1dSTonghao Zhang 253973867881SPablo Neira Ayuso mask = act->mangle.mask; 254073867881SPablo Neira Ayuso val = act->mangle.val; 254173867881SPablo Neira Ayuso offset = act->mangle.offset; 2542d79b6df6SOr Gerlitz 2543c500c86bSPablo Neira Ayuso err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]); 2544d79b6df6SOr Gerlitz if (err) 2545d79b6df6SOr Gerlitz goto out_err; 2546c500c86bSPablo Neira Ayuso 2547c500c86bSPablo Neira Ayuso hdrs[cmd].pedits++; 2548d79b6df6SOr Gerlitz 2549c500c86bSPablo Neira Ayuso return 0; 2550c500c86bSPablo Neira Ayuso out_err: 2551c500c86bSPablo Neira Ayuso return err; 2552c500c86bSPablo Neira Ayuso } 2553c500c86bSPablo Neira Ayuso 2554c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace, 2555c500c86bSPablo Neira Ayuso struct mlx5e_tc_flow_parse_attr *parse_attr, 2556c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 255727c11b6bSEli Britstein u32 *action_flags, 2558c500c86bSPablo Neira Ayuso struct netlink_ext_ack *extack) 2559c500c86bSPablo Neira Ayuso { 2560c500c86bSPablo Neira Ayuso struct pedit_headers *cmd_masks; 2561c500c86bSPablo Neira Ayuso int err; 2562c500c86bSPablo Neira Ayuso u8 cmd; 2563c500c86bSPablo Neira Ayuso 2564218d05ceSTonghao Zhang if (!parse_attr->mod_hdr_actions) { 2565c500c86bSPablo Neira Ayuso err = alloc_mod_hdr_actions(priv, hdrs, namespace, parse_attr); 2566d79b6df6SOr Gerlitz if (err) 2567d79b6df6SOr Gerlitz goto out_err; 2568218d05ceSTonghao Zhang } 2569d79b6df6SOr Gerlitz 257027c11b6bSEli Britstein err = offload_pedit_fields(hdrs, parse_attr, action_flags, extack); 2571d79b6df6SOr Gerlitz if (err < 0) 2572d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 2573d79b6df6SOr Gerlitz 2574d79b6df6SOr Gerlitz for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) { 2575c500c86bSPablo Neira Ayuso cmd_masks = &hdrs[cmd].masks; 2576d79b6df6SOr Gerlitz if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) { 2577e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2578e98bedf5SEli Britstein "attempt to offload an unsupported field"); 2579b3a433deSOr Gerlitz netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd); 2580d79b6df6SOr Gerlitz print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS, 2581d79b6df6SOr Gerlitz 16, 1, cmd_masks, sizeof(zero_masks), true); 2582d79b6df6SOr Gerlitz err = -EOPNOTSUPP; 2583d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 2584d79b6df6SOr Gerlitz } 2585d79b6df6SOr Gerlitz } 2586d79b6df6SOr Gerlitz 2587d79b6df6SOr Gerlitz return 0; 2588d79b6df6SOr Gerlitz 2589d79b6df6SOr Gerlitz out_dealloc_parsed_actions: 2590d79b6df6SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 2591d79b6df6SOr Gerlitz out_err: 2592d79b6df6SOr Gerlitz return err; 2593d79b6df6SOr Gerlitz } 2594d79b6df6SOr Gerlitz 2595e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv, 2596e98bedf5SEli Britstein u32 action, 2597e98bedf5SEli Britstein u32 update_flags, 2598e98bedf5SEli Britstein struct netlink_ext_ack *extack) 259926c02749SOr Gerlitz { 260026c02749SOr Gerlitz u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP | 260126c02749SOr Gerlitz TCA_CSUM_UPDATE_FLAG_UDP; 260226c02749SOr Gerlitz 260326c02749SOr Gerlitz /* The HW recalcs checksums only if re-writing headers */ 260426c02749SOr Gerlitz if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) { 2605e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2606e98bedf5SEli Britstein "TC csum action is only offloaded with pedit"); 260726c02749SOr Gerlitz netdev_warn(priv->netdev, 260826c02749SOr Gerlitz "TC csum action is only offloaded with pedit\n"); 260926c02749SOr Gerlitz return false; 261026c02749SOr Gerlitz } 261126c02749SOr Gerlitz 261226c02749SOr Gerlitz if (update_flags & ~prot_flags) { 2613e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2614e98bedf5SEli Britstein "can't offload TC csum action for some header/s"); 261526c02749SOr Gerlitz netdev_warn(priv->netdev, 261626c02749SOr Gerlitz "can't offload TC csum action for some header/s - flags %#x\n", 261726c02749SOr Gerlitz update_flags); 261826c02749SOr Gerlitz return false; 261926c02749SOr Gerlitz } 262026c02749SOr Gerlitz 262126c02749SOr Gerlitz return true; 262226c02749SOr Gerlitz } 262326c02749SOr Gerlitz 26248998576bSDmytro Linkin struct ip_ttl_word { 26258998576bSDmytro Linkin __u8 ttl; 26268998576bSDmytro Linkin __u8 protocol; 26278998576bSDmytro Linkin __sum16 check; 26288998576bSDmytro Linkin }; 26298998576bSDmytro Linkin 26308998576bSDmytro Linkin struct ipv6_hoplimit_word { 26318998576bSDmytro Linkin __be16 payload_len; 26328998576bSDmytro Linkin __u8 nexthdr; 26338998576bSDmytro Linkin __u8 hop_limit; 26348998576bSDmytro Linkin }; 26358998576bSDmytro Linkin 26368998576bSDmytro Linkin static bool is_action_keys_supported(const struct flow_action_entry *act) 26378998576bSDmytro Linkin { 26388998576bSDmytro Linkin u32 mask, offset; 26398998576bSDmytro Linkin u8 htype; 26408998576bSDmytro Linkin 26418998576bSDmytro Linkin htype = act->mangle.htype; 26428998576bSDmytro Linkin offset = act->mangle.offset; 26438998576bSDmytro Linkin mask = ~act->mangle.mask; 26448998576bSDmytro Linkin /* For IPv4 & IPv6 header check 4 byte word, 26458998576bSDmytro Linkin * to determine that modified fields 26468998576bSDmytro Linkin * are NOT ttl & hop_limit only. 26478998576bSDmytro Linkin */ 26488998576bSDmytro Linkin if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4) { 26498998576bSDmytro Linkin struct ip_ttl_word *ttl_word = 26508998576bSDmytro Linkin (struct ip_ttl_word *)&mask; 26518998576bSDmytro Linkin 26528998576bSDmytro Linkin if (offset != offsetof(struct iphdr, ttl) || 26538998576bSDmytro Linkin ttl_word->protocol || 26548998576bSDmytro Linkin ttl_word->check) { 26558998576bSDmytro Linkin return true; 26568998576bSDmytro Linkin } 26578998576bSDmytro Linkin } else if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) { 26588998576bSDmytro Linkin struct ipv6_hoplimit_word *hoplimit_word = 26598998576bSDmytro Linkin (struct ipv6_hoplimit_word *)&mask; 26608998576bSDmytro Linkin 26618998576bSDmytro Linkin if (offset != offsetof(struct ipv6hdr, payload_len) || 26628998576bSDmytro Linkin hoplimit_word->payload_len || 26638998576bSDmytro Linkin hoplimit_word->nexthdr) { 26648998576bSDmytro Linkin return true; 26658998576bSDmytro Linkin } 26668998576bSDmytro Linkin } 26678998576bSDmytro Linkin return false; 26688998576bSDmytro Linkin } 26698998576bSDmytro Linkin 2670bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec, 267173867881SPablo Neira Ayuso struct flow_action *flow_action, 26721651925dSGuy Shattah u32 actions, 2673e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2674bdd66ac0SOr Gerlitz { 267573867881SPablo Neira Ayuso const struct flow_action_entry *act; 2676bdd66ac0SOr Gerlitz bool modify_ip_header; 2677bdd66ac0SOr Gerlitz void *headers_v; 2678bdd66ac0SOr Gerlitz u16 ethertype; 26798998576bSDmytro Linkin u8 ip_proto; 268073867881SPablo Neira Ayuso int i; 2681bdd66ac0SOr Gerlitz 26828377629eSEli Britstein headers_v = get_match_headers_value(actions, spec); 2683bdd66ac0SOr Gerlitz ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype); 2684bdd66ac0SOr Gerlitz 2685bdd66ac0SOr Gerlitz /* for non-IP we only re-write MACs, so we're okay */ 2686bdd66ac0SOr Gerlitz if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6) 2687bdd66ac0SOr Gerlitz goto out_ok; 2688bdd66ac0SOr Gerlitz 2689bdd66ac0SOr Gerlitz modify_ip_header = false; 269073867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 269173867881SPablo Neira Ayuso if (act->id != FLOW_ACTION_MANGLE && 269273867881SPablo Neira Ayuso act->id != FLOW_ACTION_ADD) 2693bdd66ac0SOr Gerlitz continue; 2694bdd66ac0SOr Gerlitz 26958998576bSDmytro Linkin if (is_action_keys_supported(act)) { 2696bdd66ac0SOr Gerlitz modify_ip_header = true; 2697bdd66ac0SOr Gerlitz break; 2698bdd66ac0SOr Gerlitz } 2699bdd66ac0SOr Gerlitz } 2700bdd66ac0SOr Gerlitz 2701bdd66ac0SOr Gerlitz ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol); 27021ccef350SJianbo Liu if (modify_ip_header && ip_proto != IPPROTO_TCP && 27031ccef350SJianbo Liu ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) { 2704e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2705e98bedf5SEli Britstein "can't offload re-write of non TCP/UDP"); 2706bdd66ac0SOr Gerlitz pr_info("can't offload re-write of ip proto %d\n", ip_proto); 2707bdd66ac0SOr Gerlitz return false; 2708bdd66ac0SOr Gerlitz } 2709bdd66ac0SOr Gerlitz 2710bdd66ac0SOr Gerlitz out_ok: 2711bdd66ac0SOr Gerlitz return true; 2712bdd66ac0SOr Gerlitz } 2713bdd66ac0SOr Gerlitz 2714bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv, 271573867881SPablo Neira Ayuso struct flow_action *flow_action, 2716bdd66ac0SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2717e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2718e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2719bdd66ac0SOr Gerlitz { 2720bdd66ac0SOr Gerlitz u32 actions; 2721bdd66ac0SOr Gerlitz 2722226f2ca3SVlad Buslov if (mlx5e_is_eswitch_flow(flow)) 2723bdd66ac0SOr Gerlitz actions = flow->esw_attr->action; 2724bdd66ac0SOr Gerlitz else 2725bdd66ac0SOr Gerlitz actions = flow->nic_attr->action; 2726bdd66ac0SOr Gerlitz 2727226f2ca3SVlad Buslov if (flow_flag_test(flow, EGRESS) && 272835a605dbSEli Britstein !((actions & MLX5_FLOW_CONTEXT_ACTION_DECAP) || 27296830b468STonghao Zhang (actions & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) || 27306830b468STonghao Zhang (actions & MLX5_FLOW_CONTEXT_ACTION_DROP))) 27317e29392eSRoi Dayan return false; 27327e29392eSRoi Dayan 2733bdd66ac0SOr Gerlitz if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 273473867881SPablo Neira Ayuso return modify_header_match_supported(&parse_attr->spec, 2735a655fe9fSDavid S. Miller flow_action, actions, 2736e98bedf5SEli Britstein extack); 2737bdd66ac0SOr Gerlitz 2738bdd66ac0SOr Gerlitz return true; 2739bdd66ac0SOr Gerlitz } 2740bdd66ac0SOr Gerlitz 27415c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv) 27425c65c564SOr Gerlitz { 27435c65c564SOr Gerlitz struct mlx5_core_dev *fmdev, *pmdev; 2744816f6706SOr Gerlitz u64 fsystem_guid, psystem_guid; 27455c65c564SOr Gerlitz 27465c65c564SOr Gerlitz fmdev = priv->mdev; 27475c65c564SOr Gerlitz pmdev = peer_priv->mdev; 27485c65c564SOr Gerlitz 274959c9d35eSAlaa Hleihel fsystem_guid = mlx5_query_nic_system_image_guid(fmdev); 275059c9d35eSAlaa Hleihel psystem_guid = mlx5_query_nic_system_image_guid(pmdev); 27515c65c564SOr Gerlitz 2752816f6706SOr Gerlitz return (fsystem_guid == psystem_guid); 27535c65c564SOr Gerlitz } 27545c65c564SOr Gerlitz 2755bdc837eeSEli Britstein static int add_vlan_rewrite_action(struct mlx5e_priv *priv, int namespace, 2756bdc837eeSEli Britstein const struct flow_action_entry *act, 2757bdc837eeSEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 2758bdc837eeSEli Britstein struct pedit_headers_action *hdrs, 2759bdc837eeSEli Britstein u32 *action, struct netlink_ext_ack *extack) 2760bdc837eeSEli Britstein { 2761bdc837eeSEli Britstein u16 mask16 = VLAN_VID_MASK; 2762bdc837eeSEli Britstein u16 val16 = act->vlan.vid & VLAN_VID_MASK; 2763bdc837eeSEli Britstein const struct flow_action_entry pedit_act = { 2764bdc837eeSEli Britstein .id = FLOW_ACTION_MANGLE, 2765bdc837eeSEli Britstein .mangle.htype = FLOW_ACT_MANGLE_HDR_TYPE_ETH, 2766bdc837eeSEli Britstein .mangle.offset = offsetof(struct vlan_ethhdr, h_vlan_TCI), 2767bdc837eeSEli Britstein .mangle.mask = ~(u32)be16_to_cpu(*(__be16 *)&mask16), 2768bdc837eeSEli Britstein .mangle.val = (u32)be16_to_cpu(*(__be16 *)&val16), 2769bdc837eeSEli Britstein }; 27706fca9d1eSEli Britstein u8 match_prio_mask, match_prio_val; 2771bf2f3bcaSEli Britstein void *headers_c, *headers_v; 2772bdc837eeSEli Britstein int err; 2773bdc837eeSEli Britstein 2774bf2f3bcaSEli Britstein headers_c = get_match_headers_criteria(*action, &parse_attr->spec); 2775bf2f3bcaSEli Britstein headers_v = get_match_headers_value(*action, &parse_attr->spec); 2776bf2f3bcaSEli Britstein 2777bf2f3bcaSEli Britstein if (!(MLX5_GET(fte_match_set_lyr_2_4, headers_c, cvlan_tag) && 2778bf2f3bcaSEli Britstein MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag))) { 2779bf2f3bcaSEli Britstein NL_SET_ERR_MSG_MOD(extack, 2780bf2f3bcaSEli Britstein "VLAN rewrite action must have VLAN protocol match"); 2781bf2f3bcaSEli Britstein return -EOPNOTSUPP; 2782bf2f3bcaSEli Britstein } 2783bf2f3bcaSEli Britstein 27846fca9d1eSEli Britstein match_prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 27856fca9d1eSEli Britstein match_prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 27866fca9d1eSEli Britstein if (act->vlan.prio != (match_prio_val & match_prio_mask)) { 27876fca9d1eSEli Britstein NL_SET_ERR_MSG_MOD(extack, 27886fca9d1eSEli Britstein "Changing VLAN prio is not supported"); 2789bdc837eeSEli Britstein return -EOPNOTSUPP; 2790bdc837eeSEli Britstein } 2791bdc837eeSEli Britstein 2792bdc837eeSEli Britstein err = parse_tc_pedit_action(priv, &pedit_act, namespace, parse_attr, 2793bdc837eeSEli Britstein hdrs, NULL); 2794bdc837eeSEli Britstein *action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2795bdc837eeSEli Britstein 2796bdc837eeSEli Britstein return err; 2797bdc837eeSEli Britstein } 2798bdc837eeSEli Britstein 27990bac1194SEli Britstein static int 28000bac1194SEli Britstein add_vlan_prio_tag_rewrite_action(struct mlx5e_priv *priv, 28010bac1194SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 28020bac1194SEli Britstein struct pedit_headers_action *hdrs, 28030bac1194SEli Britstein u32 *action, struct netlink_ext_ack *extack) 28040bac1194SEli Britstein { 28050bac1194SEli Britstein const struct flow_action_entry prio_tag_act = { 28060bac1194SEli Britstein .vlan.vid = 0, 28070bac1194SEli Britstein .vlan.prio = 28080bac1194SEli Britstein MLX5_GET(fte_match_set_lyr_2_4, 28090bac1194SEli Britstein get_match_headers_value(*action, 28100bac1194SEli Britstein &parse_attr->spec), 28110bac1194SEli Britstein first_prio) & 28120bac1194SEli Britstein MLX5_GET(fte_match_set_lyr_2_4, 28130bac1194SEli Britstein get_match_headers_criteria(*action, 28140bac1194SEli Britstein &parse_attr->spec), 28150bac1194SEli Britstein first_prio), 28160bac1194SEli Britstein }; 28170bac1194SEli Britstein 28180bac1194SEli Britstein return add_vlan_rewrite_action(priv, MLX5_FLOW_NAMESPACE_FDB, 28190bac1194SEli Britstein &prio_tag_act, parse_attr, hdrs, action, 28200bac1194SEli Britstein extack); 28210bac1194SEli Britstein } 28220bac1194SEli Britstein 282373867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv, 282473867881SPablo Neira Ayuso struct flow_action *flow_action, 2825aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2826e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2827e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2828e3a2b7edSAmir Vadai { 2829aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 283073867881SPablo Neira Ayuso struct pedit_headers_action hdrs[2] = {}; 283173867881SPablo Neira Ayuso const struct flow_action_entry *act; 28321cab1cd7SOr Gerlitz u32 action = 0; 2833244cd96aSCong Wang int err, i; 2834e3a2b7edSAmir Vadai 283573867881SPablo Neira Ayuso if (!flow_action_has_entries(flow_action)) 2836e3a2b7edSAmir Vadai return -EINVAL; 2837e3a2b7edSAmir Vadai 28383bc4b7bfSOr Gerlitz attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG; 2839e3a2b7edSAmir Vadai 284073867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 284173867881SPablo Neira Ayuso switch (act->id) { 284273867881SPablo Neira Ayuso case FLOW_ACTION_DROP: 28431cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP; 2844aad7e08dSAmir Vadai if (MLX5_CAP_FLOWTABLE(priv->mdev, 2845aad7e08dSAmir Vadai flow_table_properties_nic_receive.flow_counter)) 28461cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 284773867881SPablo Neira Ayuso break; 284873867881SPablo Neira Ayuso case FLOW_ACTION_MANGLE: 284973867881SPablo Neira Ayuso case FLOW_ACTION_ADD: 285073867881SPablo Neira Ayuso err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL, 2851c500c86bSPablo Neira Ayuso parse_attr, hdrs, extack); 28522f4fe4caSOr Gerlitz if (err) 28532f4fe4caSOr Gerlitz return err; 28542f4fe4caSOr Gerlitz 28551cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR | 28562f4fe4caSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 285773867881SPablo Neira Ayuso break; 2858bdc837eeSEli Britstein case FLOW_ACTION_VLAN_MANGLE: 2859bdc837eeSEli Britstein err = add_vlan_rewrite_action(priv, 2860bdc837eeSEli Britstein MLX5_FLOW_NAMESPACE_KERNEL, 2861bdc837eeSEli Britstein act, parse_attr, hdrs, 2862bdc837eeSEli Britstein &action, extack); 2863bdc837eeSEli Britstein if (err) 2864bdc837eeSEli Britstein return err; 2865bdc837eeSEli Britstein 2866bdc837eeSEli Britstein break; 286773867881SPablo Neira Ayuso case FLOW_ACTION_CSUM: 28681cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 286973867881SPablo Neira Ayuso act->csum_flags, 2870e98bedf5SEli Britstein extack)) 287173867881SPablo Neira Ayuso break; 287226c02749SOr Gerlitz 287326c02749SOr Gerlitz return -EOPNOTSUPP; 287473867881SPablo Neira Ayuso case FLOW_ACTION_REDIRECT: { 287573867881SPablo Neira Ayuso struct net_device *peer_dev = act->dev; 28765c65c564SOr Gerlitz 28775c65c564SOr Gerlitz if (priv->netdev->netdev_ops == peer_dev->netdev_ops && 28785c65c564SOr Gerlitz same_hw_devs(priv, netdev_priv(peer_dev))) { 287998b66cb1SEli Britstein parse_attr->mirred_ifindex[0] = peer_dev->ifindex; 2880226f2ca3SVlad Buslov flow_flag_set(flow, HAIRPIN); 28811cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 28825c65c564SOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 28835c65c564SOr Gerlitz } else { 2884e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2885e98bedf5SEli Britstein "device is not on same HW, can't offload"); 28865c65c564SOr Gerlitz netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n", 28875c65c564SOr Gerlitz peer_dev->name); 28885c65c564SOr Gerlitz return -EINVAL; 28895c65c564SOr Gerlitz } 28905c65c564SOr Gerlitz } 289173867881SPablo Neira Ayuso break; 289273867881SPablo Neira Ayuso case FLOW_ACTION_MARK: { 289373867881SPablo Neira Ayuso u32 mark = act->mark; 2894e3a2b7edSAmir Vadai 2895e3a2b7edSAmir Vadai if (mark & ~MLX5E_TC_FLOW_ID_MASK) { 2896e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2897e98bedf5SEli Britstein "Bad flow mark - only 16 bit is supported"); 2898e3a2b7edSAmir Vadai return -EINVAL; 2899e3a2b7edSAmir Vadai } 2900e3a2b7edSAmir Vadai 29013bc4b7bfSOr Gerlitz attr->flow_tag = mark; 29021cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 2903e3a2b7edSAmir Vadai } 290473867881SPablo Neira Ayuso break; 290573867881SPablo Neira Ayuso default: 29062cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported"); 29072cc1cb1dSTonghao Zhang return -EOPNOTSUPP; 2908e3a2b7edSAmir Vadai } 290973867881SPablo Neira Ayuso } 2910e3a2b7edSAmir Vadai 2911c500c86bSPablo Neira Ayuso if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits || 2912c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) { 2913c500c86bSPablo Neira Ayuso err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL, 291427c11b6bSEli Britstein parse_attr, hdrs, &action, extack); 2915c500c86bSPablo Neira Ayuso if (err) 2916c500c86bSPablo Neira Ayuso return err; 291727c11b6bSEli Britstein /* in case all pedit actions are skipped, remove the MOD_HDR 291827c11b6bSEli Britstein * flag. 291927c11b6bSEli Britstein */ 2920e7739a60SEli Britstein if (parse_attr->num_mod_hdr_actions == 0) { 292127c11b6bSEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2922e7739a60SEli Britstein kfree(parse_attr->mod_hdr_actions); 2923e7739a60SEli Britstein } 2924c500c86bSPablo Neira Ayuso } 2925c500c86bSPablo Neira Ayuso 29261cab1cd7SOr Gerlitz attr->action = action; 292773867881SPablo Neira Ayuso if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack)) 2928bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 2929bdd66ac0SOr Gerlitz 2930e3a2b7edSAmir Vadai return 0; 2931e3a2b7edSAmir Vadai } 2932e3a2b7edSAmir Vadai 29337f1a546eSEli Britstein struct encap_key { 29341f6da306SYevgeny Kliteynik const struct ip_tunnel_key *ip_tun_key; 2935d386939aSYevgeny Kliteynik struct mlx5e_tc_tunnel *tc_tunnel; 29367f1a546eSEli Britstein }; 29377f1a546eSEli Britstein 29387f1a546eSEli Britstein static inline int cmp_encap_info(struct encap_key *a, 29397f1a546eSEli Britstein struct encap_key *b) 2940a54e20b4SHadar Hen Zion { 29417f1a546eSEli Britstein return memcmp(a->ip_tun_key, b->ip_tun_key, sizeof(*a->ip_tun_key)) || 2942d386939aSYevgeny Kliteynik a->tc_tunnel->tunnel_type != b->tc_tunnel->tunnel_type; 2943a54e20b4SHadar Hen Zion } 2944a54e20b4SHadar Hen Zion 29457f1a546eSEli Britstein static inline int hash_encap_info(struct encap_key *key) 2946a54e20b4SHadar Hen Zion { 29477f1a546eSEli Britstein return jhash(key->ip_tun_key, sizeof(*key->ip_tun_key), 2948d386939aSYevgeny Kliteynik key->tc_tunnel->tunnel_type); 2949a54e20b4SHadar Hen Zion } 2950a54e20b4SHadar Hen Zion 2951a54e20b4SHadar Hen Zion 2952b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv, 2953b1d90e6bSRabie Loulou struct net_device *peer_netdev) 2954b1d90e6bSRabie Loulou { 2955b1d90e6bSRabie Loulou struct mlx5e_priv *peer_priv; 2956b1d90e6bSRabie Loulou 2957b1d90e6bSRabie Loulou peer_priv = netdev_priv(peer_netdev); 2958b1d90e6bSRabie Loulou 2959b1d90e6bSRabie Loulou return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) && 296068931c7dSRoi Dayan mlx5e_eswitch_rep(priv->netdev) && 296168931c7dSRoi Dayan mlx5e_eswitch_rep(peer_netdev) && 296268931c7dSRoi Dayan same_hw_devs(priv, peer_priv)); 2963b1d90e6bSRabie Loulou } 2964b1d90e6bSRabie Loulou 2965ce99f6b9SOr Gerlitz 296654c177caSOz Shlomo 2967948993f2SVlad Buslov bool mlx5e_encap_take(struct mlx5e_encap_entry *e) 2968948993f2SVlad Buslov { 2969948993f2SVlad Buslov return refcount_inc_not_zero(&e->refcnt); 2970948993f2SVlad Buslov } 2971948993f2SVlad Buslov 2972948993f2SVlad Buslov static struct mlx5e_encap_entry * 2973948993f2SVlad Buslov mlx5e_encap_get(struct mlx5e_priv *priv, struct encap_key *key, 2974948993f2SVlad Buslov uintptr_t hash_key) 2975948993f2SVlad Buslov { 2976948993f2SVlad Buslov struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2977948993f2SVlad Buslov struct mlx5e_encap_entry *e; 2978948993f2SVlad Buslov struct encap_key e_key; 2979948993f2SVlad Buslov 2980948993f2SVlad Buslov hash_for_each_possible_rcu(esw->offloads.encap_tbl, e, 2981948993f2SVlad Buslov encap_hlist, hash_key) { 2982948993f2SVlad Buslov e_key.ip_tun_key = &e->tun_info->key; 2983948993f2SVlad Buslov e_key.tc_tunnel = e->tunnel; 2984948993f2SVlad Buslov if (!cmp_encap_info(&e_key, key) && 2985948993f2SVlad Buslov mlx5e_encap_take(e)) 2986948993f2SVlad Buslov return e; 2987948993f2SVlad Buslov } 2988948993f2SVlad Buslov 2989948993f2SVlad Buslov return NULL; 2990948993f2SVlad Buslov } 2991948993f2SVlad Buslov 29922a4b6526SVlad Buslov static struct ip_tunnel_info *dup_tun_info(const struct ip_tunnel_info *tun_info) 29932a4b6526SVlad Buslov { 29942a4b6526SVlad Buslov size_t tun_size = sizeof(*tun_info) + tun_info->options_len; 29952a4b6526SVlad Buslov 29962a4b6526SVlad Buslov return kmemdup(tun_info, tun_size, GFP_KERNEL); 29972a4b6526SVlad Buslov } 29982a4b6526SVlad Buslov 2999a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv, 3000e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 3001733d4f36SRoi Dayan struct net_device *mirred_dev, 3002733d4f36SRoi Dayan int out_index, 30038c4dc42bSEli Britstein struct netlink_ext_ack *extack, 30040ad060eeSRoi Dayan struct net_device **encap_dev, 30050ad060eeSRoi Dayan bool *encap_valid) 300603a9d11eSOr Gerlitz { 3007a54e20b4SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 300845247bf2SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 3009733d4f36SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 30101f6da306SYevgeny Kliteynik const struct ip_tunnel_info *tun_info; 3011948993f2SVlad Buslov struct encap_key key; 3012c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 3013733d4f36SRoi Dayan unsigned short family; 3014a54e20b4SHadar Hen Zion uintptr_t hash_key; 301554c177caSOz Shlomo int err = 0; 3016a54e20b4SHadar Hen Zion 3017733d4f36SRoi Dayan parse_attr = attr->parse_attr; 30181f6da306SYevgeny Kliteynik tun_info = parse_attr->tun_info[out_index]; 3019733d4f36SRoi Dayan family = ip_tunnel_info_af(tun_info); 30207f1a546eSEli Britstein key.ip_tun_key = &tun_info->key; 3021d386939aSYevgeny Kliteynik key.tc_tunnel = mlx5e_get_tc_tun(mirred_dev); 3022d71f895cSEli Cohen if (!key.tc_tunnel) { 3023d71f895cSEli Cohen NL_SET_ERR_MSG_MOD(extack, "Unsupported tunnel"); 3024d71f895cSEli Cohen return -EOPNOTSUPP; 3025d71f895cSEli Cohen } 3026733d4f36SRoi Dayan 30277f1a546eSEli Britstein hash_key = hash_encap_info(&key); 3028a54e20b4SHadar Hen Zion 302961086f39SVlad Buslov mutex_lock(&esw->offloads.encap_tbl_lock); 3030948993f2SVlad Buslov e = mlx5e_encap_get(priv, &key, hash_key); 3031a54e20b4SHadar Hen Zion 3032b2812089SVlad Buslov /* must verify if encap is valid or not */ 3033d589e785SVlad Buslov if (e) { 3034d589e785SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 3035d589e785SVlad Buslov wait_for_completion(&e->res_ready); 3036d589e785SVlad Buslov 3037d589e785SVlad Buslov /* Protect against concurrent neigh update. */ 3038d589e785SVlad Buslov mutex_lock(&esw->offloads.encap_tbl_lock); 30393c140dd5SVlad Buslov if (e->compl_result < 0) { 3040d589e785SVlad Buslov err = -EREMOTEIO; 3041d589e785SVlad Buslov goto out_err; 3042d589e785SVlad Buslov } 304345247bf2SOr Gerlitz goto attach_flow; 3044d589e785SVlad Buslov } 3045a54e20b4SHadar Hen Zion 3046a54e20b4SHadar Hen Zion e = kzalloc(sizeof(*e), GFP_KERNEL); 304761086f39SVlad Buslov if (!e) { 304861086f39SVlad Buslov err = -ENOMEM; 304961086f39SVlad Buslov goto out_err; 305061086f39SVlad Buslov } 3051a54e20b4SHadar Hen Zion 3052948993f2SVlad Buslov refcount_set(&e->refcnt, 1); 3053d589e785SVlad Buslov init_completion(&e->res_ready); 3054d589e785SVlad Buslov 30552a4b6526SVlad Buslov tun_info = dup_tun_info(tun_info); 30562a4b6526SVlad Buslov if (!tun_info) { 30572a4b6526SVlad Buslov err = -ENOMEM; 30582a4b6526SVlad Buslov goto out_err_init; 30592a4b6526SVlad Buslov } 30601f6da306SYevgeny Kliteynik e->tun_info = tun_info; 3061101f4de9SOz Shlomo err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack); 30622a4b6526SVlad Buslov if (err) 30632a4b6526SVlad Buslov goto out_err_init; 306454c177caSOz Shlomo 3065a54e20b4SHadar Hen Zion INIT_LIST_HEAD(&e->flows); 3066d589e785SVlad Buslov hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key); 3067d589e785SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 3068a54e20b4SHadar Hen Zion 3069ce99f6b9SOr Gerlitz if (family == AF_INET) 3070101f4de9SOz Shlomo err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e); 3071ce99f6b9SOr Gerlitz else if (family == AF_INET6) 3072101f4de9SOz Shlomo err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e); 3073ce99f6b9SOr Gerlitz 3074d589e785SVlad Buslov /* Protect against concurrent neigh update. */ 3075d589e785SVlad Buslov mutex_lock(&esw->offloads.encap_tbl_lock); 3076d589e785SVlad Buslov complete_all(&e->res_ready); 3077d589e785SVlad Buslov if (err) { 3078d589e785SVlad Buslov e->compl_result = err; 3079a54e20b4SHadar Hen Zion goto out_err; 3080d589e785SVlad Buslov } 30813c140dd5SVlad Buslov e->compl_result = 1; 3082a54e20b4SHadar Hen Zion 308345247bf2SOr Gerlitz attach_flow: 3084948993f2SVlad Buslov flow->encaps[out_index].e = e; 30858c4dc42bSEli Britstein list_add(&flow->encaps[out_index].list, &e->flows); 30868c4dc42bSEli Britstein flow->encaps[out_index].index = out_index; 308745247bf2SOr Gerlitz *encap_dev = e->out_dev; 30888c4dc42bSEli Britstein if (e->flags & MLX5_ENCAP_ENTRY_VALID) { 30892b688ea5SMaor Gottlieb attr->dests[out_index].pkt_reformat = e->pkt_reformat; 30908c4dc42bSEli Britstein attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID; 30910ad060eeSRoi Dayan *encap_valid = true; 30928c4dc42bSEli Britstein } else { 30930ad060eeSRoi Dayan *encap_valid = false; 30948c4dc42bSEli Britstein } 309561086f39SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 309645247bf2SOr Gerlitz 3097232c0013SHadar Hen Zion return err; 3098a54e20b4SHadar Hen Zion 3099a54e20b4SHadar Hen Zion out_err: 310061086f39SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 3101d589e785SVlad Buslov if (e) 3102d589e785SVlad Buslov mlx5e_encap_put(priv, e); 3103a54e20b4SHadar Hen Zion return err; 31042a4b6526SVlad Buslov 31052a4b6526SVlad Buslov out_err_init: 31062a4b6526SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 31072a4b6526SVlad Buslov kfree(tun_info); 31082a4b6526SVlad Buslov kfree(e); 31092a4b6526SVlad Buslov return err; 3110a54e20b4SHadar Hen Zion } 3111a54e20b4SHadar Hen Zion 31121482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv, 311373867881SPablo Neira Ayuso const struct flow_action_entry *act, 31141482bd3dSJianbo Liu struct mlx5_esw_flow_attr *attr, 31151482bd3dSJianbo Liu u32 *action) 31161482bd3dSJianbo Liu { 3117cc495188SJianbo Liu u8 vlan_idx = attr->total_vlan; 3118cc495188SJianbo Liu 3119cc495188SJianbo Liu if (vlan_idx >= MLX5_FS_VLAN_DEPTH) 31201482bd3dSJianbo Liu return -EOPNOTSUPP; 3121cc495188SJianbo Liu 312273867881SPablo Neira Ayuso switch (act->id) { 312373867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_POP: 3124cc495188SJianbo Liu if (vlan_idx) { 3125cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 3126cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 3127cc495188SJianbo Liu return -EOPNOTSUPP; 3128cc495188SJianbo Liu 3129cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2; 3130cc495188SJianbo Liu } else { 3131cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 3132cc495188SJianbo Liu } 313373867881SPablo Neira Ayuso break; 313473867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_PUSH: 313573867881SPablo Neira Ayuso attr->vlan_vid[vlan_idx] = act->vlan.vid; 313673867881SPablo Neira Ayuso attr->vlan_prio[vlan_idx] = act->vlan.prio; 313773867881SPablo Neira Ayuso attr->vlan_proto[vlan_idx] = act->vlan.proto; 3138cc495188SJianbo Liu if (!attr->vlan_proto[vlan_idx]) 3139cc495188SJianbo Liu attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q); 3140cc495188SJianbo Liu 3141cc495188SJianbo Liu if (vlan_idx) { 3142cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 3143cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 3144cc495188SJianbo Liu return -EOPNOTSUPP; 3145cc495188SJianbo Liu 3146cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2; 3147cc495188SJianbo Liu } else { 3148cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) && 314973867881SPablo Neira Ayuso (act->vlan.proto != htons(ETH_P_8021Q) || 315073867881SPablo Neira Ayuso act->vlan.prio)) 3151cc495188SJianbo Liu return -EOPNOTSUPP; 3152cc495188SJianbo Liu 3153cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH; 31541482bd3dSJianbo Liu } 315573867881SPablo Neira Ayuso break; 315673867881SPablo Neira Ayuso default: 3157bdc837eeSEli Britstein return -EINVAL; 31581482bd3dSJianbo Liu } 31591482bd3dSJianbo Liu 3160cc495188SJianbo Liu attr->total_vlan = vlan_idx + 1; 3161cc495188SJianbo Liu 31621482bd3dSJianbo Liu return 0; 31631482bd3dSJianbo Liu } 31641482bd3dSJianbo Liu 3165278748a9SEli Britstein static int add_vlan_push_action(struct mlx5e_priv *priv, 3166278748a9SEli Britstein struct mlx5_esw_flow_attr *attr, 3167278748a9SEli Britstein struct net_device **out_dev, 3168278748a9SEli Britstein u32 *action) 3169278748a9SEli Britstein { 3170278748a9SEli Britstein struct net_device *vlan_dev = *out_dev; 3171278748a9SEli Britstein struct flow_action_entry vlan_act = { 3172278748a9SEli Britstein .id = FLOW_ACTION_VLAN_PUSH, 3173278748a9SEli Britstein .vlan.vid = vlan_dev_vlan_id(vlan_dev), 3174278748a9SEli Britstein .vlan.proto = vlan_dev_vlan_proto(vlan_dev), 3175278748a9SEli Britstein .vlan.prio = 0, 3176278748a9SEli Britstein }; 3177278748a9SEli Britstein int err; 3178278748a9SEli Britstein 3179278748a9SEli Britstein err = parse_tc_vlan_action(priv, &vlan_act, attr, action); 3180278748a9SEli Britstein if (err) 3181278748a9SEli Britstein return err; 3182278748a9SEli Britstein 3183278748a9SEli Britstein *out_dev = dev_get_by_index_rcu(dev_net(vlan_dev), 3184278748a9SEli Britstein dev_get_iflink(vlan_dev)); 3185278748a9SEli Britstein if (is_vlan_dev(*out_dev)) 3186278748a9SEli Britstein err = add_vlan_push_action(priv, attr, out_dev, action); 3187278748a9SEli Britstein 3188278748a9SEli Britstein return err; 3189278748a9SEli Britstein } 3190278748a9SEli Britstein 319135a605dbSEli Britstein static int add_vlan_pop_action(struct mlx5e_priv *priv, 319235a605dbSEli Britstein struct mlx5_esw_flow_attr *attr, 319335a605dbSEli Britstein u32 *action) 319435a605dbSEli Britstein { 3195f3b0a18bSTaehee Yoo int nest_level = attr->parse_attr->filter_dev->lower_level; 319635a605dbSEli Britstein struct flow_action_entry vlan_act = { 319735a605dbSEli Britstein .id = FLOW_ACTION_VLAN_POP, 319835a605dbSEli Britstein }; 319935a605dbSEli Britstein int err = 0; 320035a605dbSEli Britstein 320135a605dbSEli Britstein while (nest_level--) { 320235a605dbSEli Britstein err = parse_tc_vlan_action(priv, &vlan_act, attr, action); 320335a605dbSEli Britstein if (err) 320435a605dbSEli Britstein return err; 320535a605dbSEli Britstein } 320635a605dbSEli Britstein 320735a605dbSEli Britstein return err; 320835a605dbSEli Britstein } 320935a605dbSEli Britstein 3210f6dc1264SPaul Blakey bool mlx5e_is_valid_eswitch_fwd_dev(struct mlx5e_priv *priv, 3211f6dc1264SPaul Blakey struct net_device *out_dev) 3212f6dc1264SPaul Blakey { 3213f6dc1264SPaul Blakey if (is_merged_eswitch_dev(priv, out_dev)) 3214f6dc1264SPaul Blakey return true; 3215f6dc1264SPaul Blakey 3216f6dc1264SPaul Blakey return mlx5e_eswitch_rep(out_dev) && 3217f6dc1264SPaul Blakey same_hw_devs(priv, netdev_priv(out_dev)); 3218f6dc1264SPaul Blakey } 3219f6dc1264SPaul Blakey 322073867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv, 322173867881SPablo Neira Ayuso struct flow_action *flow_action, 3222e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 3223e98bedf5SEli Britstein struct netlink_ext_ack *extack) 3224a54e20b4SHadar Hen Zion { 322573867881SPablo Neira Ayuso struct pedit_headers_action hdrs[2] = {}; 3226bf07aa73SPaul Blakey struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3227ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 32286f9af8ffSTonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr; 32291d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 323073867881SPablo Neira Ayuso const struct ip_tunnel_info *info = NULL; 323184179981SPaul Blakey bool ft_flow = mlx5e_is_ft_flow(flow); 323273867881SPablo Neira Ayuso const struct flow_action_entry *act; 3233a54e20b4SHadar Hen Zion bool encap = false; 32341cab1cd7SOr Gerlitz u32 action = 0; 3235244cd96aSCong Wang int err, i; 323603a9d11eSOr Gerlitz 323773867881SPablo Neira Ayuso if (!flow_action_has_entries(flow_action)) 323803a9d11eSOr Gerlitz return -EINVAL; 323903a9d11eSOr Gerlitz 324073867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 324173867881SPablo Neira Ayuso switch (act->id) { 324273867881SPablo Neira Ayuso case FLOW_ACTION_DROP: 32431cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP | 324403a9d11eSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 324573867881SPablo Neira Ayuso break; 324673867881SPablo Neira Ayuso case FLOW_ACTION_MANGLE: 324773867881SPablo Neira Ayuso case FLOW_ACTION_ADD: 324873867881SPablo Neira Ayuso err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB, 3249c500c86bSPablo Neira Ayuso parse_attr, hdrs, extack); 3250d7e75a32SOr Gerlitz if (err) 3251d7e75a32SOr Gerlitz return err; 3252d7e75a32SOr Gerlitz 32531cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 3254e85e02baSEli Britstein attr->split_count = attr->out_count; 325573867881SPablo Neira Ayuso break; 325673867881SPablo Neira Ayuso case FLOW_ACTION_CSUM: 32571cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 325873867881SPablo Neira Ayuso act->csum_flags, extack)) 325973867881SPablo Neira Ayuso break; 326026c02749SOr Gerlitz 326126c02749SOr Gerlitz return -EOPNOTSUPP; 326273867881SPablo Neira Ayuso case FLOW_ACTION_REDIRECT: 326373867881SPablo Neira Ayuso case FLOW_ACTION_MIRRED: { 326403a9d11eSOr Gerlitz struct mlx5e_priv *out_priv; 3265592d3651SChris Mi struct net_device *out_dev; 326603a9d11eSOr Gerlitz 326773867881SPablo Neira Ayuso out_dev = act->dev; 3268ef381359SOz Shlomo if (!out_dev) { 3269ef381359SOz Shlomo /* out_dev is NULL when filters with 3270ef381359SOz Shlomo * non-existing mirred device are replayed to 3271ef381359SOz Shlomo * the driver. 3272ef381359SOz Shlomo */ 3273ef381359SOz Shlomo return -EINVAL; 3274ef381359SOz Shlomo } 327503a9d11eSOr Gerlitz 327684179981SPaul Blakey if (ft_flow && out_dev == priv->netdev) { 327784179981SPaul Blakey /* Ignore forward to self rules generated 327884179981SPaul Blakey * by adding both mlx5 devs to the flow table 327984179981SPaul Blakey * block on a normal nft offload setup. 328084179981SPaul Blakey */ 328184179981SPaul Blakey return -EOPNOTSUPP; 328284179981SPaul Blakey } 328384179981SPaul Blakey 3284592d3651SChris Mi if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) { 3285e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 3286e98bedf5SEli Britstein "can't support more output ports, can't offload forwarding"); 3287592d3651SChris Mi pr_err("can't support more than %d output ports, can't offload forwarding\n", 3288592d3651SChris Mi attr->out_count); 3289592d3651SChris Mi return -EOPNOTSUPP; 3290592d3651SChris Mi } 3291592d3651SChris Mi 3292f493f155SEli Britstein action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 3293f493f155SEli Britstein MLX5_FLOW_CONTEXT_ACTION_COUNT; 3294f6dc1264SPaul Blakey if (netdev_port_same_parent_id(priv->netdev, out_dev)) { 32957ba58ba7SRabie Loulou struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 32967ba58ba7SRabie Loulou struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH); 3297fa833bd5SVlad Buslov struct net_device *uplink_upper; 32987ba58ba7SRabie Loulou 3299fa833bd5SVlad Buslov rcu_read_lock(); 3300fa833bd5SVlad Buslov uplink_upper = 3301fa833bd5SVlad Buslov netdev_master_upper_dev_get_rcu(uplink_dev); 33027ba58ba7SRabie Loulou if (uplink_upper && 33037ba58ba7SRabie Loulou netif_is_lag_master(uplink_upper) && 33047ba58ba7SRabie Loulou uplink_upper == out_dev) 33057ba58ba7SRabie Loulou out_dev = uplink_dev; 3306fa833bd5SVlad Buslov rcu_read_unlock(); 33077ba58ba7SRabie Loulou 3308278748a9SEli Britstein if (is_vlan_dev(out_dev)) { 3309278748a9SEli Britstein err = add_vlan_push_action(priv, attr, 3310278748a9SEli Britstein &out_dev, 3311278748a9SEli Britstein &action); 3312278748a9SEli Britstein if (err) 3313278748a9SEli Britstein return err; 3314278748a9SEli Britstein } 3315f6dc1264SPaul Blakey 331635a605dbSEli Britstein if (is_vlan_dev(parse_attr->filter_dev)) { 331735a605dbSEli Britstein err = add_vlan_pop_action(priv, attr, 331835a605dbSEli Britstein &action); 331935a605dbSEli Britstein if (err) 332035a605dbSEli Britstein return err; 332135a605dbSEli Britstein } 3322278748a9SEli Britstein 3323f6dc1264SPaul Blakey if (!mlx5e_is_valid_eswitch_fwd_dev(priv, out_dev)) { 3324f6dc1264SPaul Blakey NL_SET_ERR_MSG_MOD(extack, 3325f6dc1264SPaul Blakey "devices are not on same switch HW, can't offload forwarding"); 3326f6dc1264SPaul Blakey pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 3327f6dc1264SPaul Blakey priv->netdev->name, out_dev->name); 3328a0646c88SEli Britstein return -EOPNOTSUPP; 3329f6dc1264SPaul Blakey } 3330a0646c88SEli Britstein 333103a9d11eSOr Gerlitz out_priv = netdev_priv(out_dev); 33321d447a39SSaeed Mahameed rpriv = out_priv->ppriv; 3333df65a573SEli Britstein attr->dests[attr->out_count].rep = rpriv->rep; 3334df65a573SEli Britstein attr->dests[attr->out_count].mdev = out_priv->mdev; 3335df65a573SEli Britstein attr->out_count++; 3336a54e20b4SHadar Hen Zion } else if (encap) { 33378c4dc42bSEli Britstein parse_attr->mirred_ifindex[attr->out_count] = 33388c4dc42bSEli Britstein out_dev->ifindex; 33392a4b6526SVlad Buslov parse_attr->tun_info[attr->out_count] = dup_tun_info(info); 33402a4b6526SVlad Buslov if (!parse_attr->tun_info[attr->out_count]) 33412a4b6526SVlad Buslov return -ENOMEM; 33428c4dc42bSEli Britstein encap = false; 3343f493f155SEli Britstein attr->dests[attr->out_count].flags |= 3344f493f155SEli Britstein MLX5_ESW_DEST_ENCAP; 33451cc26d74SEli Britstein attr->out_count++; 3346df65a573SEli Britstein /* attr->dests[].rep is resolved when we 3347df65a573SEli Britstein * handle encap 3348df65a573SEli Britstein */ 3349ef381359SOz Shlomo } else if (parse_attr->filter_dev != priv->netdev) { 3350ef381359SOz Shlomo /* All mlx5 devices are called to configure 3351ef381359SOz Shlomo * high level device filters. Therefore, the 3352ef381359SOz Shlomo * *attempt* to install a filter on invalid 3353ef381359SOz Shlomo * eswitch should not trigger an explicit error 3354ef381359SOz Shlomo */ 3355ef381359SOz Shlomo return -EINVAL; 3356a54e20b4SHadar Hen Zion } else { 3357e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 3358e98bedf5SEli Britstein "devices are not on same switch HW, can't offload forwarding"); 3359a54e20b4SHadar Hen Zion pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 3360a54e20b4SHadar Hen Zion priv->netdev->name, out_dev->name); 3361a54e20b4SHadar Hen Zion return -EINVAL; 3362a54e20b4SHadar Hen Zion } 3363a54e20b4SHadar Hen Zion } 336473867881SPablo Neira Ayuso break; 336573867881SPablo Neira Ayuso case FLOW_ACTION_TUNNEL_ENCAP: 336673867881SPablo Neira Ayuso info = act->tunnel; 3367a54e20b4SHadar Hen Zion if (info) 3368a54e20b4SHadar Hen Zion encap = true; 3369a54e20b4SHadar Hen Zion else 3370a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 337103a9d11eSOr Gerlitz 337273867881SPablo Neira Ayuso break; 337373867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_PUSH: 337473867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_POP: 337576b496b1SEli Britstein if (act->id == FLOW_ACTION_VLAN_PUSH && 337676b496b1SEli Britstein (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP)) { 337776b496b1SEli Britstein /* Replace vlan pop+push with vlan modify */ 337876b496b1SEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 337976b496b1SEli Britstein err = add_vlan_rewrite_action(priv, 338076b496b1SEli Britstein MLX5_FLOW_NAMESPACE_FDB, 338176b496b1SEli Britstein act, parse_attr, hdrs, 338276b496b1SEli Britstein &action, extack); 338376b496b1SEli Britstein } else { 338473867881SPablo Neira Ayuso err = parse_tc_vlan_action(priv, act, attr, &action); 338576b496b1SEli Britstein } 33861482bd3dSJianbo Liu if (err) 33871482bd3dSJianbo Liu return err; 33881482bd3dSJianbo Liu 3389e85e02baSEli Britstein attr->split_count = attr->out_count; 339073867881SPablo Neira Ayuso break; 3391bdc837eeSEli Britstein case FLOW_ACTION_VLAN_MANGLE: 3392bdc837eeSEli Britstein err = add_vlan_rewrite_action(priv, 3393bdc837eeSEli Britstein MLX5_FLOW_NAMESPACE_FDB, 3394bdc837eeSEli Britstein act, parse_attr, hdrs, 3395bdc837eeSEli Britstein &action, extack); 3396bdc837eeSEli Britstein if (err) 3397bdc837eeSEli Britstein return err; 3398bdc837eeSEli Britstein 3399bdc837eeSEli Britstein attr->split_count = attr->out_count; 3400bdc837eeSEli Britstein break; 340173867881SPablo Neira Ayuso case FLOW_ACTION_TUNNEL_DECAP: 34021cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DECAP; 340373867881SPablo Neira Ayuso break; 340473867881SPablo Neira Ayuso case FLOW_ACTION_GOTO: { 340573867881SPablo Neira Ayuso u32 dest_chain = act->chain_index; 3406bf07aa73SPaul Blakey u32 max_chain = mlx5_eswitch_get_chain_range(esw); 3407bf07aa73SPaul Blakey 340884179981SPaul Blakey if (ft_flow) { 340984179981SPaul Blakey NL_SET_ERR_MSG_MOD(extack, "Goto action is not supported"); 341084179981SPaul Blakey return -EOPNOTSUPP; 341184179981SPaul Blakey } 3412bf07aa73SPaul Blakey if (dest_chain <= attr->chain) { 3413bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported"); 3414bf07aa73SPaul Blakey return -EOPNOTSUPP; 3415bf07aa73SPaul Blakey } 3416bf07aa73SPaul Blakey if (dest_chain > max_chain) { 3417bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range"); 3418bf07aa73SPaul Blakey return -EOPNOTSUPP; 3419bf07aa73SPaul Blakey } 3420e88afe75SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 3421bf07aa73SPaul Blakey attr->dest_chain = dest_chain; 342273867881SPablo Neira Ayuso break; 3423bf07aa73SPaul Blakey } 342473867881SPablo Neira Ayuso default: 34252cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported"); 34262cc1cb1dSTonghao Zhang return -EOPNOTSUPP; 342703a9d11eSOr Gerlitz } 342873867881SPablo Neira Ayuso } 3429bdd66ac0SOr Gerlitz 34300bac1194SEli Britstein if (MLX5_CAP_GEN(esw->dev, prio_tag_required) && 34310bac1194SEli Britstein action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) { 34320bac1194SEli Britstein /* For prio tag mode, replace vlan pop with rewrite vlan prio 34330bac1194SEli Britstein * tag rewrite. 34340bac1194SEli Britstein */ 34350bac1194SEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 34360bac1194SEli Britstein err = add_vlan_prio_tag_rewrite_action(priv, parse_attr, hdrs, 34370bac1194SEli Britstein &action, extack); 34380bac1194SEli Britstein if (err) 34390bac1194SEli Britstein return err; 34400bac1194SEli Britstein } 34410bac1194SEli Britstein 3442c500c86bSPablo Neira Ayuso if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits || 3443c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) { 344484be899fSTonghao Zhang err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_FDB, 344527c11b6bSEli Britstein parse_attr, hdrs, &action, extack); 3446c500c86bSPablo Neira Ayuso if (err) 3447c500c86bSPablo Neira Ayuso return err; 344827c11b6bSEli Britstein /* in case all pedit actions are skipped, remove the MOD_HDR 344927c11b6bSEli Britstein * flag. we might have set split_count either by pedit or 345027c11b6bSEli Britstein * pop/push. if there is no pop/push either, reset it too. 345127c11b6bSEli Britstein */ 345227c11b6bSEli Britstein if (parse_attr->num_mod_hdr_actions == 0) { 345327c11b6bSEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 3454e7739a60SEli Britstein kfree(parse_attr->mod_hdr_actions); 345527c11b6bSEli Britstein if (!((action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) || 345627c11b6bSEli Britstein (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH))) 345727c11b6bSEli Britstein attr->split_count = 0; 345827c11b6bSEli Britstein } 3459c500c86bSPablo Neira Ayuso } 3460c500c86bSPablo Neira Ayuso 34611cab1cd7SOr Gerlitz attr->action = action; 346273867881SPablo Neira Ayuso if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack)) 3463bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 3464bdd66ac0SOr Gerlitz 3465e88afe75SOr Gerlitz if (attr->dest_chain) { 3466e88afe75SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 3467e88afe75SOr Gerlitz NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported"); 3468e88afe75SOr Gerlitz return -EOPNOTSUPP; 3469e88afe75SOr Gerlitz } 3470e88afe75SOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 3471e88afe75SOr Gerlitz } 3472e88afe75SOr Gerlitz 3473ae2741e2SVlad Buslov if (!(attr->action & 3474ae2741e2SVlad Buslov (MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | MLX5_FLOW_CONTEXT_ACTION_DROP))) { 3475ae2741e2SVlad Buslov NL_SET_ERR_MSG(extack, "Rule must have at least one forward/drop action"); 3476ae2741e2SVlad Buslov return -EOPNOTSUPP; 3477ae2741e2SVlad Buslov } 3478ae2741e2SVlad Buslov 3479e85e02baSEli Britstein if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) { 3480e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 3481e98bedf5SEli Britstein "current firmware doesn't support split rule for port mirroring"); 3482592d3651SChris Mi netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n"); 3483592d3651SChris Mi return -EOPNOTSUPP; 3484592d3651SChris Mi } 3485592d3651SChris Mi 348631c8eba5SOr Gerlitz return 0; 348703a9d11eSOr Gerlitz } 348803a9d11eSOr Gerlitz 3489226f2ca3SVlad Buslov static void get_flags(int flags, unsigned long *flow_flags) 349060bd4af8SOr Gerlitz { 3491226f2ca3SVlad Buslov unsigned long __flow_flags = 0; 349260bd4af8SOr Gerlitz 3493226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(INGRESS)) 3494226f2ca3SVlad Buslov __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_INGRESS); 3495226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(EGRESS)) 3496226f2ca3SVlad Buslov __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_EGRESS); 349760bd4af8SOr Gerlitz 3498226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(ESW_OFFLOAD)) 3499226f2ca3SVlad Buslov __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_ESWITCH); 3500226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(NIC_OFFLOAD)) 3501226f2ca3SVlad Buslov __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_NIC); 350284179981SPaul Blakey if (flags & MLX5_TC_FLAG(FT_OFFLOAD)) 350384179981SPaul Blakey __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_FT); 3504d9ee0491SOr Gerlitz 350560bd4af8SOr Gerlitz *flow_flags = __flow_flags; 350660bd4af8SOr Gerlitz } 350760bd4af8SOr Gerlitz 350805866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = { 350905866c82SOr Gerlitz .head_offset = offsetof(struct mlx5e_tc_flow, node), 351005866c82SOr Gerlitz .key_offset = offsetof(struct mlx5e_tc_flow, cookie), 351105866c82SOr Gerlitz .key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie), 351205866c82SOr Gerlitz .automatic_shrinking = true, 351305866c82SOr Gerlitz }; 351405866c82SOr Gerlitz 3515226f2ca3SVlad Buslov static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv, 3516226f2ca3SVlad Buslov unsigned long flags) 351705866c82SOr Gerlitz { 3518655dc3d2SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3519655dc3d2SOr Gerlitz struct mlx5e_rep_priv *uplink_rpriv; 3520655dc3d2SOr Gerlitz 3521226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(ESW_OFFLOAD)) { 3522655dc3d2SOr Gerlitz uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 3523ec1366c2SOz Shlomo return &uplink_rpriv->uplink_priv.tc_ht; 3524d9ee0491SOr Gerlitz } else /* NIC offload */ 352505866c82SOr Gerlitz return &priv->fs.tc.ht; 352605866c82SOr Gerlitz } 352705866c82SOr Gerlitz 352804de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow) 352904de7ddaSRoi Dayan { 35301418ddd9SAviv Heller struct mlx5_esw_flow_attr *attr = flow->esw_attr; 3531b05af6aaSBodong Wang bool is_rep_ingress = attr->in_rep->vport != MLX5_VPORT_UPLINK && 3532226f2ca3SVlad Buslov flow_flag_test(flow, INGRESS); 35331418ddd9SAviv Heller bool act_is_encap = !!(attr->action & 35341418ddd9SAviv Heller MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT); 35351418ddd9SAviv Heller bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom, 35361418ddd9SAviv Heller MLX5_DEVCOM_ESW_OFFLOADS); 35371418ddd9SAviv Heller 353810fbb1cdSRoi Dayan if (!esw_paired) 353910fbb1cdSRoi Dayan return false; 354010fbb1cdSRoi Dayan 354110fbb1cdSRoi Dayan if ((mlx5_lag_is_sriov(attr->in_mdev) || 354210fbb1cdSRoi Dayan mlx5_lag_is_multipath(attr->in_mdev)) && 354310fbb1cdSRoi Dayan (is_rep_ingress || act_is_encap)) 354410fbb1cdSRoi Dayan return true; 354510fbb1cdSRoi Dayan 354610fbb1cdSRoi Dayan return false; 354704de7ddaSRoi Dayan } 354804de7ddaSRoi Dayan 3549a88780a9SRoi Dayan static int 3550a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size, 3551226f2ca3SVlad Buslov struct flow_cls_offload *f, unsigned long flow_flags, 3552a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr **__parse_attr, 3553a88780a9SRoi Dayan struct mlx5e_tc_flow **__flow) 3554e3a2b7edSAmir Vadai { 355517091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr; 35563bc4b7bfSOr Gerlitz struct mlx5e_tc_flow *flow; 35575a7e5bcbSVlad Buslov int out_index, err; 3558776b12b6SOr Gerlitz 355965ba8fb7SOr Gerlitz flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL); 35601b9a07eeSLeon Romanovsky parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL); 356117091853SOr Gerlitz if (!parse_attr || !flow) { 3562e3a2b7edSAmir Vadai err = -ENOMEM; 3563e3a2b7edSAmir Vadai goto err_free; 3564e3a2b7edSAmir Vadai } 3565e3a2b7edSAmir Vadai 3566e3a2b7edSAmir Vadai flow->cookie = f->cookie; 356765ba8fb7SOr Gerlitz flow->flags = flow_flags; 3568655dc3d2SOr Gerlitz flow->priv = priv; 35695a7e5bcbSVlad Buslov for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) 35705a7e5bcbSVlad Buslov INIT_LIST_HEAD(&flow->encaps[out_index].list); 35715a7e5bcbSVlad Buslov INIT_LIST_HEAD(&flow->mod_hdr); 35725a7e5bcbSVlad Buslov INIT_LIST_HEAD(&flow->hairpin); 35735a7e5bcbSVlad Buslov refcount_set(&flow->refcnt, 1); 357495435ad7SVlad Buslov init_completion(&flow->init_done); 3575e3a2b7edSAmir Vadai 3576a88780a9SRoi Dayan *__flow = flow; 3577a88780a9SRoi Dayan *__parse_attr = parse_attr; 3578a88780a9SRoi Dayan 3579a88780a9SRoi Dayan return 0; 3580a88780a9SRoi Dayan 3581a88780a9SRoi Dayan err_free: 3582a88780a9SRoi Dayan kfree(flow); 3583a88780a9SRoi Dayan kvfree(parse_attr); 3584a88780a9SRoi Dayan return err; 3585adb4c123SOr Gerlitz } 3586adb4c123SOr Gerlitz 3587988ab9c7STonghao Zhang static void 3588988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(struct mlx5_esw_flow_attr *esw_attr, 3589988ab9c7STonghao Zhang struct mlx5e_priv *priv, 3590988ab9c7STonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr, 3591f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3592988ab9c7STonghao Zhang struct mlx5_eswitch_rep *in_rep, 3593988ab9c7STonghao Zhang struct mlx5_core_dev *in_mdev) 3594988ab9c7STonghao Zhang { 3595988ab9c7STonghao Zhang struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3596988ab9c7STonghao Zhang 3597988ab9c7STonghao Zhang esw_attr->parse_attr = parse_attr; 3598988ab9c7STonghao Zhang esw_attr->chain = f->common.chain_index; 3599ef01adaeSPablo Neira Ayuso esw_attr->prio = f->common.prio; 3600988ab9c7STonghao Zhang 3601988ab9c7STonghao Zhang esw_attr->in_rep = in_rep; 3602988ab9c7STonghao Zhang esw_attr->in_mdev = in_mdev; 3603988ab9c7STonghao Zhang 3604988ab9c7STonghao Zhang if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) == 3605988ab9c7STonghao Zhang MLX5_COUNTER_SOURCE_ESWITCH) 3606988ab9c7STonghao Zhang esw_attr->counter_dev = in_mdev; 3607988ab9c7STonghao Zhang else 3608988ab9c7STonghao Zhang esw_attr->counter_dev = priv->mdev; 3609988ab9c7STonghao Zhang } 3610988ab9c7STonghao Zhang 361171129676SJason Gunthorpe static struct mlx5e_tc_flow * 361204de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv, 3613f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3614226f2ca3SVlad Buslov unsigned long flow_flags, 3615d11afc26SOz Shlomo struct net_device *filter_dev, 361604de7ddaSRoi Dayan struct mlx5_eswitch_rep *in_rep, 361771129676SJason Gunthorpe struct mlx5_core_dev *in_mdev) 3618a88780a9SRoi Dayan { 3619f9e30088SPablo Neira Ayuso struct flow_rule *rule = flow_cls_offload_flow_rule(f); 3620a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3621a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 3622a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3623a88780a9SRoi Dayan int attr_size, err; 3624a88780a9SRoi Dayan 3625226f2ca3SVlad Buslov flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_ESWITCH); 3626a88780a9SRoi Dayan attr_size = sizeof(struct mlx5_esw_flow_attr); 3627a88780a9SRoi Dayan err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags, 3628a88780a9SRoi Dayan &parse_attr, &flow); 3629a88780a9SRoi Dayan if (err) 3630a88780a9SRoi Dayan goto out; 3631988ab9c7STonghao Zhang 3632d11afc26SOz Shlomo parse_attr->filter_dev = filter_dev; 3633988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(flow->esw_attr, 3634988ab9c7STonghao Zhang priv, parse_attr, 3635988ab9c7STonghao Zhang f, in_rep, in_mdev); 3636988ab9c7STonghao Zhang 363754c177caSOz Shlomo err = parse_cls_flower(flow->priv, flow, &parse_attr->spec, 363854c177caSOz Shlomo f, filter_dev); 3639d11afc26SOz Shlomo if (err) 3640d11afc26SOz Shlomo goto err_free; 3641a88780a9SRoi Dayan 36426f9af8ffSTonghao Zhang err = parse_tc_fdb_actions(priv, &rule->action, flow, extack); 3643a88780a9SRoi Dayan if (err) 3644a88780a9SRoi Dayan goto err_free; 3645a88780a9SRoi Dayan 36467040632dSTonghao Zhang err = mlx5e_tc_add_fdb_flow(priv, flow, extack); 364795435ad7SVlad Buslov complete_all(&flow->init_done); 3648ef06c9eeSRoi Dayan if (err) { 3649ef06c9eeSRoi Dayan if (!(err == -ENETUNREACH && mlx5_lag_is_multipath(in_mdev))) 3650aa0cbbaeSOr Gerlitz goto err_free; 36515c40348cSOr Gerlitz 3652b4a23329SRoi Dayan add_unready_flow(flow); 3653ef06c9eeSRoi Dayan } 3654ef06c9eeSRoi Dayan 365571129676SJason Gunthorpe return flow; 3656e3a2b7edSAmir Vadai 3657e3a2b7edSAmir Vadai err_free: 36585a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 3659a88780a9SRoi Dayan out: 366071129676SJason Gunthorpe return ERR_PTR(err); 3661a88780a9SRoi Dayan } 3662a88780a9SRoi Dayan 3663f9e30088SPablo Neira Ayuso static int mlx5e_tc_add_fdb_peer_flow(struct flow_cls_offload *f, 366495dc1902SRoi Dayan struct mlx5e_tc_flow *flow, 3665226f2ca3SVlad Buslov unsigned long flow_flags) 366604de7ddaSRoi Dayan { 366704de7ddaSRoi Dayan struct mlx5e_priv *priv = flow->priv, *peer_priv; 366804de7ddaSRoi Dayan struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw; 366904de7ddaSRoi Dayan struct mlx5_devcom *devcom = priv->mdev->priv.devcom; 367004de7ddaSRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 367104de7ddaSRoi Dayan struct mlx5e_rep_priv *peer_urpriv; 367204de7ddaSRoi Dayan struct mlx5e_tc_flow *peer_flow; 367304de7ddaSRoi Dayan struct mlx5_core_dev *in_mdev; 367404de7ddaSRoi Dayan int err = 0; 367504de7ddaSRoi Dayan 367604de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 367704de7ddaSRoi Dayan if (!peer_esw) 367804de7ddaSRoi Dayan return -ENODEV; 367904de7ddaSRoi Dayan 368004de7ddaSRoi Dayan peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH); 368104de7ddaSRoi Dayan peer_priv = netdev_priv(peer_urpriv->netdev); 368204de7ddaSRoi Dayan 368304de7ddaSRoi Dayan /* in_mdev is assigned of which the packet originated from. 368404de7ddaSRoi Dayan * So packets redirected to uplink use the same mdev of the 368504de7ddaSRoi Dayan * original flow and packets redirected from uplink use the 368604de7ddaSRoi Dayan * peer mdev. 368704de7ddaSRoi Dayan */ 3688b05af6aaSBodong Wang if (flow->esw_attr->in_rep->vport == MLX5_VPORT_UPLINK) 368904de7ddaSRoi Dayan in_mdev = peer_priv->mdev; 369004de7ddaSRoi Dayan else 369104de7ddaSRoi Dayan in_mdev = priv->mdev; 369204de7ddaSRoi Dayan 369304de7ddaSRoi Dayan parse_attr = flow->esw_attr->parse_attr; 369495dc1902SRoi Dayan peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow_flags, 369504de7ddaSRoi Dayan parse_attr->filter_dev, 369671129676SJason Gunthorpe flow->esw_attr->in_rep, in_mdev); 369771129676SJason Gunthorpe if (IS_ERR(peer_flow)) { 369871129676SJason Gunthorpe err = PTR_ERR(peer_flow); 369904de7ddaSRoi Dayan goto out; 370071129676SJason Gunthorpe } 370104de7ddaSRoi Dayan 370204de7ddaSRoi Dayan flow->peer_flow = peer_flow; 3703226f2ca3SVlad Buslov flow_flag_set(flow, DUP); 370404de7ddaSRoi Dayan mutex_lock(&esw->offloads.peer_mutex); 370504de7ddaSRoi Dayan list_add_tail(&flow->peer, &esw->offloads.peer_flows); 370604de7ddaSRoi Dayan mutex_unlock(&esw->offloads.peer_mutex); 370704de7ddaSRoi Dayan 370804de7ddaSRoi Dayan out: 370904de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 371004de7ddaSRoi Dayan return err; 371104de7ddaSRoi Dayan } 371204de7ddaSRoi Dayan 371304de7ddaSRoi Dayan static int 371404de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv, 3715f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3716226f2ca3SVlad Buslov unsigned long flow_flags, 371704de7ddaSRoi Dayan struct net_device *filter_dev, 371804de7ddaSRoi Dayan struct mlx5e_tc_flow **__flow) 371904de7ddaSRoi Dayan { 372004de7ddaSRoi Dayan struct mlx5e_rep_priv *rpriv = priv->ppriv; 372104de7ddaSRoi Dayan struct mlx5_eswitch_rep *in_rep = rpriv->rep; 372204de7ddaSRoi Dayan struct mlx5_core_dev *in_mdev = priv->mdev; 372304de7ddaSRoi Dayan struct mlx5e_tc_flow *flow; 372404de7ddaSRoi Dayan int err; 372504de7ddaSRoi Dayan 372671129676SJason Gunthorpe flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep, 372771129676SJason Gunthorpe in_mdev); 372871129676SJason Gunthorpe if (IS_ERR(flow)) 372971129676SJason Gunthorpe return PTR_ERR(flow); 373004de7ddaSRoi Dayan 373104de7ddaSRoi Dayan if (is_peer_flow_needed(flow)) { 373295dc1902SRoi Dayan err = mlx5e_tc_add_fdb_peer_flow(f, flow, flow_flags); 373304de7ddaSRoi Dayan if (err) { 373404de7ddaSRoi Dayan mlx5e_tc_del_fdb_flow(priv, flow); 373504de7ddaSRoi Dayan goto out; 373604de7ddaSRoi Dayan } 373704de7ddaSRoi Dayan } 373804de7ddaSRoi Dayan 373904de7ddaSRoi Dayan *__flow = flow; 374004de7ddaSRoi Dayan 374104de7ddaSRoi Dayan return 0; 374204de7ddaSRoi Dayan 374304de7ddaSRoi Dayan out: 374404de7ddaSRoi Dayan return err; 374504de7ddaSRoi Dayan } 374604de7ddaSRoi Dayan 3747a88780a9SRoi Dayan static int 3748a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv, 3749f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3750226f2ca3SVlad Buslov unsigned long flow_flags, 3751d11afc26SOz Shlomo struct net_device *filter_dev, 3752a88780a9SRoi Dayan struct mlx5e_tc_flow **__flow) 3753a88780a9SRoi Dayan { 3754f9e30088SPablo Neira Ayuso struct flow_rule *rule = flow_cls_offload_flow_rule(f); 3755a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3756a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 3757a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3758a88780a9SRoi Dayan int attr_size, err; 3759a88780a9SRoi Dayan 3760bf07aa73SPaul Blakey /* multi-chain not supported for NIC rules */ 3761bf07aa73SPaul Blakey if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common)) 3762bf07aa73SPaul Blakey return -EOPNOTSUPP; 3763bf07aa73SPaul Blakey 3764226f2ca3SVlad Buslov flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_NIC); 3765a88780a9SRoi Dayan attr_size = sizeof(struct mlx5_nic_flow_attr); 3766a88780a9SRoi Dayan err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags, 3767a88780a9SRoi Dayan &parse_attr, &flow); 3768a88780a9SRoi Dayan if (err) 3769a88780a9SRoi Dayan goto out; 3770a88780a9SRoi Dayan 3771d11afc26SOz Shlomo parse_attr->filter_dev = filter_dev; 377254c177caSOz Shlomo err = parse_cls_flower(flow->priv, flow, &parse_attr->spec, 377354c177caSOz Shlomo f, filter_dev); 3774d11afc26SOz Shlomo if (err) 3775d11afc26SOz Shlomo goto err_free; 3776d11afc26SOz Shlomo 377773867881SPablo Neira Ayuso err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack); 3778a88780a9SRoi Dayan if (err) 3779a88780a9SRoi Dayan goto err_free; 3780a88780a9SRoi Dayan 3781a88780a9SRoi Dayan err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack); 3782a88780a9SRoi Dayan if (err) 3783a88780a9SRoi Dayan goto err_free; 3784a88780a9SRoi Dayan 3785226f2ca3SVlad Buslov flow_flag_set(flow, OFFLOADED); 3786a88780a9SRoi Dayan kvfree(parse_attr); 3787a88780a9SRoi Dayan *__flow = flow; 3788a88780a9SRoi Dayan 3789a88780a9SRoi Dayan return 0; 3790a88780a9SRoi Dayan 3791a88780a9SRoi Dayan err_free: 37925a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 3793a88780a9SRoi Dayan kvfree(parse_attr); 3794a88780a9SRoi Dayan out: 3795a88780a9SRoi Dayan return err; 3796a88780a9SRoi Dayan } 3797a88780a9SRoi Dayan 3798a88780a9SRoi Dayan static int 3799a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv, 3800f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3801226f2ca3SVlad Buslov unsigned long flags, 3802d11afc26SOz Shlomo struct net_device *filter_dev, 3803a88780a9SRoi Dayan struct mlx5e_tc_flow **flow) 3804a88780a9SRoi Dayan { 3805a88780a9SRoi Dayan struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3806226f2ca3SVlad Buslov unsigned long flow_flags; 3807a88780a9SRoi Dayan int err; 3808a88780a9SRoi Dayan 3809a88780a9SRoi Dayan get_flags(flags, &flow_flags); 3810a88780a9SRoi Dayan 3811bf07aa73SPaul Blakey if (!tc_can_offload_extack(priv->netdev, f->common.extack)) 3812bf07aa73SPaul Blakey return -EOPNOTSUPP; 3813bf07aa73SPaul Blakey 3814f6455de0SBodong Wang if (esw && esw->mode == MLX5_ESWITCH_OFFLOADS) 3815d11afc26SOz Shlomo err = mlx5e_add_fdb_flow(priv, f, flow_flags, 3816d11afc26SOz Shlomo filter_dev, flow); 3817a88780a9SRoi Dayan else 3818d11afc26SOz Shlomo err = mlx5e_add_nic_flow(priv, f, flow_flags, 3819d11afc26SOz Shlomo filter_dev, flow); 3820a88780a9SRoi Dayan 3821a88780a9SRoi Dayan return err; 3822a88780a9SRoi Dayan } 3823a88780a9SRoi Dayan 382471d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv, 3825226f2ca3SVlad Buslov struct flow_cls_offload *f, unsigned long flags) 3826a88780a9SRoi Dayan { 3827a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3828d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 3829a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3830a88780a9SRoi Dayan int err = 0; 3831a88780a9SRoi Dayan 3832c5d326b2SVlad Buslov rcu_read_lock(); 3833c5d326b2SVlad Buslov flow = rhashtable_lookup(tc_ht, &f->cookie, tc_ht_params); 3834c5d326b2SVlad Buslov rcu_read_unlock(); 3835a88780a9SRoi Dayan if (flow) { 3836a88780a9SRoi Dayan NL_SET_ERR_MSG_MOD(extack, 3837a88780a9SRoi Dayan "flow cookie already exists, ignoring"); 3838a88780a9SRoi Dayan netdev_warn_once(priv->netdev, 3839a88780a9SRoi Dayan "flow cookie %lx already exists, ignoring\n", 3840a88780a9SRoi Dayan f->cookie); 38410e1c1a2fSVlad Buslov err = -EEXIST; 3842a88780a9SRoi Dayan goto out; 3843a88780a9SRoi Dayan } 3844a88780a9SRoi Dayan 38457a978759SDmytro Linkin trace_mlx5e_configure_flower(f); 3846d11afc26SOz Shlomo err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow); 3847a88780a9SRoi Dayan if (err) 3848a88780a9SRoi Dayan goto out; 3849a88780a9SRoi Dayan 3850c5d326b2SVlad Buslov err = rhashtable_lookup_insert_fast(tc_ht, &flow->node, tc_ht_params); 3851a88780a9SRoi Dayan if (err) 3852a88780a9SRoi Dayan goto err_free; 3853a88780a9SRoi Dayan 3854a88780a9SRoi Dayan return 0; 3855a88780a9SRoi Dayan 3856a88780a9SRoi Dayan err_free: 38575a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 3858a88780a9SRoi Dayan out: 3859e3a2b7edSAmir Vadai return err; 3860e3a2b7edSAmir Vadai } 3861e3a2b7edSAmir Vadai 38628f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags) 38638f8ae895SOr Gerlitz { 3864226f2ca3SVlad Buslov bool dir_ingress = !!(flags & MLX5_TC_FLAG(INGRESS)); 3865226f2ca3SVlad Buslov bool dir_egress = !!(flags & MLX5_TC_FLAG(EGRESS)); 38668f8ae895SOr Gerlitz 3867226f2ca3SVlad Buslov return flow_flag_test(flow, INGRESS) == dir_ingress && 3868226f2ca3SVlad Buslov flow_flag_test(flow, EGRESS) == dir_egress; 38698f8ae895SOr Gerlitz } 38708f8ae895SOr Gerlitz 387171d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv, 3872226f2ca3SVlad Buslov struct flow_cls_offload *f, unsigned long flags) 3873e3a2b7edSAmir Vadai { 3874d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 3875e3a2b7edSAmir Vadai struct mlx5e_tc_flow *flow; 3876c5d326b2SVlad Buslov int err; 3877e3a2b7edSAmir Vadai 3878c5d326b2SVlad Buslov rcu_read_lock(); 387905866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 3880c5d326b2SVlad Buslov if (!flow || !same_flow_direction(flow, flags)) { 3881c5d326b2SVlad Buslov err = -EINVAL; 3882c5d326b2SVlad Buslov goto errout; 3883c5d326b2SVlad Buslov } 3884e3a2b7edSAmir Vadai 3885c5d326b2SVlad Buslov /* Only delete the flow if it doesn't have MLX5E_TC_FLOW_DELETED flag 3886c5d326b2SVlad Buslov * set. 3887c5d326b2SVlad Buslov */ 3888c5d326b2SVlad Buslov if (flow_flag_test_and_set(flow, DELETED)) { 3889c5d326b2SVlad Buslov err = -EINVAL; 3890c5d326b2SVlad Buslov goto errout; 3891c5d326b2SVlad Buslov } 389205866c82SOr Gerlitz rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params); 3893c5d326b2SVlad Buslov rcu_read_unlock(); 3894e3a2b7edSAmir Vadai 38957a978759SDmytro Linkin trace_mlx5e_delete_flower(f); 38965a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 3897e3a2b7edSAmir Vadai 3898e3a2b7edSAmir Vadai return 0; 3899c5d326b2SVlad Buslov 3900c5d326b2SVlad Buslov errout: 3901c5d326b2SVlad Buslov rcu_read_unlock(); 3902c5d326b2SVlad Buslov return err; 3903e3a2b7edSAmir Vadai } 3904e3a2b7edSAmir Vadai 390571d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv, 3906226f2ca3SVlad Buslov struct flow_cls_offload *f, unsigned long flags) 3907aad7e08dSAmir Vadai { 390804de7ddaSRoi Dayan struct mlx5_devcom *devcom = priv->mdev->priv.devcom; 3909d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 391004de7ddaSRoi Dayan struct mlx5_eswitch *peer_esw; 3911aad7e08dSAmir Vadai struct mlx5e_tc_flow *flow; 3912aad7e08dSAmir Vadai struct mlx5_fc *counter; 3913316d5f72SRoi Dayan u64 lastuse = 0; 3914316d5f72SRoi Dayan u64 packets = 0; 3915316d5f72SRoi Dayan u64 bytes = 0; 39165a7e5bcbSVlad Buslov int err = 0; 3917aad7e08dSAmir Vadai 3918c5d326b2SVlad Buslov rcu_read_lock(); 3919c5d326b2SVlad Buslov flow = mlx5e_flow_get(rhashtable_lookup(tc_ht, &f->cookie, 39205a7e5bcbSVlad Buslov tc_ht_params)); 3921c5d326b2SVlad Buslov rcu_read_unlock(); 39225a7e5bcbSVlad Buslov if (IS_ERR(flow)) 39235a7e5bcbSVlad Buslov return PTR_ERR(flow); 39245a7e5bcbSVlad Buslov 39255a7e5bcbSVlad Buslov if (!same_flow_direction(flow, flags)) { 39265a7e5bcbSVlad Buslov err = -EINVAL; 39275a7e5bcbSVlad Buslov goto errout; 39285a7e5bcbSVlad Buslov } 3929aad7e08dSAmir Vadai 3930226f2ca3SVlad Buslov if (mlx5e_is_offloaded_flow(flow)) { 3931b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 3932aad7e08dSAmir Vadai if (!counter) 39335a7e5bcbSVlad Buslov goto errout; 3934aad7e08dSAmir Vadai 3935aad7e08dSAmir Vadai mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 3936316d5f72SRoi Dayan } 3937aad7e08dSAmir Vadai 3938316d5f72SRoi Dayan /* Under multipath it's possible for one rule to be currently 3939316d5f72SRoi Dayan * un-offloaded while the other rule is offloaded. 3940316d5f72SRoi Dayan */ 394104de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 394204de7ddaSRoi Dayan if (!peer_esw) 394304de7ddaSRoi Dayan goto out; 394404de7ddaSRoi Dayan 3945226f2ca3SVlad Buslov if (flow_flag_test(flow, DUP) && 3946226f2ca3SVlad Buslov flow_flag_test(flow->peer_flow, OFFLOADED)) { 394704de7ddaSRoi Dayan u64 bytes2; 394804de7ddaSRoi Dayan u64 packets2; 394904de7ddaSRoi Dayan u64 lastuse2; 395004de7ddaSRoi Dayan 395104de7ddaSRoi Dayan counter = mlx5e_tc_get_counter(flow->peer_flow); 3952316d5f72SRoi Dayan if (!counter) 3953316d5f72SRoi Dayan goto no_peer_counter; 395404de7ddaSRoi Dayan mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2); 395504de7ddaSRoi Dayan 395604de7ddaSRoi Dayan bytes += bytes2; 395704de7ddaSRoi Dayan packets += packets2; 395804de7ddaSRoi Dayan lastuse = max_t(u64, lastuse, lastuse2); 395904de7ddaSRoi Dayan } 396004de7ddaSRoi Dayan 3961316d5f72SRoi Dayan no_peer_counter: 396204de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 396304de7ddaSRoi Dayan out: 39643b1903efSPablo Neira Ayuso flow_stats_update(&f->stats, bytes, packets, lastuse); 39657a978759SDmytro Linkin trace_mlx5e_stats_flower(f); 39665a7e5bcbSVlad Buslov errout: 39675a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 39685a7e5bcbSVlad Buslov return err; 3969aad7e08dSAmir Vadai } 3970aad7e08dSAmir Vadai 3971fcb64c0fSEli Cohen static int apply_police_params(struct mlx5e_priv *priv, u32 rate, 3972fcb64c0fSEli Cohen struct netlink_ext_ack *extack) 3973fcb64c0fSEli Cohen { 3974fcb64c0fSEli Cohen struct mlx5e_rep_priv *rpriv = priv->ppriv; 3975fcb64c0fSEli Cohen struct mlx5_eswitch *esw; 3976fcb64c0fSEli Cohen u16 vport_num; 3977fcb64c0fSEli Cohen u32 rate_mbps; 3978fcb64c0fSEli Cohen int err; 3979fcb64c0fSEli Cohen 3980fcb64c0fSEli Cohen esw = priv->mdev->priv.eswitch; 3981fcb64c0fSEli Cohen /* rate is given in bytes/sec. 3982fcb64c0fSEli Cohen * First convert to bits/sec and then round to the nearest mbit/secs. 3983fcb64c0fSEli Cohen * mbit means million bits. 3984fcb64c0fSEli Cohen * Moreover, if rate is non zero we choose to configure to a minimum of 3985fcb64c0fSEli Cohen * 1 mbit/sec. 3986fcb64c0fSEli Cohen */ 3987fcb64c0fSEli Cohen rate_mbps = rate ? max_t(u32, (rate * 8 + 500000) / 1000000, 1) : 0; 3988fcb64c0fSEli Cohen vport_num = rpriv->rep->vport; 3989fcb64c0fSEli Cohen 3990fcb64c0fSEli Cohen err = mlx5_esw_modify_vport_rate(esw, vport_num, rate_mbps); 3991fcb64c0fSEli Cohen if (err) 3992fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "failed applying action to hardware"); 3993fcb64c0fSEli Cohen 3994fcb64c0fSEli Cohen return err; 3995fcb64c0fSEli Cohen } 3996fcb64c0fSEli Cohen 3997fcb64c0fSEli Cohen static int scan_tc_matchall_fdb_actions(struct mlx5e_priv *priv, 3998fcb64c0fSEli Cohen struct flow_action *flow_action, 3999fcb64c0fSEli Cohen struct netlink_ext_ack *extack) 4000fcb64c0fSEli Cohen { 4001fcb64c0fSEli Cohen struct mlx5e_rep_priv *rpriv = priv->ppriv; 4002fcb64c0fSEli Cohen const struct flow_action_entry *act; 4003fcb64c0fSEli Cohen int err; 4004fcb64c0fSEli Cohen int i; 4005fcb64c0fSEli Cohen 4006fcb64c0fSEli Cohen if (!flow_action_has_entries(flow_action)) { 4007fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "matchall called with no action"); 4008fcb64c0fSEli Cohen return -EINVAL; 4009fcb64c0fSEli Cohen } 4010fcb64c0fSEli Cohen 4011fcb64c0fSEli Cohen if (!flow_offload_has_one_action(flow_action)) { 4012fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "matchall policing support only a single action"); 4013fcb64c0fSEli Cohen return -EOPNOTSUPP; 4014fcb64c0fSEli Cohen } 4015fcb64c0fSEli Cohen 4016fcb64c0fSEli Cohen flow_action_for_each(i, act, flow_action) { 4017fcb64c0fSEli Cohen switch (act->id) { 4018fcb64c0fSEli Cohen case FLOW_ACTION_POLICE: 4019fcb64c0fSEli Cohen err = apply_police_params(priv, act->police.rate_bytes_ps, extack); 4020fcb64c0fSEli Cohen if (err) 4021fcb64c0fSEli Cohen return err; 4022fcb64c0fSEli Cohen 4023fcb64c0fSEli Cohen rpriv->prev_vf_vport_stats = priv->stats.vf_vport; 4024fcb64c0fSEli Cohen break; 4025fcb64c0fSEli Cohen default: 4026fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "mlx5 supports only police action for matchall"); 4027fcb64c0fSEli Cohen return -EOPNOTSUPP; 4028fcb64c0fSEli Cohen } 4029fcb64c0fSEli Cohen } 4030fcb64c0fSEli Cohen 4031fcb64c0fSEli Cohen return 0; 4032fcb64c0fSEli Cohen } 4033fcb64c0fSEli Cohen 4034fcb64c0fSEli Cohen int mlx5e_tc_configure_matchall(struct mlx5e_priv *priv, 4035fcb64c0fSEli Cohen struct tc_cls_matchall_offload *ma) 4036fcb64c0fSEli Cohen { 4037fcb64c0fSEli Cohen struct netlink_ext_ack *extack = ma->common.extack; 4038fcb64c0fSEli Cohen int prio = TC_H_MAJ(ma->common.prio) >> 16; 4039fcb64c0fSEli Cohen 4040fcb64c0fSEli Cohen if (prio != 1) { 4041fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "only priority 1 is supported"); 4042fcb64c0fSEli Cohen return -EINVAL; 4043fcb64c0fSEli Cohen } 4044fcb64c0fSEli Cohen 4045fcb64c0fSEli Cohen return scan_tc_matchall_fdb_actions(priv, &ma->rule->action, extack); 4046fcb64c0fSEli Cohen } 4047fcb64c0fSEli Cohen 4048fcb64c0fSEli Cohen int mlx5e_tc_delete_matchall(struct mlx5e_priv *priv, 4049fcb64c0fSEli Cohen struct tc_cls_matchall_offload *ma) 4050fcb64c0fSEli Cohen { 4051fcb64c0fSEli Cohen struct netlink_ext_ack *extack = ma->common.extack; 4052fcb64c0fSEli Cohen 4053fcb64c0fSEli Cohen return apply_police_params(priv, 0, extack); 4054fcb64c0fSEli Cohen } 4055fcb64c0fSEli Cohen 4056fcb64c0fSEli Cohen void mlx5e_tc_stats_matchall(struct mlx5e_priv *priv, 4057fcb64c0fSEli Cohen struct tc_cls_matchall_offload *ma) 4058fcb64c0fSEli Cohen { 4059fcb64c0fSEli Cohen struct mlx5e_rep_priv *rpriv = priv->ppriv; 4060fcb64c0fSEli Cohen struct rtnl_link_stats64 cur_stats; 4061fcb64c0fSEli Cohen u64 dbytes; 4062fcb64c0fSEli Cohen u64 dpkts; 4063fcb64c0fSEli Cohen 4064fcb64c0fSEli Cohen cur_stats = priv->stats.vf_vport; 4065fcb64c0fSEli Cohen dpkts = cur_stats.rx_packets - rpriv->prev_vf_vport_stats.rx_packets; 4066fcb64c0fSEli Cohen dbytes = cur_stats.rx_bytes - rpriv->prev_vf_vport_stats.rx_bytes; 4067fcb64c0fSEli Cohen rpriv->prev_vf_vport_stats = cur_stats; 4068fcb64c0fSEli Cohen flow_stats_update(&ma->stats, dpkts, dbytes, jiffies); 4069fcb64c0fSEli Cohen } 4070fcb64c0fSEli Cohen 40714d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv, 40724d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv) 40734d8fcf21SAlaa Hleihel { 40744d8fcf21SAlaa Hleihel struct mlx5_core_dev *peer_mdev = peer_priv->mdev; 4075db76ca24SVlad Buslov struct mlx5e_hairpin_entry *hpe, *tmp; 4076db76ca24SVlad Buslov LIST_HEAD(init_wait_list); 40774d8fcf21SAlaa Hleihel u16 peer_vhca_id; 40784d8fcf21SAlaa Hleihel int bkt; 40794d8fcf21SAlaa Hleihel 40804d8fcf21SAlaa Hleihel if (!same_hw_devs(priv, peer_priv)) 40814d8fcf21SAlaa Hleihel return; 40824d8fcf21SAlaa Hleihel 40834d8fcf21SAlaa Hleihel peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 40844d8fcf21SAlaa Hleihel 4085b32accdaSVlad Buslov mutex_lock(&priv->fs.tc.hairpin_tbl_lock); 4086db76ca24SVlad Buslov hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) 4087db76ca24SVlad Buslov if (refcount_inc_not_zero(&hpe->refcnt)) 4088db76ca24SVlad Buslov list_add(&hpe->dead_peer_wait_list, &init_wait_list); 4089b32accdaSVlad Buslov mutex_unlock(&priv->fs.tc.hairpin_tbl_lock); 4090db76ca24SVlad Buslov 4091db76ca24SVlad Buslov list_for_each_entry_safe(hpe, tmp, &init_wait_list, dead_peer_wait_list) { 4092db76ca24SVlad Buslov wait_for_completion(&hpe->res_ready); 4093db76ca24SVlad Buslov if (!IS_ERR_OR_NULL(hpe->hp) && hpe->peer_vhca_id == peer_vhca_id) 4094db76ca24SVlad Buslov hpe->hp->pair->peer_gone = true; 4095db76ca24SVlad Buslov 4096db76ca24SVlad Buslov mlx5e_hairpin_put(priv, hpe); 4097db76ca24SVlad Buslov } 40984d8fcf21SAlaa Hleihel } 40994d8fcf21SAlaa Hleihel 41004d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this, 41014d8fcf21SAlaa Hleihel unsigned long event, void *ptr) 41024d8fcf21SAlaa Hleihel { 41034d8fcf21SAlaa Hleihel struct net_device *ndev = netdev_notifier_info_to_dev(ptr); 41044d8fcf21SAlaa Hleihel struct mlx5e_flow_steering *fs; 41054d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv; 41064d8fcf21SAlaa Hleihel struct mlx5e_tc_table *tc; 41074d8fcf21SAlaa Hleihel struct mlx5e_priv *priv; 41084d8fcf21SAlaa Hleihel 41094d8fcf21SAlaa Hleihel if (ndev->netdev_ops != &mlx5e_netdev_ops || 41104d8fcf21SAlaa Hleihel event != NETDEV_UNREGISTER || 41114d8fcf21SAlaa Hleihel ndev->reg_state == NETREG_REGISTERED) 41124d8fcf21SAlaa Hleihel return NOTIFY_DONE; 41134d8fcf21SAlaa Hleihel 41144d8fcf21SAlaa Hleihel tc = container_of(this, struct mlx5e_tc_table, netdevice_nb); 41154d8fcf21SAlaa Hleihel fs = container_of(tc, struct mlx5e_flow_steering, tc); 41164d8fcf21SAlaa Hleihel priv = container_of(fs, struct mlx5e_priv, fs); 41174d8fcf21SAlaa Hleihel peer_priv = netdev_priv(ndev); 41184d8fcf21SAlaa Hleihel if (priv == peer_priv || 41194d8fcf21SAlaa Hleihel !(priv->netdev->features & NETIF_F_HW_TC)) 41204d8fcf21SAlaa Hleihel return NOTIFY_DONE; 41214d8fcf21SAlaa Hleihel 41224d8fcf21SAlaa Hleihel mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv); 41234d8fcf21SAlaa Hleihel 41244d8fcf21SAlaa Hleihel return NOTIFY_DONE; 41254d8fcf21SAlaa Hleihel } 41264d8fcf21SAlaa Hleihel 4127655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv) 4128e8f887acSAmir Vadai { 4129acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 41304d8fcf21SAlaa Hleihel int err; 4131e8f887acSAmir Vadai 4132b6fac0b4SVlad Buslov mutex_init(&tc->t_lock); 4133d2faae25SVlad Buslov mutex_init(&tc->mod_hdr.lock); 4134dd58edc3SVlad Buslov hash_init(tc->mod_hdr.hlist); 4135b32accdaSVlad Buslov mutex_init(&tc->hairpin_tbl_lock); 41365c65c564SOr Gerlitz hash_init(tc->hairpin_tbl); 413711c9c548SOr Gerlitz 41384d8fcf21SAlaa Hleihel err = rhashtable_init(&tc->ht, &tc_ht_params); 41394d8fcf21SAlaa Hleihel if (err) 41404d8fcf21SAlaa Hleihel return err; 41414d8fcf21SAlaa Hleihel 41424d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event; 41434d8fcf21SAlaa Hleihel if (register_netdevice_notifier(&tc->netdevice_nb)) { 41444d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = NULL; 41454d8fcf21SAlaa Hleihel mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n"); 41464d8fcf21SAlaa Hleihel } 41474d8fcf21SAlaa Hleihel 41484d8fcf21SAlaa Hleihel return err; 4149e8f887acSAmir Vadai } 4150e8f887acSAmir Vadai 4151e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg) 4152e8f887acSAmir Vadai { 4153e8f887acSAmir Vadai struct mlx5e_tc_flow *flow = ptr; 4154655dc3d2SOr Gerlitz struct mlx5e_priv *priv = flow->priv; 4155e8f887acSAmir Vadai 4156961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 4157e8f887acSAmir Vadai kfree(flow); 4158e8f887acSAmir Vadai } 4159e8f887acSAmir Vadai 4160655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv) 4161e8f887acSAmir Vadai { 4162acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 4163e8f887acSAmir Vadai 41644d8fcf21SAlaa Hleihel if (tc->netdevice_nb.notifier_call) 41654d8fcf21SAlaa Hleihel unregister_netdevice_notifier(&tc->netdevice_nb); 41664d8fcf21SAlaa Hleihel 4167d2faae25SVlad Buslov mutex_destroy(&tc->mod_hdr.lock); 4168b32accdaSVlad Buslov mutex_destroy(&tc->hairpin_tbl_lock); 4169b32accdaSVlad Buslov 4170d9ee0491SOr Gerlitz rhashtable_destroy(&tc->ht); 4171e8f887acSAmir Vadai 4172acff797cSMaor Gottlieb if (!IS_ERR_OR_NULL(tc->t)) { 4173acff797cSMaor Gottlieb mlx5_destroy_flow_table(tc->t); 4174acff797cSMaor Gottlieb tc->t = NULL; 4175e8f887acSAmir Vadai } 4176b6fac0b4SVlad Buslov mutex_destroy(&tc->t_lock); 4177e8f887acSAmir Vadai } 4178655dc3d2SOr Gerlitz 4179655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht) 4180655dc3d2SOr Gerlitz { 4181655dc3d2SOr Gerlitz return rhashtable_init(tc_ht, &tc_ht_params); 4182655dc3d2SOr Gerlitz } 4183655dc3d2SOr Gerlitz 4184655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht) 4185655dc3d2SOr Gerlitz { 4186655dc3d2SOr Gerlitz rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL); 4187655dc3d2SOr Gerlitz } 418801252a27SOr Gerlitz 4189226f2ca3SVlad Buslov int mlx5e_tc_num_filters(struct mlx5e_priv *priv, unsigned long flags) 419001252a27SOr Gerlitz { 4191d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 419201252a27SOr Gerlitz 419301252a27SOr Gerlitz return atomic_read(&tc_ht->nelems); 419401252a27SOr Gerlitz } 419504de7ddaSRoi Dayan 419604de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw) 419704de7ddaSRoi Dayan { 419804de7ddaSRoi Dayan struct mlx5e_tc_flow *flow, *tmp; 419904de7ddaSRoi Dayan 420004de7ddaSRoi Dayan list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer) 420104de7ddaSRoi Dayan __mlx5e_tc_del_fdb_peer_flow(flow); 420204de7ddaSRoi Dayan } 4203b4a23329SRoi Dayan 4204b4a23329SRoi Dayan void mlx5e_tc_reoffload_flows_work(struct work_struct *work) 4205b4a23329SRoi Dayan { 4206b4a23329SRoi Dayan struct mlx5_rep_uplink_priv *rpriv = 4207b4a23329SRoi Dayan container_of(work, struct mlx5_rep_uplink_priv, 4208b4a23329SRoi Dayan reoffload_flows_work); 4209b4a23329SRoi Dayan struct mlx5e_tc_flow *flow, *tmp; 4210b4a23329SRoi Dayan 4211ad86755bSVlad Buslov mutex_lock(&rpriv->unready_flows_lock); 4212b4a23329SRoi Dayan list_for_each_entry_safe(flow, tmp, &rpriv->unready_flows, unready) { 4213b4a23329SRoi Dayan if (!mlx5e_tc_add_fdb_flow(flow->priv, flow, NULL)) 4214ad86755bSVlad Buslov unready_flow_del(flow); 4215b4a23329SRoi Dayan } 4216ad86755bSVlad Buslov mutex_unlock(&rpriv->unready_flows_lock); 4217b4a23329SRoi Dayan } 4218