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 1629eb252c3aSRoi Dayan if (refcount_dec_and_test(&flow->peer_flow->refcnt)) { 163004de7ddaSRoi Dayan mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow); 1631a23dae79SRoi Dayan kfree(flow->peer_flow); 1632eb252c3aSRoi Dayan } 1633eb252c3aSRoi Dayan 163404de7ddaSRoi Dayan flow->peer_flow = NULL; 163504de7ddaSRoi Dayan } 163604de7ddaSRoi Dayan 163704de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow) 163804de7ddaSRoi Dayan { 163904de7ddaSRoi Dayan struct mlx5_core_dev *dev = flow->priv->mdev; 164004de7ddaSRoi Dayan struct mlx5_devcom *devcom = dev->priv.devcom; 164104de7ddaSRoi Dayan struct mlx5_eswitch *peer_esw; 164204de7ddaSRoi Dayan 164304de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 164404de7ddaSRoi Dayan if (!peer_esw) 164504de7ddaSRoi Dayan return; 164604de7ddaSRoi Dayan 164704de7ddaSRoi Dayan __mlx5e_tc_del_fdb_peer_flow(flow); 164804de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 164904de7ddaSRoi Dayan } 165004de7ddaSRoi Dayan 1651e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv, 1652961e8979SRoi Dayan struct mlx5e_tc_flow *flow) 1653e8f887acSAmir Vadai { 1654226f2ca3SVlad Buslov if (mlx5e_is_eswitch_flow(flow)) { 165504de7ddaSRoi Dayan mlx5e_tc_del_fdb_peer_flow(flow); 1656d85cdccbSOr Gerlitz mlx5e_tc_del_fdb_flow(priv, flow); 165704de7ddaSRoi Dayan } else { 1658d85cdccbSOr Gerlitz mlx5e_tc_del_nic_flow(priv, flow); 1659e8f887acSAmir Vadai } 166004de7ddaSRoi Dayan } 1661e8f887acSAmir Vadai 1662bbd00f7eSHadar Hen Zion 1663bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv, 1664bbd00f7eSHadar Hen Zion struct mlx5_flow_spec *spec, 1665f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 16666363651dSOr Gerlitz struct net_device *filter_dev, u8 *match_level) 1667bbd00f7eSHadar Hen Zion { 1668e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1669bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1670bbd00f7eSHadar Hen Zion outer_headers); 1671bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1672bbd00f7eSHadar Hen Zion outer_headers); 1673f9e30088SPablo Neira Ayuso struct flow_rule *rule = flow_cls_offload_flow_rule(f); 16748f256622SPablo Neira Ayuso int err; 1675bbd00f7eSHadar Hen Zion 1676101f4de9SOz Shlomo err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f, 16776363651dSOr Gerlitz headers_c, headers_v, match_level); 167854c177caSOz Shlomo if (err) { 167954c177caSOz Shlomo NL_SET_ERR_MSG_MOD(extack, 168054c177caSOz Shlomo "failed to parse tunnel attributes"); 1681101f4de9SOz Shlomo return err; 1682bbd00f7eSHadar Hen Zion } 1683bbd00f7eSHadar Hen Zion 1684fe1587a7SDmytro Linkin if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL)) { 1685fe1587a7SDmytro Linkin struct flow_match_control match; 1686fe1587a7SDmytro Linkin u16 addr_type; 1687fe1587a7SDmytro Linkin 1688fe1587a7SDmytro Linkin flow_rule_match_enc_control(rule, &match); 1689fe1587a7SDmytro Linkin addr_type = match.key->addr_type; 1690fe1587a7SDmytro Linkin 1691fe1587a7SDmytro Linkin /* For tunnel addr_type used same key id`s as for non-tunnel */ 1692fe1587a7SDmytro Linkin if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 16938f256622SPablo Neira Ayuso struct flow_match_ipv4_addrs match; 16948f256622SPablo Neira Ayuso 16958f256622SPablo Neira Ayuso flow_rule_match_enc_ipv4_addrs(rule, &match); 1696bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1697bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 16988f256622SPablo Neira Ayuso ntohl(match.mask->src)); 1699bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1700bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 17018f256622SPablo Neira Ayuso ntohl(match.key->src)); 1702bbd00f7eSHadar Hen Zion 1703bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1704bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 17058f256622SPablo Neira Ayuso ntohl(match.mask->dst)); 1706bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1707bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 17088f256622SPablo Neira Ayuso ntohl(match.key->dst)); 1709bbd00f7eSHadar Hen Zion 1710fe1587a7SDmytro Linkin MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, 1711fe1587a7SDmytro Linkin ethertype); 1712fe1587a7SDmytro Linkin MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 1713fe1587a7SDmytro Linkin ETH_P_IP); 1714fe1587a7SDmytro Linkin } else if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 17158f256622SPablo Neira Ayuso struct flow_match_ipv6_addrs match; 171619f44401SOr Gerlitz 17178f256622SPablo Neira Ayuso flow_rule_match_enc_ipv6_addrs(rule, &match); 171819f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 171919f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 1720fe1587a7SDmytro Linkin &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, 1721fe1587a7SDmytro Linkin ipv6)); 172219f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 172319f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 1724fe1587a7SDmytro Linkin &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, 1725fe1587a7SDmytro Linkin ipv6)); 172619f44401SOr Gerlitz 172719f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 172819f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 1729fe1587a7SDmytro Linkin &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, 1730fe1587a7SDmytro Linkin ipv6)); 173119f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 173219f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 1733fe1587a7SDmytro Linkin &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, 1734fe1587a7SDmytro Linkin ipv6)); 173519f44401SOr Gerlitz 1736fe1587a7SDmytro Linkin MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, 1737fe1587a7SDmytro Linkin ethertype); 1738fe1587a7SDmytro Linkin MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 1739fe1587a7SDmytro Linkin ETH_P_IPV6); 1740fe1587a7SDmytro Linkin } 17412e72eb43SOr Gerlitz } 1742bbd00f7eSHadar Hen Zion 17438f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) { 17448f256622SPablo Neira Ayuso struct flow_match_ip match; 1745bcef735cSOr Gerlitz 17468f256622SPablo Neira Ayuso flow_rule_match_enc_ip(rule, &match); 17478f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, 17488f256622SPablo Neira Ayuso match.mask->tos & 0x3); 17498f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, 17508f256622SPablo Neira Ayuso match.key->tos & 0x3); 1751bcef735cSOr Gerlitz 17528f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, 17538f256622SPablo Neira Ayuso match.mask->tos >> 2); 17548f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, 17558f256622SPablo Neira Ayuso match.key->tos >> 2); 1756bcef735cSOr Gerlitz 17578f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, 17588f256622SPablo Neira Ayuso match.mask->ttl); 17598f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, 17608f256622SPablo Neira Ayuso match.key->ttl); 1761e98bedf5SEli Britstein 17628f256622SPablo Neira Ayuso if (match.mask->ttl && 1763e98bedf5SEli Britstein !MLX5_CAP_ESW_FLOWTABLE_FDB 1764e98bedf5SEli Britstein (priv->mdev, 1765e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 1766e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1767e98bedf5SEli Britstein "Matching on TTL is not supported"); 1768e98bedf5SEli Britstein return -EOPNOTSUPP; 1769e98bedf5SEli Britstein } 1770e98bedf5SEli Britstein 1771bcef735cSOr Gerlitz } 1772bcef735cSOr Gerlitz 1773bbd00f7eSHadar Hen Zion /* Enforce DMAC when offloading incoming tunneled flows. 1774bbd00f7eSHadar Hen Zion * Flow counters require a match on the DMAC. 1775bbd00f7eSHadar Hen Zion */ 1776bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16); 1777bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0); 1778bbd00f7eSHadar Hen Zion ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1779bbd00f7eSHadar Hen Zion dmac_47_16), priv->netdev->dev_addr); 1780bbd00f7eSHadar Hen Zion 1781bbd00f7eSHadar Hen Zion /* let software handle IP fragments */ 1782bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 1783bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0); 1784bbd00f7eSHadar Hen Zion 1785bbd00f7eSHadar Hen Zion return 0; 1786bbd00f7eSHadar Hen Zion } 1787bbd00f7eSHadar Hen Zion 17888377629eSEli Britstein static void *get_match_headers_criteria(u32 flags, 17898377629eSEli Britstein struct mlx5_flow_spec *spec) 17908377629eSEli Britstein { 17918377629eSEli Britstein return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ? 17928377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 17938377629eSEli Britstein inner_headers) : 17948377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 17958377629eSEli Britstein outer_headers); 17968377629eSEli Britstein } 17978377629eSEli Britstein 17988377629eSEli Britstein static void *get_match_headers_value(u32 flags, 17998377629eSEli Britstein struct mlx5_flow_spec *spec) 18008377629eSEli Britstein { 18018377629eSEli Britstein return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ? 18028377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_value, 18038377629eSEli Britstein inner_headers) : 18048377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_value, 18058377629eSEli Britstein outer_headers); 18068377629eSEli Britstein } 18078377629eSEli Britstein 1808de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv, 1809de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 1810f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 181154c177caSOz Shlomo struct net_device *filter_dev, 181293b3586eSHuy Nguyen u8 *inner_match_level, u8 *outer_match_level) 1813e3a2b7edSAmir Vadai { 1814e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1815c5bb1730SMaor Gottlieb void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1816c5bb1730SMaor Gottlieb outer_headers); 1817c5bb1730SMaor Gottlieb void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1818c5bb1730SMaor Gottlieb outer_headers); 1819699e96ddSJianbo Liu void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1820699e96ddSJianbo Liu misc_parameters); 1821699e96ddSJianbo Liu void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1822699e96ddSJianbo Liu misc_parameters); 1823f9e30088SPablo Neira Ayuso struct flow_rule *rule = flow_cls_offload_flow_rule(f); 18248f256622SPablo Neira Ayuso struct flow_dissector *dissector = rule->match.dissector; 1825e3a2b7edSAmir Vadai u16 addr_type = 0; 1826e3a2b7edSAmir Vadai u8 ip_proto = 0; 182793b3586eSHuy Nguyen u8 *match_level; 1828e3a2b7edSAmir Vadai 182993b3586eSHuy Nguyen match_level = outer_match_level; 1830de0af0bfSRoi Dayan 18318f256622SPablo Neira Ayuso if (dissector->used_keys & 18323d144578SVlad Buslov ~(BIT(FLOW_DISSECTOR_KEY_META) | 18333d144578SVlad Buslov BIT(FLOW_DISSECTOR_KEY_CONTROL) | 1834e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_BASIC) | 1835e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) | 1836095b6cfdSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_VLAN) | 1837699e96ddSJianbo Liu BIT(FLOW_DISSECTOR_KEY_CVLAN) | 1838e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) | 1839e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) | 1840bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_PORTS) | 1841bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) | 1842bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) | 1843bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) | 1844bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_PORTS) | 1845e77834ecSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) | 1846fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_TCP) | 1847bcef735cSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_IP) | 18489272e3dfSYevgeny Kliteynik BIT(FLOW_DISSECTOR_KEY_ENC_IP) | 18499272e3dfSYevgeny Kliteynik BIT(FLOW_DISSECTOR_KEY_ENC_OPTS))) { 1850e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "Unsupported key"); 1851e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n", 18528f256622SPablo Neira Ayuso dissector->used_keys); 1853e3a2b7edSAmir Vadai return -EOPNOTSUPP; 1854e3a2b7edSAmir Vadai } 1855e3a2b7edSAmir Vadai 1856075973c7SVlad Buslov if (mlx5e_get_tc_tun(filter_dev)) { 185793b3586eSHuy Nguyen if (parse_tunnel_attr(priv, spec, f, filter_dev, 185893b3586eSHuy Nguyen outer_match_level)) 1859bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1860bbd00f7eSHadar Hen Zion 186193b3586eSHuy Nguyen /* At this point, header pointers should point to the inner 1862bbd00f7eSHadar Hen Zion * headers, outer header were already set by parse_tunnel_attr 1863bbd00f7eSHadar Hen Zion */ 186493b3586eSHuy Nguyen match_level = inner_match_level; 18658377629eSEli Britstein headers_c = get_match_headers_criteria(MLX5_FLOW_CONTEXT_ACTION_DECAP, 18668377629eSEli Britstein spec); 18678377629eSEli Britstein headers_v = get_match_headers_value(MLX5_FLOW_CONTEXT_ACTION_DECAP, 18688377629eSEli Britstein spec); 1869bbd00f7eSHadar Hen Zion } 1870bbd00f7eSHadar Hen Zion 18718f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { 18728f256622SPablo Neira Ayuso struct flow_match_basic match; 1873e3a2b7edSAmir Vadai 18748f256622SPablo Neira Ayuso flow_rule_match_basic(rule, &match); 18758f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype, 18768f256622SPablo Neira Ayuso ntohs(match.mask->n_proto)); 18778f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 18788f256622SPablo Neira Ayuso ntohs(match.key->n_proto)); 18798f256622SPablo Neira Ayuso 18808f256622SPablo Neira Ayuso if (match.mask->n_proto) 1881d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1882e3a2b7edSAmir Vadai } 188335a605dbSEli Britstein if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN) || 188435a605dbSEli Britstein is_vlan_dev(filter_dev)) { 188535a605dbSEli Britstein struct flow_dissector_key_vlan filter_dev_mask; 188635a605dbSEli Britstein struct flow_dissector_key_vlan filter_dev_key; 18878f256622SPablo Neira Ayuso struct flow_match_vlan match; 18888f256622SPablo Neira Ayuso 188935a605dbSEli Britstein if (is_vlan_dev(filter_dev)) { 189035a605dbSEli Britstein match.key = &filter_dev_key; 189135a605dbSEli Britstein match.key->vlan_id = vlan_dev_vlan_id(filter_dev); 189235a605dbSEli Britstein match.key->vlan_tpid = vlan_dev_vlan_proto(filter_dev); 189335a605dbSEli Britstein match.key->vlan_priority = 0; 189435a605dbSEli Britstein match.mask = &filter_dev_mask; 189535a605dbSEli Britstein memset(match.mask, 0xff, sizeof(*match.mask)); 189635a605dbSEli Britstein match.mask->vlan_priority = 0; 189735a605dbSEli Britstein } else { 18988f256622SPablo Neira Ayuso flow_rule_match_vlan(rule, &match); 189935a605dbSEli Britstein } 19008f256622SPablo Neira Ayuso if (match.mask->vlan_id || 19018f256622SPablo Neira Ayuso match.mask->vlan_priority || 19028f256622SPablo Neira Ayuso match.mask->vlan_tpid) { 19038f256622SPablo Neira Ayuso if (match.key->vlan_tpid == htons(ETH_P_8021AD)) { 1904699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1905699e96ddSJianbo Liu svlan_tag, 1); 1906699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1907699e96ddSJianbo Liu svlan_tag, 1); 1908699e96ddSJianbo Liu } else { 1909699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1910699e96ddSJianbo Liu cvlan_tag, 1); 1911699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1912699e96ddSJianbo Liu cvlan_tag, 1); 1913699e96ddSJianbo Liu } 1914095b6cfdSOr Gerlitz 19158f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid, 19168f256622SPablo Neira Ayuso match.mask->vlan_id); 19178f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid, 19188f256622SPablo Neira Ayuso match.key->vlan_id); 1919358d79a4SOr Gerlitz 19208f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio, 19218f256622SPablo Neira Ayuso match.mask->vlan_priority); 19228f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio, 19238f256622SPablo Neira Ayuso match.key->vlan_priority); 192454782900SOr Gerlitz 1925d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1926095b6cfdSOr Gerlitz } 1927d3a80bb5SOr Gerlitz } else if (*match_level != MLX5_MATCH_NONE) { 1928fc603294SMark Bloch /* cvlan_tag enabled in match criteria and 1929fc603294SMark Bloch * disabled in match value means both S & C tags 1930fc603294SMark Bloch * don't exist (untagged of both) 1931fc603294SMark Bloch */ 1932cee26487SJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1); 1933d3a80bb5SOr Gerlitz *match_level = MLX5_MATCH_L2; 1934095b6cfdSOr Gerlitz } 1935095b6cfdSOr Gerlitz 19368f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) { 19378f256622SPablo Neira Ayuso struct flow_match_vlan match; 19388f256622SPablo Neira Ayuso 193912d5cbf8SJianbo Liu flow_rule_match_cvlan(rule, &match); 19408f256622SPablo Neira Ayuso if (match.mask->vlan_id || 19418f256622SPablo Neira Ayuso match.mask->vlan_priority || 19428f256622SPablo Neira Ayuso match.mask->vlan_tpid) { 19438f256622SPablo Neira Ayuso if (match.key->vlan_tpid == htons(ETH_P_8021AD)) { 1944699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1945699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1946699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1947699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1948699e96ddSJianbo Liu } else { 1949699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1950699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1951699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1952699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1953699e96ddSJianbo Liu } 1954699e96ddSJianbo Liu 1955699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid, 19568f256622SPablo Neira Ayuso match.mask->vlan_id); 1957699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid, 19588f256622SPablo Neira Ayuso match.key->vlan_id); 1959699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio, 19608f256622SPablo Neira Ayuso match.mask->vlan_priority); 1961699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio, 19628f256622SPablo Neira Ayuso match.key->vlan_priority); 1963699e96ddSJianbo Liu 1964699e96ddSJianbo Liu *match_level = MLX5_MATCH_L2; 1965699e96ddSJianbo Liu } 1966699e96ddSJianbo Liu } 1967699e96ddSJianbo Liu 19688f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) { 19698f256622SPablo Neira Ayuso struct flow_match_eth_addrs match; 197054782900SOr Gerlitz 19718f256622SPablo Neira Ayuso flow_rule_match_eth_addrs(rule, &match); 1972d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1973d3a80bb5SOr Gerlitz dmac_47_16), 19748f256622SPablo Neira Ayuso match.mask->dst); 1975d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1976d3a80bb5SOr Gerlitz dmac_47_16), 19778f256622SPablo Neira Ayuso match.key->dst); 1978d3a80bb5SOr Gerlitz 1979d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1980d3a80bb5SOr Gerlitz smac_47_16), 19818f256622SPablo Neira Ayuso match.mask->src); 1982d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1983d3a80bb5SOr Gerlitz smac_47_16), 19848f256622SPablo Neira Ayuso match.key->src); 1985d3a80bb5SOr Gerlitz 19868f256622SPablo Neira Ayuso if (!is_zero_ether_addr(match.mask->src) || 19878f256622SPablo Neira Ayuso !is_zero_ether_addr(match.mask->dst)) 1988d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 198954782900SOr Gerlitz } 199054782900SOr Gerlitz 19918f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) { 19928f256622SPablo Neira Ayuso struct flow_match_control match; 199354782900SOr Gerlitz 19948f256622SPablo Neira Ayuso flow_rule_match_control(rule, &match); 19958f256622SPablo Neira Ayuso addr_type = match.key->addr_type; 199654782900SOr Gerlitz 199754782900SOr Gerlitz /* the HW doesn't support frag first/later */ 19988f256622SPablo Neira Ayuso if (match.mask->flags & FLOW_DIS_FIRST_FRAG) 199954782900SOr Gerlitz return -EOPNOTSUPP; 200054782900SOr Gerlitz 20018f256622SPablo Neira Ayuso if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) { 200254782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 200354782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 20048f256622SPablo Neira Ayuso match.key->flags & FLOW_DIS_IS_FRAGMENT); 200554782900SOr Gerlitz 200654782900SOr Gerlitz /* the HW doesn't need L3 inline to match on frag=no */ 20078f256622SPablo Neira Ayuso if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT)) 200883621b7dSOr Gerlitz *match_level = MLX5_MATCH_L2; 200954782900SOr Gerlitz /* *** L2 attributes parsing up to here *** */ 201054782900SOr Gerlitz else 201183621b7dSOr Gerlitz *match_level = MLX5_MATCH_L3; 201254782900SOr Gerlitz } 201354782900SOr Gerlitz } 201454782900SOr Gerlitz 20158f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { 20168f256622SPablo Neira Ayuso struct flow_match_basic match; 20178f256622SPablo Neira Ayuso 20188f256622SPablo Neira Ayuso flow_rule_match_basic(rule, &match); 20198f256622SPablo Neira Ayuso ip_proto = match.key->ip_proto; 202054782900SOr Gerlitz 202154782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol, 20228f256622SPablo Neira Ayuso match.mask->ip_proto); 202354782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, 20248f256622SPablo Neira Ayuso match.key->ip_proto); 202554782900SOr Gerlitz 20268f256622SPablo Neira Ayuso if (match.mask->ip_proto) 2027d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 202854782900SOr Gerlitz } 202954782900SOr Gerlitz 2030e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 20318f256622SPablo Neira Ayuso struct flow_match_ipv4_addrs match; 2032e3a2b7edSAmir Vadai 20338f256622SPablo Neira Ayuso flow_rule_match_ipv4_addrs(rule, &match); 2034e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 2035e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 20368f256622SPablo Neira Ayuso &match.mask->src, sizeof(match.mask->src)); 2037e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 2038e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 20398f256622SPablo Neira Ayuso &match.key->src, sizeof(match.key->src)); 2040e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 2041e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 20428f256622SPablo Neira Ayuso &match.mask->dst, sizeof(match.mask->dst)); 2043e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 2044e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 20458f256622SPablo Neira Ayuso &match.key->dst, sizeof(match.key->dst)); 2046de0af0bfSRoi Dayan 20478f256622SPablo Neira Ayuso if (match.mask->src || match.mask->dst) 2048d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 2049e3a2b7edSAmir Vadai } 2050e3a2b7edSAmir Vadai 2051e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 20528f256622SPablo Neira Ayuso struct flow_match_ipv6_addrs match; 2053e3a2b7edSAmir Vadai 20548f256622SPablo Neira Ayuso flow_rule_match_ipv6_addrs(rule, &match); 2055e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 2056e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 20578f256622SPablo Neira Ayuso &match.mask->src, sizeof(match.mask->src)); 2058e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 2059e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 20608f256622SPablo Neira Ayuso &match.key->src, sizeof(match.key->src)); 2061e3a2b7edSAmir Vadai 2062e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 2063e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 20648f256622SPablo Neira Ayuso &match.mask->dst, sizeof(match.mask->dst)); 2065e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 2066e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 20678f256622SPablo Neira Ayuso &match.key->dst, sizeof(match.key->dst)); 2068de0af0bfSRoi Dayan 20698f256622SPablo Neira Ayuso if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY || 20708f256622SPablo Neira Ayuso ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY) 2071d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 2072e3a2b7edSAmir Vadai } 2073e3a2b7edSAmir Vadai 20748f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) { 20758f256622SPablo Neira Ayuso struct flow_match_ip match; 20761f97a526SOr Gerlitz 20778f256622SPablo Neira Ayuso flow_rule_match_ip(rule, &match); 20788f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, 20798f256622SPablo Neira Ayuso match.mask->tos & 0x3); 20808f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, 20818f256622SPablo Neira Ayuso match.key->tos & 0x3); 20821f97a526SOr Gerlitz 20838f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, 20848f256622SPablo Neira Ayuso match.mask->tos >> 2); 20858f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, 20868f256622SPablo Neira Ayuso match.key->tos >> 2); 20871f97a526SOr Gerlitz 20888f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, 20898f256622SPablo Neira Ayuso match.mask->ttl); 20908f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, 20918f256622SPablo Neira Ayuso match.key->ttl); 20921f97a526SOr Gerlitz 20938f256622SPablo Neira Ayuso if (match.mask->ttl && 2094a8ade55fSOr Gerlitz !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, 2095e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 2096e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2097e98bedf5SEli Britstein "Matching on TTL is not supported"); 20981f97a526SOr Gerlitz return -EOPNOTSUPP; 2099e98bedf5SEli Britstein } 2100a8ade55fSOr Gerlitz 21018f256622SPablo Neira Ayuso if (match.mask->tos || match.mask->ttl) 2102d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 21031f97a526SOr Gerlitz } 21041f97a526SOr Gerlitz 210554782900SOr Gerlitz /* *** L3 attributes parsing up to here *** */ 210654782900SOr Gerlitz 21078f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) { 21088f256622SPablo Neira Ayuso struct flow_match_ports match; 21098f256622SPablo Neira Ayuso 21108f256622SPablo Neira Ayuso flow_rule_match_ports(rule, &match); 2111e3a2b7edSAmir Vadai switch (ip_proto) { 2112e3a2b7edSAmir Vadai case IPPROTO_TCP: 2113e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 21148f256622SPablo Neira Ayuso tcp_sport, ntohs(match.mask->src)); 2115e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 21168f256622SPablo Neira Ayuso tcp_sport, ntohs(match.key->src)); 2117e3a2b7edSAmir Vadai 2118e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 21198f256622SPablo Neira Ayuso tcp_dport, ntohs(match.mask->dst)); 2120e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 21218f256622SPablo Neira Ayuso tcp_dport, ntohs(match.key->dst)); 2122e3a2b7edSAmir Vadai break; 2123e3a2b7edSAmir Vadai 2124e3a2b7edSAmir Vadai case IPPROTO_UDP: 2125e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 21268f256622SPablo Neira Ayuso udp_sport, ntohs(match.mask->src)); 2127e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 21288f256622SPablo Neira Ayuso udp_sport, ntohs(match.key->src)); 2129e3a2b7edSAmir Vadai 2130e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 21318f256622SPablo Neira Ayuso udp_dport, ntohs(match.mask->dst)); 2132e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 21338f256622SPablo Neira Ayuso udp_dport, ntohs(match.key->dst)); 2134e3a2b7edSAmir Vadai break; 2135e3a2b7edSAmir Vadai default: 2136e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2137e98bedf5SEli Britstein "Only UDP and TCP transports are supported for L4 matching"); 2138e3a2b7edSAmir Vadai netdev_err(priv->netdev, 2139e3a2b7edSAmir Vadai "Only UDP and TCP transport are supported\n"); 2140e3a2b7edSAmir Vadai return -EINVAL; 2141e3a2b7edSAmir Vadai } 2142de0af0bfSRoi Dayan 21438f256622SPablo Neira Ayuso if (match.mask->src || match.mask->dst) 2144d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 2145e3a2b7edSAmir Vadai } 2146e3a2b7edSAmir Vadai 21478f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) { 21488f256622SPablo Neira Ayuso struct flow_match_tcp match; 2149e77834ecSOr Gerlitz 21508f256622SPablo Neira Ayuso flow_rule_match_tcp(rule, &match); 2151e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags, 21528f256622SPablo Neira Ayuso ntohs(match.mask->flags)); 2153e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags, 21548f256622SPablo Neira Ayuso ntohs(match.key->flags)); 2155e77834ecSOr Gerlitz 21568f256622SPablo Neira Ayuso if (match.mask->flags) 2157d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 2158e77834ecSOr Gerlitz } 2159e77834ecSOr Gerlitz 2160e3a2b7edSAmir Vadai return 0; 2161e3a2b7edSAmir Vadai } 2162e3a2b7edSAmir Vadai 2163de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv, 216465ba8fb7SOr Gerlitz struct mlx5e_tc_flow *flow, 2165de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 2166f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 216754c177caSOz Shlomo struct net_device *filter_dev) 2168de0af0bfSRoi Dayan { 216993b3586eSHuy Nguyen u8 inner_match_level, outer_match_level, non_tunnel_match_level; 2170e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 2171de0af0bfSRoi Dayan struct mlx5_core_dev *dev = priv->mdev; 2172de0af0bfSRoi Dayan struct mlx5_eswitch *esw = dev->priv.eswitch; 21731d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 21741d447a39SSaeed Mahameed struct mlx5_eswitch_rep *rep; 2175226f2ca3SVlad Buslov bool is_eswitch_flow; 2176de0af0bfSRoi Dayan int err; 2177de0af0bfSRoi Dayan 217893b3586eSHuy Nguyen inner_match_level = MLX5_MATCH_NONE; 217993b3586eSHuy Nguyen outer_match_level = MLX5_MATCH_NONE; 218093b3586eSHuy Nguyen 218193b3586eSHuy Nguyen err = __parse_cls_flower(priv, spec, f, filter_dev, &inner_match_level, 218293b3586eSHuy Nguyen &outer_match_level); 218393b3586eSHuy Nguyen non_tunnel_match_level = (inner_match_level == MLX5_MATCH_NONE) ? 218493b3586eSHuy Nguyen outer_match_level : inner_match_level; 2185de0af0bfSRoi Dayan 2186226f2ca3SVlad Buslov is_eswitch_flow = mlx5e_is_eswitch_flow(flow); 2187226f2ca3SVlad Buslov if (!err && is_eswitch_flow) { 21881d447a39SSaeed Mahameed rep = rpriv->rep; 2189b05af6aaSBodong Wang if (rep->vport != MLX5_VPORT_UPLINK && 21901d447a39SSaeed Mahameed (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE && 219193b3586eSHuy Nguyen esw->offloads.inline_mode < non_tunnel_match_level)) { 2192e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2193e98bedf5SEli Britstein "Flow is not offloaded due to min inline setting"); 2194de0af0bfSRoi Dayan netdev_warn(priv->netdev, 2195de0af0bfSRoi Dayan "Flow is not offloaded due to min inline setting, required %d actual %d\n", 219693b3586eSHuy Nguyen non_tunnel_match_level, esw->offloads.inline_mode); 2197de0af0bfSRoi Dayan return -EOPNOTSUPP; 2198de0af0bfSRoi Dayan } 2199de0af0bfSRoi Dayan } 2200de0af0bfSRoi Dayan 2201226f2ca3SVlad Buslov if (is_eswitch_flow) { 220293b3586eSHuy Nguyen flow->esw_attr->inner_match_level = inner_match_level; 220393b3586eSHuy Nguyen flow->esw_attr->outer_match_level = outer_match_level; 22046363651dSOr Gerlitz } else { 220593b3586eSHuy Nguyen flow->nic_attr->match_level = non_tunnel_match_level; 22066363651dSOr Gerlitz } 220738aa51c1SOr Gerlitz 2208de0af0bfSRoi Dayan return err; 2209de0af0bfSRoi Dayan } 2210de0af0bfSRoi Dayan 2211d79b6df6SOr Gerlitz struct pedit_headers { 2212d79b6df6SOr Gerlitz struct ethhdr eth; 22130eb69bb9SEli Britstein struct vlan_hdr vlan; 2214d79b6df6SOr Gerlitz struct iphdr ip4; 2215d79b6df6SOr Gerlitz struct ipv6hdr ip6; 2216d79b6df6SOr Gerlitz struct tcphdr tcp; 2217d79b6df6SOr Gerlitz struct udphdr udp; 2218d79b6df6SOr Gerlitz }; 2219d79b6df6SOr Gerlitz 2220c500c86bSPablo Neira Ayuso struct pedit_headers_action { 2221c500c86bSPablo Neira Ayuso struct pedit_headers vals; 2222c500c86bSPablo Neira Ayuso struct pedit_headers masks; 2223c500c86bSPablo Neira Ayuso u32 pedits; 2224c500c86bSPablo Neira Ayuso }; 2225c500c86bSPablo Neira Ayuso 2226d79b6df6SOr Gerlitz static int pedit_header_offsets[] = { 222773867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth), 222873867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4), 222973867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6), 223073867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp), 223173867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp), 2232d79b6df6SOr Gerlitz }; 2233d79b6df6SOr Gerlitz 2234d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype]) 2235d79b6df6SOr Gerlitz 2236d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset, 2237c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs) 2238d79b6df6SOr Gerlitz { 2239d79b6df6SOr Gerlitz u32 *curr_pmask, *curr_pval; 2240d79b6df6SOr Gerlitz 2241c500c86bSPablo Neira Ayuso curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset); 2242c500c86bSPablo Neira Ayuso curr_pval = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset); 2243d79b6df6SOr Gerlitz 2244d79b6df6SOr Gerlitz if (*curr_pmask & mask) /* disallow acting twice on the same location */ 2245d79b6df6SOr Gerlitz goto out_err; 2246d79b6df6SOr Gerlitz 2247d79b6df6SOr Gerlitz *curr_pmask |= mask; 2248d79b6df6SOr Gerlitz *curr_pval |= (val & mask); 2249d79b6df6SOr Gerlitz 2250d79b6df6SOr Gerlitz return 0; 2251d79b6df6SOr Gerlitz 2252d79b6df6SOr Gerlitz out_err: 2253d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2254d79b6df6SOr Gerlitz } 2255d79b6df6SOr Gerlitz 2256d79b6df6SOr Gerlitz struct mlx5_fields { 2257d79b6df6SOr Gerlitz u8 field; 225888f30bbcSDmytro Linkin u8 field_bsize; 225988f30bbcSDmytro Linkin u32 field_mask; 2260d79b6df6SOr Gerlitz u32 offset; 226127c11b6bSEli Britstein u32 match_offset; 2262d79b6df6SOr Gerlitz }; 2263d79b6df6SOr Gerlitz 226488f30bbcSDmytro Linkin #define OFFLOAD(fw_field, field_bsize, field_mask, field, off, match_field) \ 226588f30bbcSDmytro Linkin {MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, field_bsize, field_mask, \ 226627c11b6bSEli Britstein offsetof(struct pedit_headers, field) + (off), \ 226727c11b6bSEli Britstein MLX5_BYTE_OFF(fte_match_set_lyr_2_4, match_field)} 226827c11b6bSEli Britstein 22692ef86872SEli Britstein /* masked values are the same and there are no rewrites that do not have a 22702ef86872SEli Britstein * match. 22712ef86872SEli Britstein */ 22722ef86872SEli Britstein #define SAME_VAL_MASK(type, valp, maskp, matchvalp, matchmaskp) ({ \ 22732ef86872SEli Britstein type matchmaskx = *(type *)(matchmaskp); \ 22742ef86872SEli Britstein type matchvalx = *(type *)(matchvalp); \ 22752ef86872SEli Britstein type maskx = *(type *)(maskp); \ 22762ef86872SEli Britstein type valx = *(type *)(valp); \ 22772ef86872SEli Britstein \ 22782ef86872SEli Britstein (valx & maskx) == (matchvalx & matchmaskx) && !(maskx & (maskx ^ \ 22792ef86872SEli Britstein matchmaskx)); \ 22802ef86872SEli Britstein }) 22812ef86872SEli Britstein 228227c11b6bSEli Britstein static bool cmp_val_mask(void *valp, void *maskp, void *matchvalp, 228388f30bbcSDmytro Linkin void *matchmaskp, u8 bsize) 228427c11b6bSEli Britstein { 228527c11b6bSEli Britstein bool same = false; 228627c11b6bSEli Britstein 228788f30bbcSDmytro Linkin switch (bsize) { 228888f30bbcSDmytro Linkin case 8: 22892ef86872SEli Britstein same = SAME_VAL_MASK(u8, valp, maskp, matchvalp, matchmaskp); 229027c11b6bSEli Britstein break; 229188f30bbcSDmytro Linkin case 16: 22922ef86872SEli Britstein same = SAME_VAL_MASK(u16, valp, maskp, matchvalp, matchmaskp); 229327c11b6bSEli Britstein break; 229488f30bbcSDmytro Linkin case 32: 22952ef86872SEli Britstein same = SAME_VAL_MASK(u32, valp, maskp, matchvalp, matchmaskp); 229627c11b6bSEli Britstein break; 229727c11b6bSEli Britstein } 229827c11b6bSEli Britstein 229927c11b6bSEli Britstein return same; 230027c11b6bSEli Britstein } 2301a8e4f0c4SOr Gerlitz 2302d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = { 230388f30bbcSDmytro Linkin OFFLOAD(DMAC_47_16, 32, U32_MAX, eth.h_dest[0], 0, dmac_47_16), 230488f30bbcSDmytro Linkin OFFLOAD(DMAC_15_0, 16, U16_MAX, eth.h_dest[4], 0, dmac_15_0), 230588f30bbcSDmytro Linkin OFFLOAD(SMAC_47_16, 32, U32_MAX, eth.h_source[0], 0, smac_47_16), 230688f30bbcSDmytro Linkin OFFLOAD(SMAC_15_0, 16, U16_MAX, eth.h_source[4], 0, smac_15_0), 230788f30bbcSDmytro Linkin OFFLOAD(ETHERTYPE, 16, U16_MAX, eth.h_proto, 0, ethertype), 230888f30bbcSDmytro Linkin OFFLOAD(FIRST_VID, 16, U16_MAX, vlan.h_vlan_TCI, 0, first_vid), 2309d79b6df6SOr Gerlitz 2310ab9341b5SDmytro Linkin OFFLOAD(IP_DSCP, 8, 0xfc, ip4.tos, 0, ip_dscp), 231188f30bbcSDmytro Linkin OFFLOAD(IP_TTL, 8, U8_MAX, ip4.ttl, 0, ttl_hoplimit), 231288f30bbcSDmytro Linkin OFFLOAD(SIPV4, 32, U32_MAX, ip4.saddr, 0, src_ipv4_src_ipv6.ipv4_layout.ipv4), 231388f30bbcSDmytro Linkin OFFLOAD(DIPV4, 32, U32_MAX, ip4.daddr, 0, dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 2314d79b6df6SOr Gerlitz 231588f30bbcSDmytro Linkin OFFLOAD(SIPV6_127_96, 32, U32_MAX, ip6.saddr.s6_addr32[0], 0, 231627c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[0]), 231788f30bbcSDmytro Linkin OFFLOAD(SIPV6_95_64, 32, U32_MAX, ip6.saddr.s6_addr32[1], 0, 231827c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[4]), 231988f30bbcSDmytro Linkin OFFLOAD(SIPV6_63_32, 32, U32_MAX, ip6.saddr.s6_addr32[2], 0, 232027c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[8]), 232188f30bbcSDmytro Linkin OFFLOAD(SIPV6_31_0, 32, U32_MAX, ip6.saddr.s6_addr32[3], 0, 232227c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[12]), 232388f30bbcSDmytro Linkin OFFLOAD(DIPV6_127_96, 32, U32_MAX, ip6.daddr.s6_addr32[0], 0, 232427c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[0]), 232588f30bbcSDmytro Linkin OFFLOAD(DIPV6_95_64, 32, U32_MAX, ip6.daddr.s6_addr32[1], 0, 232627c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[4]), 232788f30bbcSDmytro Linkin OFFLOAD(DIPV6_63_32, 32, U32_MAX, ip6.daddr.s6_addr32[2], 0, 232827c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[8]), 232988f30bbcSDmytro Linkin OFFLOAD(DIPV6_31_0, 32, U32_MAX, ip6.daddr.s6_addr32[3], 0, 233027c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[12]), 233188f30bbcSDmytro Linkin OFFLOAD(IPV6_HOPLIMIT, 8, U8_MAX, ip6.hop_limit, 0, ttl_hoplimit), 2332d79b6df6SOr Gerlitz 233388f30bbcSDmytro Linkin OFFLOAD(TCP_SPORT, 16, U16_MAX, tcp.source, 0, tcp_sport), 233488f30bbcSDmytro Linkin OFFLOAD(TCP_DPORT, 16, U16_MAX, tcp.dest, 0, tcp_dport), 233588f30bbcSDmytro Linkin /* in linux iphdr tcp_flags is 8 bits long */ 233688f30bbcSDmytro Linkin OFFLOAD(TCP_FLAGS, 8, U8_MAX, tcp.ack_seq, 5, tcp_flags), 2337d79b6df6SOr Gerlitz 233888f30bbcSDmytro Linkin OFFLOAD(UDP_SPORT, 16, U16_MAX, udp.source, 0, udp_sport), 233988f30bbcSDmytro Linkin OFFLOAD(UDP_DPORT, 16, U16_MAX, udp.dest, 0, udp_dport), 2340d79b6df6SOr Gerlitz }; 2341d79b6df6SOr Gerlitz 2342218d05ceSTonghao Zhang /* On input attr->max_mod_hdr_actions tells how many HW actions can be parsed at 2343218d05ceSTonghao Zhang * max from the SW pedit action. On success, attr->num_mod_hdr_actions 2344218d05ceSTonghao Zhang * says how many HW actions were actually parsed. 2345d79b6df6SOr Gerlitz */ 2346c500c86bSPablo Neira Ayuso static int offload_pedit_fields(struct pedit_headers_action *hdrs, 2347e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 234827c11b6bSEli Britstein u32 *action_flags, 2349e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2350d79b6df6SOr Gerlitz { 2351d79b6df6SOr Gerlitz struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals; 23522b64bebaSOr Gerlitz int i, action_size, nactions, max_actions, first, last, next_z; 235388f30bbcSDmytro Linkin void *headers_c, *headers_v, *action, *vals_p; 235488f30bbcSDmytro Linkin u32 *s_masks_p, *a_masks_p, s_mask, a_mask; 2355d79b6df6SOr Gerlitz struct mlx5_fields *f; 2356d79b6df6SOr Gerlitz unsigned long mask; 23572b64bebaSOr Gerlitz __be32 mask_be32; 23582b64bebaSOr Gerlitz __be16 mask_be16; 235988f30bbcSDmytro Linkin u8 cmd; 236088f30bbcSDmytro Linkin 236188f30bbcSDmytro Linkin headers_c = get_match_headers_criteria(*action_flags, &parse_attr->spec); 236288f30bbcSDmytro Linkin headers_v = get_match_headers_value(*action_flags, &parse_attr->spec); 2363d79b6df6SOr Gerlitz 236473867881SPablo Neira Ayuso set_masks = &hdrs[0].masks; 236573867881SPablo Neira Ayuso add_masks = &hdrs[1].masks; 236673867881SPablo Neira Ayuso set_vals = &hdrs[0].vals; 236773867881SPablo Neira Ayuso add_vals = &hdrs[1].vals; 2368d79b6df6SOr Gerlitz 2369d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 2370218d05ceSTonghao Zhang action = parse_attr->mod_hdr_actions + 2371218d05ceSTonghao Zhang parse_attr->num_mod_hdr_actions * action_size; 2372218d05ceSTonghao Zhang 2373218d05ceSTonghao Zhang max_actions = parse_attr->max_mod_hdr_actions; 2374218d05ceSTonghao Zhang nactions = parse_attr->num_mod_hdr_actions; 2375d79b6df6SOr Gerlitz 2376d79b6df6SOr Gerlitz for (i = 0; i < ARRAY_SIZE(fields); i++) { 237727c11b6bSEli Britstein bool skip; 237827c11b6bSEli Britstein 2379d79b6df6SOr Gerlitz f = &fields[i]; 2380d79b6df6SOr Gerlitz /* avoid seeing bits set from previous iterations */ 2381e3ca4e05SOr Gerlitz s_mask = 0; 2382e3ca4e05SOr Gerlitz a_mask = 0; 2383d79b6df6SOr Gerlitz 2384d79b6df6SOr Gerlitz s_masks_p = (void *)set_masks + f->offset; 2385d79b6df6SOr Gerlitz a_masks_p = (void *)add_masks + f->offset; 2386d79b6df6SOr Gerlitz 238788f30bbcSDmytro Linkin s_mask = *s_masks_p & f->field_mask; 238888f30bbcSDmytro Linkin a_mask = *a_masks_p & f->field_mask; 2389d79b6df6SOr Gerlitz 2390d79b6df6SOr Gerlitz if (!s_mask && !a_mask) /* nothing to offload here */ 2391d79b6df6SOr Gerlitz continue; 2392d79b6df6SOr Gerlitz 2393d79b6df6SOr Gerlitz if (s_mask && a_mask) { 2394e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2395e98bedf5SEli Britstein "can't set and add to the same HW field"); 2396d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field); 2397d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2398d79b6df6SOr Gerlitz } 2399d79b6df6SOr Gerlitz 2400d79b6df6SOr Gerlitz if (nactions == max_actions) { 2401e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2402e98bedf5SEli Britstein "too many pedit actions, can't offload"); 2403d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions); 2404d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2405d79b6df6SOr Gerlitz } 2406d79b6df6SOr Gerlitz 240727c11b6bSEli Britstein skip = false; 2408d79b6df6SOr Gerlitz if (s_mask) { 240927c11b6bSEli Britstein void *match_mask = headers_c + f->match_offset; 241027c11b6bSEli Britstein void *match_val = headers_v + f->match_offset; 241127c11b6bSEli Britstein 2412d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_SET; 2413d79b6df6SOr Gerlitz mask = s_mask; 2414d79b6df6SOr Gerlitz vals_p = (void *)set_vals + f->offset; 241527c11b6bSEli Britstein /* don't rewrite if we have a match on the same value */ 241627c11b6bSEli Britstein if (cmp_val_mask(vals_p, s_masks_p, match_val, 241788f30bbcSDmytro Linkin match_mask, f->field_bsize)) 241827c11b6bSEli Britstein skip = true; 2419d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 242088f30bbcSDmytro Linkin *s_masks_p &= ~f->field_mask; 2421d79b6df6SOr Gerlitz } else { 2422d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_ADD; 2423d79b6df6SOr Gerlitz mask = a_mask; 2424d79b6df6SOr Gerlitz vals_p = (void *)add_vals + f->offset; 242527c11b6bSEli Britstein /* add 0 is no change */ 242688f30bbcSDmytro Linkin if ((*(u32 *)vals_p & f->field_mask) == 0) 242727c11b6bSEli Britstein skip = true; 2428d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 242988f30bbcSDmytro Linkin *a_masks_p &= ~f->field_mask; 2430d79b6df6SOr Gerlitz } 243127c11b6bSEli Britstein if (skip) 243227c11b6bSEli Britstein continue; 2433d79b6df6SOr Gerlitz 243488f30bbcSDmytro Linkin if (f->field_bsize == 32) { 24352b64bebaSOr Gerlitz mask_be32 = *(__be32 *)&mask; 24362b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32)); 243788f30bbcSDmytro Linkin } else if (f->field_bsize == 16) { 24382b64bebaSOr Gerlitz mask_be16 = *(__be16 *)&mask; 24392b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16)); 24402b64bebaSOr Gerlitz } 24412b64bebaSOr Gerlitz 244288f30bbcSDmytro Linkin first = find_first_bit(&mask, f->field_bsize); 244388f30bbcSDmytro Linkin next_z = find_next_zero_bit(&mask, f->field_bsize, first); 244488f30bbcSDmytro Linkin last = find_last_bit(&mask, f->field_bsize); 24452b64bebaSOr Gerlitz if (first < next_z && next_z < last) { 2446e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2447e98bedf5SEli Britstein "rewrite of few sub-fields isn't supported"); 24482b64bebaSOr Gerlitz printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n", 2449d79b6df6SOr Gerlitz mask); 2450d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2451d79b6df6SOr Gerlitz } 2452d79b6df6SOr Gerlitz 2453d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, action_type, cmd); 2454d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, field, f->field); 2455d79b6df6SOr Gerlitz 2456d79b6df6SOr Gerlitz if (cmd == MLX5_ACTION_TYPE_SET) { 245788f30bbcSDmytro Linkin int start; 245888f30bbcSDmytro Linkin 245988f30bbcSDmytro Linkin /* if field is bit sized it can start not from first bit */ 246088f30bbcSDmytro Linkin start = find_first_bit((unsigned long *)&f->field_mask, 246188f30bbcSDmytro Linkin f->field_bsize); 246288f30bbcSDmytro Linkin 246388f30bbcSDmytro Linkin MLX5_SET(set_action_in, action, offset, first - start); 2464d79b6df6SOr Gerlitz /* length is num of bits to be written, zero means length of 32 */ 24652b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, length, (last - first + 1)); 2466d79b6df6SOr Gerlitz } 2467d79b6df6SOr Gerlitz 246888f30bbcSDmytro Linkin if (f->field_bsize == 32) 24692b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first); 247088f30bbcSDmytro Linkin else if (f->field_bsize == 16) 24712b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first); 247288f30bbcSDmytro Linkin else if (f->field_bsize == 8) 24732b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first); 2474d79b6df6SOr Gerlitz 2475d79b6df6SOr Gerlitz action += action_size; 2476d79b6df6SOr Gerlitz nactions++; 2477d79b6df6SOr Gerlitz } 2478d79b6df6SOr Gerlitz 2479d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = nactions; 2480d79b6df6SOr Gerlitz return 0; 2481d79b6df6SOr Gerlitz } 2482d79b6df6SOr Gerlitz 24832cc1cb1dSTonghao Zhang static int mlx5e_flow_namespace_max_modify_action(struct mlx5_core_dev *mdev, 24842cc1cb1dSTonghao Zhang int namespace) 24852cc1cb1dSTonghao Zhang { 24862cc1cb1dSTonghao Zhang if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */ 24872cc1cb1dSTonghao Zhang return MLX5_CAP_ESW_FLOWTABLE_FDB(mdev, max_modify_header_actions); 24882cc1cb1dSTonghao Zhang else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */ 24892cc1cb1dSTonghao Zhang return MLX5_CAP_FLOWTABLE_NIC_RX(mdev, max_modify_header_actions); 24902cc1cb1dSTonghao Zhang } 24912cc1cb1dSTonghao Zhang 2492d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv, 2493c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 2494c500c86bSPablo Neira Ayuso int namespace, 2495d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 2496d79b6df6SOr Gerlitz { 2497d79b6df6SOr Gerlitz int nkeys, action_size, max_actions; 2498d79b6df6SOr Gerlitz 2499c500c86bSPablo Neira Ayuso nkeys = hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits + 2500c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits; 2501d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 2502d79b6df6SOr Gerlitz 25032cc1cb1dSTonghao Zhang max_actions = mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace); 2504d79b6df6SOr Gerlitz /* can get up to crazingly 16 HW actions in 32 bits pedit SW key */ 2505d79b6df6SOr Gerlitz max_actions = min(max_actions, nkeys * 16); 2506d79b6df6SOr Gerlitz 2507d79b6df6SOr Gerlitz parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL); 2508d79b6df6SOr Gerlitz if (!parse_attr->mod_hdr_actions) 2509d79b6df6SOr Gerlitz return -ENOMEM; 2510d79b6df6SOr Gerlitz 2511218d05ceSTonghao Zhang parse_attr->max_mod_hdr_actions = max_actions; 2512d79b6df6SOr Gerlitz return 0; 2513d79b6df6SOr Gerlitz } 2514d79b6df6SOr Gerlitz 2515d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {}; 2516d79b6df6SOr Gerlitz 2517d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv, 251873867881SPablo Neira Ayuso const struct flow_action_entry *act, int namespace, 2519e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 2520c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 2521e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2522d79b6df6SOr Gerlitz { 252373867881SPablo Neira Ayuso u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1; 252473867881SPablo Neira Ayuso int err = -EOPNOTSUPP; 2525d79b6df6SOr Gerlitz u32 mask, val, offset; 252673867881SPablo Neira Ayuso u8 htype; 2527d79b6df6SOr Gerlitz 252873867881SPablo Neira Ayuso htype = act->mangle.htype; 2529d79b6df6SOr Gerlitz err = -EOPNOTSUPP; /* can't be all optimistic */ 2530d79b6df6SOr Gerlitz 253173867881SPablo Neira Ayuso if (htype == FLOW_ACT_MANGLE_UNSPEC) { 253273867881SPablo Neira Ayuso NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded"); 2533d79b6df6SOr Gerlitz goto out_err; 2534d79b6df6SOr Gerlitz } 2535d79b6df6SOr Gerlitz 25362cc1cb1dSTonghao Zhang if (!mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace)) { 25372cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, 25382cc1cb1dSTonghao Zhang "The pedit offload action is not supported"); 25392cc1cb1dSTonghao Zhang goto out_err; 25402cc1cb1dSTonghao Zhang } 25412cc1cb1dSTonghao Zhang 254273867881SPablo Neira Ayuso mask = act->mangle.mask; 254373867881SPablo Neira Ayuso val = act->mangle.val; 254473867881SPablo Neira Ayuso offset = act->mangle.offset; 2545d79b6df6SOr Gerlitz 2546c500c86bSPablo Neira Ayuso err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]); 2547d79b6df6SOr Gerlitz if (err) 2548d79b6df6SOr Gerlitz goto out_err; 2549c500c86bSPablo Neira Ayuso 2550c500c86bSPablo Neira Ayuso hdrs[cmd].pedits++; 2551d79b6df6SOr Gerlitz 2552c500c86bSPablo Neira Ayuso return 0; 2553c500c86bSPablo Neira Ayuso out_err: 2554c500c86bSPablo Neira Ayuso return err; 2555c500c86bSPablo Neira Ayuso } 2556c500c86bSPablo Neira Ayuso 2557c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace, 2558c500c86bSPablo Neira Ayuso struct mlx5e_tc_flow_parse_attr *parse_attr, 2559c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 256027c11b6bSEli Britstein u32 *action_flags, 2561c500c86bSPablo Neira Ayuso struct netlink_ext_ack *extack) 2562c500c86bSPablo Neira Ayuso { 2563c500c86bSPablo Neira Ayuso struct pedit_headers *cmd_masks; 2564c500c86bSPablo Neira Ayuso int err; 2565c500c86bSPablo Neira Ayuso u8 cmd; 2566c500c86bSPablo Neira Ayuso 2567218d05ceSTonghao Zhang if (!parse_attr->mod_hdr_actions) { 2568c500c86bSPablo Neira Ayuso err = alloc_mod_hdr_actions(priv, hdrs, namespace, parse_attr); 2569d79b6df6SOr Gerlitz if (err) 2570d79b6df6SOr Gerlitz goto out_err; 2571218d05ceSTonghao Zhang } 2572d79b6df6SOr Gerlitz 257327c11b6bSEli Britstein err = offload_pedit_fields(hdrs, parse_attr, action_flags, extack); 2574d79b6df6SOr Gerlitz if (err < 0) 2575d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 2576d79b6df6SOr Gerlitz 2577d79b6df6SOr Gerlitz for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) { 2578c500c86bSPablo Neira Ayuso cmd_masks = &hdrs[cmd].masks; 2579d79b6df6SOr Gerlitz if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) { 2580e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2581e98bedf5SEli Britstein "attempt to offload an unsupported field"); 2582b3a433deSOr Gerlitz netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd); 2583d79b6df6SOr Gerlitz print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS, 2584d79b6df6SOr Gerlitz 16, 1, cmd_masks, sizeof(zero_masks), true); 2585d79b6df6SOr Gerlitz err = -EOPNOTSUPP; 2586d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 2587d79b6df6SOr Gerlitz } 2588d79b6df6SOr Gerlitz } 2589d79b6df6SOr Gerlitz 2590d79b6df6SOr Gerlitz return 0; 2591d79b6df6SOr Gerlitz 2592d79b6df6SOr Gerlitz out_dealloc_parsed_actions: 2593d79b6df6SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 2594d79b6df6SOr Gerlitz out_err: 2595d79b6df6SOr Gerlitz return err; 2596d79b6df6SOr Gerlitz } 2597d79b6df6SOr Gerlitz 2598e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv, 2599e98bedf5SEli Britstein u32 action, 2600e98bedf5SEli Britstein u32 update_flags, 2601e98bedf5SEli Britstein struct netlink_ext_ack *extack) 260226c02749SOr Gerlitz { 260326c02749SOr Gerlitz u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP | 260426c02749SOr Gerlitz TCA_CSUM_UPDATE_FLAG_UDP; 260526c02749SOr Gerlitz 260626c02749SOr Gerlitz /* The HW recalcs checksums only if re-writing headers */ 260726c02749SOr Gerlitz if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) { 2608e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2609e98bedf5SEli Britstein "TC csum action is only offloaded with pedit"); 261026c02749SOr Gerlitz netdev_warn(priv->netdev, 261126c02749SOr Gerlitz "TC csum action is only offloaded with pedit\n"); 261226c02749SOr Gerlitz return false; 261326c02749SOr Gerlitz } 261426c02749SOr Gerlitz 261526c02749SOr Gerlitz if (update_flags & ~prot_flags) { 2616e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2617e98bedf5SEli Britstein "can't offload TC csum action for some header/s"); 261826c02749SOr Gerlitz netdev_warn(priv->netdev, 261926c02749SOr Gerlitz "can't offload TC csum action for some header/s - flags %#x\n", 262026c02749SOr Gerlitz update_flags); 262126c02749SOr Gerlitz return false; 262226c02749SOr Gerlitz } 262326c02749SOr Gerlitz 262426c02749SOr Gerlitz return true; 262526c02749SOr Gerlitz } 262626c02749SOr Gerlitz 26278998576bSDmytro Linkin struct ip_ttl_word { 26288998576bSDmytro Linkin __u8 ttl; 26298998576bSDmytro Linkin __u8 protocol; 26308998576bSDmytro Linkin __sum16 check; 26318998576bSDmytro Linkin }; 26328998576bSDmytro Linkin 26338998576bSDmytro Linkin struct ipv6_hoplimit_word { 26348998576bSDmytro Linkin __be16 payload_len; 26358998576bSDmytro Linkin __u8 nexthdr; 26368998576bSDmytro Linkin __u8 hop_limit; 26378998576bSDmytro Linkin }; 26388998576bSDmytro Linkin 26398998576bSDmytro Linkin static bool is_action_keys_supported(const struct flow_action_entry *act) 26408998576bSDmytro Linkin { 26418998576bSDmytro Linkin u32 mask, offset; 26428998576bSDmytro Linkin u8 htype; 26438998576bSDmytro Linkin 26448998576bSDmytro Linkin htype = act->mangle.htype; 26458998576bSDmytro Linkin offset = act->mangle.offset; 26468998576bSDmytro Linkin mask = ~act->mangle.mask; 26478998576bSDmytro Linkin /* For IPv4 & IPv6 header check 4 byte word, 26488998576bSDmytro Linkin * to determine that modified fields 26498998576bSDmytro Linkin * are NOT ttl & hop_limit only. 26508998576bSDmytro Linkin */ 26518998576bSDmytro Linkin if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4) { 26528998576bSDmytro Linkin struct ip_ttl_word *ttl_word = 26538998576bSDmytro Linkin (struct ip_ttl_word *)&mask; 26548998576bSDmytro Linkin 26558998576bSDmytro Linkin if (offset != offsetof(struct iphdr, ttl) || 26568998576bSDmytro Linkin ttl_word->protocol || 26578998576bSDmytro Linkin ttl_word->check) { 26588998576bSDmytro Linkin return true; 26598998576bSDmytro Linkin } 26608998576bSDmytro Linkin } else if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) { 26618998576bSDmytro Linkin struct ipv6_hoplimit_word *hoplimit_word = 26628998576bSDmytro Linkin (struct ipv6_hoplimit_word *)&mask; 26638998576bSDmytro Linkin 26648998576bSDmytro Linkin if (offset != offsetof(struct ipv6hdr, payload_len) || 26658998576bSDmytro Linkin hoplimit_word->payload_len || 26668998576bSDmytro Linkin hoplimit_word->nexthdr) { 26678998576bSDmytro Linkin return true; 26688998576bSDmytro Linkin } 26698998576bSDmytro Linkin } 26708998576bSDmytro Linkin return false; 26718998576bSDmytro Linkin } 26728998576bSDmytro Linkin 2673bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec, 267473867881SPablo Neira Ayuso struct flow_action *flow_action, 26751651925dSGuy Shattah u32 actions, 2676e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2677bdd66ac0SOr Gerlitz { 267873867881SPablo Neira Ayuso const struct flow_action_entry *act; 2679bdd66ac0SOr Gerlitz bool modify_ip_header; 2680bdd66ac0SOr Gerlitz void *headers_v; 2681bdd66ac0SOr Gerlitz u16 ethertype; 26828998576bSDmytro Linkin u8 ip_proto; 268373867881SPablo Neira Ayuso int i; 2684bdd66ac0SOr Gerlitz 26858377629eSEli Britstein headers_v = get_match_headers_value(actions, spec); 2686bdd66ac0SOr Gerlitz ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype); 2687bdd66ac0SOr Gerlitz 2688bdd66ac0SOr Gerlitz /* for non-IP we only re-write MACs, so we're okay */ 2689bdd66ac0SOr Gerlitz if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6) 2690bdd66ac0SOr Gerlitz goto out_ok; 2691bdd66ac0SOr Gerlitz 2692bdd66ac0SOr Gerlitz modify_ip_header = false; 269373867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 269473867881SPablo Neira Ayuso if (act->id != FLOW_ACTION_MANGLE && 269573867881SPablo Neira Ayuso act->id != FLOW_ACTION_ADD) 2696bdd66ac0SOr Gerlitz continue; 2697bdd66ac0SOr Gerlitz 26988998576bSDmytro Linkin if (is_action_keys_supported(act)) { 2699bdd66ac0SOr Gerlitz modify_ip_header = true; 2700bdd66ac0SOr Gerlitz break; 2701bdd66ac0SOr Gerlitz } 2702bdd66ac0SOr Gerlitz } 2703bdd66ac0SOr Gerlitz 2704bdd66ac0SOr Gerlitz ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol); 27051ccef350SJianbo Liu if (modify_ip_header && ip_proto != IPPROTO_TCP && 27061ccef350SJianbo Liu ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) { 2707e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2708e98bedf5SEli Britstein "can't offload re-write of non TCP/UDP"); 2709bdd66ac0SOr Gerlitz pr_info("can't offload re-write of ip proto %d\n", ip_proto); 2710bdd66ac0SOr Gerlitz return false; 2711bdd66ac0SOr Gerlitz } 2712bdd66ac0SOr Gerlitz 2713bdd66ac0SOr Gerlitz out_ok: 2714bdd66ac0SOr Gerlitz return true; 2715bdd66ac0SOr Gerlitz } 2716bdd66ac0SOr Gerlitz 2717bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv, 271873867881SPablo Neira Ayuso struct flow_action *flow_action, 2719bdd66ac0SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2720e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2721e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2722bdd66ac0SOr Gerlitz { 2723bdd66ac0SOr Gerlitz u32 actions; 2724bdd66ac0SOr Gerlitz 2725226f2ca3SVlad Buslov if (mlx5e_is_eswitch_flow(flow)) 2726bdd66ac0SOr Gerlitz actions = flow->esw_attr->action; 2727bdd66ac0SOr Gerlitz else 2728bdd66ac0SOr Gerlitz actions = flow->nic_attr->action; 2729bdd66ac0SOr Gerlitz 2730226f2ca3SVlad Buslov if (flow_flag_test(flow, EGRESS) && 273135a605dbSEli Britstein !((actions & MLX5_FLOW_CONTEXT_ACTION_DECAP) || 27326830b468STonghao Zhang (actions & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) || 27336830b468STonghao Zhang (actions & MLX5_FLOW_CONTEXT_ACTION_DROP))) 27347e29392eSRoi Dayan return false; 27357e29392eSRoi Dayan 2736bdd66ac0SOr Gerlitz if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 273773867881SPablo Neira Ayuso return modify_header_match_supported(&parse_attr->spec, 2738a655fe9fSDavid S. Miller flow_action, actions, 2739e98bedf5SEli Britstein extack); 2740bdd66ac0SOr Gerlitz 2741bdd66ac0SOr Gerlitz return true; 2742bdd66ac0SOr Gerlitz } 2743bdd66ac0SOr Gerlitz 27445c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv) 27455c65c564SOr Gerlitz { 27465c65c564SOr Gerlitz struct mlx5_core_dev *fmdev, *pmdev; 2747816f6706SOr Gerlitz u64 fsystem_guid, psystem_guid; 27485c65c564SOr Gerlitz 27495c65c564SOr Gerlitz fmdev = priv->mdev; 27505c65c564SOr Gerlitz pmdev = peer_priv->mdev; 27515c65c564SOr Gerlitz 275259c9d35eSAlaa Hleihel fsystem_guid = mlx5_query_nic_system_image_guid(fmdev); 275359c9d35eSAlaa Hleihel psystem_guid = mlx5_query_nic_system_image_guid(pmdev); 27545c65c564SOr Gerlitz 2755816f6706SOr Gerlitz return (fsystem_guid == psystem_guid); 27565c65c564SOr Gerlitz } 27575c65c564SOr Gerlitz 2758bdc837eeSEli Britstein static int add_vlan_rewrite_action(struct mlx5e_priv *priv, int namespace, 2759bdc837eeSEli Britstein const struct flow_action_entry *act, 2760bdc837eeSEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 2761bdc837eeSEli Britstein struct pedit_headers_action *hdrs, 2762bdc837eeSEli Britstein u32 *action, struct netlink_ext_ack *extack) 2763bdc837eeSEli Britstein { 2764bdc837eeSEli Britstein u16 mask16 = VLAN_VID_MASK; 2765bdc837eeSEli Britstein u16 val16 = act->vlan.vid & VLAN_VID_MASK; 2766bdc837eeSEli Britstein const struct flow_action_entry pedit_act = { 2767bdc837eeSEli Britstein .id = FLOW_ACTION_MANGLE, 2768bdc837eeSEli Britstein .mangle.htype = FLOW_ACT_MANGLE_HDR_TYPE_ETH, 2769bdc837eeSEli Britstein .mangle.offset = offsetof(struct vlan_ethhdr, h_vlan_TCI), 2770bdc837eeSEli Britstein .mangle.mask = ~(u32)be16_to_cpu(*(__be16 *)&mask16), 2771bdc837eeSEli Britstein .mangle.val = (u32)be16_to_cpu(*(__be16 *)&val16), 2772bdc837eeSEli Britstein }; 27736fca9d1eSEli Britstein u8 match_prio_mask, match_prio_val; 2774bf2f3bcaSEli Britstein void *headers_c, *headers_v; 2775bdc837eeSEli Britstein int err; 2776bdc837eeSEli Britstein 2777bf2f3bcaSEli Britstein headers_c = get_match_headers_criteria(*action, &parse_attr->spec); 2778bf2f3bcaSEli Britstein headers_v = get_match_headers_value(*action, &parse_attr->spec); 2779bf2f3bcaSEli Britstein 2780bf2f3bcaSEli Britstein if (!(MLX5_GET(fte_match_set_lyr_2_4, headers_c, cvlan_tag) && 2781bf2f3bcaSEli Britstein MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag))) { 2782bf2f3bcaSEli Britstein NL_SET_ERR_MSG_MOD(extack, 2783bf2f3bcaSEli Britstein "VLAN rewrite action must have VLAN protocol match"); 2784bf2f3bcaSEli Britstein return -EOPNOTSUPP; 2785bf2f3bcaSEli Britstein } 2786bf2f3bcaSEli Britstein 27876fca9d1eSEli Britstein match_prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 27886fca9d1eSEli Britstein match_prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 27896fca9d1eSEli Britstein if (act->vlan.prio != (match_prio_val & match_prio_mask)) { 27906fca9d1eSEli Britstein NL_SET_ERR_MSG_MOD(extack, 27916fca9d1eSEli Britstein "Changing VLAN prio is not supported"); 2792bdc837eeSEli Britstein return -EOPNOTSUPP; 2793bdc837eeSEli Britstein } 2794bdc837eeSEli Britstein 2795bdc837eeSEli Britstein err = parse_tc_pedit_action(priv, &pedit_act, namespace, parse_attr, 2796bdc837eeSEli Britstein hdrs, NULL); 2797bdc837eeSEli Britstein *action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2798bdc837eeSEli Britstein 2799bdc837eeSEli Britstein return err; 2800bdc837eeSEli Britstein } 2801bdc837eeSEli Britstein 28020bac1194SEli Britstein static int 28030bac1194SEli Britstein add_vlan_prio_tag_rewrite_action(struct mlx5e_priv *priv, 28040bac1194SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 28050bac1194SEli Britstein struct pedit_headers_action *hdrs, 28060bac1194SEli Britstein u32 *action, struct netlink_ext_ack *extack) 28070bac1194SEli Britstein { 28080bac1194SEli Britstein const struct flow_action_entry prio_tag_act = { 28090bac1194SEli Britstein .vlan.vid = 0, 28100bac1194SEli Britstein .vlan.prio = 28110bac1194SEli Britstein MLX5_GET(fte_match_set_lyr_2_4, 28120bac1194SEli Britstein get_match_headers_value(*action, 28130bac1194SEli Britstein &parse_attr->spec), 28140bac1194SEli Britstein first_prio) & 28150bac1194SEli Britstein MLX5_GET(fte_match_set_lyr_2_4, 28160bac1194SEli Britstein get_match_headers_criteria(*action, 28170bac1194SEli Britstein &parse_attr->spec), 28180bac1194SEli Britstein first_prio), 28190bac1194SEli Britstein }; 28200bac1194SEli Britstein 28210bac1194SEli Britstein return add_vlan_rewrite_action(priv, MLX5_FLOW_NAMESPACE_FDB, 28220bac1194SEli Britstein &prio_tag_act, parse_attr, hdrs, action, 28230bac1194SEli Britstein extack); 28240bac1194SEli Britstein } 28250bac1194SEli Britstein 282673867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv, 282773867881SPablo Neira Ayuso struct flow_action *flow_action, 2828aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2829e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2830e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2831e3a2b7edSAmir Vadai { 2832aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 283373867881SPablo Neira Ayuso struct pedit_headers_action hdrs[2] = {}; 283473867881SPablo Neira Ayuso const struct flow_action_entry *act; 28351cab1cd7SOr Gerlitz u32 action = 0; 2836244cd96aSCong Wang int err, i; 2837e3a2b7edSAmir Vadai 283873867881SPablo Neira Ayuso if (!flow_action_has_entries(flow_action)) 2839e3a2b7edSAmir Vadai return -EINVAL; 2840e3a2b7edSAmir Vadai 28413bc4b7bfSOr Gerlitz attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG; 2842e3a2b7edSAmir Vadai 284373867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 284473867881SPablo Neira Ayuso switch (act->id) { 284515fc92ecSTonghao Zhang case FLOW_ACTION_ACCEPT: 284615fc92ecSTonghao Zhang action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 284715fc92ecSTonghao Zhang MLX5_FLOW_CONTEXT_ACTION_COUNT; 284815fc92ecSTonghao Zhang break; 284973867881SPablo Neira Ayuso case FLOW_ACTION_DROP: 28501cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP; 2851aad7e08dSAmir Vadai if (MLX5_CAP_FLOWTABLE(priv->mdev, 2852aad7e08dSAmir Vadai flow_table_properties_nic_receive.flow_counter)) 28531cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 285473867881SPablo Neira Ayuso break; 285573867881SPablo Neira Ayuso case FLOW_ACTION_MANGLE: 285673867881SPablo Neira Ayuso case FLOW_ACTION_ADD: 285773867881SPablo Neira Ayuso err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL, 2858c500c86bSPablo Neira Ayuso parse_attr, hdrs, extack); 28592f4fe4caSOr Gerlitz if (err) 28602f4fe4caSOr Gerlitz return err; 28612f4fe4caSOr Gerlitz 28621cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR | 28632f4fe4caSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 286473867881SPablo Neira Ayuso break; 2865bdc837eeSEli Britstein case FLOW_ACTION_VLAN_MANGLE: 2866bdc837eeSEli Britstein err = add_vlan_rewrite_action(priv, 2867bdc837eeSEli Britstein MLX5_FLOW_NAMESPACE_KERNEL, 2868bdc837eeSEli Britstein act, parse_attr, hdrs, 2869bdc837eeSEli Britstein &action, extack); 2870bdc837eeSEli Britstein if (err) 2871bdc837eeSEli Britstein return err; 2872bdc837eeSEli Britstein 2873bdc837eeSEli Britstein break; 287473867881SPablo Neira Ayuso case FLOW_ACTION_CSUM: 28751cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 287673867881SPablo Neira Ayuso act->csum_flags, 2877e98bedf5SEli Britstein extack)) 287873867881SPablo Neira Ayuso break; 287926c02749SOr Gerlitz 288026c02749SOr Gerlitz return -EOPNOTSUPP; 288173867881SPablo Neira Ayuso case FLOW_ACTION_REDIRECT: { 288273867881SPablo Neira Ayuso struct net_device *peer_dev = act->dev; 28835c65c564SOr Gerlitz 28845c65c564SOr Gerlitz if (priv->netdev->netdev_ops == peer_dev->netdev_ops && 28855c65c564SOr Gerlitz same_hw_devs(priv, netdev_priv(peer_dev))) { 288698b66cb1SEli Britstein parse_attr->mirred_ifindex[0] = peer_dev->ifindex; 2887226f2ca3SVlad Buslov flow_flag_set(flow, HAIRPIN); 28881cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 28895c65c564SOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 28905c65c564SOr Gerlitz } else { 2891e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2892e98bedf5SEli Britstein "device is not on same HW, can't offload"); 28935c65c564SOr Gerlitz netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n", 28945c65c564SOr Gerlitz peer_dev->name); 28955c65c564SOr Gerlitz return -EINVAL; 28965c65c564SOr Gerlitz } 28975c65c564SOr Gerlitz } 289873867881SPablo Neira Ayuso break; 289973867881SPablo Neira Ayuso case FLOW_ACTION_MARK: { 290073867881SPablo Neira Ayuso u32 mark = act->mark; 2901e3a2b7edSAmir Vadai 2902e3a2b7edSAmir Vadai if (mark & ~MLX5E_TC_FLOW_ID_MASK) { 2903e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2904e98bedf5SEli Britstein "Bad flow mark - only 16 bit is supported"); 2905e3a2b7edSAmir Vadai return -EINVAL; 2906e3a2b7edSAmir Vadai } 2907e3a2b7edSAmir Vadai 29083bc4b7bfSOr Gerlitz attr->flow_tag = mark; 29091cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 2910e3a2b7edSAmir Vadai } 291173867881SPablo Neira Ayuso break; 291273867881SPablo Neira Ayuso default: 29132cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported"); 29142cc1cb1dSTonghao Zhang return -EOPNOTSUPP; 2915e3a2b7edSAmir Vadai } 291673867881SPablo Neira Ayuso } 2917e3a2b7edSAmir Vadai 2918c500c86bSPablo Neira Ayuso if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits || 2919c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) { 2920c500c86bSPablo Neira Ayuso err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL, 292127c11b6bSEli Britstein parse_attr, hdrs, &action, extack); 2922c500c86bSPablo Neira Ayuso if (err) 2923c500c86bSPablo Neira Ayuso return err; 292427c11b6bSEli Britstein /* in case all pedit actions are skipped, remove the MOD_HDR 292527c11b6bSEli Britstein * flag. 292627c11b6bSEli Britstein */ 2927e7739a60SEli Britstein if (parse_attr->num_mod_hdr_actions == 0) { 292827c11b6bSEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2929e7739a60SEli Britstein kfree(parse_attr->mod_hdr_actions); 2930e7739a60SEli Britstein } 2931c500c86bSPablo Neira Ayuso } 2932c500c86bSPablo Neira Ayuso 29331cab1cd7SOr Gerlitz attr->action = action; 293473867881SPablo Neira Ayuso if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack)) 2935bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 2936bdd66ac0SOr Gerlitz 2937e3a2b7edSAmir Vadai return 0; 2938e3a2b7edSAmir Vadai } 2939e3a2b7edSAmir Vadai 29407f1a546eSEli Britstein struct encap_key { 29411f6da306SYevgeny Kliteynik const struct ip_tunnel_key *ip_tun_key; 2942d386939aSYevgeny Kliteynik struct mlx5e_tc_tunnel *tc_tunnel; 29437f1a546eSEli Britstein }; 29447f1a546eSEli Britstein 29457f1a546eSEli Britstein static inline int cmp_encap_info(struct encap_key *a, 29467f1a546eSEli Britstein struct encap_key *b) 2947a54e20b4SHadar Hen Zion { 29487f1a546eSEli Britstein return memcmp(a->ip_tun_key, b->ip_tun_key, sizeof(*a->ip_tun_key)) || 2949d386939aSYevgeny Kliteynik a->tc_tunnel->tunnel_type != b->tc_tunnel->tunnel_type; 2950a54e20b4SHadar Hen Zion } 2951a54e20b4SHadar Hen Zion 29527f1a546eSEli Britstein static inline int hash_encap_info(struct encap_key *key) 2953a54e20b4SHadar Hen Zion { 29547f1a546eSEli Britstein return jhash(key->ip_tun_key, sizeof(*key->ip_tun_key), 2955d386939aSYevgeny Kliteynik key->tc_tunnel->tunnel_type); 2956a54e20b4SHadar Hen Zion } 2957a54e20b4SHadar Hen Zion 2958a54e20b4SHadar Hen Zion 2959b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv, 2960b1d90e6bSRabie Loulou struct net_device *peer_netdev) 2961b1d90e6bSRabie Loulou { 2962b1d90e6bSRabie Loulou struct mlx5e_priv *peer_priv; 2963b1d90e6bSRabie Loulou 2964b1d90e6bSRabie Loulou peer_priv = netdev_priv(peer_netdev); 2965b1d90e6bSRabie Loulou 2966b1d90e6bSRabie Loulou return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) && 296768931c7dSRoi Dayan mlx5e_eswitch_rep(priv->netdev) && 296868931c7dSRoi Dayan mlx5e_eswitch_rep(peer_netdev) && 296968931c7dSRoi Dayan same_hw_devs(priv, peer_priv)); 2970b1d90e6bSRabie Loulou } 2971b1d90e6bSRabie Loulou 2972ce99f6b9SOr Gerlitz 297354c177caSOz Shlomo 2974948993f2SVlad Buslov bool mlx5e_encap_take(struct mlx5e_encap_entry *e) 2975948993f2SVlad Buslov { 2976948993f2SVlad Buslov return refcount_inc_not_zero(&e->refcnt); 2977948993f2SVlad Buslov } 2978948993f2SVlad Buslov 2979948993f2SVlad Buslov static struct mlx5e_encap_entry * 2980948993f2SVlad Buslov mlx5e_encap_get(struct mlx5e_priv *priv, struct encap_key *key, 2981948993f2SVlad Buslov uintptr_t hash_key) 2982948993f2SVlad Buslov { 2983948993f2SVlad Buslov struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2984948993f2SVlad Buslov struct mlx5e_encap_entry *e; 2985948993f2SVlad Buslov struct encap_key e_key; 2986948993f2SVlad Buslov 2987948993f2SVlad Buslov hash_for_each_possible_rcu(esw->offloads.encap_tbl, e, 2988948993f2SVlad Buslov encap_hlist, hash_key) { 2989948993f2SVlad Buslov e_key.ip_tun_key = &e->tun_info->key; 2990948993f2SVlad Buslov e_key.tc_tunnel = e->tunnel; 2991948993f2SVlad Buslov if (!cmp_encap_info(&e_key, key) && 2992948993f2SVlad Buslov mlx5e_encap_take(e)) 2993948993f2SVlad Buslov return e; 2994948993f2SVlad Buslov } 2995948993f2SVlad Buslov 2996948993f2SVlad Buslov return NULL; 2997948993f2SVlad Buslov } 2998948993f2SVlad Buslov 29992a4b6526SVlad Buslov static struct ip_tunnel_info *dup_tun_info(const struct ip_tunnel_info *tun_info) 30002a4b6526SVlad Buslov { 30012a4b6526SVlad Buslov size_t tun_size = sizeof(*tun_info) + tun_info->options_len; 30022a4b6526SVlad Buslov 30032a4b6526SVlad Buslov return kmemdup(tun_info, tun_size, GFP_KERNEL); 30042a4b6526SVlad Buslov } 30052a4b6526SVlad Buslov 3006a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv, 3007e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 3008733d4f36SRoi Dayan struct net_device *mirred_dev, 3009733d4f36SRoi Dayan int out_index, 30108c4dc42bSEli Britstein struct netlink_ext_ack *extack, 30110ad060eeSRoi Dayan struct net_device **encap_dev, 30120ad060eeSRoi Dayan bool *encap_valid) 301303a9d11eSOr Gerlitz { 3014a54e20b4SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 301545247bf2SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 3016733d4f36SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 30171f6da306SYevgeny Kliteynik const struct ip_tunnel_info *tun_info; 3018948993f2SVlad Buslov struct encap_key key; 3019c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 3020733d4f36SRoi Dayan unsigned short family; 3021a54e20b4SHadar Hen Zion uintptr_t hash_key; 302254c177caSOz Shlomo int err = 0; 3023a54e20b4SHadar Hen Zion 3024733d4f36SRoi Dayan parse_attr = attr->parse_attr; 30251f6da306SYevgeny Kliteynik tun_info = parse_attr->tun_info[out_index]; 3026733d4f36SRoi Dayan family = ip_tunnel_info_af(tun_info); 30277f1a546eSEli Britstein key.ip_tun_key = &tun_info->key; 3028d386939aSYevgeny Kliteynik key.tc_tunnel = mlx5e_get_tc_tun(mirred_dev); 3029d71f895cSEli Cohen if (!key.tc_tunnel) { 3030d71f895cSEli Cohen NL_SET_ERR_MSG_MOD(extack, "Unsupported tunnel"); 3031d71f895cSEli Cohen return -EOPNOTSUPP; 3032d71f895cSEli Cohen } 3033733d4f36SRoi Dayan 30347f1a546eSEli Britstein hash_key = hash_encap_info(&key); 3035a54e20b4SHadar Hen Zion 303661086f39SVlad Buslov mutex_lock(&esw->offloads.encap_tbl_lock); 3037948993f2SVlad Buslov e = mlx5e_encap_get(priv, &key, hash_key); 3038a54e20b4SHadar Hen Zion 3039b2812089SVlad Buslov /* must verify if encap is valid or not */ 3040d589e785SVlad Buslov if (e) { 3041d589e785SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 3042d589e785SVlad Buslov wait_for_completion(&e->res_ready); 3043d589e785SVlad Buslov 3044d589e785SVlad Buslov /* Protect against concurrent neigh update. */ 3045d589e785SVlad Buslov mutex_lock(&esw->offloads.encap_tbl_lock); 30463c140dd5SVlad Buslov if (e->compl_result < 0) { 3047d589e785SVlad Buslov err = -EREMOTEIO; 3048d589e785SVlad Buslov goto out_err; 3049d589e785SVlad Buslov } 305045247bf2SOr Gerlitz goto attach_flow; 3051d589e785SVlad Buslov } 3052a54e20b4SHadar Hen Zion 3053a54e20b4SHadar Hen Zion e = kzalloc(sizeof(*e), GFP_KERNEL); 305461086f39SVlad Buslov if (!e) { 305561086f39SVlad Buslov err = -ENOMEM; 305661086f39SVlad Buslov goto out_err; 305761086f39SVlad Buslov } 3058a54e20b4SHadar Hen Zion 3059948993f2SVlad Buslov refcount_set(&e->refcnt, 1); 3060d589e785SVlad Buslov init_completion(&e->res_ready); 3061d589e785SVlad Buslov 30622a4b6526SVlad Buslov tun_info = dup_tun_info(tun_info); 30632a4b6526SVlad Buslov if (!tun_info) { 30642a4b6526SVlad Buslov err = -ENOMEM; 30652a4b6526SVlad Buslov goto out_err_init; 30662a4b6526SVlad Buslov } 30671f6da306SYevgeny Kliteynik e->tun_info = tun_info; 3068101f4de9SOz Shlomo err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack); 30692a4b6526SVlad Buslov if (err) 30702a4b6526SVlad Buslov goto out_err_init; 307154c177caSOz Shlomo 3072a54e20b4SHadar Hen Zion INIT_LIST_HEAD(&e->flows); 3073d589e785SVlad Buslov hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key); 3074d589e785SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 3075a54e20b4SHadar Hen Zion 3076ce99f6b9SOr Gerlitz if (family == AF_INET) 3077101f4de9SOz Shlomo err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e); 3078ce99f6b9SOr Gerlitz else if (family == AF_INET6) 3079101f4de9SOz Shlomo err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e); 3080ce99f6b9SOr Gerlitz 3081d589e785SVlad Buslov /* Protect against concurrent neigh update. */ 3082d589e785SVlad Buslov mutex_lock(&esw->offloads.encap_tbl_lock); 3083d589e785SVlad Buslov complete_all(&e->res_ready); 3084d589e785SVlad Buslov if (err) { 3085d589e785SVlad Buslov e->compl_result = err; 3086a54e20b4SHadar Hen Zion goto out_err; 3087d589e785SVlad Buslov } 30883c140dd5SVlad Buslov e->compl_result = 1; 3089a54e20b4SHadar Hen Zion 309045247bf2SOr Gerlitz attach_flow: 3091948993f2SVlad Buslov flow->encaps[out_index].e = e; 30928c4dc42bSEli Britstein list_add(&flow->encaps[out_index].list, &e->flows); 30938c4dc42bSEli Britstein flow->encaps[out_index].index = out_index; 309445247bf2SOr Gerlitz *encap_dev = e->out_dev; 30958c4dc42bSEli Britstein if (e->flags & MLX5_ENCAP_ENTRY_VALID) { 30962b688ea5SMaor Gottlieb attr->dests[out_index].pkt_reformat = e->pkt_reformat; 30978c4dc42bSEli Britstein attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID; 30980ad060eeSRoi Dayan *encap_valid = true; 30998c4dc42bSEli Britstein } else { 31000ad060eeSRoi Dayan *encap_valid = false; 31018c4dc42bSEli Britstein } 310261086f39SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 310345247bf2SOr Gerlitz 3104232c0013SHadar Hen Zion return err; 3105a54e20b4SHadar Hen Zion 3106a54e20b4SHadar Hen Zion out_err: 310761086f39SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 3108d589e785SVlad Buslov if (e) 3109d589e785SVlad Buslov mlx5e_encap_put(priv, e); 3110a54e20b4SHadar Hen Zion return err; 31112a4b6526SVlad Buslov 31122a4b6526SVlad Buslov out_err_init: 31132a4b6526SVlad Buslov mutex_unlock(&esw->offloads.encap_tbl_lock); 31142a4b6526SVlad Buslov kfree(tun_info); 31152a4b6526SVlad Buslov kfree(e); 31162a4b6526SVlad Buslov return err; 3117a54e20b4SHadar Hen Zion } 3118a54e20b4SHadar Hen Zion 31191482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv, 312073867881SPablo Neira Ayuso const struct flow_action_entry *act, 31211482bd3dSJianbo Liu struct mlx5_esw_flow_attr *attr, 31221482bd3dSJianbo Liu u32 *action) 31231482bd3dSJianbo Liu { 3124cc495188SJianbo Liu u8 vlan_idx = attr->total_vlan; 3125cc495188SJianbo Liu 3126cc495188SJianbo Liu if (vlan_idx >= MLX5_FS_VLAN_DEPTH) 31271482bd3dSJianbo Liu return -EOPNOTSUPP; 3128cc495188SJianbo Liu 312973867881SPablo Neira Ayuso switch (act->id) { 313073867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_POP: 3131cc495188SJianbo Liu if (vlan_idx) { 3132cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 3133cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 3134cc495188SJianbo Liu return -EOPNOTSUPP; 3135cc495188SJianbo Liu 3136cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2; 3137cc495188SJianbo Liu } else { 3138cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 3139cc495188SJianbo Liu } 314073867881SPablo Neira Ayuso break; 314173867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_PUSH: 314273867881SPablo Neira Ayuso attr->vlan_vid[vlan_idx] = act->vlan.vid; 314373867881SPablo Neira Ayuso attr->vlan_prio[vlan_idx] = act->vlan.prio; 314473867881SPablo Neira Ayuso attr->vlan_proto[vlan_idx] = act->vlan.proto; 3145cc495188SJianbo Liu if (!attr->vlan_proto[vlan_idx]) 3146cc495188SJianbo Liu attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q); 3147cc495188SJianbo Liu 3148cc495188SJianbo Liu if (vlan_idx) { 3149cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 3150cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 3151cc495188SJianbo Liu return -EOPNOTSUPP; 3152cc495188SJianbo Liu 3153cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2; 3154cc495188SJianbo Liu } else { 3155cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) && 315673867881SPablo Neira Ayuso (act->vlan.proto != htons(ETH_P_8021Q) || 315773867881SPablo Neira Ayuso act->vlan.prio)) 3158cc495188SJianbo Liu return -EOPNOTSUPP; 3159cc495188SJianbo Liu 3160cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH; 31611482bd3dSJianbo Liu } 316273867881SPablo Neira Ayuso break; 316373867881SPablo Neira Ayuso default: 3164bdc837eeSEli Britstein return -EINVAL; 31651482bd3dSJianbo Liu } 31661482bd3dSJianbo Liu 3167cc495188SJianbo Liu attr->total_vlan = vlan_idx + 1; 3168cc495188SJianbo Liu 31691482bd3dSJianbo Liu return 0; 31701482bd3dSJianbo Liu } 31711482bd3dSJianbo Liu 3172278748a9SEli Britstein static int add_vlan_push_action(struct mlx5e_priv *priv, 3173278748a9SEli Britstein struct mlx5_esw_flow_attr *attr, 3174278748a9SEli Britstein struct net_device **out_dev, 3175278748a9SEli Britstein u32 *action) 3176278748a9SEli Britstein { 3177278748a9SEli Britstein struct net_device *vlan_dev = *out_dev; 3178278748a9SEli Britstein struct flow_action_entry vlan_act = { 3179278748a9SEli Britstein .id = FLOW_ACTION_VLAN_PUSH, 3180278748a9SEli Britstein .vlan.vid = vlan_dev_vlan_id(vlan_dev), 3181278748a9SEli Britstein .vlan.proto = vlan_dev_vlan_proto(vlan_dev), 3182278748a9SEli Britstein .vlan.prio = 0, 3183278748a9SEli Britstein }; 3184278748a9SEli Britstein int err; 3185278748a9SEli Britstein 3186278748a9SEli Britstein err = parse_tc_vlan_action(priv, &vlan_act, attr, action); 3187278748a9SEli Britstein if (err) 3188278748a9SEli Britstein return err; 3189278748a9SEli Britstein 3190278748a9SEli Britstein *out_dev = dev_get_by_index_rcu(dev_net(vlan_dev), 3191278748a9SEli Britstein dev_get_iflink(vlan_dev)); 3192278748a9SEli Britstein if (is_vlan_dev(*out_dev)) 3193278748a9SEli Britstein err = add_vlan_push_action(priv, attr, out_dev, action); 3194278748a9SEli Britstein 3195278748a9SEli Britstein return err; 3196278748a9SEli Britstein } 3197278748a9SEli Britstein 319835a605dbSEli Britstein static int add_vlan_pop_action(struct mlx5e_priv *priv, 319935a605dbSEli Britstein struct mlx5_esw_flow_attr *attr, 320035a605dbSEli Britstein u32 *action) 320135a605dbSEli Britstein { 3202f3b0a18bSTaehee Yoo int nest_level = attr->parse_attr->filter_dev->lower_level; 320335a605dbSEli Britstein struct flow_action_entry vlan_act = { 320435a605dbSEli Britstein .id = FLOW_ACTION_VLAN_POP, 320535a605dbSEli Britstein }; 320635a605dbSEli Britstein int err = 0; 320735a605dbSEli Britstein 320835a605dbSEli Britstein while (nest_level--) { 320935a605dbSEli Britstein err = parse_tc_vlan_action(priv, &vlan_act, attr, action); 321035a605dbSEli Britstein if (err) 321135a605dbSEli Britstein return err; 321235a605dbSEli Britstein } 321335a605dbSEli Britstein 321435a605dbSEli Britstein return err; 321535a605dbSEli Britstein } 321635a605dbSEli Britstein 3217f6dc1264SPaul Blakey bool mlx5e_is_valid_eswitch_fwd_dev(struct mlx5e_priv *priv, 3218f6dc1264SPaul Blakey struct net_device *out_dev) 3219f6dc1264SPaul Blakey { 3220f6dc1264SPaul Blakey if (is_merged_eswitch_dev(priv, out_dev)) 3221f6dc1264SPaul Blakey return true; 3222f6dc1264SPaul Blakey 3223f6dc1264SPaul Blakey return mlx5e_eswitch_rep(out_dev) && 3224f6dc1264SPaul Blakey same_hw_devs(priv, netdev_priv(out_dev)); 3225f6dc1264SPaul Blakey } 3226f6dc1264SPaul Blakey 322773867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv, 322873867881SPablo Neira Ayuso struct flow_action *flow_action, 3229e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 3230e98bedf5SEli Britstein struct netlink_ext_ack *extack) 3231a54e20b4SHadar Hen Zion { 323273867881SPablo Neira Ayuso struct pedit_headers_action hdrs[2] = {}; 3233bf07aa73SPaul Blakey struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3234ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 32356f9af8ffSTonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr; 32361d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 323773867881SPablo Neira Ayuso const struct ip_tunnel_info *info = NULL; 323884179981SPaul Blakey bool ft_flow = mlx5e_is_ft_flow(flow); 323973867881SPablo Neira Ayuso const struct flow_action_entry *act; 3240a54e20b4SHadar Hen Zion bool encap = false; 32411cab1cd7SOr Gerlitz u32 action = 0; 3242244cd96aSCong Wang int err, i; 324303a9d11eSOr Gerlitz 324473867881SPablo Neira Ayuso if (!flow_action_has_entries(flow_action)) 324503a9d11eSOr Gerlitz return -EINVAL; 324603a9d11eSOr Gerlitz 324773867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 324873867881SPablo Neira Ayuso switch (act->id) { 324973867881SPablo Neira Ayuso case FLOW_ACTION_DROP: 32501cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP | 325103a9d11eSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 325273867881SPablo Neira Ayuso break; 325373867881SPablo Neira Ayuso case FLOW_ACTION_MANGLE: 325473867881SPablo Neira Ayuso case FLOW_ACTION_ADD: 325573867881SPablo Neira Ayuso err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB, 3256c500c86bSPablo Neira Ayuso parse_attr, hdrs, extack); 3257d7e75a32SOr Gerlitz if (err) 3258d7e75a32SOr Gerlitz return err; 3259d7e75a32SOr Gerlitz 32601cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 3261e85e02baSEli Britstein attr->split_count = attr->out_count; 326273867881SPablo Neira Ayuso break; 326373867881SPablo Neira Ayuso case FLOW_ACTION_CSUM: 32641cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 326573867881SPablo Neira Ayuso act->csum_flags, extack)) 326673867881SPablo Neira Ayuso break; 326726c02749SOr Gerlitz 326826c02749SOr Gerlitz return -EOPNOTSUPP; 326973867881SPablo Neira Ayuso case FLOW_ACTION_REDIRECT: 327073867881SPablo Neira Ayuso case FLOW_ACTION_MIRRED: { 327103a9d11eSOr Gerlitz struct mlx5e_priv *out_priv; 3272592d3651SChris Mi struct net_device *out_dev; 327303a9d11eSOr Gerlitz 327473867881SPablo Neira Ayuso out_dev = act->dev; 3275ef381359SOz Shlomo if (!out_dev) { 3276ef381359SOz Shlomo /* out_dev is NULL when filters with 3277ef381359SOz Shlomo * non-existing mirred device are replayed to 3278ef381359SOz Shlomo * the driver. 3279ef381359SOz Shlomo */ 3280ef381359SOz Shlomo return -EINVAL; 3281ef381359SOz Shlomo } 328203a9d11eSOr Gerlitz 328384179981SPaul Blakey if (ft_flow && out_dev == priv->netdev) { 328484179981SPaul Blakey /* Ignore forward to self rules generated 328584179981SPaul Blakey * by adding both mlx5 devs to the flow table 328684179981SPaul Blakey * block on a normal nft offload setup. 328784179981SPaul Blakey */ 328884179981SPaul Blakey return -EOPNOTSUPP; 328984179981SPaul Blakey } 329084179981SPaul Blakey 3291592d3651SChris Mi if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) { 3292e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 3293e98bedf5SEli Britstein "can't support more output ports, can't offload forwarding"); 3294592d3651SChris Mi pr_err("can't support more than %d output ports, can't offload forwarding\n", 3295592d3651SChris Mi attr->out_count); 3296592d3651SChris Mi return -EOPNOTSUPP; 3297592d3651SChris Mi } 3298592d3651SChris Mi 3299f493f155SEli Britstein action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 3300f493f155SEli Britstein MLX5_FLOW_CONTEXT_ACTION_COUNT; 3301b6a4ac24SVlad Buslov if (encap) { 3302b6a4ac24SVlad Buslov parse_attr->mirred_ifindex[attr->out_count] = 3303b6a4ac24SVlad Buslov out_dev->ifindex; 3304b6a4ac24SVlad Buslov parse_attr->tun_info[attr->out_count] = dup_tun_info(info); 3305b6a4ac24SVlad Buslov if (!parse_attr->tun_info[attr->out_count]) 3306b6a4ac24SVlad Buslov return -ENOMEM; 3307b6a4ac24SVlad Buslov encap = false; 3308b6a4ac24SVlad Buslov attr->dests[attr->out_count].flags |= 3309b6a4ac24SVlad Buslov MLX5_ESW_DEST_ENCAP; 3310b6a4ac24SVlad Buslov attr->out_count++; 3311b6a4ac24SVlad Buslov /* attr->dests[].rep is resolved when we 3312b6a4ac24SVlad Buslov * handle encap 3313b6a4ac24SVlad Buslov */ 3314b6a4ac24SVlad Buslov } else if (netdev_port_same_parent_id(priv->netdev, out_dev)) { 33157ba58ba7SRabie Loulou struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 33167ba58ba7SRabie Loulou struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH); 3317fa833bd5SVlad Buslov struct net_device *uplink_upper; 33187ba58ba7SRabie Loulou 3319fa833bd5SVlad Buslov rcu_read_lock(); 3320fa833bd5SVlad Buslov uplink_upper = 3321fa833bd5SVlad Buslov netdev_master_upper_dev_get_rcu(uplink_dev); 33227ba58ba7SRabie Loulou if (uplink_upper && 33237ba58ba7SRabie Loulou netif_is_lag_master(uplink_upper) && 33247ba58ba7SRabie Loulou uplink_upper == out_dev) 33257ba58ba7SRabie Loulou out_dev = uplink_dev; 3326fa833bd5SVlad Buslov rcu_read_unlock(); 33277ba58ba7SRabie Loulou 3328278748a9SEli Britstein if (is_vlan_dev(out_dev)) { 3329278748a9SEli Britstein err = add_vlan_push_action(priv, attr, 3330278748a9SEli Britstein &out_dev, 3331278748a9SEli Britstein &action); 3332278748a9SEli Britstein if (err) 3333278748a9SEli Britstein return err; 3334278748a9SEli Britstein } 3335f6dc1264SPaul Blakey 333635a605dbSEli Britstein if (is_vlan_dev(parse_attr->filter_dev)) { 333735a605dbSEli Britstein err = add_vlan_pop_action(priv, attr, 333835a605dbSEli Britstein &action); 333935a605dbSEli Britstein if (err) 334035a605dbSEli Britstein return err; 334135a605dbSEli Britstein } 3342278748a9SEli Britstein 3343f6dc1264SPaul Blakey if (!mlx5e_is_valid_eswitch_fwd_dev(priv, out_dev)) { 3344f6dc1264SPaul Blakey NL_SET_ERR_MSG_MOD(extack, 3345f6dc1264SPaul Blakey "devices are not on same switch HW, can't offload forwarding"); 3346f6dc1264SPaul Blakey pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 3347f6dc1264SPaul Blakey priv->netdev->name, out_dev->name); 3348a0646c88SEli Britstein return -EOPNOTSUPP; 3349f6dc1264SPaul Blakey } 3350a0646c88SEli Britstein 335103a9d11eSOr Gerlitz out_priv = netdev_priv(out_dev); 33521d447a39SSaeed Mahameed rpriv = out_priv->ppriv; 3353df65a573SEli Britstein attr->dests[attr->out_count].rep = rpriv->rep; 3354df65a573SEli Britstein attr->dests[attr->out_count].mdev = out_priv->mdev; 3355df65a573SEli Britstein attr->out_count++; 3356ef381359SOz Shlomo } else if (parse_attr->filter_dev != priv->netdev) { 3357ef381359SOz Shlomo /* All mlx5 devices are called to configure 3358ef381359SOz Shlomo * high level device filters. Therefore, the 3359ef381359SOz Shlomo * *attempt* to install a filter on invalid 3360ef381359SOz Shlomo * eswitch should not trigger an explicit error 3361ef381359SOz Shlomo */ 3362ef381359SOz Shlomo return -EINVAL; 3363a54e20b4SHadar Hen Zion } else { 3364e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 3365e98bedf5SEli Britstein "devices are not on same switch HW, can't offload forwarding"); 3366a54e20b4SHadar Hen Zion pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 3367a54e20b4SHadar Hen Zion priv->netdev->name, out_dev->name); 3368a54e20b4SHadar Hen Zion return -EINVAL; 3369a54e20b4SHadar Hen Zion } 3370a54e20b4SHadar Hen Zion } 337173867881SPablo Neira Ayuso break; 337273867881SPablo Neira Ayuso case FLOW_ACTION_TUNNEL_ENCAP: 337373867881SPablo Neira Ayuso info = act->tunnel; 3374a54e20b4SHadar Hen Zion if (info) 3375a54e20b4SHadar Hen Zion encap = true; 3376a54e20b4SHadar Hen Zion else 3377a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 337803a9d11eSOr Gerlitz 337973867881SPablo Neira Ayuso break; 338073867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_PUSH: 338173867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_POP: 338276b496b1SEli Britstein if (act->id == FLOW_ACTION_VLAN_PUSH && 338376b496b1SEli Britstein (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP)) { 338476b496b1SEli Britstein /* Replace vlan pop+push with vlan modify */ 338576b496b1SEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 338676b496b1SEli Britstein err = add_vlan_rewrite_action(priv, 338776b496b1SEli Britstein MLX5_FLOW_NAMESPACE_FDB, 338876b496b1SEli Britstein act, parse_attr, hdrs, 338976b496b1SEli Britstein &action, extack); 339076b496b1SEli Britstein } else { 339173867881SPablo Neira Ayuso err = parse_tc_vlan_action(priv, act, attr, &action); 339276b496b1SEli Britstein } 33931482bd3dSJianbo Liu if (err) 33941482bd3dSJianbo Liu return err; 33951482bd3dSJianbo Liu 3396e85e02baSEli Britstein attr->split_count = attr->out_count; 339773867881SPablo Neira Ayuso break; 3398bdc837eeSEli Britstein case FLOW_ACTION_VLAN_MANGLE: 3399bdc837eeSEli Britstein err = add_vlan_rewrite_action(priv, 3400bdc837eeSEli Britstein MLX5_FLOW_NAMESPACE_FDB, 3401bdc837eeSEli Britstein act, parse_attr, hdrs, 3402bdc837eeSEli Britstein &action, extack); 3403bdc837eeSEli Britstein if (err) 3404bdc837eeSEli Britstein return err; 3405bdc837eeSEli Britstein 3406bdc837eeSEli Britstein attr->split_count = attr->out_count; 3407bdc837eeSEli Britstein break; 340873867881SPablo Neira Ayuso case FLOW_ACTION_TUNNEL_DECAP: 34091cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DECAP; 341073867881SPablo Neira Ayuso break; 341173867881SPablo Neira Ayuso case FLOW_ACTION_GOTO: { 341273867881SPablo Neira Ayuso u32 dest_chain = act->chain_index; 3413bf07aa73SPaul Blakey u32 max_chain = mlx5_eswitch_get_chain_range(esw); 3414bf07aa73SPaul Blakey 341584179981SPaul Blakey if (ft_flow) { 341684179981SPaul Blakey NL_SET_ERR_MSG_MOD(extack, "Goto action is not supported"); 341784179981SPaul Blakey return -EOPNOTSUPP; 341884179981SPaul Blakey } 3419bf07aa73SPaul Blakey if (dest_chain <= attr->chain) { 3420bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported"); 3421bf07aa73SPaul Blakey return -EOPNOTSUPP; 3422bf07aa73SPaul Blakey } 3423bf07aa73SPaul Blakey if (dest_chain > max_chain) { 3424bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range"); 3425bf07aa73SPaul Blakey return -EOPNOTSUPP; 3426bf07aa73SPaul Blakey } 3427e88afe75SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 3428bf07aa73SPaul Blakey attr->dest_chain = dest_chain; 342973867881SPablo Neira Ayuso break; 3430bf07aa73SPaul Blakey } 343173867881SPablo Neira Ayuso default: 34322cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported"); 34332cc1cb1dSTonghao Zhang return -EOPNOTSUPP; 343403a9d11eSOr Gerlitz } 343573867881SPablo Neira Ayuso } 3436bdd66ac0SOr Gerlitz 34370bac1194SEli Britstein if (MLX5_CAP_GEN(esw->dev, prio_tag_required) && 34380bac1194SEli Britstein action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) { 34390bac1194SEli Britstein /* For prio tag mode, replace vlan pop with rewrite vlan prio 34400bac1194SEli Britstein * tag rewrite. 34410bac1194SEli Britstein */ 34420bac1194SEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 34430bac1194SEli Britstein err = add_vlan_prio_tag_rewrite_action(priv, parse_attr, hdrs, 34440bac1194SEli Britstein &action, extack); 34450bac1194SEli Britstein if (err) 34460bac1194SEli Britstein return err; 34470bac1194SEli Britstein } 34480bac1194SEli Britstein 3449c500c86bSPablo Neira Ayuso if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits || 3450c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) { 345184be899fSTonghao Zhang err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_FDB, 345227c11b6bSEli Britstein parse_attr, hdrs, &action, extack); 3453c500c86bSPablo Neira Ayuso if (err) 3454c500c86bSPablo Neira Ayuso return err; 345527c11b6bSEli Britstein /* in case all pedit actions are skipped, remove the MOD_HDR 345627c11b6bSEli Britstein * flag. we might have set split_count either by pedit or 345727c11b6bSEli Britstein * pop/push. if there is no pop/push either, reset it too. 345827c11b6bSEli Britstein */ 345927c11b6bSEli Britstein if (parse_attr->num_mod_hdr_actions == 0) { 346027c11b6bSEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 3461e7739a60SEli Britstein kfree(parse_attr->mod_hdr_actions); 346227c11b6bSEli Britstein if (!((action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) || 346327c11b6bSEli Britstein (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH))) 346427c11b6bSEli Britstein attr->split_count = 0; 346527c11b6bSEli Britstein } 3466c500c86bSPablo Neira Ayuso } 3467c500c86bSPablo Neira Ayuso 34681cab1cd7SOr Gerlitz attr->action = action; 346973867881SPablo Neira Ayuso if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack)) 3470bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 3471bdd66ac0SOr Gerlitz 3472e88afe75SOr Gerlitz if (attr->dest_chain) { 3473e88afe75SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 3474e88afe75SOr Gerlitz NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported"); 3475e88afe75SOr Gerlitz return -EOPNOTSUPP; 3476e88afe75SOr Gerlitz } 3477e88afe75SOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 3478e88afe75SOr Gerlitz } 3479e88afe75SOr Gerlitz 3480ae2741e2SVlad Buslov if (!(attr->action & 3481ae2741e2SVlad Buslov (MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | MLX5_FLOW_CONTEXT_ACTION_DROP))) { 3482ae2741e2SVlad Buslov NL_SET_ERR_MSG(extack, "Rule must have at least one forward/drop action"); 3483ae2741e2SVlad Buslov return -EOPNOTSUPP; 3484ae2741e2SVlad Buslov } 3485ae2741e2SVlad Buslov 3486e85e02baSEli Britstein if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) { 3487e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 3488e98bedf5SEli Britstein "current firmware doesn't support split rule for port mirroring"); 3489592d3651SChris Mi netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n"); 3490592d3651SChris Mi return -EOPNOTSUPP; 3491592d3651SChris Mi } 3492592d3651SChris Mi 349331c8eba5SOr Gerlitz return 0; 349403a9d11eSOr Gerlitz } 349503a9d11eSOr Gerlitz 3496226f2ca3SVlad Buslov static void get_flags(int flags, unsigned long *flow_flags) 349760bd4af8SOr Gerlitz { 3498226f2ca3SVlad Buslov unsigned long __flow_flags = 0; 349960bd4af8SOr Gerlitz 3500226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(INGRESS)) 3501226f2ca3SVlad Buslov __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_INGRESS); 3502226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(EGRESS)) 3503226f2ca3SVlad Buslov __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_EGRESS); 350460bd4af8SOr Gerlitz 3505226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(ESW_OFFLOAD)) 3506226f2ca3SVlad Buslov __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_ESWITCH); 3507226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(NIC_OFFLOAD)) 3508226f2ca3SVlad Buslov __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_NIC); 350984179981SPaul Blakey if (flags & MLX5_TC_FLAG(FT_OFFLOAD)) 351084179981SPaul Blakey __flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_FT); 3511d9ee0491SOr Gerlitz 351260bd4af8SOr Gerlitz *flow_flags = __flow_flags; 351360bd4af8SOr Gerlitz } 351460bd4af8SOr Gerlitz 351505866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = { 351605866c82SOr Gerlitz .head_offset = offsetof(struct mlx5e_tc_flow, node), 351705866c82SOr Gerlitz .key_offset = offsetof(struct mlx5e_tc_flow, cookie), 351805866c82SOr Gerlitz .key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie), 351905866c82SOr Gerlitz .automatic_shrinking = true, 352005866c82SOr Gerlitz }; 352105866c82SOr Gerlitz 3522226f2ca3SVlad Buslov static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv, 3523226f2ca3SVlad Buslov unsigned long flags) 352405866c82SOr Gerlitz { 3525655dc3d2SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3526655dc3d2SOr Gerlitz struct mlx5e_rep_priv *uplink_rpriv; 3527655dc3d2SOr Gerlitz 3528226f2ca3SVlad Buslov if (flags & MLX5_TC_FLAG(ESW_OFFLOAD)) { 3529655dc3d2SOr Gerlitz uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 3530ec1366c2SOz Shlomo return &uplink_rpriv->uplink_priv.tc_ht; 3531d9ee0491SOr Gerlitz } else /* NIC offload */ 353205866c82SOr Gerlitz return &priv->fs.tc.ht; 353305866c82SOr Gerlitz } 353405866c82SOr Gerlitz 353504de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow) 353604de7ddaSRoi Dayan { 35371418ddd9SAviv Heller struct mlx5_esw_flow_attr *attr = flow->esw_attr; 3538b05af6aaSBodong Wang bool is_rep_ingress = attr->in_rep->vport != MLX5_VPORT_UPLINK && 3539226f2ca3SVlad Buslov flow_flag_test(flow, INGRESS); 35401418ddd9SAviv Heller bool act_is_encap = !!(attr->action & 35411418ddd9SAviv Heller MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT); 35421418ddd9SAviv Heller bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom, 35431418ddd9SAviv Heller MLX5_DEVCOM_ESW_OFFLOADS); 35441418ddd9SAviv Heller 354510fbb1cdSRoi Dayan if (!esw_paired) 354610fbb1cdSRoi Dayan return false; 354710fbb1cdSRoi Dayan 354810fbb1cdSRoi Dayan if ((mlx5_lag_is_sriov(attr->in_mdev) || 354910fbb1cdSRoi Dayan mlx5_lag_is_multipath(attr->in_mdev)) && 355010fbb1cdSRoi Dayan (is_rep_ingress || act_is_encap)) 355110fbb1cdSRoi Dayan return true; 355210fbb1cdSRoi Dayan 355310fbb1cdSRoi Dayan return false; 355404de7ddaSRoi Dayan } 355504de7ddaSRoi Dayan 3556a88780a9SRoi Dayan static int 3557a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size, 3558226f2ca3SVlad Buslov struct flow_cls_offload *f, unsigned long flow_flags, 3559a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr **__parse_attr, 3560a88780a9SRoi Dayan struct mlx5e_tc_flow **__flow) 3561e3a2b7edSAmir Vadai { 356217091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr; 35633bc4b7bfSOr Gerlitz struct mlx5e_tc_flow *flow; 35645a7e5bcbSVlad Buslov int out_index, err; 3565776b12b6SOr Gerlitz 356665ba8fb7SOr Gerlitz flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL); 35671b9a07eeSLeon Romanovsky parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL); 356817091853SOr Gerlitz if (!parse_attr || !flow) { 3569e3a2b7edSAmir Vadai err = -ENOMEM; 3570e3a2b7edSAmir Vadai goto err_free; 3571e3a2b7edSAmir Vadai } 3572e3a2b7edSAmir Vadai 3573e3a2b7edSAmir Vadai flow->cookie = f->cookie; 357465ba8fb7SOr Gerlitz flow->flags = flow_flags; 3575655dc3d2SOr Gerlitz flow->priv = priv; 35765a7e5bcbSVlad Buslov for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) 35775a7e5bcbSVlad Buslov INIT_LIST_HEAD(&flow->encaps[out_index].list); 35785a7e5bcbSVlad Buslov INIT_LIST_HEAD(&flow->mod_hdr); 35795a7e5bcbSVlad Buslov INIT_LIST_HEAD(&flow->hairpin); 35805a7e5bcbSVlad Buslov refcount_set(&flow->refcnt, 1); 358195435ad7SVlad Buslov init_completion(&flow->init_done); 3582e3a2b7edSAmir Vadai 3583a88780a9SRoi Dayan *__flow = flow; 3584a88780a9SRoi Dayan *__parse_attr = parse_attr; 3585a88780a9SRoi Dayan 3586a88780a9SRoi Dayan return 0; 3587a88780a9SRoi Dayan 3588a88780a9SRoi Dayan err_free: 3589a88780a9SRoi Dayan kfree(flow); 3590a88780a9SRoi Dayan kvfree(parse_attr); 3591a88780a9SRoi Dayan return err; 3592adb4c123SOr Gerlitz } 3593adb4c123SOr Gerlitz 3594988ab9c7STonghao Zhang static void 3595988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(struct mlx5_esw_flow_attr *esw_attr, 3596988ab9c7STonghao Zhang struct mlx5e_priv *priv, 3597988ab9c7STonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr, 3598f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3599988ab9c7STonghao Zhang struct mlx5_eswitch_rep *in_rep, 3600988ab9c7STonghao Zhang struct mlx5_core_dev *in_mdev) 3601988ab9c7STonghao Zhang { 3602988ab9c7STonghao Zhang struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3603988ab9c7STonghao Zhang 3604988ab9c7STonghao Zhang esw_attr->parse_attr = parse_attr; 3605988ab9c7STonghao Zhang esw_attr->chain = f->common.chain_index; 3606ef01adaeSPablo Neira Ayuso esw_attr->prio = f->common.prio; 3607988ab9c7STonghao Zhang 3608988ab9c7STonghao Zhang esw_attr->in_rep = in_rep; 3609988ab9c7STonghao Zhang esw_attr->in_mdev = in_mdev; 3610988ab9c7STonghao Zhang 3611988ab9c7STonghao Zhang if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) == 3612988ab9c7STonghao Zhang MLX5_COUNTER_SOURCE_ESWITCH) 3613988ab9c7STonghao Zhang esw_attr->counter_dev = in_mdev; 3614988ab9c7STonghao Zhang else 3615988ab9c7STonghao Zhang esw_attr->counter_dev = priv->mdev; 3616988ab9c7STonghao Zhang } 3617988ab9c7STonghao Zhang 361871129676SJason Gunthorpe static struct mlx5e_tc_flow * 361904de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv, 3620f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3621226f2ca3SVlad Buslov unsigned long flow_flags, 3622d11afc26SOz Shlomo struct net_device *filter_dev, 362304de7ddaSRoi Dayan struct mlx5_eswitch_rep *in_rep, 362471129676SJason Gunthorpe struct mlx5_core_dev *in_mdev) 3625a88780a9SRoi Dayan { 3626f9e30088SPablo Neira Ayuso struct flow_rule *rule = flow_cls_offload_flow_rule(f); 3627a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3628a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 3629a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3630a88780a9SRoi Dayan int attr_size, err; 3631a88780a9SRoi Dayan 3632226f2ca3SVlad Buslov flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_ESWITCH); 3633a88780a9SRoi Dayan attr_size = sizeof(struct mlx5_esw_flow_attr); 3634a88780a9SRoi Dayan err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags, 3635a88780a9SRoi Dayan &parse_attr, &flow); 3636a88780a9SRoi Dayan if (err) 3637a88780a9SRoi Dayan goto out; 3638988ab9c7STonghao Zhang 3639d11afc26SOz Shlomo parse_attr->filter_dev = filter_dev; 3640988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(flow->esw_attr, 3641988ab9c7STonghao Zhang priv, parse_attr, 3642988ab9c7STonghao Zhang f, in_rep, in_mdev); 3643988ab9c7STonghao Zhang 364454c177caSOz Shlomo err = parse_cls_flower(flow->priv, flow, &parse_attr->spec, 364554c177caSOz Shlomo f, filter_dev); 3646d11afc26SOz Shlomo if (err) 3647d11afc26SOz Shlomo goto err_free; 3648a88780a9SRoi Dayan 36496f9af8ffSTonghao Zhang err = parse_tc_fdb_actions(priv, &rule->action, flow, extack); 3650a88780a9SRoi Dayan if (err) 3651a88780a9SRoi Dayan goto err_free; 3652a88780a9SRoi Dayan 36537040632dSTonghao Zhang err = mlx5e_tc_add_fdb_flow(priv, flow, extack); 365495435ad7SVlad Buslov complete_all(&flow->init_done); 3655ef06c9eeSRoi Dayan if (err) { 3656ef06c9eeSRoi Dayan if (!(err == -ENETUNREACH && mlx5_lag_is_multipath(in_mdev))) 3657aa0cbbaeSOr Gerlitz goto err_free; 36585c40348cSOr Gerlitz 3659b4a23329SRoi Dayan add_unready_flow(flow); 3660ef06c9eeSRoi Dayan } 3661ef06c9eeSRoi Dayan 366271129676SJason Gunthorpe return flow; 3663e3a2b7edSAmir Vadai 3664e3a2b7edSAmir Vadai err_free: 36655a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 3666a88780a9SRoi Dayan out: 366771129676SJason Gunthorpe return ERR_PTR(err); 3668a88780a9SRoi Dayan } 3669a88780a9SRoi Dayan 3670f9e30088SPablo Neira Ayuso static int mlx5e_tc_add_fdb_peer_flow(struct flow_cls_offload *f, 367195dc1902SRoi Dayan struct mlx5e_tc_flow *flow, 3672226f2ca3SVlad Buslov unsigned long flow_flags) 367304de7ddaSRoi Dayan { 367404de7ddaSRoi Dayan struct mlx5e_priv *priv = flow->priv, *peer_priv; 367504de7ddaSRoi Dayan struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw; 367604de7ddaSRoi Dayan struct mlx5_devcom *devcom = priv->mdev->priv.devcom; 367704de7ddaSRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 367804de7ddaSRoi Dayan struct mlx5e_rep_priv *peer_urpriv; 367904de7ddaSRoi Dayan struct mlx5e_tc_flow *peer_flow; 368004de7ddaSRoi Dayan struct mlx5_core_dev *in_mdev; 368104de7ddaSRoi Dayan int err = 0; 368204de7ddaSRoi Dayan 368304de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 368404de7ddaSRoi Dayan if (!peer_esw) 368504de7ddaSRoi Dayan return -ENODEV; 368604de7ddaSRoi Dayan 368704de7ddaSRoi Dayan peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH); 368804de7ddaSRoi Dayan peer_priv = netdev_priv(peer_urpriv->netdev); 368904de7ddaSRoi Dayan 369004de7ddaSRoi Dayan /* in_mdev is assigned of which the packet originated from. 369104de7ddaSRoi Dayan * So packets redirected to uplink use the same mdev of the 369204de7ddaSRoi Dayan * original flow and packets redirected from uplink use the 369304de7ddaSRoi Dayan * peer mdev. 369404de7ddaSRoi Dayan */ 3695b05af6aaSBodong Wang if (flow->esw_attr->in_rep->vport == MLX5_VPORT_UPLINK) 369604de7ddaSRoi Dayan in_mdev = peer_priv->mdev; 369704de7ddaSRoi Dayan else 369804de7ddaSRoi Dayan in_mdev = priv->mdev; 369904de7ddaSRoi Dayan 370004de7ddaSRoi Dayan parse_attr = flow->esw_attr->parse_attr; 370195dc1902SRoi Dayan peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow_flags, 370204de7ddaSRoi Dayan parse_attr->filter_dev, 370371129676SJason Gunthorpe flow->esw_attr->in_rep, in_mdev); 370471129676SJason Gunthorpe if (IS_ERR(peer_flow)) { 370571129676SJason Gunthorpe err = PTR_ERR(peer_flow); 370604de7ddaSRoi Dayan goto out; 370771129676SJason Gunthorpe } 370804de7ddaSRoi Dayan 370904de7ddaSRoi Dayan flow->peer_flow = peer_flow; 3710226f2ca3SVlad Buslov flow_flag_set(flow, DUP); 371104de7ddaSRoi Dayan mutex_lock(&esw->offloads.peer_mutex); 371204de7ddaSRoi Dayan list_add_tail(&flow->peer, &esw->offloads.peer_flows); 371304de7ddaSRoi Dayan mutex_unlock(&esw->offloads.peer_mutex); 371404de7ddaSRoi Dayan 371504de7ddaSRoi Dayan out: 371604de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 371704de7ddaSRoi Dayan return err; 371804de7ddaSRoi Dayan } 371904de7ddaSRoi Dayan 372004de7ddaSRoi Dayan static int 372104de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv, 3722f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3723226f2ca3SVlad Buslov unsigned long flow_flags, 372404de7ddaSRoi Dayan struct net_device *filter_dev, 372504de7ddaSRoi Dayan struct mlx5e_tc_flow **__flow) 372604de7ddaSRoi Dayan { 372704de7ddaSRoi Dayan struct mlx5e_rep_priv *rpriv = priv->ppriv; 372804de7ddaSRoi Dayan struct mlx5_eswitch_rep *in_rep = rpriv->rep; 372904de7ddaSRoi Dayan struct mlx5_core_dev *in_mdev = priv->mdev; 373004de7ddaSRoi Dayan struct mlx5e_tc_flow *flow; 373104de7ddaSRoi Dayan int err; 373204de7ddaSRoi Dayan 373371129676SJason Gunthorpe flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep, 373471129676SJason Gunthorpe in_mdev); 373571129676SJason Gunthorpe if (IS_ERR(flow)) 373671129676SJason Gunthorpe return PTR_ERR(flow); 373704de7ddaSRoi Dayan 373804de7ddaSRoi Dayan if (is_peer_flow_needed(flow)) { 373995dc1902SRoi Dayan err = mlx5e_tc_add_fdb_peer_flow(f, flow, flow_flags); 374004de7ddaSRoi Dayan if (err) { 374104de7ddaSRoi Dayan mlx5e_tc_del_fdb_flow(priv, flow); 374204de7ddaSRoi Dayan goto out; 374304de7ddaSRoi Dayan } 374404de7ddaSRoi Dayan } 374504de7ddaSRoi Dayan 374604de7ddaSRoi Dayan *__flow = flow; 374704de7ddaSRoi Dayan 374804de7ddaSRoi Dayan return 0; 374904de7ddaSRoi Dayan 375004de7ddaSRoi Dayan out: 375104de7ddaSRoi Dayan return err; 375204de7ddaSRoi Dayan } 375304de7ddaSRoi Dayan 3754a88780a9SRoi Dayan static int 3755a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv, 3756f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3757226f2ca3SVlad Buslov unsigned long flow_flags, 3758d11afc26SOz Shlomo struct net_device *filter_dev, 3759a88780a9SRoi Dayan struct mlx5e_tc_flow **__flow) 3760a88780a9SRoi Dayan { 3761f9e30088SPablo Neira Ayuso struct flow_rule *rule = flow_cls_offload_flow_rule(f); 3762a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3763a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 3764a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3765a88780a9SRoi Dayan int attr_size, err; 3766a88780a9SRoi Dayan 3767bf07aa73SPaul Blakey /* multi-chain not supported for NIC rules */ 3768bf07aa73SPaul Blakey if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common)) 3769bf07aa73SPaul Blakey return -EOPNOTSUPP; 3770bf07aa73SPaul Blakey 3771226f2ca3SVlad Buslov flow_flags |= BIT(MLX5E_TC_FLOW_FLAG_NIC); 3772a88780a9SRoi Dayan attr_size = sizeof(struct mlx5_nic_flow_attr); 3773a88780a9SRoi Dayan err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags, 3774a88780a9SRoi Dayan &parse_attr, &flow); 3775a88780a9SRoi Dayan if (err) 3776a88780a9SRoi Dayan goto out; 3777a88780a9SRoi Dayan 3778d11afc26SOz Shlomo parse_attr->filter_dev = filter_dev; 377954c177caSOz Shlomo err = parse_cls_flower(flow->priv, flow, &parse_attr->spec, 378054c177caSOz Shlomo f, filter_dev); 3781d11afc26SOz Shlomo if (err) 3782d11afc26SOz Shlomo goto err_free; 3783d11afc26SOz Shlomo 378473867881SPablo Neira Ayuso err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack); 3785a88780a9SRoi Dayan if (err) 3786a88780a9SRoi Dayan goto err_free; 3787a88780a9SRoi Dayan 3788a88780a9SRoi Dayan err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack); 3789a88780a9SRoi Dayan if (err) 3790a88780a9SRoi Dayan goto err_free; 3791a88780a9SRoi Dayan 3792226f2ca3SVlad Buslov flow_flag_set(flow, OFFLOADED); 3793a88780a9SRoi Dayan kvfree(parse_attr); 3794a88780a9SRoi Dayan *__flow = flow; 3795a88780a9SRoi Dayan 3796a88780a9SRoi Dayan return 0; 3797a88780a9SRoi Dayan 3798a88780a9SRoi Dayan err_free: 37995a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 3800a88780a9SRoi Dayan kvfree(parse_attr); 3801a88780a9SRoi Dayan out: 3802a88780a9SRoi Dayan return err; 3803a88780a9SRoi Dayan } 3804a88780a9SRoi Dayan 3805a88780a9SRoi Dayan static int 3806a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv, 3807f9e30088SPablo Neira Ayuso struct flow_cls_offload *f, 3808226f2ca3SVlad Buslov unsigned long flags, 3809d11afc26SOz Shlomo struct net_device *filter_dev, 3810a88780a9SRoi Dayan struct mlx5e_tc_flow **flow) 3811a88780a9SRoi Dayan { 3812a88780a9SRoi Dayan struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3813226f2ca3SVlad Buslov unsigned long flow_flags; 3814a88780a9SRoi Dayan int err; 3815a88780a9SRoi Dayan 3816a88780a9SRoi Dayan get_flags(flags, &flow_flags); 3817a88780a9SRoi Dayan 3818bf07aa73SPaul Blakey if (!tc_can_offload_extack(priv->netdev, f->common.extack)) 3819bf07aa73SPaul Blakey return -EOPNOTSUPP; 3820bf07aa73SPaul Blakey 3821f6455de0SBodong Wang if (esw && esw->mode == MLX5_ESWITCH_OFFLOADS) 3822d11afc26SOz Shlomo err = mlx5e_add_fdb_flow(priv, f, flow_flags, 3823d11afc26SOz Shlomo filter_dev, flow); 3824a88780a9SRoi Dayan else 3825d11afc26SOz Shlomo err = mlx5e_add_nic_flow(priv, f, flow_flags, 3826d11afc26SOz Shlomo filter_dev, flow); 3827a88780a9SRoi Dayan 3828a88780a9SRoi Dayan return err; 3829a88780a9SRoi Dayan } 3830a88780a9SRoi Dayan 383171d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv, 3832226f2ca3SVlad Buslov struct flow_cls_offload *f, unsigned long flags) 3833a88780a9SRoi Dayan { 3834a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3835d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 3836a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3837a88780a9SRoi Dayan int err = 0; 3838a88780a9SRoi Dayan 3839c5d326b2SVlad Buslov rcu_read_lock(); 3840c5d326b2SVlad Buslov flow = rhashtable_lookup(tc_ht, &f->cookie, tc_ht_params); 3841c5d326b2SVlad Buslov rcu_read_unlock(); 3842a88780a9SRoi Dayan if (flow) { 3843a88780a9SRoi Dayan NL_SET_ERR_MSG_MOD(extack, 3844a88780a9SRoi Dayan "flow cookie already exists, ignoring"); 3845a88780a9SRoi Dayan netdev_warn_once(priv->netdev, 3846a88780a9SRoi Dayan "flow cookie %lx already exists, ignoring\n", 3847a88780a9SRoi Dayan f->cookie); 38480e1c1a2fSVlad Buslov err = -EEXIST; 3849a88780a9SRoi Dayan goto out; 3850a88780a9SRoi Dayan } 3851a88780a9SRoi Dayan 38527a978759SDmytro Linkin trace_mlx5e_configure_flower(f); 3853d11afc26SOz Shlomo err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow); 3854a88780a9SRoi Dayan if (err) 3855a88780a9SRoi Dayan goto out; 3856a88780a9SRoi Dayan 3857c5d326b2SVlad Buslov err = rhashtable_lookup_insert_fast(tc_ht, &flow->node, tc_ht_params); 3858a88780a9SRoi Dayan if (err) 3859a88780a9SRoi Dayan goto err_free; 3860a88780a9SRoi Dayan 3861a88780a9SRoi Dayan return 0; 3862a88780a9SRoi Dayan 3863a88780a9SRoi Dayan err_free: 38645a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 3865a88780a9SRoi Dayan out: 3866e3a2b7edSAmir Vadai return err; 3867e3a2b7edSAmir Vadai } 3868e3a2b7edSAmir Vadai 38698f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags) 38708f8ae895SOr Gerlitz { 3871226f2ca3SVlad Buslov bool dir_ingress = !!(flags & MLX5_TC_FLAG(INGRESS)); 3872226f2ca3SVlad Buslov bool dir_egress = !!(flags & MLX5_TC_FLAG(EGRESS)); 38738f8ae895SOr Gerlitz 3874226f2ca3SVlad Buslov return flow_flag_test(flow, INGRESS) == dir_ingress && 3875226f2ca3SVlad Buslov flow_flag_test(flow, EGRESS) == dir_egress; 38768f8ae895SOr Gerlitz } 38778f8ae895SOr Gerlitz 387871d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv, 3879226f2ca3SVlad Buslov struct flow_cls_offload *f, unsigned long flags) 3880e3a2b7edSAmir Vadai { 3881d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 3882e3a2b7edSAmir Vadai struct mlx5e_tc_flow *flow; 3883c5d326b2SVlad Buslov int err; 3884e3a2b7edSAmir Vadai 3885c5d326b2SVlad Buslov rcu_read_lock(); 3886ab818362STaehee Yoo flow = rhashtable_lookup(tc_ht, &f->cookie, tc_ht_params); 3887c5d326b2SVlad Buslov if (!flow || !same_flow_direction(flow, flags)) { 3888c5d326b2SVlad Buslov err = -EINVAL; 3889c5d326b2SVlad Buslov goto errout; 3890c5d326b2SVlad Buslov } 3891e3a2b7edSAmir Vadai 3892c5d326b2SVlad Buslov /* Only delete the flow if it doesn't have MLX5E_TC_FLOW_DELETED flag 3893c5d326b2SVlad Buslov * set. 3894c5d326b2SVlad Buslov */ 3895c5d326b2SVlad Buslov if (flow_flag_test_and_set(flow, DELETED)) { 3896c5d326b2SVlad Buslov err = -EINVAL; 3897c5d326b2SVlad Buslov goto errout; 3898c5d326b2SVlad Buslov } 389905866c82SOr Gerlitz rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params); 3900c5d326b2SVlad Buslov rcu_read_unlock(); 3901e3a2b7edSAmir Vadai 39027a978759SDmytro Linkin trace_mlx5e_delete_flower(f); 39035a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 3904e3a2b7edSAmir Vadai 3905e3a2b7edSAmir Vadai return 0; 3906c5d326b2SVlad Buslov 3907c5d326b2SVlad Buslov errout: 3908c5d326b2SVlad Buslov rcu_read_unlock(); 3909c5d326b2SVlad Buslov return err; 3910e3a2b7edSAmir Vadai } 3911e3a2b7edSAmir Vadai 391271d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv, 3913226f2ca3SVlad Buslov struct flow_cls_offload *f, unsigned long flags) 3914aad7e08dSAmir Vadai { 391504de7ddaSRoi Dayan struct mlx5_devcom *devcom = priv->mdev->priv.devcom; 3916d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 391704de7ddaSRoi Dayan struct mlx5_eswitch *peer_esw; 3918aad7e08dSAmir Vadai struct mlx5e_tc_flow *flow; 3919aad7e08dSAmir Vadai struct mlx5_fc *counter; 3920316d5f72SRoi Dayan u64 lastuse = 0; 3921316d5f72SRoi Dayan u64 packets = 0; 3922316d5f72SRoi Dayan u64 bytes = 0; 39235a7e5bcbSVlad Buslov int err = 0; 3924aad7e08dSAmir Vadai 3925c5d326b2SVlad Buslov rcu_read_lock(); 3926c5d326b2SVlad Buslov flow = mlx5e_flow_get(rhashtable_lookup(tc_ht, &f->cookie, 39275a7e5bcbSVlad Buslov tc_ht_params)); 3928c5d326b2SVlad Buslov rcu_read_unlock(); 39295a7e5bcbSVlad Buslov if (IS_ERR(flow)) 39305a7e5bcbSVlad Buslov return PTR_ERR(flow); 39315a7e5bcbSVlad Buslov 39325a7e5bcbSVlad Buslov if (!same_flow_direction(flow, flags)) { 39335a7e5bcbSVlad Buslov err = -EINVAL; 39345a7e5bcbSVlad Buslov goto errout; 39355a7e5bcbSVlad Buslov } 3936aad7e08dSAmir Vadai 3937226f2ca3SVlad Buslov if (mlx5e_is_offloaded_flow(flow)) { 3938b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 3939aad7e08dSAmir Vadai if (!counter) 39405a7e5bcbSVlad Buslov goto errout; 3941aad7e08dSAmir Vadai 3942aad7e08dSAmir Vadai mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 3943316d5f72SRoi Dayan } 3944aad7e08dSAmir Vadai 3945316d5f72SRoi Dayan /* Under multipath it's possible for one rule to be currently 3946316d5f72SRoi Dayan * un-offloaded while the other rule is offloaded. 3947316d5f72SRoi Dayan */ 394804de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 394904de7ddaSRoi Dayan if (!peer_esw) 395004de7ddaSRoi Dayan goto out; 395104de7ddaSRoi Dayan 3952226f2ca3SVlad Buslov if (flow_flag_test(flow, DUP) && 3953226f2ca3SVlad Buslov flow_flag_test(flow->peer_flow, OFFLOADED)) { 395404de7ddaSRoi Dayan u64 bytes2; 395504de7ddaSRoi Dayan u64 packets2; 395604de7ddaSRoi Dayan u64 lastuse2; 395704de7ddaSRoi Dayan 395804de7ddaSRoi Dayan counter = mlx5e_tc_get_counter(flow->peer_flow); 3959316d5f72SRoi Dayan if (!counter) 3960316d5f72SRoi Dayan goto no_peer_counter; 396104de7ddaSRoi Dayan mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2); 396204de7ddaSRoi Dayan 396304de7ddaSRoi Dayan bytes += bytes2; 396404de7ddaSRoi Dayan packets += packets2; 396504de7ddaSRoi Dayan lastuse = max_t(u64, lastuse, lastuse2); 396604de7ddaSRoi Dayan } 396704de7ddaSRoi Dayan 3968316d5f72SRoi Dayan no_peer_counter: 396904de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 397004de7ddaSRoi Dayan out: 39713b1903efSPablo Neira Ayuso flow_stats_update(&f->stats, bytes, packets, lastuse); 39727a978759SDmytro Linkin trace_mlx5e_stats_flower(f); 39735a7e5bcbSVlad Buslov errout: 39745a7e5bcbSVlad Buslov mlx5e_flow_put(priv, flow); 39755a7e5bcbSVlad Buslov return err; 3976aad7e08dSAmir Vadai } 3977aad7e08dSAmir Vadai 3978fcb64c0fSEli Cohen static int apply_police_params(struct mlx5e_priv *priv, u32 rate, 3979fcb64c0fSEli Cohen struct netlink_ext_ack *extack) 3980fcb64c0fSEli Cohen { 3981fcb64c0fSEli Cohen struct mlx5e_rep_priv *rpriv = priv->ppriv; 3982fcb64c0fSEli Cohen struct mlx5_eswitch *esw; 3983fcb64c0fSEli Cohen u16 vport_num; 3984fcb64c0fSEli Cohen u32 rate_mbps; 3985fcb64c0fSEli Cohen int err; 3986fcb64c0fSEli Cohen 3987fcb64c0fSEli Cohen esw = priv->mdev->priv.eswitch; 3988fcb64c0fSEli Cohen /* rate is given in bytes/sec. 3989fcb64c0fSEli Cohen * First convert to bits/sec and then round to the nearest mbit/secs. 3990fcb64c0fSEli Cohen * mbit means million bits. 3991fcb64c0fSEli Cohen * Moreover, if rate is non zero we choose to configure to a minimum of 3992fcb64c0fSEli Cohen * 1 mbit/sec. 3993fcb64c0fSEli Cohen */ 3994fcb64c0fSEli Cohen rate_mbps = rate ? max_t(u32, (rate * 8 + 500000) / 1000000, 1) : 0; 3995fcb64c0fSEli Cohen vport_num = rpriv->rep->vport; 3996fcb64c0fSEli Cohen 3997fcb64c0fSEli Cohen err = mlx5_esw_modify_vport_rate(esw, vport_num, rate_mbps); 3998fcb64c0fSEli Cohen if (err) 3999fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "failed applying action to hardware"); 4000fcb64c0fSEli Cohen 4001fcb64c0fSEli Cohen return err; 4002fcb64c0fSEli Cohen } 4003fcb64c0fSEli Cohen 4004fcb64c0fSEli Cohen static int scan_tc_matchall_fdb_actions(struct mlx5e_priv *priv, 4005fcb64c0fSEli Cohen struct flow_action *flow_action, 4006fcb64c0fSEli Cohen struct netlink_ext_ack *extack) 4007fcb64c0fSEli Cohen { 4008fcb64c0fSEli Cohen struct mlx5e_rep_priv *rpriv = priv->ppriv; 4009fcb64c0fSEli Cohen const struct flow_action_entry *act; 4010fcb64c0fSEli Cohen int err; 4011fcb64c0fSEli Cohen int i; 4012fcb64c0fSEli Cohen 4013fcb64c0fSEli Cohen if (!flow_action_has_entries(flow_action)) { 4014fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "matchall called with no action"); 4015fcb64c0fSEli Cohen return -EINVAL; 4016fcb64c0fSEli Cohen } 4017fcb64c0fSEli Cohen 4018fcb64c0fSEli Cohen if (!flow_offload_has_one_action(flow_action)) { 4019fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "matchall policing support only a single action"); 4020fcb64c0fSEli Cohen return -EOPNOTSUPP; 4021fcb64c0fSEli Cohen } 4022fcb64c0fSEli Cohen 4023fcb64c0fSEli Cohen flow_action_for_each(i, act, flow_action) { 4024fcb64c0fSEli Cohen switch (act->id) { 4025fcb64c0fSEli Cohen case FLOW_ACTION_POLICE: 4026fcb64c0fSEli Cohen err = apply_police_params(priv, act->police.rate_bytes_ps, extack); 4027fcb64c0fSEli Cohen if (err) 4028fcb64c0fSEli Cohen return err; 4029fcb64c0fSEli Cohen 4030fcb64c0fSEli Cohen rpriv->prev_vf_vport_stats = priv->stats.vf_vport; 4031fcb64c0fSEli Cohen break; 4032fcb64c0fSEli Cohen default: 4033fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "mlx5 supports only police action for matchall"); 4034fcb64c0fSEli Cohen return -EOPNOTSUPP; 4035fcb64c0fSEli Cohen } 4036fcb64c0fSEli Cohen } 4037fcb64c0fSEli Cohen 4038fcb64c0fSEli Cohen return 0; 4039fcb64c0fSEli Cohen } 4040fcb64c0fSEli Cohen 4041fcb64c0fSEli Cohen int mlx5e_tc_configure_matchall(struct mlx5e_priv *priv, 4042fcb64c0fSEli Cohen struct tc_cls_matchall_offload *ma) 4043fcb64c0fSEli Cohen { 4044fcb64c0fSEli Cohen struct netlink_ext_ack *extack = ma->common.extack; 4045fcb64c0fSEli Cohen 40467b83355fSEli Cohen if (ma->common.prio != 1) { 4047fcb64c0fSEli Cohen NL_SET_ERR_MSG_MOD(extack, "only priority 1 is supported"); 4048fcb64c0fSEli Cohen return -EINVAL; 4049fcb64c0fSEli Cohen } 4050fcb64c0fSEli Cohen 4051fcb64c0fSEli Cohen return scan_tc_matchall_fdb_actions(priv, &ma->rule->action, extack); 4052fcb64c0fSEli Cohen } 4053fcb64c0fSEli Cohen 4054fcb64c0fSEli Cohen int mlx5e_tc_delete_matchall(struct mlx5e_priv *priv, 4055fcb64c0fSEli Cohen struct tc_cls_matchall_offload *ma) 4056fcb64c0fSEli Cohen { 4057fcb64c0fSEli Cohen struct netlink_ext_ack *extack = ma->common.extack; 4058fcb64c0fSEli Cohen 4059fcb64c0fSEli Cohen return apply_police_params(priv, 0, extack); 4060fcb64c0fSEli Cohen } 4061fcb64c0fSEli Cohen 4062fcb64c0fSEli Cohen void mlx5e_tc_stats_matchall(struct mlx5e_priv *priv, 4063fcb64c0fSEli Cohen struct tc_cls_matchall_offload *ma) 4064fcb64c0fSEli Cohen { 4065fcb64c0fSEli Cohen struct mlx5e_rep_priv *rpriv = priv->ppriv; 4066fcb64c0fSEli Cohen struct rtnl_link_stats64 cur_stats; 4067fcb64c0fSEli Cohen u64 dbytes; 4068fcb64c0fSEli Cohen u64 dpkts; 4069fcb64c0fSEli Cohen 4070fcb64c0fSEli Cohen cur_stats = priv->stats.vf_vport; 4071fcb64c0fSEli Cohen dpkts = cur_stats.rx_packets - rpriv->prev_vf_vport_stats.rx_packets; 4072fcb64c0fSEli Cohen dbytes = cur_stats.rx_bytes - rpriv->prev_vf_vport_stats.rx_bytes; 4073fcb64c0fSEli Cohen rpriv->prev_vf_vport_stats = cur_stats; 4074fcb64c0fSEli Cohen flow_stats_update(&ma->stats, dpkts, dbytes, jiffies); 4075fcb64c0fSEli Cohen } 4076fcb64c0fSEli Cohen 40774d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv, 40784d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv) 40794d8fcf21SAlaa Hleihel { 40804d8fcf21SAlaa Hleihel struct mlx5_core_dev *peer_mdev = peer_priv->mdev; 4081db76ca24SVlad Buslov struct mlx5e_hairpin_entry *hpe, *tmp; 4082db76ca24SVlad Buslov LIST_HEAD(init_wait_list); 40834d8fcf21SAlaa Hleihel u16 peer_vhca_id; 40844d8fcf21SAlaa Hleihel int bkt; 40854d8fcf21SAlaa Hleihel 40864d8fcf21SAlaa Hleihel if (!same_hw_devs(priv, peer_priv)) 40874d8fcf21SAlaa Hleihel return; 40884d8fcf21SAlaa Hleihel 40894d8fcf21SAlaa Hleihel peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 40904d8fcf21SAlaa Hleihel 4091b32accdaSVlad Buslov mutex_lock(&priv->fs.tc.hairpin_tbl_lock); 4092db76ca24SVlad Buslov hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) 4093db76ca24SVlad Buslov if (refcount_inc_not_zero(&hpe->refcnt)) 4094db76ca24SVlad Buslov list_add(&hpe->dead_peer_wait_list, &init_wait_list); 4095b32accdaSVlad Buslov mutex_unlock(&priv->fs.tc.hairpin_tbl_lock); 4096db76ca24SVlad Buslov 4097db76ca24SVlad Buslov list_for_each_entry_safe(hpe, tmp, &init_wait_list, dead_peer_wait_list) { 4098db76ca24SVlad Buslov wait_for_completion(&hpe->res_ready); 4099db76ca24SVlad Buslov if (!IS_ERR_OR_NULL(hpe->hp) && hpe->peer_vhca_id == peer_vhca_id) 4100db76ca24SVlad Buslov hpe->hp->pair->peer_gone = true; 4101db76ca24SVlad Buslov 4102db76ca24SVlad Buslov mlx5e_hairpin_put(priv, hpe); 4103db76ca24SVlad Buslov } 41044d8fcf21SAlaa Hleihel } 41054d8fcf21SAlaa Hleihel 41064d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this, 41074d8fcf21SAlaa Hleihel unsigned long event, void *ptr) 41084d8fcf21SAlaa Hleihel { 41094d8fcf21SAlaa Hleihel struct net_device *ndev = netdev_notifier_info_to_dev(ptr); 41104d8fcf21SAlaa Hleihel struct mlx5e_flow_steering *fs; 41114d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv; 41124d8fcf21SAlaa Hleihel struct mlx5e_tc_table *tc; 41134d8fcf21SAlaa Hleihel struct mlx5e_priv *priv; 41144d8fcf21SAlaa Hleihel 41154d8fcf21SAlaa Hleihel if (ndev->netdev_ops != &mlx5e_netdev_ops || 41164d8fcf21SAlaa Hleihel event != NETDEV_UNREGISTER || 41174d8fcf21SAlaa Hleihel ndev->reg_state == NETREG_REGISTERED) 41184d8fcf21SAlaa Hleihel return NOTIFY_DONE; 41194d8fcf21SAlaa Hleihel 41204d8fcf21SAlaa Hleihel tc = container_of(this, struct mlx5e_tc_table, netdevice_nb); 41214d8fcf21SAlaa Hleihel fs = container_of(tc, struct mlx5e_flow_steering, tc); 41224d8fcf21SAlaa Hleihel priv = container_of(fs, struct mlx5e_priv, fs); 41234d8fcf21SAlaa Hleihel peer_priv = netdev_priv(ndev); 41244d8fcf21SAlaa Hleihel if (priv == peer_priv || 41254d8fcf21SAlaa Hleihel !(priv->netdev->features & NETIF_F_HW_TC)) 41264d8fcf21SAlaa Hleihel return NOTIFY_DONE; 41274d8fcf21SAlaa Hleihel 41284d8fcf21SAlaa Hleihel mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv); 41294d8fcf21SAlaa Hleihel 41304d8fcf21SAlaa Hleihel return NOTIFY_DONE; 41314d8fcf21SAlaa Hleihel } 41324d8fcf21SAlaa Hleihel 4133655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv) 4134e8f887acSAmir Vadai { 4135acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 41364d8fcf21SAlaa Hleihel int err; 4137e8f887acSAmir Vadai 4138b6fac0b4SVlad Buslov mutex_init(&tc->t_lock); 4139d2faae25SVlad Buslov mutex_init(&tc->mod_hdr.lock); 4140dd58edc3SVlad Buslov hash_init(tc->mod_hdr.hlist); 4141b32accdaSVlad Buslov mutex_init(&tc->hairpin_tbl_lock); 41425c65c564SOr Gerlitz hash_init(tc->hairpin_tbl); 414311c9c548SOr Gerlitz 41444d8fcf21SAlaa Hleihel err = rhashtable_init(&tc->ht, &tc_ht_params); 41454d8fcf21SAlaa Hleihel if (err) 41464d8fcf21SAlaa Hleihel return err; 41474d8fcf21SAlaa Hleihel 41484d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event; 41494d8fcf21SAlaa Hleihel if (register_netdevice_notifier(&tc->netdevice_nb)) { 41504d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = NULL; 41514d8fcf21SAlaa Hleihel mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n"); 41524d8fcf21SAlaa Hleihel } 41534d8fcf21SAlaa Hleihel 41544d8fcf21SAlaa Hleihel return err; 4155e8f887acSAmir Vadai } 4156e8f887acSAmir Vadai 4157e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg) 4158e8f887acSAmir Vadai { 4159e8f887acSAmir Vadai struct mlx5e_tc_flow *flow = ptr; 4160655dc3d2SOr Gerlitz struct mlx5e_priv *priv = flow->priv; 4161e8f887acSAmir Vadai 4162961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 4163e8f887acSAmir Vadai kfree(flow); 4164e8f887acSAmir Vadai } 4165e8f887acSAmir Vadai 4166655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv) 4167e8f887acSAmir Vadai { 4168acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 4169e8f887acSAmir Vadai 41704d8fcf21SAlaa Hleihel if (tc->netdevice_nb.notifier_call) 41714d8fcf21SAlaa Hleihel unregister_netdevice_notifier(&tc->netdevice_nb); 41724d8fcf21SAlaa Hleihel 4173d2faae25SVlad Buslov mutex_destroy(&tc->mod_hdr.lock); 4174b32accdaSVlad Buslov mutex_destroy(&tc->hairpin_tbl_lock); 4175b32accdaSVlad Buslov 4176d9ee0491SOr Gerlitz rhashtable_destroy(&tc->ht); 4177e8f887acSAmir Vadai 4178acff797cSMaor Gottlieb if (!IS_ERR_OR_NULL(tc->t)) { 4179acff797cSMaor Gottlieb mlx5_destroy_flow_table(tc->t); 4180acff797cSMaor Gottlieb tc->t = NULL; 4181e8f887acSAmir Vadai } 4182b6fac0b4SVlad Buslov mutex_destroy(&tc->t_lock); 4183e8f887acSAmir Vadai } 4184655dc3d2SOr Gerlitz 4185655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht) 4186655dc3d2SOr Gerlitz { 4187655dc3d2SOr Gerlitz return rhashtable_init(tc_ht, &tc_ht_params); 4188655dc3d2SOr Gerlitz } 4189655dc3d2SOr Gerlitz 4190655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht) 4191655dc3d2SOr Gerlitz { 4192655dc3d2SOr Gerlitz rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL); 4193655dc3d2SOr Gerlitz } 419401252a27SOr Gerlitz 4195226f2ca3SVlad Buslov int mlx5e_tc_num_filters(struct mlx5e_priv *priv, unsigned long flags) 419601252a27SOr Gerlitz { 4197d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 419801252a27SOr Gerlitz 419901252a27SOr Gerlitz return atomic_read(&tc_ht->nelems); 420001252a27SOr Gerlitz } 420104de7ddaSRoi Dayan 420204de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw) 420304de7ddaSRoi Dayan { 420404de7ddaSRoi Dayan struct mlx5e_tc_flow *flow, *tmp; 420504de7ddaSRoi Dayan 420604de7ddaSRoi Dayan list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer) 420704de7ddaSRoi Dayan __mlx5e_tc_del_fdb_peer_flow(flow); 420804de7ddaSRoi Dayan } 4209b4a23329SRoi Dayan 4210b4a23329SRoi Dayan void mlx5e_tc_reoffload_flows_work(struct work_struct *work) 4211b4a23329SRoi Dayan { 4212b4a23329SRoi Dayan struct mlx5_rep_uplink_priv *rpriv = 4213b4a23329SRoi Dayan container_of(work, struct mlx5_rep_uplink_priv, 4214b4a23329SRoi Dayan reoffload_flows_work); 4215b4a23329SRoi Dayan struct mlx5e_tc_flow *flow, *tmp; 4216b4a23329SRoi Dayan 4217ad86755bSVlad Buslov mutex_lock(&rpriv->unready_flows_lock); 4218b4a23329SRoi Dayan list_for_each_entry_safe(flow, tmp, &rpriv->unready_flows, unready) { 4219b4a23329SRoi Dayan if (!mlx5e_tc_add_fdb_flow(flow->priv, flow, NULL)) 4220ad86755bSVlad Buslov unready_flow_del(flow); 4221b4a23329SRoi Dayan } 4222ad86755bSVlad Buslov mutex_unlock(&rpriv->unready_flows_lock); 4223b4a23329SRoi Dayan } 4224