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> 4103a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h> 42776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h> 43bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h> 44d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h> 4526c02749SOr Gerlitz #include <net/tc_act/tc_csum.h> 46f6dfb4c3SHadar Hen Zion #include <net/arp.h> 473616d08bSDavid Ahern #include <net/ipv6_stubs.h> 48e8f887acSAmir Vadai #include "en.h" 491d447a39SSaeed Mahameed #include "en_rep.h" 50232c0013SHadar Hen Zion #include "en_tc.h" 5103a9d11eSOr Gerlitz #include "eswitch.h" 523f6d08d1SOr Gerlitz #include "fs_core.h" 532c81bfd5SHuy Nguyen #include "en/port.h" 54101f4de9SOz Shlomo #include "en/tc_tun.h" 5504de7ddaSRoi Dayan #include "lib/devcom.h" 56e8f887acSAmir Vadai 573bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr { 583bc4b7bfSOr Gerlitz u32 action; 593bc4b7bfSOr Gerlitz u32 flow_tag; 602f4fe4caSOr Gerlitz u32 mod_hdr_id; 615c65c564SOr Gerlitz u32 hairpin_tirn; 6238aa51c1SOr Gerlitz u8 match_level; 633f6d08d1SOr Gerlitz struct mlx5_flow_table *hairpin_ft; 64b8aee822SMark Bloch struct mlx5_fc *counter; 653bc4b7bfSOr Gerlitz }; 663bc4b7bfSOr Gerlitz 6760bd4af8SOr Gerlitz #define MLX5E_TC_FLOW_BASE (MLX5E_TC_LAST_EXPORTED_BIT + 1) 6860bd4af8SOr Gerlitz 6965ba8fb7SOr Gerlitz enum { 7060bd4af8SOr Gerlitz MLX5E_TC_FLOW_INGRESS = MLX5E_TC_INGRESS, 7160bd4af8SOr Gerlitz MLX5E_TC_FLOW_EGRESS = MLX5E_TC_EGRESS, 72d9ee0491SOr Gerlitz MLX5E_TC_FLOW_ESWITCH = MLX5E_TC_ESW_OFFLOAD, 73d9ee0491SOr Gerlitz MLX5E_TC_FLOW_NIC = MLX5E_TC_NIC_OFFLOAD, 74d9ee0491SOr Gerlitz MLX5E_TC_FLOW_OFFLOADED = BIT(MLX5E_TC_FLOW_BASE), 75d9ee0491SOr Gerlitz MLX5E_TC_FLOW_HAIRPIN = BIT(MLX5E_TC_FLOW_BASE + 1), 76d9ee0491SOr Gerlitz MLX5E_TC_FLOW_HAIRPIN_RSS = BIT(MLX5E_TC_FLOW_BASE + 2), 77d9ee0491SOr Gerlitz MLX5E_TC_FLOW_SLOW = BIT(MLX5E_TC_FLOW_BASE + 3), 78d9ee0491SOr Gerlitz MLX5E_TC_FLOW_DUP = BIT(MLX5E_TC_FLOW_BASE + 4), 79ef06c9eeSRoi Dayan MLX5E_TC_FLOW_NOT_READY = BIT(MLX5E_TC_FLOW_BASE + 5), 8065ba8fb7SOr Gerlitz }; 8165ba8fb7SOr Gerlitz 82e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1 83e4ad91f2SChris Mi 8479baaec7SEli Britstein /* Helper struct for accessing a struct containing list_head array. 8579baaec7SEli Britstein * Containing struct 8679baaec7SEli Britstein * |- Helper array 8779baaec7SEli Britstein * [0] Helper item 0 8879baaec7SEli Britstein * |- list_head item 0 8979baaec7SEli Britstein * |- index (0) 9079baaec7SEli Britstein * [1] Helper item 1 9179baaec7SEli Britstein * |- list_head item 1 9279baaec7SEli Britstein * |- index (1) 9379baaec7SEli Britstein * To access the containing struct from one of the list_head items: 9479baaec7SEli Britstein * 1. Get the helper item from the list_head item using 9579baaec7SEli Britstein * helper item = 9679baaec7SEli Britstein * container_of(list_head item, helper struct type, list_head field) 9779baaec7SEli Britstein * 2. Get the contining struct from the helper item and its index in the array: 9879baaec7SEli Britstein * containing struct = 9979baaec7SEli Britstein * container_of(helper item, containing struct type, helper field[index]) 10079baaec7SEli Britstein */ 10179baaec7SEli Britstein struct encap_flow_item { 10279baaec7SEli Britstein struct list_head list; 10379baaec7SEli Britstein int index; 10479baaec7SEli Britstein }; 10579baaec7SEli Britstein 106e8f887acSAmir Vadai struct mlx5e_tc_flow { 107e8f887acSAmir Vadai struct rhash_head node; 108655dc3d2SOr Gerlitz struct mlx5e_priv *priv; 109e8f887acSAmir Vadai u64 cookie; 1105dbe906fSPaul Blakey u16 flags; 111e4ad91f2SChris Mi struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1]; 11279baaec7SEli Britstein /* Flow can be associated with multiple encap IDs. 11379baaec7SEli Britstein * The number of encaps is bounded by the number of supported 11479baaec7SEli Britstein * destinations. 11579baaec7SEli Britstein */ 11679baaec7SEli Britstein struct encap_flow_item encaps[MLX5_MAX_FLOW_FWD_VPORTS]; 11704de7ddaSRoi Dayan struct mlx5e_tc_flow *peer_flow; 11811c9c548SOr Gerlitz struct list_head mod_hdr; /* flows sharing the same mod hdr ID */ 1195c65c564SOr Gerlitz struct list_head hairpin; /* flows sharing the same hairpin */ 12004de7ddaSRoi Dayan struct list_head peer; /* flows with peer flow */ 121b4a23329SRoi Dayan struct list_head unready; /* flows not ready to be offloaded (e.g due to missing route) */ 1223bc4b7bfSOr Gerlitz union { 123ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr esw_attr[0]; 1243bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr nic_attr[0]; 1253bc4b7bfSOr Gerlitz }; 126e8f887acSAmir Vadai }; 127e8f887acSAmir Vadai 12817091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr { 12998b66cb1SEli Britstein struct ip_tunnel_info tun_info[MLX5_MAX_FLOW_FWD_VPORTS]; 130d11afc26SOz Shlomo struct net_device *filter_dev; 13117091853SOr Gerlitz struct mlx5_flow_spec spec; 132d79b6df6SOr Gerlitz int num_mod_hdr_actions; 133218d05ceSTonghao Zhang int max_mod_hdr_actions; 134d79b6df6SOr Gerlitz void *mod_hdr_actions; 13598b66cb1SEli Britstein int mirred_ifindex[MLX5_MAX_FLOW_FWD_VPORTS]; 13617091853SOr Gerlitz }; 13717091853SOr Gerlitz 138acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4 139b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16) 140e8f887acSAmir Vadai 14177ab67b7SOr Gerlitz struct mlx5e_hairpin { 14277ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 14377ab67b7SOr Gerlitz 14477ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev; 1453f6d08d1SOr Gerlitz struct mlx5e_priv *func_priv; 14677ab67b7SOr Gerlitz u32 tdn; 14777ab67b7SOr Gerlitz u32 tirn; 1483f6d08d1SOr Gerlitz 1493f6d08d1SOr Gerlitz int num_channels; 1503f6d08d1SOr Gerlitz struct mlx5e_rqt indir_rqt; 1513f6d08d1SOr Gerlitz u32 indir_tirn[MLX5E_NUM_INDIR_TIRS]; 1523f6d08d1SOr Gerlitz struct mlx5e_ttc_table ttc; 15377ab67b7SOr Gerlitz }; 15477ab67b7SOr Gerlitz 1555c65c564SOr Gerlitz struct mlx5e_hairpin_entry { 1565c65c564SOr Gerlitz /* a node of a hash table which keeps all the hairpin entries */ 1575c65c564SOr Gerlitz struct hlist_node hairpin_hlist; 1585c65c564SOr Gerlitz 1595c65c564SOr Gerlitz /* flows sharing the same hairpin */ 1605c65c564SOr Gerlitz struct list_head flows; 1615c65c564SOr Gerlitz 162d8822868SOr Gerlitz u16 peer_vhca_id; 163106be53bSOr Gerlitz u8 prio; 1645c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 1655c65c564SOr Gerlitz }; 1665c65c564SOr Gerlitz 16711c9c548SOr Gerlitz struct mod_hdr_key { 16811c9c548SOr Gerlitz int num_actions; 16911c9c548SOr Gerlitz void *actions; 17011c9c548SOr Gerlitz }; 17111c9c548SOr Gerlitz 17211c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry { 17311c9c548SOr Gerlitz /* a node of a hash table which keeps all the mod_hdr entries */ 17411c9c548SOr Gerlitz struct hlist_node mod_hdr_hlist; 17511c9c548SOr Gerlitz 17611c9c548SOr Gerlitz /* flows sharing the same mod_hdr entry */ 17711c9c548SOr Gerlitz struct list_head flows; 17811c9c548SOr Gerlitz 17911c9c548SOr Gerlitz struct mod_hdr_key key; 18011c9c548SOr Gerlitz 18111c9c548SOr Gerlitz u32 mod_hdr_id; 18211c9c548SOr Gerlitz }; 18311c9c548SOr Gerlitz 18411c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto) 18511c9c548SOr Gerlitz 18611c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key) 18711c9c548SOr Gerlitz { 18811c9c548SOr Gerlitz return jhash(key->actions, 18911c9c548SOr Gerlitz key->num_actions * MLX5_MH_ACT_SZ, 0); 19011c9c548SOr Gerlitz } 19111c9c548SOr Gerlitz 19211c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a, 19311c9c548SOr Gerlitz struct mod_hdr_key *b) 19411c9c548SOr Gerlitz { 19511c9c548SOr Gerlitz if (a->num_actions != b->num_actions) 19611c9c548SOr Gerlitz return 1; 19711c9c548SOr Gerlitz 19811c9c548SOr Gerlitz return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ); 19911c9c548SOr Gerlitz } 20011c9c548SOr Gerlitz 20111c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv, 20211c9c548SOr Gerlitz struct mlx5e_tc_flow *flow, 20311c9c548SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 20411c9c548SOr Gerlitz { 20511c9c548SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 20611c9c548SOr Gerlitz int num_actions, actions_size, namespace, err; 20711c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 20811c9c548SOr Gerlitz struct mod_hdr_key key; 20911c9c548SOr Gerlitz bool found = false; 21011c9c548SOr Gerlitz u32 hash_key; 21111c9c548SOr Gerlitz 21211c9c548SOr Gerlitz num_actions = parse_attr->num_mod_hdr_actions; 21311c9c548SOr Gerlitz actions_size = MLX5_MH_ACT_SZ * num_actions; 21411c9c548SOr Gerlitz 21511c9c548SOr Gerlitz key.actions = parse_attr->mod_hdr_actions; 21611c9c548SOr Gerlitz key.num_actions = num_actions; 21711c9c548SOr Gerlitz 21811c9c548SOr Gerlitz hash_key = hash_mod_hdr_info(&key); 21911c9c548SOr Gerlitz 22011c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 22111c9c548SOr Gerlitz namespace = MLX5_FLOW_NAMESPACE_FDB; 22211c9c548SOr Gerlitz hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh, 22311c9c548SOr Gerlitz mod_hdr_hlist, hash_key) { 22411c9c548SOr Gerlitz if (!cmp_mod_hdr_info(&mh->key, &key)) { 22511c9c548SOr Gerlitz found = true; 22611c9c548SOr Gerlitz break; 22711c9c548SOr Gerlitz } 22811c9c548SOr Gerlitz } 22911c9c548SOr Gerlitz } else { 23011c9c548SOr Gerlitz namespace = MLX5_FLOW_NAMESPACE_KERNEL; 23111c9c548SOr Gerlitz hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh, 23211c9c548SOr Gerlitz mod_hdr_hlist, hash_key) { 23311c9c548SOr Gerlitz if (!cmp_mod_hdr_info(&mh->key, &key)) { 23411c9c548SOr Gerlitz found = true; 23511c9c548SOr Gerlitz break; 23611c9c548SOr Gerlitz } 23711c9c548SOr Gerlitz } 23811c9c548SOr Gerlitz } 23911c9c548SOr Gerlitz 24011c9c548SOr Gerlitz if (found) 24111c9c548SOr Gerlitz goto attach_flow; 24211c9c548SOr Gerlitz 24311c9c548SOr Gerlitz mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL); 24411c9c548SOr Gerlitz if (!mh) 24511c9c548SOr Gerlitz return -ENOMEM; 24611c9c548SOr Gerlitz 24711c9c548SOr Gerlitz mh->key.actions = (void *)mh + sizeof(*mh); 24811c9c548SOr Gerlitz memcpy(mh->key.actions, key.actions, actions_size); 24911c9c548SOr Gerlitz mh->key.num_actions = num_actions; 25011c9c548SOr Gerlitz INIT_LIST_HEAD(&mh->flows); 25111c9c548SOr Gerlitz 25211c9c548SOr Gerlitz err = mlx5_modify_header_alloc(priv->mdev, namespace, 25311c9c548SOr Gerlitz mh->key.num_actions, 25411c9c548SOr Gerlitz mh->key.actions, 25511c9c548SOr Gerlitz &mh->mod_hdr_id); 25611c9c548SOr Gerlitz if (err) 25711c9c548SOr Gerlitz goto out_err; 25811c9c548SOr Gerlitz 25911c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 26011c9c548SOr Gerlitz hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key); 26111c9c548SOr Gerlitz else 26211c9c548SOr Gerlitz hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key); 26311c9c548SOr Gerlitz 26411c9c548SOr Gerlitz attach_flow: 26511c9c548SOr Gerlitz list_add(&flow->mod_hdr, &mh->flows); 26611c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 26711c9c548SOr Gerlitz flow->esw_attr->mod_hdr_id = mh->mod_hdr_id; 26811c9c548SOr Gerlitz else 26911c9c548SOr Gerlitz flow->nic_attr->mod_hdr_id = mh->mod_hdr_id; 27011c9c548SOr Gerlitz 27111c9c548SOr Gerlitz return 0; 27211c9c548SOr Gerlitz 27311c9c548SOr Gerlitz out_err: 27411c9c548SOr Gerlitz kfree(mh); 27511c9c548SOr Gerlitz return err; 27611c9c548SOr Gerlitz } 27711c9c548SOr Gerlitz 27811c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv, 27911c9c548SOr Gerlitz struct mlx5e_tc_flow *flow) 28011c9c548SOr Gerlitz { 28111c9c548SOr Gerlitz struct list_head *next = flow->mod_hdr.next; 28211c9c548SOr Gerlitz 28311c9c548SOr Gerlitz list_del(&flow->mod_hdr); 28411c9c548SOr Gerlitz 28511c9c548SOr Gerlitz if (list_empty(next)) { 28611c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 28711c9c548SOr Gerlitz 28811c9c548SOr Gerlitz mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows); 28911c9c548SOr Gerlitz 29011c9c548SOr Gerlitz mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id); 29111c9c548SOr Gerlitz hash_del(&mh->mod_hdr_hlist); 29211c9c548SOr Gerlitz kfree(mh); 29311c9c548SOr Gerlitz } 29411c9c548SOr Gerlitz } 29511c9c548SOr Gerlitz 29677ab67b7SOr Gerlitz static 29777ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex) 29877ab67b7SOr Gerlitz { 29977ab67b7SOr Gerlitz struct net_device *netdev; 30077ab67b7SOr Gerlitz struct mlx5e_priv *priv; 30177ab67b7SOr Gerlitz 30277ab67b7SOr Gerlitz netdev = __dev_get_by_index(net, ifindex); 30377ab67b7SOr Gerlitz priv = netdev_priv(netdev); 30477ab67b7SOr Gerlitz return priv->mdev; 30577ab67b7SOr Gerlitz } 30677ab67b7SOr Gerlitz 30777ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp) 30877ab67b7SOr Gerlitz { 30977ab67b7SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0}; 31077ab67b7SOr Gerlitz void *tirc; 31177ab67b7SOr Gerlitz int err; 31277ab67b7SOr Gerlitz 31377ab67b7SOr Gerlitz err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn); 31477ab67b7SOr Gerlitz if (err) 31577ab67b7SOr Gerlitz goto alloc_tdn_err; 31677ab67b7SOr Gerlitz 31777ab67b7SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 31877ab67b7SOr Gerlitz 31977ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT); 320ddae74acSOr Gerlitz MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]); 32177ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 32277ab67b7SOr Gerlitz 32377ab67b7SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn); 32477ab67b7SOr Gerlitz if (err) 32577ab67b7SOr Gerlitz goto create_tir_err; 32677ab67b7SOr Gerlitz 32777ab67b7SOr Gerlitz return 0; 32877ab67b7SOr Gerlitz 32977ab67b7SOr Gerlitz create_tir_err: 33077ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 33177ab67b7SOr Gerlitz alloc_tdn_err: 33277ab67b7SOr Gerlitz return err; 33377ab67b7SOr Gerlitz } 33477ab67b7SOr Gerlitz 33577ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp) 33677ab67b7SOr Gerlitz { 33777ab67b7SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->tirn); 33877ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 33977ab67b7SOr Gerlitz } 34077ab67b7SOr Gerlitz 3413f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc) 3423f6d08d1SOr Gerlitz { 3433f6d08d1SOr Gerlitz u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn; 3443f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3453f6d08d1SOr Gerlitz int i, ix, sz = MLX5E_INDIR_RQT_SIZE; 3463f6d08d1SOr Gerlitz 3473f6d08d1SOr Gerlitz mlx5e_build_default_indir_rqt(indirection_rqt, sz, 3483f6d08d1SOr Gerlitz hp->num_channels); 3493f6d08d1SOr Gerlitz 3503f6d08d1SOr Gerlitz for (i = 0; i < sz; i++) { 3513f6d08d1SOr Gerlitz ix = i; 352bbeb53b8SAya Levin if (priv->rss_params.hfunc == ETH_RSS_HASH_XOR) 3533f6d08d1SOr Gerlitz ix = mlx5e_bits_invert(i, ilog2(sz)); 3543f6d08d1SOr Gerlitz ix = indirection_rqt[ix]; 3553f6d08d1SOr Gerlitz rqn = hp->pair->rqn[ix]; 3563f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rq_num[i], rqn); 3573f6d08d1SOr Gerlitz } 3583f6d08d1SOr Gerlitz } 3593f6d08d1SOr Gerlitz 3603f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp) 3613f6d08d1SOr Gerlitz { 3623f6d08d1SOr Gerlitz int inlen, err, sz = MLX5E_INDIR_RQT_SIZE; 3633f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3643f6d08d1SOr Gerlitz struct mlx5_core_dev *mdev = priv->mdev; 3653f6d08d1SOr Gerlitz void *rqtc; 3663f6d08d1SOr Gerlitz u32 *in; 3673f6d08d1SOr Gerlitz 3683f6d08d1SOr Gerlitz inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz; 3693f6d08d1SOr Gerlitz in = kvzalloc(inlen, GFP_KERNEL); 3703f6d08d1SOr Gerlitz if (!in) 3713f6d08d1SOr Gerlitz return -ENOMEM; 3723f6d08d1SOr Gerlitz 3733f6d08d1SOr Gerlitz rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context); 3743f6d08d1SOr Gerlitz 3753f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_actual_size, sz); 3763f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_max_size, sz); 3773f6d08d1SOr Gerlitz 3783f6d08d1SOr Gerlitz mlx5e_hairpin_fill_rqt_rqns(hp, rqtc); 3793f6d08d1SOr Gerlitz 3803f6d08d1SOr Gerlitz err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn); 3813f6d08d1SOr Gerlitz if (!err) 3823f6d08d1SOr Gerlitz hp->indir_rqt.enabled = true; 3833f6d08d1SOr Gerlitz 3843f6d08d1SOr Gerlitz kvfree(in); 3853f6d08d1SOr Gerlitz return err; 3863f6d08d1SOr Gerlitz } 3873f6d08d1SOr Gerlitz 3883f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp) 3893f6d08d1SOr Gerlitz { 3903f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3913f6d08d1SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)]; 3923f6d08d1SOr Gerlitz int tt, i, err; 3933f6d08d1SOr Gerlitz void *tirc; 3943f6d08d1SOr Gerlitz 3953f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) { 396d930ac79SAya Levin struct mlx5e_tirc_config ttconfig = mlx5e_tirc_get_default_config(tt); 397d930ac79SAya Levin 3983f6d08d1SOr Gerlitz memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in)); 3993f6d08d1SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 4003f6d08d1SOr Gerlitz 4013f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 4023f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT); 4033f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn); 404bbeb53b8SAya Levin mlx5e_build_indir_tir_ctx_hash(&priv->rss_params, &ttconfig, tirc, false); 405bbeb53b8SAya Levin 4063f6d08d1SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, 4073f6d08d1SOr Gerlitz MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]); 4083f6d08d1SOr Gerlitz if (err) { 4093f6d08d1SOr Gerlitz mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err); 4103f6d08d1SOr Gerlitz goto err_destroy_tirs; 4113f6d08d1SOr Gerlitz } 4123f6d08d1SOr Gerlitz } 4133f6d08d1SOr Gerlitz return 0; 4143f6d08d1SOr Gerlitz 4153f6d08d1SOr Gerlitz err_destroy_tirs: 4163f6d08d1SOr Gerlitz for (i = 0; i < tt; i++) 4173f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]); 4183f6d08d1SOr Gerlitz return err; 4193f6d08d1SOr Gerlitz } 4203f6d08d1SOr Gerlitz 4213f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp) 4223f6d08d1SOr Gerlitz { 4233f6d08d1SOr Gerlitz int tt; 4243f6d08d1SOr Gerlitz 4253f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 4263f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]); 4273f6d08d1SOr Gerlitz } 4283f6d08d1SOr Gerlitz 4293f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp, 4303f6d08d1SOr Gerlitz struct ttc_params *ttc_params) 4313f6d08d1SOr Gerlitz { 4323f6d08d1SOr Gerlitz struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr; 4333f6d08d1SOr Gerlitz int tt; 4343f6d08d1SOr Gerlitz 4353f6d08d1SOr Gerlitz memset(ttc_params, 0, sizeof(*ttc_params)); 4363f6d08d1SOr Gerlitz 4373f6d08d1SOr Gerlitz ttc_params->any_tt_tirn = hp->tirn; 4383f6d08d1SOr Gerlitz 4393f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 4403f6d08d1SOr Gerlitz ttc_params->indir_tirn[tt] = hp->indir_tirn[tt]; 4413f6d08d1SOr Gerlitz 4423f6d08d1SOr Gerlitz ft_attr->max_fte = MLX5E_NUM_TT; 4433f6d08d1SOr Gerlitz ft_attr->level = MLX5E_TC_TTC_FT_LEVEL; 4443f6d08d1SOr Gerlitz ft_attr->prio = MLX5E_TC_PRIO; 4453f6d08d1SOr Gerlitz } 4463f6d08d1SOr Gerlitz 4473f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp) 4483f6d08d1SOr Gerlitz { 4493f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4503f6d08d1SOr Gerlitz struct ttc_params ttc_params; 4513f6d08d1SOr Gerlitz int err; 4523f6d08d1SOr Gerlitz 4533f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_rqt(hp); 4543f6d08d1SOr Gerlitz if (err) 4553f6d08d1SOr Gerlitz return err; 4563f6d08d1SOr Gerlitz 4573f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_tirs(hp); 4583f6d08d1SOr Gerlitz if (err) 4593f6d08d1SOr Gerlitz goto err_create_indirect_tirs; 4603f6d08d1SOr Gerlitz 4613f6d08d1SOr Gerlitz mlx5e_hairpin_set_ttc_params(hp, &ttc_params); 4623f6d08d1SOr Gerlitz err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc); 4633f6d08d1SOr Gerlitz if (err) 4643f6d08d1SOr Gerlitz goto err_create_ttc_table; 4653f6d08d1SOr Gerlitz 4663f6d08d1SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n", 4673f6d08d1SOr Gerlitz hp->num_channels, hp->ttc.ft.t->id); 4683f6d08d1SOr Gerlitz 4693f6d08d1SOr Gerlitz return 0; 4703f6d08d1SOr Gerlitz 4713f6d08d1SOr Gerlitz err_create_ttc_table: 4723f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 4733f6d08d1SOr Gerlitz err_create_indirect_tirs: 4743f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 4753f6d08d1SOr Gerlitz 4763f6d08d1SOr Gerlitz return err; 4773f6d08d1SOr Gerlitz } 4783f6d08d1SOr Gerlitz 4793f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp) 4803f6d08d1SOr Gerlitz { 4813f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4823f6d08d1SOr Gerlitz 4833f6d08d1SOr Gerlitz mlx5e_destroy_ttc_table(priv, &hp->ttc); 4843f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 4853f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 4863f6d08d1SOr Gerlitz } 4873f6d08d1SOr Gerlitz 48877ab67b7SOr Gerlitz static struct mlx5e_hairpin * 48977ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params, 49077ab67b7SOr Gerlitz int peer_ifindex) 49177ab67b7SOr Gerlitz { 49277ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev, *peer_mdev; 49377ab67b7SOr Gerlitz struct mlx5e_hairpin *hp; 49477ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 49577ab67b7SOr Gerlitz int err; 49677ab67b7SOr Gerlitz 49777ab67b7SOr Gerlitz hp = kzalloc(sizeof(*hp), GFP_KERNEL); 49877ab67b7SOr Gerlitz if (!hp) 49977ab67b7SOr Gerlitz return ERR_PTR(-ENOMEM); 50077ab67b7SOr Gerlitz 50177ab67b7SOr Gerlitz func_mdev = priv->mdev; 50277ab67b7SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 50377ab67b7SOr Gerlitz 50477ab67b7SOr Gerlitz pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params); 50577ab67b7SOr Gerlitz if (IS_ERR(pair)) { 50677ab67b7SOr Gerlitz err = PTR_ERR(pair); 50777ab67b7SOr Gerlitz goto create_pair_err; 50877ab67b7SOr Gerlitz } 50977ab67b7SOr Gerlitz hp->pair = pair; 51077ab67b7SOr Gerlitz hp->func_mdev = func_mdev; 5113f6d08d1SOr Gerlitz hp->func_priv = priv; 5123f6d08d1SOr Gerlitz hp->num_channels = params->num_channels; 51377ab67b7SOr Gerlitz 51477ab67b7SOr Gerlitz err = mlx5e_hairpin_create_transport(hp); 51577ab67b7SOr Gerlitz if (err) 51677ab67b7SOr Gerlitz goto create_transport_err; 51777ab67b7SOr Gerlitz 5183f6d08d1SOr Gerlitz if (hp->num_channels > 1) { 5193f6d08d1SOr Gerlitz err = mlx5e_hairpin_rss_init(hp); 5203f6d08d1SOr Gerlitz if (err) 5213f6d08d1SOr Gerlitz goto rss_init_err; 5223f6d08d1SOr Gerlitz } 5233f6d08d1SOr Gerlitz 52477ab67b7SOr Gerlitz return hp; 52577ab67b7SOr Gerlitz 5263f6d08d1SOr Gerlitz rss_init_err: 5273f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 52877ab67b7SOr Gerlitz create_transport_err: 52977ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 53077ab67b7SOr Gerlitz create_pair_err: 53177ab67b7SOr Gerlitz kfree(hp); 53277ab67b7SOr Gerlitz return ERR_PTR(err); 53377ab67b7SOr Gerlitz } 53477ab67b7SOr Gerlitz 53577ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp) 53677ab67b7SOr Gerlitz { 5373f6d08d1SOr Gerlitz if (hp->num_channels > 1) 5383f6d08d1SOr Gerlitz mlx5e_hairpin_rss_cleanup(hp); 53977ab67b7SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 54077ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 54177ab67b7SOr Gerlitz kvfree(hp); 54277ab67b7SOr Gerlitz } 54377ab67b7SOr Gerlitz 544106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio) 545106be53bSOr Gerlitz { 546106be53bSOr Gerlitz return (peer_vhca_id << 16 | prio); 547106be53bSOr Gerlitz } 548106be53bSOr Gerlitz 5495c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv, 550106be53bSOr Gerlitz u16 peer_vhca_id, u8 prio) 5515c65c564SOr Gerlitz { 5525c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 553106be53bSOr Gerlitz u32 hash_key = hash_hairpin_info(peer_vhca_id, prio); 5545c65c564SOr Gerlitz 5555c65c564SOr Gerlitz hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe, 556106be53bSOr Gerlitz hairpin_hlist, hash_key) { 557106be53bSOr Gerlitz if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio) 5585c65c564SOr Gerlitz return hpe; 5595c65c564SOr Gerlitz } 5605c65c564SOr Gerlitz 5615c65c564SOr Gerlitz return NULL; 5625c65c564SOr Gerlitz } 5635c65c564SOr Gerlitz 564106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8 565106be53bSOr Gerlitz 566106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv, 567e98bedf5SEli Britstein struct mlx5_flow_spec *spec, u8 *match_prio, 568e98bedf5SEli Britstein struct netlink_ext_ack *extack) 569106be53bSOr Gerlitz { 570106be53bSOr Gerlitz void *headers_c, *headers_v; 571106be53bSOr Gerlitz u8 prio_val, prio_mask = 0; 572106be53bSOr Gerlitz bool vlan_present; 573106be53bSOr Gerlitz 574106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB 575106be53bSOr Gerlitz if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) { 576e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 577e98bedf5SEli Britstein "only PCP trust state supported for hairpin"); 578106be53bSOr Gerlitz return -EOPNOTSUPP; 579106be53bSOr Gerlitz } 580106be53bSOr Gerlitz #endif 581106be53bSOr Gerlitz headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers); 582106be53bSOr Gerlitz headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers); 583106be53bSOr Gerlitz 584106be53bSOr Gerlitz vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag); 585106be53bSOr Gerlitz if (vlan_present) { 586106be53bSOr Gerlitz prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 587106be53bSOr Gerlitz prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 588106be53bSOr Gerlitz } 589106be53bSOr Gerlitz 590106be53bSOr Gerlitz if (!vlan_present || !prio_mask) { 591106be53bSOr Gerlitz prio_val = UNKNOWN_MATCH_PRIO; 592106be53bSOr Gerlitz } else if (prio_mask != 0x7) { 593e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 594e98bedf5SEli Britstein "masked priority match not supported for hairpin"); 595106be53bSOr Gerlitz return -EOPNOTSUPP; 596106be53bSOr Gerlitz } 597106be53bSOr Gerlitz 598106be53bSOr Gerlitz *match_prio = prio_val; 599106be53bSOr Gerlitz return 0; 600106be53bSOr Gerlitz } 601106be53bSOr Gerlitz 6025c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv, 6035c65c564SOr Gerlitz struct mlx5e_tc_flow *flow, 604e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 605e98bedf5SEli Britstein struct netlink_ext_ack *extack) 6065c65c564SOr Gerlitz { 60798b66cb1SEli Britstein int peer_ifindex = parse_attr->mirred_ifindex[0]; 6085c65c564SOr Gerlitz struct mlx5_hairpin_params params; 609d8822868SOr Gerlitz struct mlx5_core_dev *peer_mdev; 6105c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 6115c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 6123f6d08d1SOr Gerlitz u64 link_speed64; 6133f6d08d1SOr Gerlitz u32 link_speed; 614106be53bSOr Gerlitz u8 match_prio; 615d8822868SOr Gerlitz u16 peer_id; 6165c65c564SOr Gerlitz int err; 6175c65c564SOr Gerlitz 618d8822868SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 619d8822868SOr Gerlitz if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) { 620e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported"); 6215c65c564SOr Gerlitz return -EOPNOTSUPP; 6225c65c564SOr Gerlitz } 6235c65c564SOr Gerlitz 624d8822868SOr Gerlitz peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 625e98bedf5SEli Britstein err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio, 626e98bedf5SEli Britstein extack); 627106be53bSOr Gerlitz if (err) 628106be53bSOr Gerlitz return err; 629106be53bSOr Gerlitz hpe = mlx5e_hairpin_get(priv, peer_id, match_prio); 6305c65c564SOr Gerlitz if (hpe) 6315c65c564SOr Gerlitz goto attach_flow; 6325c65c564SOr Gerlitz 6335c65c564SOr Gerlitz hpe = kzalloc(sizeof(*hpe), GFP_KERNEL); 6345c65c564SOr Gerlitz if (!hpe) 6355c65c564SOr Gerlitz return -ENOMEM; 6365c65c564SOr Gerlitz 6375c65c564SOr Gerlitz INIT_LIST_HEAD(&hpe->flows); 638d8822868SOr Gerlitz hpe->peer_vhca_id = peer_id; 639106be53bSOr Gerlitz hpe->prio = match_prio; 6405c65c564SOr Gerlitz 6415c65c564SOr Gerlitz params.log_data_size = 15; 6425c65c564SOr Gerlitz params.log_data_size = min_t(u8, params.log_data_size, 6435c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz)); 6445c65c564SOr Gerlitz params.log_data_size = max_t(u8, params.log_data_size, 6455c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz)); 6465c65c564SOr Gerlitz 647eb9180f7SOr Gerlitz params.log_num_packets = params.log_data_size - 648eb9180f7SOr Gerlitz MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev); 649eb9180f7SOr Gerlitz params.log_num_packets = min_t(u8, params.log_num_packets, 650eb9180f7SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets)); 651eb9180f7SOr Gerlitz 652eb9180f7SOr Gerlitz params.q_counter = priv->q_counter; 6533f6d08d1SOr Gerlitz /* set hairpin pair per each 50Gbs share of the link */ 6542c81bfd5SHuy Nguyen mlx5e_port_max_linkspeed(priv->mdev, &link_speed); 6553f6d08d1SOr Gerlitz link_speed = max_t(u32, link_speed, 50000); 6563f6d08d1SOr Gerlitz link_speed64 = link_speed; 6573f6d08d1SOr Gerlitz do_div(link_speed64, 50000); 6583f6d08d1SOr Gerlitz params.num_channels = link_speed64; 6593f6d08d1SOr Gerlitz 6605c65c564SOr Gerlitz hp = mlx5e_hairpin_create(priv, ¶ms, peer_ifindex); 6615c65c564SOr Gerlitz if (IS_ERR(hp)) { 6625c65c564SOr Gerlitz err = PTR_ERR(hp); 6635c65c564SOr Gerlitz goto create_hairpin_err; 6645c65c564SOr Gerlitz } 6655c65c564SOr Gerlitz 666eb9180f7SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n", 66727b942fbSParav Pandit hp->tirn, hp->pair->rqn[0], 66827b942fbSParav Pandit dev_name(hp->pair->peer_mdev->device), 669eb9180f7SOr Gerlitz hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets); 6705c65c564SOr Gerlitz 6715c65c564SOr Gerlitz hpe->hp = hp; 672106be53bSOr Gerlitz hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist, 673106be53bSOr Gerlitz hash_hairpin_info(peer_id, match_prio)); 6745c65c564SOr Gerlitz 6755c65c564SOr Gerlitz attach_flow: 6763f6d08d1SOr Gerlitz if (hpe->hp->num_channels > 1) { 6773f6d08d1SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_HAIRPIN_RSS; 6783f6d08d1SOr Gerlitz flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t; 6793f6d08d1SOr Gerlitz } else { 6805c65c564SOr Gerlitz flow->nic_attr->hairpin_tirn = hpe->hp->tirn; 6813f6d08d1SOr Gerlitz } 6825c65c564SOr Gerlitz list_add(&flow->hairpin, &hpe->flows); 6833f6d08d1SOr Gerlitz 6845c65c564SOr Gerlitz return 0; 6855c65c564SOr Gerlitz 6865c65c564SOr Gerlitz create_hairpin_err: 6875c65c564SOr Gerlitz kfree(hpe); 6885c65c564SOr Gerlitz return err; 6895c65c564SOr Gerlitz } 6905c65c564SOr Gerlitz 6915c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv, 6925c65c564SOr Gerlitz struct mlx5e_tc_flow *flow) 6935c65c564SOr Gerlitz { 6945c65c564SOr Gerlitz struct list_head *next = flow->hairpin.next; 6955c65c564SOr Gerlitz 6965c65c564SOr Gerlitz list_del(&flow->hairpin); 6975c65c564SOr Gerlitz 6985c65c564SOr Gerlitz /* no more hairpin flows for us, release the hairpin pair */ 6995c65c564SOr Gerlitz if (list_empty(next)) { 7005c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 7015c65c564SOr Gerlitz 7025c65c564SOr Gerlitz hpe = list_entry(next, struct mlx5e_hairpin_entry, flows); 7035c65c564SOr Gerlitz 7045c65c564SOr Gerlitz netdev_dbg(priv->netdev, "del hairpin: peer %s\n", 70527b942fbSParav Pandit dev_name(hpe->hp->pair->peer_mdev->device)); 7065c65c564SOr Gerlitz 7075c65c564SOr Gerlitz mlx5e_hairpin_destroy(hpe->hp); 7085c65c564SOr Gerlitz hash_del(&hpe->hairpin_hlist); 7095c65c564SOr Gerlitz kfree(hpe); 7105c65c564SOr Gerlitz } 7115c65c564SOr Gerlitz } 7125c65c564SOr Gerlitz 713c83954abSRabie Loulou static int 71474491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv, 71517091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 716e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 717e98bedf5SEli Britstein struct netlink_ext_ack *extack) 718e8f887acSAmir Vadai { 719bb0ee7dcSJianbo Liu struct mlx5_flow_context *flow_context = &parse_attr->spec.flow_context; 720aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 721aad7e08dSAmir Vadai struct mlx5_core_dev *dev = priv->mdev; 7225c65c564SOr Gerlitz struct mlx5_flow_destination dest[2] = {}; 72366958ed9SHadar Hen Zion struct mlx5_flow_act flow_act = { 7243bc4b7bfSOr Gerlitz .action = attr->action, 72560786f09SMark Bloch .reformat_id = 0, 726bb0ee7dcSJianbo Liu .flags = FLOW_ACT_NO_APPEND, 72766958ed9SHadar Hen Zion }; 728aad7e08dSAmir Vadai struct mlx5_fc *counter = NULL; 729e8f887acSAmir Vadai bool table_created = false; 7305c65c564SOr Gerlitz int err, dest_ix = 0; 731e8f887acSAmir Vadai 732bb0ee7dcSJianbo Liu flow_context->flags |= FLOW_CONTEXT_HAS_TAG; 733bb0ee7dcSJianbo Liu flow_context->flow_tag = attr->flow_tag; 734bb0ee7dcSJianbo Liu 7355c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) { 736e98bedf5SEli Britstein err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack); 7375c65c564SOr Gerlitz if (err) { 7385c65c564SOr Gerlitz goto err_add_hairpin_flow; 7395c65c564SOr Gerlitz } 7403f6d08d1SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN_RSS) { 7413f6d08d1SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 7423f6d08d1SOr Gerlitz dest[dest_ix].ft = attr->hairpin_ft; 7433f6d08d1SOr Gerlitz } else { 7445c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR; 7455c65c564SOr Gerlitz dest[dest_ix].tir_num = attr->hairpin_tirn; 7463f6d08d1SOr Gerlitz } 7473f6d08d1SOr Gerlitz dest_ix++; 7483f6d08d1SOr Gerlitz } else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 7495c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 7505c65c564SOr Gerlitz dest[dest_ix].ft = priv->fs.vlan.ft.t; 7515c65c564SOr Gerlitz dest_ix++; 7525c65c564SOr Gerlitz } 753aad7e08dSAmir Vadai 7545c65c564SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 7555c65c564SOr Gerlitz counter = mlx5_fc_create(dev, true); 7565c65c564SOr Gerlitz if (IS_ERR(counter)) { 757c83954abSRabie Loulou err = PTR_ERR(counter); 7585c65c564SOr Gerlitz goto err_fc_create; 7595c65c564SOr Gerlitz } 7605c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER; 761171c7625SMark Bloch dest[dest_ix].counter_id = mlx5_fc_id(counter); 7625c65c564SOr Gerlitz dest_ix++; 763b8aee822SMark Bloch attr->counter = counter; 764aad7e08dSAmir Vadai } 765aad7e08dSAmir Vadai 7662f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 7673099eb5aSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 768d7e75a32SOr Gerlitz flow_act.modify_id = attr->mod_hdr_id; 7692f4fe4caSOr Gerlitz kfree(parse_attr->mod_hdr_actions); 770c83954abSRabie Loulou if (err) 7712f4fe4caSOr Gerlitz goto err_create_mod_hdr_id; 7722f4fe4caSOr Gerlitz } 7732f4fe4caSOr Gerlitz 774acff797cSMaor Gottlieb if (IS_ERR_OR_NULL(priv->fs.tc.t)) { 77521b9c144SOr Gerlitz int tc_grp_size, tc_tbl_size; 77621b9c144SOr Gerlitz u32 max_flow_counter; 77721b9c144SOr Gerlitz 77821b9c144SOr Gerlitz max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) | 77921b9c144SOr Gerlitz MLX5_CAP_GEN(dev, max_flow_counter_15_0); 78021b9c144SOr Gerlitz 78121b9c144SOr Gerlitz tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE); 78221b9c144SOr Gerlitz 78321b9c144SOr Gerlitz tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS, 78421b9c144SOr Gerlitz BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size))); 78521b9c144SOr Gerlitz 786acff797cSMaor Gottlieb priv->fs.tc.t = 787acff797cSMaor Gottlieb mlx5_create_auto_grouped_flow_table(priv->fs.ns, 788acff797cSMaor Gottlieb MLX5E_TC_PRIO, 78921b9c144SOr Gerlitz tc_tbl_size, 790acff797cSMaor Gottlieb MLX5E_TC_TABLE_NUM_GROUPS, 7913f6d08d1SOr Gerlitz MLX5E_TC_FT_LEVEL, 0); 792acff797cSMaor Gottlieb if (IS_ERR(priv->fs.tc.t)) { 793e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 794e98bedf5SEli Britstein "Failed to create tc offload table\n"); 795e8f887acSAmir Vadai netdev_err(priv->netdev, 796e8f887acSAmir Vadai "Failed to create tc offload table\n"); 797c83954abSRabie Loulou err = PTR_ERR(priv->fs.tc.t); 798aad7e08dSAmir Vadai goto err_create_ft; 799e8f887acSAmir Vadai } 800e8f887acSAmir Vadai 801e8f887acSAmir Vadai table_created = true; 802e8f887acSAmir Vadai } 803e8f887acSAmir Vadai 80438aa51c1SOr Gerlitz if (attr->match_level != MLX5_MATCH_NONE) 80517091853SOr Gerlitz parse_attr->spec.match_criteria_enable = MLX5_MATCH_OUTER_HEADERS; 80638aa51c1SOr Gerlitz 807c83954abSRabie Loulou flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec, 8085c65c564SOr Gerlitz &flow_act, dest, dest_ix); 809e8f887acSAmir Vadai 810c83954abSRabie Loulou if (IS_ERR(flow->rule[0])) { 811c83954abSRabie Loulou err = PTR_ERR(flow->rule[0]); 812aad7e08dSAmir Vadai goto err_add_rule; 813c83954abSRabie Loulou } 814aad7e08dSAmir Vadai 815c83954abSRabie Loulou return 0; 816aad7e08dSAmir Vadai 817aad7e08dSAmir Vadai err_add_rule: 818aad7e08dSAmir Vadai if (table_created) { 819acff797cSMaor Gottlieb mlx5_destroy_flow_table(priv->fs.tc.t); 820acff797cSMaor Gottlieb priv->fs.tc.t = NULL; 821e8f887acSAmir Vadai } 822aad7e08dSAmir Vadai err_create_ft: 8232f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 8243099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 8252f4fe4caSOr Gerlitz err_create_mod_hdr_id: 826aad7e08dSAmir Vadai mlx5_fc_destroy(dev, counter); 8275c65c564SOr Gerlitz err_fc_create: 8285c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) 8295c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 8305c65c564SOr Gerlitz err_add_hairpin_flow: 831c83954abSRabie Loulou return err; 832e8f887acSAmir Vadai } 833e8f887acSAmir Vadai 834d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv, 835d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 836d85cdccbSOr Gerlitz { 837513f8f7fSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 838d85cdccbSOr Gerlitz struct mlx5_fc *counter = NULL; 839d85cdccbSOr Gerlitz 840b8aee822SMark Bloch counter = attr->counter; 841e4ad91f2SChris Mi mlx5_del_flow_rules(flow->rule[0]); 842d85cdccbSOr Gerlitz mlx5_fc_destroy(priv->mdev, counter); 843d85cdccbSOr Gerlitz 844d9ee0491SOr Gerlitz if (!mlx5e_tc_num_filters(priv, MLX5E_TC_NIC_OFFLOAD) && priv->fs.tc.t) { 845d85cdccbSOr Gerlitz mlx5_destroy_flow_table(priv->fs.tc.t); 846d85cdccbSOr Gerlitz priv->fs.tc.t = NULL; 847d85cdccbSOr Gerlitz } 8482f4fe4caSOr Gerlitz 849513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 8503099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 8515c65c564SOr Gerlitz 8525c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) 8535c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 854d85cdccbSOr Gerlitz } 855d85cdccbSOr Gerlitz 856aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 8578c4dc42bSEli Britstein struct mlx5e_tc_flow *flow, int out_index); 858aa0cbbaeSOr Gerlitz 8593c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv, 860e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 861733d4f36SRoi Dayan struct net_device *mirred_dev, 862733d4f36SRoi Dayan int out_index, 8638c4dc42bSEli Britstein struct netlink_ext_ack *extack, 8640ad060eeSRoi Dayan struct net_device **encap_dev, 8650ad060eeSRoi Dayan bool *encap_valid); 8663c37745eSOr Gerlitz 8676d2a3ed0SOr Gerlitz static struct mlx5_flow_handle * 8686d2a3ed0SOr Gerlitz mlx5e_tc_offload_fdb_rules(struct mlx5_eswitch *esw, 8696d2a3ed0SOr Gerlitz struct mlx5e_tc_flow *flow, 8706d2a3ed0SOr Gerlitz struct mlx5_flow_spec *spec, 8716d2a3ed0SOr Gerlitz struct mlx5_esw_flow_attr *attr) 8726d2a3ed0SOr Gerlitz { 8736d2a3ed0SOr Gerlitz struct mlx5_flow_handle *rule; 8746d2a3ed0SOr Gerlitz 8756d2a3ed0SOr Gerlitz rule = mlx5_eswitch_add_offloaded_rule(esw, spec, attr); 8766d2a3ed0SOr Gerlitz if (IS_ERR(rule)) 8776d2a3ed0SOr Gerlitz return rule; 8786d2a3ed0SOr Gerlitz 879e85e02baSEli Britstein if (attr->split_count) { 8806d2a3ed0SOr Gerlitz flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, spec, attr); 8816d2a3ed0SOr Gerlitz if (IS_ERR(flow->rule[1])) { 8826d2a3ed0SOr Gerlitz mlx5_eswitch_del_offloaded_rule(esw, rule, attr); 8836d2a3ed0SOr Gerlitz return flow->rule[1]; 8846d2a3ed0SOr Gerlitz } 8856d2a3ed0SOr Gerlitz } 8866d2a3ed0SOr Gerlitz 8876d2a3ed0SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 8886d2a3ed0SOr Gerlitz return rule; 8896d2a3ed0SOr Gerlitz } 8906d2a3ed0SOr Gerlitz 8916d2a3ed0SOr Gerlitz static void 8926d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(struct mlx5_eswitch *esw, 8936d2a3ed0SOr Gerlitz struct mlx5e_tc_flow *flow, 8946d2a3ed0SOr Gerlitz struct mlx5_esw_flow_attr *attr) 8956d2a3ed0SOr Gerlitz { 8966d2a3ed0SOr Gerlitz flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED; 8976d2a3ed0SOr Gerlitz 898e85e02baSEli Britstein if (attr->split_count) 8996d2a3ed0SOr Gerlitz mlx5_eswitch_del_fwd_rule(esw, flow->rule[1], attr); 9006d2a3ed0SOr Gerlitz 9016d2a3ed0SOr Gerlitz mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr); 9026d2a3ed0SOr Gerlitz } 9036d2a3ed0SOr Gerlitz 9045dbe906fSPaul Blakey static struct mlx5_flow_handle * 9055dbe906fSPaul Blakey mlx5e_tc_offload_to_slow_path(struct mlx5_eswitch *esw, 9065dbe906fSPaul Blakey struct mlx5e_tc_flow *flow, 9075dbe906fSPaul Blakey struct mlx5_flow_spec *spec, 9085dbe906fSPaul Blakey struct mlx5_esw_flow_attr *slow_attr) 9095dbe906fSPaul Blakey { 9105dbe906fSPaul Blakey struct mlx5_flow_handle *rule; 9115dbe906fSPaul Blakey 9125dbe906fSPaul Blakey memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr)); 913154e62abSOr Gerlitz slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 9142be09de7SDavid S. Miller slow_attr->split_count = 0; 915154e62abSOr Gerlitz slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN; 9165dbe906fSPaul Blakey 9175dbe906fSPaul Blakey rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, slow_attr); 9185dbe906fSPaul Blakey if (!IS_ERR(rule)) 9195dbe906fSPaul Blakey flow->flags |= MLX5E_TC_FLOW_SLOW; 9205dbe906fSPaul Blakey 9215dbe906fSPaul Blakey return rule; 9225dbe906fSPaul Blakey } 9235dbe906fSPaul Blakey 9245dbe906fSPaul Blakey static void 9255dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(struct mlx5_eswitch *esw, 9265dbe906fSPaul Blakey struct mlx5e_tc_flow *flow, 9275dbe906fSPaul Blakey struct mlx5_esw_flow_attr *slow_attr) 9285dbe906fSPaul Blakey { 9295dbe906fSPaul Blakey memcpy(slow_attr, flow->esw_attr, sizeof(*slow_attr)); 930154e62abSOr Gerlitz slow_attr->action = MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 9312be09de7SDavid S. Miller slow_attr->split_count = 0; 932154e62abSOr Gerlitz slow_attr->dest_chain = FDB_SLOW_PATH_CHAIN; 9335dbe906fSPaul Blakey mlx5e_tc_unoffload_fdb_rules(esw, flow, slow_attr); 9345dbe906fSPaul Blakey flow->flags &= ~MLX5E_TC_FLOW_SLOW; 9355dbe906fSPaul Blakey } 9365dbe906fSPaul Blakey 937b4a23329SRoi Dayan static void add_unready_flow(struct mlx5e_tc_flow *flow) 938b4a23329SRoi Dayan { 939b4a23329SRoi Dayan struct mlx5_rep_uplink_priv *uplink_priv; 940b4a23329SRoi Dayan struct mlx5e_rep_priv *rpriv; 941b4a23329SRoi Dayan struct mlx5_eswitch *esw; 942b4a23329SRoi Dayan 943b4a23329SRoi Dayan esw = flow->priv->mdev->priv.eswitch; 944b4a23329SRoi Dayan rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 945b4a23329SRoi Dayan uplink_priv = &rpriv->uplink_priv; 946b4a23329SRoi Dayan 947b4a23329SRoi Dayan flow->flags |= MLX5E_TC_FLOW_NOT_READY; 948b4a23329SRoi Dayan list_add_tail(&flow->unready, &uplink_priv->unready_flows); 949b4a23329SRoi Dayan } 950b4a23329SRoi Dayan 951b4a23329SRoi Dayan static void remove_unready_flow(struct mlx5e_tc_flow *flow) 952b4a23329SRoi Dayan { 953b4a23329SRoi Dayan list_del(&flow->unready); 954b4a23329SRoi Dayan flow->flags &= ~MLX5E_TC_FLOW_NOT_READY; 955b4a23329SRoi Dayan } 956b4a23329SRoi Dayan 957c83954abSRabie Loulou static int 95874491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv, 959e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 960e98bedf5SEli Britstein struct netlink_ext_ack *extack) 961adb4c123SOr Gerlitz { 962adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 963bf07aa73SPaul Blakey u32 max_chain = mlx5_eswitch_get_chain_range(esw); 964aa0cbbaeSOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 9657040632dSTonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr; 966bf07aa73SPaul Blakey u16 max_prio = mlx5_eswitch_get_prio_range(esw); 9673c37745eSOr Gerlitz struct net_device *out_dev, *encap_dev = NULL; 968b8aee822SMark Bloch struct mlx5_fc *counter = NULL; 9693c37745eSOr Gerlitz struct mlx5e_rep_priv *rpriv; 9703c37745eSOr Gerlitz struct mlx5e_priv *out_priv; 9710ad060eeSRoi Dayan bool encap_valid = true; 9720ad060eeSRoi Dayan int err = 0; 973f493f155SEli Britstein int out_index; 9748b32580dSOr Gerlitz 975d14f6f2aSOr Gerlitz if (!mlx5_eswitch_prios_supported(esw) && attr->prio != 1) { 976d14f6f2aSOr Gerlitz NL_SET_ERR_MSG(extack, "E-switch priorities unsupported, upgrade FW"); 977d14f6f2aSOr Gerlitz return -EOPNOTSUPP; 978d14f6f2aSOr Gerlitz } 979e52c2802SPaul Blakey 980bf07aa73SPaul Blakey if (attr->chain > max_chain) { 981bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested chain is out of supported range"); 982bf07aa73SPaul Blakey err = -EOPNOTSUPP; 983bf07aa73SPaul Blakey goto err_max_prio_chain; 984bf07aa73SPaul Blakey } 985bf07aa73SPaul Blakey 986bf07aa73SPaul Blakey if (attr->prio > max_prio) { 987bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested priority is out of supported range"); 988bf07aa73SPaul Blakey err = -EOPNOTSUPP; 989bf07aa73SPaul Blakey goto err_max_prio_chain; 990bf07aa73SPaul Blakey } 991bf07aa73SPaul Blakey 992f493f155SEli Britstein for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) { 9938c4dc42bSEli Britstein int mirred_ifindex; 9948c4dc42bSEli Britstein 995f493f155SEli Britstein if (!(attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP)) 996f493f155SEli Britstein continue; 997f493f155SEli Britstein 9987040632dSTonghao Zhang mirred_ifindex = parse_attr->mirred_ifindex[out_index]; 9993c37745eSOr Gerlitz out_dev = __dev_get_by_index(dev_net(priv->netdev), 10008c4dc42bSEli Britstein mirred_ifindex); 1001733d4f36SRoi Dayan err = mlx5e_attach_encap(priv, flow, out_dev, out_index, 10020ad060eeSRoi Dayan extack, &encap_dev, &encap_valid); 10030ad060eeSRoi Dayan if (err) 10043c37745eSOr Gerlitz goto err_attach_encap; 10050ad060eeSRoi Dayan 10063c37745eSOr Gerlitz out_priv = netdev_priv(encap_dev); 10073c37745eSOr Gerlitz rpriv = out_priv->ppriv; 10081cc26d74SEli Britstein attr->dests[out_index].rep = rpriv->rep; 10091cc26d74SEli Britstein attr->dests[out_index].mdev = out_priv->mdev; 10103c37745eSOr Gerlitz } 10113c37745eSOr Gerlitz 10128b32580dSOr Gerlitz err = mlx5_eswitch_add_vlan_action(esw, attr); 1013c83954abSRabie Loulou if (err) 1014aa0cbbaeSOr Gerlitz goto err_add_vlan; 1015adb4c123SOr Gerlitz 1016d7e75a32SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 10171a9527bbSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 1018d7e75a32SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 1019c83954abSRabie Loulou if (err) 1020d7e75a32SOr Gerlitz goto err_mod_hdr; 1021d7e75a32SOr Gerlitz } 1022d7e75a32SOr Gerlitz 1023b8aee822SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 1024f9392795SShahar Klein counter = mlx5_fc_create(attr->counter_dev, true); 1025b8aee822SMark Bloch if (IS_ERR(counter)) { 1026c83954abSRabie Loulou err = PTR_ERR(counter); 1027b8aee822SMark Bloch goto err_create_counter; 1028b8aee822SMark Bloch } 1029b8aee822SMark Bloch 1030b8aee822SMark Bloch attr->counter = counter; 1031b8aee822SMark Bloch } 1032b8aee822SMark Bloch 10330ad060eeSRoi Dayan /* we get here if one of the following takes place: 10340ad060eeSRoi Dayan * (1) there's no error 10350ad060eeSRoi Dayan * (2) there's an encap action and we don't have valid neigh 10363c37745eSOr Gerlitz */ 10370ad060eeSRoi Dayan if (!encap_valid) { 10385dbe906fSPaul Blakey /* continue with goto slow path rule instead */ 10395dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 10405dbe906fSPaul Blakey 10415dbe906fSPaul Blakey flow->rule[0] = mlx5e_tc_offload_to_slow_path(esw, flow, &parse_attr->spec, &slow_attr); 10425dbe906fSPaul Blakey } else { 10436d2a3ed0SOr Gerlitz flow->rule[0] = mlx5e_tc_offload_fdb_rules(esw, flow, &parse_attr->spec, attr); 10445dbe906fSPaul Blakey } 10455dbe906fSPaul Blakey 1046c83954abSRabie Loulou if (IS_ERR(flow->rule[0])) { 1047c83954abSRabie Loulou err = PTR_ERR(flow->rule[0]); 1048aa0cbbaeSOr Gerlitz goto err_add_rule; 1049c83954abSRabie Loulou } 1050c83954abSRabie Loulou 10515dbe906fSPaul Blakey return 0; 1052aa0cbbaeSOr Gerlitz 1053aa0cbbaeSOr Gerlitz err_add_rule: 1054f9392795SShahar Klein mlx5_fc_destroy(attr->counter_dev, counter); 1055b8aee822SMark Bloch err_create_counter: 1056513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 10571a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 1058d7e75a32SOr Gerlitz err_mod_hdr: 1059aa0cbbaeSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 1060aa0cbbaeSOr Gerlitz err_add_vlan: 1061f493f155SEli Britstein for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) 10628c4dc42bSEli Britstein if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP) 10638c4dc42bSEli Britstein mlx5e_detach_encap(priv, flow, out_index); 10643c37745eSOr Gerlitz err_attach_encap: 1065bf07aa73SPaul Blakey err_max_prio_chain: 1066c83954abSRabie Loulou return err; 1067aa0cbbaeSOr Gerlitz } 1068d85cdccbSOr Gerlitz 1069d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv, 1070d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 1071d85cdccbSOr Gerlitz { 1072d85cdccbSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 1073d7e75a32SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 10745dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 1075f493f155SEli Britstein int out_index; 1076d85cdccbSOr Gerlitz 1077ef06c9eeSRoi Dayan if (flow->flags & MLX5E_TC_FLOW_NOT_READY) { 1078b4a23329SRoi Dayan remove_unready_flow(flow); 1079ef06c9eeSRoi Dayan kvfree(attr->parse_attr); 1080ef06c9eeSRoi Dayan return; 1081ef06c9eeSRoi Dayan } 1082ef06c9eeSRoi Dayan 10835dbe906fSPaul Blakey if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 10845dbe906fSPaul Blakey if (flow->flags & MLX5E_TC_FLOW_SLOW) 10855dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr); 10865dbe906fSPaul Blakey else 10875dbe906fSPaul Blakey mlx5e_tc_unoffload_fdb_rules(esw, flow, attr); 10885dbe906fSPaul Blakey } 1089d85cdccbSOr Gerlitz 1090513f8f7fSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 1091d85cdccbSOr Gerlitz 1092f493f155SEli Britstein for (out_index = 0; out_index < MLX5_MAX_FLOW_FWD_VPORTS; out_index++) 10938c4dc42bSEli Britstein if (attr->dests[out_index].flags & MLX5_ESW_DEST_ENCAP) 10948c4dc42bSEli Britstein mlx5e_detach_encap(priv, flow, out_index); 1095f493f155SEli Britstein kvfree(attr->parse_attr); 1096d7e75a32SOr Gerlitz 1097513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 10981a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 1099b8aee822SMark Bloch 1100b8aee822SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) 1101f9392795SShahar Klein mlx5_fc_destroy(attr->counter_dev, attr->counter); 1102d85cdccbSOr Gerlitz } 1103d85cdccbSOr Gerlitz 1104232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv, 1105232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 1106232c0013SHadar Hen Zion { 11073c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 11085dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr, *esw_attr; 11096d2a3ed0SOr Gerlitz struct mlx5_flow_handle *rule; 11106d2a3ed0SOr Gerlitz struct mlx5_flow_spec *spec; 111179baaec7SEli Britstein struct encap_flow_item *efi; 1112232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 1113232c0013SHadar Hen Zion int err; 1114232c0013SHadar Hen Zion 111554c177caSOz Shlomo err = mlx5_packet_reformat_alloc(priv->mdev, 111654c177caSOz Shlomo e->reformat_type, 1117232c0013SHadar Hen Zion e->encap_size, e->encap_header, 111831ca3648SMark Bloch MLX5_FLOW_NAMESPACE_FDB, 1119232c0013SHadar Hen Zion &e->encap_id); 1120232c0013SHadar Hen Zion if (err) { 1121232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n", 1122232c0013SHadar Hen Zion err); 1123232c0013SHadar Hen Zion return; 1124232c0013SHadar Hen Zion } 1125232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 1126f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(priv); 1127232c0013SHadar Hen Zion 112879baaec7SEli Britstein list_for_each_entry(efi, &e->flows, list) { 11298c4dc42bSEli Britstein bool all_flow_encaps_valid = true; 11308c4dc42bSEli Britstein int i; 11318c4dc42bSEli Britstein 113279baaec7SEli Britstein flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]); 11333c37745eSOr Gerlitz esw_attr = flow->esw_attr; 11346d2a3ed0SOr Gerlitz spec = &esw_attr->parse_attr->spec; 11356d2a3ed0SOr Gerlitz 11368c4dc42bSEli Britstein esw_attr->dests[efi->index].encap_id = e->encap_id; 11378c4dc42bSEli Britstein esw_attr->dests[efi->index].flags |= MLX5_ESW_DEST_ENCAP_VALID; 11388c4dc42bSEli Britstein /* Flow can be associated with multiple encap entries. 11398c4dc42bSEli Britstein * Before offloading the flow verify that all of them have 11408c4dc42bSEli Britstein * a valid neighbour. 11418c4dc42bSEli Britstein */ 11428c4dc42bSEli Britstein for (i = 0; i < MLX5_MAX_FLOW_FWD_VPORTS; i++) { 11438c4dc42bSEli Britstein if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP)) 11448c4dc42bSEli Britstein continue; 11458c4dc42bSEli Britstein if (!(esw_attr->dests[i].flags & MLX5_ESW_DEST_ENCAP_VALID)) { 11468c4dc42bSEli Britstein all_flow_encaps_valid = false; 11478c4dc42bSEli Britstein break; 11488c4dc42bSEli Britstein } 11498c4dc42bSEli Britstein } 11508c4dc42bSEli Britstein /* Do not offload flows with unresolved neighbors */ 11518c4dc42bSEli Britstein if (!all_flow_encaps_valid) 11528c4dc42bSEli Britstein continue; 11535dbe906fSPaul Blakey /* update from slow path rule to encap rule */ 11546d2a3ed0SOr Gerlitz rule = mlx5e_tc_offload_fdb_rules(esw, flow, spec, esw_attr); 11556d2a3ed0SOr Gerlitz if (IS_ERR(rule)) { 11566d2a3ed0SOr Gerlitz err = PTR_ERR(rule); 1157232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n", 1158232c0013SHadar Hen Zion err); 1159232c0013SHadar Hen Zion continue; 1160232c0013SHadar Hen Zion } 11615dbe906fSPaul Blakey 11625dbe906fSPaul Blakey mlx5e_tc_unoffload_from_slow_path(esw, flow, &slow_attr); 11635dbe906fSPaul Blakey flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when slow path rule removed */ 11646d2a3ed0SOr Gerlitz flow->rule[0] = rule; 1165232c0013SHadar Hen Zion } 1166232c0013SHadar Hen Zion } 1167232c0013SHadar Hen Zion 1168232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv, 1169232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 1170232c0013SHadar Hen Zion { 11713c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 11725dbe906fSPaul Blakey struct mlx5_esw_flow_attr slow_attr; 11735dbe906fSPaul Blakey struct mlx5_flow_handle *rule; 11745dbe906fSPaul Blakey struct mlx5_flow_spec *spec; 117579baaec7SEli Britstein struct encap_flow_item *efi; 1176232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 11775dbe906fSPaul Blakey int err; 1178232c0013SHadar Hen Zion 117979baaec7SEli Britstein list_for_each_entry(efi, &e->flows, list) { 118079baaec7SEli Britstein flow = container_of(efi, struct mlx5e_tc_flow, encaps[efi->index]); 11815dbe906fSPaul Blakey spec = &flow->esw_attr->parse_attr->spec; 11825dbe906fSPaul Blakey 11835dbe906fSPaul Blakey /* update from encap rule to slow path rule */ 11845dbe906fSPaul Blakey rule = mlx5e_tc_offload_to_slow_path(esw, flow, spec, &slow_attr); 11858c4dc42bSEli Britstein /* mark the flow's encap dest as non-valid */ 11868c4dc42bSEli Britstein flow->esw_attr->dests[efi->index].flags &= ~MLX5_ESW_DEST_ENCAP_VALID; 11875dbe906fSPaul Blakey 11885dbe906fSPaul Blakey if (IS_ERR(rule)) { 11895dbe906fSPaul Blakey err = PTR_ERR(rule); 11905dbe906fSPaul Blakey mlx5_core_warn(priv->mdev, "Failed to update slow path (encap) flow, %d\n", 11915dbe906fSPaul Blakey err); 11925dbe906fSPaul Blakey continue; 11935dbe906fSPaul Blakey } 11945dbe906fSPaul Blakey 11956d2a3ed0SOr Gerlitz mlx5e_tc_unoffload_fdb_rules(esw, flow, flow->esw_attr); 11965dbe906fSPaul Blakey flow->flags |= MLX5E_TC_FLOW_OFFLOADED; /* was unset when fast path rule removed */ 11975dbe906fSPaul Blakey flow->rule[0] = rule; 1198232c0013SHadar Hen Zion } 1199232c0013SHadar Hen Zion 120061c806daSOr Gerlitz /* we know that the encap is valid */ 1201232c0013SHadar Hen Zion e->flags &= ~MLX5_ENCAP_ENTRY_VALID; 120260786f09SMark Bloch mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id); 1203232c0013SHadar Hen Zion } 1204232c0013SHadar Hen Zion 1205b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow) 1206b8aee822SMark Bloch { 1207b8aee822SMark Bloch if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 1208b8aee822SMark Bloch return flow->esw_attr->counter; 1209b8aee822SMark Bloch else 1210b8aee822SMark Bloch return flow->nic_attr->counter; 1211b8aee822SMark Bloch } 1212b8aee822SMark Bloch 1213f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe) 1214f6dfb4c3SHadar Hen Zion { 1215f6dfb4c3SHadar Hen Zion struct mlx5e_neigh *m_neigh = &nhe->m_neigh; 1216f6dfb4c3SHadar Hen Zion u64 bytes, packets, lastuse = 0; 1217f6dfb4c3SHadar Hen Zion struct mlx5e_tc_flow *flow; 1218f6dfb4c3SHadar Hen Zion struct mlx5e_encap_entry *e; 1219f6dfb4c3SHadar Hen Zion struct mlx5_fc *counter; 1220f6dfb4c3SHadar Hen Zion struct neigh_table *tbl; 1221f6dfb4c3SHadar Hen Zion bool neigh_used = false; 1222f6dfb4c3SHadar Hen Zion struct neighbour *n; 1223f6dfb4c3SHadar Hen Zion 1224f6dfb4c3SHadar Hen Zion if (m_neigh->family == AF_INET) 1225f6dfb4c3SHadar Hen Zion tbl = &arp_tbl; 1226f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6) 1227f6dfb4c3SHadar Hen Zion else if (m_neigh->family == AF_INET6) 1228423c9db2SOr Gerlitz tbl = &nd_tbl; 1229f6dfb4c3SHadar Hen Zion #endif 1230f6dfb4c3SHadar Hen Zion else 1231f6dfb4c3SHadar Hen Zion return; 1232f6dfb4c3SHadar Hen Zion 1233f6dfb4c3SHadar Hen Zion list_for_each_entry(e, &nhe->encap_list, encap_list) { 123479baaec7SEli Britstein struct encap_flow_item *efi; 1235f6dfb4c3SHadar Hen Zion if (!(e->flags & MLX5_ENCAP_ENTRY_VALID)) 1236f6dfb4c3SHadar Hen Zion continue; 123779baaec7SEli Britstein list_for_each_entry(efi, &e->flows, list) { 123879baaec7SEli Britstein flow = container_of(efi, struct mlx5e_tc_flow, 123979baaec7SEli Britstein encaps[efi->index]); 1240f6dfb4c3SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 1241b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 1242f6dfb4c3SHadar Hen Zion mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 1243f6dfb4c3SHadar Hen Zion if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) { 1244f6dfb4c3SHadar Hen Zion neigh_used = true; 1245f6dfb4c3SHadar Hen Zion break; 1246f6dfb4c3SHadar Hen Zion } 1247f6dfb4c3SHadar Hen Zion } 1248f6dfb4c3SHadar Hen Zion } 1249e36d4810SRoi Dayan if (neigh_used) 1250e36d4810SRoi Dayan break; 1251f6dfb4c3SHadar Hen Zion } 1252f6dfb4c3SHadar Hen Zion 1253f6dfb4c3SHadar Hen Zion if (neigh_used) { 1254f6dfb4c3SHadar Hen Zion nhe->reported_lastuse = jiffies; 1255f6dfb4c3SHadar Hen Zion 1256f6dfb4c3SHadar Hen Zion /* find the relevant neigh according to the cached device and 1257f6dfb4c3SHadar Hen Zion * dst ip pair 1258f6dfb4c3SHadar Hen Zion */ 1259f6dfb4c3SHadar Hen Zion n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev); 1260c7f7ba8dSRoi Dayan if (!n) 1261f6dfb4c3SHadar Hen Zion return; 1262f6dfb4c3SHadar Hen Zion 1263f6dfb4c3SHadar Hen Zion neigh_event_send(n, NULL); 1264f6dfb4c3SHadar Hen Zion neigh_release(n); 1265f6dfb4c3SHadar Hen Zion } 1266f6dfb4c3SHadar Hen Zion } 1267f6dfb4c3SHadar Hen Zion 1268d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 12698c4dc42bSEli Britstein struct mlx5e_tc_flow *flow, int out_index) 1270d85cdccbSOr Gerlitz { 12718c4dc42bSEli Britstein struct list_head *next = flow->encaps[out_index].list.next; 12725067b602SRoi Dayan 12738c4dc42bSEli Britstein list_del(&flow->encaps[out_index].list); 12745067b602SRoi Dayan if (list_empty(next)) { 1275c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 12765067b602SRoi Dayan 1277c1ae1152SOr Gerlitz e = list_entry(next, struct mlx5e_encap_entry, flows); 1278232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 1279232c0013SHadar Hen Zion 1280232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 128160786f09SMark Bloch mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id); 1282232c0013SHadar Hen Zion 1283cdc5a7f3SOr Gerlitz hash_del_rcu(&e->encap_hlist); 1284232c0013SHadar Hen Zion kfree(e->encap_header); 12855067b602SRoi Dayan kfree(e); 12865067b602SRoi Dayan } 12875067b602SRoi Dayan } 12885067b602SRoi Dayan 128904de7ddaSRoi Dayan static void __mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow) 129004de7ddaSRoi Dayan { 129104de7ddaSRoi Dayan struct mlx5_eswitch *esw = flow->priv->mdev->priv.eswitch; 129204de7ddaSRoi Dayan 129304de7ddaSRoi Dayan if (!(flow->flags & MLX5E_TC_FLOW_ESWITCH) || 129404de7ddaSRoi Dayan !(flow->flags & MLX5E_TC_FLOW_DUP)) 129504de7ddaSRoi Dayan return; 129604de7ddaSRoi Dayan 129704de7ddaSRoi Dayan mutex_lock(&esw->offloads.peer_mutex); 129804de7ddaSRoi Dayan list_del(&flow->peer); 129904de7ddaSRoi Dayan mutex_unlock(&esw->offloads.peer_mutex); 130004de7ddaSRoi Dayan 130104de7ddaSRoi Dayan flow->flags &= ~MLX5E_TC_FLOW_DUP; 130204de7ddaSRoi Dayan 130304de7ddaSRoi Dayan mlx5e_tc_del_fdb_flow(flow->peer_flow->priv, flow->peer_flow); 130404de7ddaSRoi Dayan kvfree(flow->peer_flow); 130504de7ddaSRoi Dayan flow->peer_flow = NULL; 130604de7ddaSRoi Dayan } 130704de7ddaSRoi Dayan 130804de7ddaSRoi Dayan static void mlx5e_tc_del_fdb_peer_flow(struct mlx5e_tc_flow *flow) 130904de7ddaSRoi Dayan { 131004de7ddaSRoi Dayan struct mlx5_core_dev *dev = flow->priv->mdev; 131104de7ddaSRoi Dayan struct mlx5_devcom *devcom = dev->priv.devcom; 131204de7ddaSRoi Dayan struct mlx5_eswitch *peer_esw; 131304de7ddaSRoi Dayan 131404de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 131504de7ddaSRoi Dayan if (!peer_esw) 131604de7ddaSRoi Dayan return; 131704de7ddaSRoi Dayan 131804de7ddaSRoi Dayan __mlx5e_tc_del_fdb_peer_flow(flow); 131904de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 132004de7ddaSRoi Dayan } 132104de7ddaSRoi Dayan 1322e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv, 1323961e8979SRoi Dayan struct mlx5e_tc_flow *flow) 1324e8f887acSAmir Vadai { 132504de7ddaSRoi Dayan if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 132604de7ddaSRoi Dayan mlx5e_tc_del_fdb_peer_flow(flow); 1327d85cdccbSOr Gerlitz mlx5e_tc_del_fdb_flow(priv, flow); 132804de7ddaSRoi Dayan } else { 1329d85cdccbSOr Gerlitz mlx5e_tc_del_nic_flow(priv, flow); 1330e8f887acSAmir Vadai } 133104de7ddaSRoi Dayan } 1332e8f887acSAmir Vadai 1333bbd00f7eSHadar Hen Zion 1334bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv, 1335bbd00f7eSHadar Hen Zion struct mlx5_flow_spec *spec, 133654c177caSOz Shlomo struct tc_cls_flower_offload *f, 13376363651dSOr Gerlitz struct net_device *filter_dev, u8 *match_level) 1338bbd00f7eSHadar Hen Zion { 1339e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1340bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1341bbd00f7eSHadar Hen Zion outer_headers); 1342bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1343bbd00f7eSHadar Hen Zion outer_headers); 13448f256622SPablo Neira Ayuso struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f); 13458f256622SPablo Neira Ayuso struct flow_match_control enc_control; 13468f256622SPablo Neira Ayuso int err; 1347bbd00f7eSHadar Hen Zion 1348101f4de9SOz Shlomo err = mlx5e_tc_tun_parse(filter_dev, priv, spec, f, 13496363651dSOr Gerlitz headers_c, headers_v, match_level); 135054c177caSOz Shlomo if (err) { 135154c177caSOz Shlomo NL_SET_ERR_MSG_MOD(extack, 135254c177caSOz Shlomo "failed to parse tunnel attributes"); 1353101f4de9SOz Shlomo return err; 1354bbd00f7eSHadar Hen Zion } 1355bbd00f7eSHadar Hen Zion 13568f256622SPablo Neira Ayuso flow_rule_match_enc_control(rule, &enc_control); 13578f256622SPablo Neira Ayuso 13588f256622SPablo Neira Ayuso if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 13598f256622SPablo Neira Ayuso struct flow_match_ipv4_addrs match; 13608f256622SPablo Neira Ayuso 13618f256622SPablo Neira Ayuso flow_rule_match_enc_ipv4_addrs(rule, &match); 1362bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1363bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 13648f256622SPablo Neira Ayuso ntohl(match.mask->src)); 1365bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1366bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 13678f256622SPablo Neira Ayuso ntohl(match.key->src)); 1368bbd00f7eSHadar Hen Zion 1369bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1370bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 13718f256622SPablo Neira Ayuso ntohl(match.mask->dst)); 1372bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1373bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 13748f256622SPablo Neira Ayuso ntohl(match.key->dst)); 1375bbd00f7eSHadar Hen Zion 1376bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 1377bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP); 13788f256622SPablo Neira Ayuso } else if (enc_control.key->addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 13798f256622SPablo Neira Ayuso struct flow_match_ipv6_addrs match; 138019f44401SOr Gerlitz 13818f256622SPablo Neira Ayuso flow_rule_match_enc_ipv6_addrs(rule, &match); 138219f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 138319f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 13848f256622SPablo Neira Ayuso &match.mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 138519f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 138619f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 13878f256622SPablo Neira Ayuso &match.key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 138819f44401SOr Gerlitz 138919f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 139019f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 13918f256622SPablo Neira Ayuso &match.mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 139219f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 139319f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 13948f256622SPablo Neira Ayuso &match.key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 139519f44401SOr Gerlitz 139619f44401SOr Gerlitz MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 139719f44401SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6); 13982e72eb43SOr Gerlitz } 1399bbd00f7eSHadar Hen Zion 14008f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) { 14018f256622SPablo Neira Ayuso struct flow_match_ip match; 1402bcef735cSOr Gerlitz 14038f256622SPablo Neira Ayuso flow_rule_match_enc_ip(rule, &match); 14048f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, 14058f256622SPablo Neira Ayuso match.mask->tos & 0x3); 14068f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, 14078f256622SPablo Neira Ayuso match.key->tos & 0x3); 1408bcef735cSOr Gerlitz 14098f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, 14108f256622SPablo Neira Ayuso match.mask->tos >> 2); 14118f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, 14128f256622SPablo Neira Ayuso match.key->tos >> 2); 1413bcef735cSOr Gerlitz 14148f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, 14158f256622SPablo Neira Ayuso match.mask->ttl); 14168f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, 14178f256622SPablo Neira Ayuso match.key->ttl); 1418e98bedf5SEli Britstein 14198f256622SPablo Neira Ayuso if (match.mask->ttl && 1420e98bedf5SEli Britstein !MLX5_CAP_ESW_FLOWTABLE_FDB 1421e98bedf5SEli Britstein (priv->mdev, 1422e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 1423e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1424e98bedf5SEli Britstein "Matching on TTL is not supported"); 1425e98bedf5SEli Britstein return -EOPNOTSUPP; 1426e98bedf5SEli Britstein } 1427e98bedf5SEli Britstein 1428bcef735cSOr Gerlitz } 1429bcef735cSOr Gerlitz 1430bbd00f7eSHadar Hen Zion /* Enforce DMAC when offloading incoming tunneled flows. 1431bbd00f7eSHadar Hen Zion * Flow counters require a match on the DMAC. 1432bbd00f7eSHadar Hen Zion */ 1433bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16); 1434bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0); 1435bbd00f7eSHadar Hen Zion ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1436bbd00f7eSHadar Hen Zion dmac_47_16), priv->netdev->dev_addr); 1437bbd00f7eSHadar Hen Zion 1438bbd00f7eSHadar Hen Zion /* let software handle IP fragments */ 1439bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 1440bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0); 1441bbd00f7eSHadar Hen Zion 1442bbd00f7eSHadar Hen Zion return 0; 1443bbd00f7eSHadar Hen Zion } 1444bbd00f7eSHadar Hen Zion 14458377629eSEli Britstein static void *get_match_headers_criteria(u32 flags, 14468377629eSEli Britstein struct mlx5_flow_spec *spec) 14478377629eSEli Britstein { 14488377629eSEli Britstein return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ? 14498377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 14508377629eSEli Britstein inner_headers) : 14518377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 14528377629eSEli Britstein outer_headers); 14538377629eSEli Britstein } 14548377629eSEli Britstein 14558377629eSEli Britstein static void *get_match_headers_value(u32 flags, 14568377629eSEli Britstein struct mlx5_flow_spec *spec) 14578377629eSEli Britstein { 14588377629eSEli Britstein return (flags & MLX5_FLOW_CONTEXT_ACTION_DECAP) ? 14598377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_value, 14608377629eSEli Britstein inner_headers) : 14618377629eSEli Britstein MLX5_ADDR_OF(fte_match_param, spec->match_value, 14628377629eSEli Britstein outer_headers); 14638377629eSEli Britstein } 14648377629eSEli Britstein 1465de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv, 1466de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 1467de0af0bfSRoi Dayan struct tc_cls_flower_offload *f, 146854c177caSOz Shlomo struct net_device *filter_dev, 14696363651dSOr Gerlitz u8 *match_level, u8 *tunnel_match_level) 1470e3a2b7edSAmir Vadai { 1471e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1472c5bb1730SMaor Gottlieb void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1473c5bb1730SMaor Gottlieb outer_headers); 1474c5bb1730SMaor Gottlieb void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1475c5bb1730SMaor Gottlieb outer_headers); 1476699e96ddSJianbo Liu void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1477699e96ddSJianbo Liu misc_parameters); 1478699e96ddSJianbo Liu void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1479699e96ddSJianbo Liu misc_parameters); 14808f256622SPablo Neira Ayuso struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f); 14818f256622SPablo Neira Ayuso struct flow_dissector *dissector = rule->match.dissector; 1482e3a2b7edSAmir Vadai u16 addr_type = 0; 1483e3a2b7edSAmir Vadai u8 ip_proto = 0; 1484e3a2b7edSAmir Vadai 1485d708f902SOr Gerlitz *match_level = MLX5_MATCH_NONE; 1486de0af0bfSRoi Dayan 14878f256622SPablo Neira Ayuso if (dissector->used_keys & 1488e3a2b7edSAmir Vadai ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) | 1489e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_BASIC) | 1490e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) | 1491095b6cfdSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_VLAN) | 1492699e96ddSJianbo Liu BIT(FLOW_DISSECTOR_KEY_CVLAN) | 1493e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) | 1494e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) | 1495bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_PORTS) | 1496bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) | 1497bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) | 1498bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) | 1499bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_PORTS) | 1500e77834ecSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) | 1501fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_TCP) | 1502bcef735cSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_IP) | 1503bcef735cSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_IP))) { 1504e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "Unsupported key"); 1505e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n", 15068f256622SPablo Neira Ayuso dissector->used_keys); 1507e3a2b7edSAmir Vadai return -EOPNOTSUPP; 1508e3a2b7edSAmir Vadai } 1509e3a2b7edSAmir Vadai 15108f256622SPablo Neira Ayuso if ((flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) || 15118f256622SPablo Neira Ayuso flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_KEYID) || 15128f256622SPablo Neira Ayuso flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_PORTS)) && 15138f256622SPablo Neira Ayuso flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL)) { 15148f256622SPablo Neira Ayuso struct flow_match_control match; 15158f256622SPablo Neira Ayuso 15168f256622SPablo Neira Ayuso flow_rule_match_enc_control(rule, &match); 15178f256622SPablo Neira Ayuso switch (match.key->addr_type) { 1518bbd00f7eSHadar Hen Zion case FLOW_DISSECTOR_KEY_IPV4_ADDRS: 151919f44401SOr Gerlitz case FLOW_DISSECTOR_KEY_IPV6_ADDRS: 15206363651dSOr Gerlitz if (parse_tunnel_attr(priv, spec, f, filter_dev, tunnel_match_level)) 1521bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1522bbd00f7eSHadar Hen Zion break; 1523bbd00f7eSHadar Hen Zion default: 1524bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1525bbd00f7eSHadar Hen Zion } 1526bbd00f7eSHadar Hen Zion 1527bbd00f7eSHadar Hen Zion /* In decap flow, header pointers should point to the inner 1528bbd00f7eSHadar Hen Zion * headers, outer header were already set by parse_tunnel_attr 1529bbd00f7eSHadar Hen Zion */ 15308377629eSEli Britstein headers_c = get_match_headers_criteria(MLX5_FLOW_CONTEXT_ACTION_DECAP, 15318377629eSEli Britstein spec); 15328377629eSEli Britstein headers_v = get_match_headers_value(MLX5_FLOW_CONTEXT_ACTION_DECAP, 15338377629eSEli Britstein spec); 1534bbd00f7eSHadar Hen Zion } 1535bbd00f7eSHadar Hen Zion 15368f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { 15378f256622SPablo Neira Ayuso struct flow_match_basic match; 1538e3a2b7edSAmir Vadai 15398f256622SPablo Neira Ayuso flow_rule_match_basic(rule, &match); 15408f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype, 15418f256622SPablo Neira Ayuso ntohs(match.mask->n_proto)); 15428f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 15438f256622SPablo Neira Ayuso ntohs(match.key->n_proto)); 15448f256622SPablo Neira Ayuso 15458f256622SPablo Neira Ayuso if (match.mask->n_proto) 1546d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1547e3a2b7edSAmir Vadai } 154835a605dbSEli Britstein if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN) || 154935a605dbSEli Britstein is_vlan_dev(filter_dev)) { 155035a605dbSEli Britstein struct flow_dissector_key_vlan filter_dev_mask; 155135a605dbSEli Britstein struct flow_dissector_key_vlan filter_dev_key; 15528f256622SPablo Neira Ayuso struct flow_match_vlan match; 15538f256622SPablo Neira Ayuso 155435a605dbSEli Britstein if (is_vlan_dev(filter_dev)) { 155535a605dbSEli Britstein match.key = &filter_dev_key; 155635a605dbSEli Britstein match.key->vlan_id = vlan_dev_vlan_id(filter_dev); 155735a605dbSEli Britstein match.key->vlan_tpid = vlan_dev_vlan_proto(filter_dev); 155835a605dbSEli Britstein match.key->vlan_priority = 0; 155935a605dbSEli Britstein match.mask = &filter_dev_mask; 156035a605dbSEli Britstein memset(match.mask, 0xff, sizeof(*match.mask)); 156135a605dbSEli Britstein match.mask->vlan_priority = 0; 156235a605dbSEli Britstein } else { 15638f256622SPablo Neira Ayuso flow_rule_match_vlan(rule, &match); 156435a605dbSEli Britstein } 15658f256622SPablo Neira Ayuso if (match.mask->vlan_id || 15668f256622SPablo Neira Ayuso match.mask->vlan_priority || 15678f256622SPablo Neira Ayuso match.mask->vlan_tpid) { 15688f256622SPablo Neira Ayuso if (match.key->vlan_tpid == htons(ETH_P_8021AD)) { 1569699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1570699e96ddSJianbo Liu svlan_tag, 1); 1571699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1572699e96ddSJianbo Liu svlan_tag, 1); 1573699e96ddSJianbo Liu } else { 1574699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1575699e96ddSJianbo Liu cvlan_tag, 1); 1576699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1577699e96ddSJianbo Liu cvlan_tag, 1); 1578699e96ddSJianbo Liu } 1579095b6cfdSOr Gerlitz 15808f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid, 15818f256622SPablo Neira Ayuso match.mask->vlan_id); 15828f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid, 15838f256622SPablo Neira Ayuso match.key->vlan_id); 1584358d79a4SOr Gerlitz 15858f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio, 15868f256622SPablo Neira Ayuso match.mask->vlan_priority); 15878f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio, 15888f256622SPablo Neira Ayuso match.key->vlan_priority); 158954782900SOr Gerlitz 1590d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1591095b6cfdSOr Gerlitz } 1592d3a80bb5SOr Gerlitz } else if (*match_level != MLX5_MATCH_NONE) { 1593cee26487SJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, svlan_tag, 1); 1594cee26487SJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1); 1595d3a80bb5SOr Gerlitz *match_level = MLX5_MATCH_L2; 1596095b6cfdSOr Gerlitz } 1597095b6cfdSOr Gerlitz 15988f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) { 15998f256622SPablo Neira Ayuso struct flow_match_vlan match; 16008f256622SPablo Neira Ayuso 16018f256622SPablo Neira Ayuso flow_rule_match_vlan(rule, &match); 16028f256622SPablo Neira Ayuso if (match.mask->vlan_id || 16038f256622SPablo Neira Ayuso match.mask->vlan_priority || 16048f256622SPablo Neira Ayuso match.mask->vlan_tpid) { 16058f256622SPablo Neira Ayuso if (match.key->vlan_tpid == htons(ETH_P_8021AD)) { 1606699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1607699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1608699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1609699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1610699e96ddSJianbo Liu } else { 1611699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1612699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1613699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1614699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1615699e96ddSJianbo Liu } 1616699e96ddSJianbo Liu 1617699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid, 16188f256622SPablo Neira Ayuso match.mask->vlan_id); 1619699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid, 16208f256622SPablo Neira Ayuso match.key->vlan_id); 1621699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio, 16228f256622SPablo Neira Ayuso match.mask->vlan_priority); 1623699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio, 16248f256622SPablo Neira Ayuso match.key->vlan_priority); 1625699e96ddSJianbo Liu 1626699e96ddSJianbo Liu *match_level = MLX5_MATCH_L2; 1627699e96ddSJianbo Liu } 1628699e96ddSJianbo Liu } 1629699e96ddSJianbo Liu 16308f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) { 16318f256622SPablo Neira Ayuso struct flow_match_eth_addrs match; 163254782900SOr Gerlitz 16338f256622SPablo Neira Ayuso flow_rule_match_eth_addrs(rule, &match); 1634d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1635d3a80bb5SOr Gerlitz dmac_47_16), 16368f256622SPablo Neira Ayuso match.mask->dst); 1637d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1638d3a80bb5SOr Gerlitz dmac_47_16), 16398f256622SPablo Neira Ayuso match.key->dst); 1640d3a80bb5SOr Gerlitz 1641d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1642d3a80bb5SOr Gerlitz smac_47_16), 16438f256622SPablo Neira Ayuso match.mask->src); 1644d3a80bb5SOr Gerlitz ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1645d3a80bb5SOr Gerlitz smac_47_16), 16468f256622SPablo Neira Ayuso match.key->src); 1647d3a80bb5SOr Gerlitz 16488f256622SPablo Neira Ayuso if (!is_zero_ether_addr(match.mask->src) || 16498f256622SPablo Neira Ayuso !is_zero_ether_addr(match.mask->dst)) 1650d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 165154782900SOr Gerlitz } 165254782900SOr Gerlitz 16538f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) { 16548f256622SPablo Neira Ayuso struct flow_match_control match; 165554782900SOr Gerlitz 16568f256622SPablo Neira Ayuso flow_rule_match_control(rule, &match); 16578f256622SPablo Neira Ayuso addr_type = match.key->addr_type; 165854782900SOr Gerlitz 165954782900SOr Gerlitz /* the HW doesn't support frag first/later */ 16608f256622SPablo Neira Ayuso if (match.mask->flags & FLOW_DIS_FIRST_FRAG) 166154782900SOr Gerlitz return -EOPNOTSUPP; 166254782900SOr Gerlitz 16638f256622SPablo Neira Ayuso if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) { 166454782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 166554782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 16668f256622SPablo Neira Ayuso match.key->flags & FLOW_DIS_IS_FRAGMENT); 166754782900SOr Gerlitz 166854782900SOr Gerlitz /* the HW doesn't need L3 inline to match on frag=no */ 16698f256622SPablo Neira Ayuso if (!(match.key->flags & FLOW_DIS_IS_FRAGMENT)) 167083621b7dSOr Gerlitz *match_level = MLX5_MATCH_L2; 167154782900SOr Gerlitz /* *** L2 attributes parsing up to here *** */ 167254782900SOr Gerlitz else 167383621b7dSOr Gerlitz *match_level = MLX5_MATCH_L3; 167454782900SOr Gerlitz } 167554782900SOr Gerlitz } 167654782900SOr Gerlitz 16778f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { 16788f256622SPablo Neira Ayuso struct flow_match_basic match; 16798f256622SPablo Neira Ayuso 16808f256622SPablo Neira Ayuso flow_rule_match_basic(rule, &match); 16818f256622SPablo Neira Ayuso ip_proto = match.key->ip_proto; 168254782900SOr Gerlitz 168354782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol, 16848f256622SPablo Neira Ayuso match.mask->ip_proto); 168554782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, 16868f256622SPablo Neira Ayuso match.key->ip_proto); 168754782900SOr Gerlitz 16888f256622SPablo Neira Ayuso if (match.mask->ip_proto) 1689d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 169054782900SOr Gerlitz } 169154782900SOr Gerlitz 1692e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 16938f256622SPablo Neira Ayuso struct flow_match_ipv4_addrs match; 1694e3a2b7edSAmir Vadai 16958f256622SPablo Neira Ayuso flow_rule_match_ipv4_addrs(rule, &match); 1696e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1697e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 16988f256622SPablo Neira Ayuso &match.mask->src, sizeof(match.mask->src)); 1699e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1700e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 17018f256622SPablo Neira Ayuso &match.key->src, sizeof(match.key->src)); 1702e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1703e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 17048f256622SPablo Neira Ayuso &match.mask->dst, sizeof(match.mask->dst)); 1705e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1706e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 17078f256622SPablo Neira Ayuso &match.key->dst, sizeof(match.key->dst)); 1708de0af0bfSRoi Dayan 17098f256622SPablo Neira Ayuso if (match.mask->src || match.mask->dst) 1710d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 1711e3a2b7edSAmir Vadai } 1712e3a2b7edSAmir Vadai 1713e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 17148f256622SPablo Neira Ayuso struct flow_match_ipv6_addrs match; 1715e3a2b7edSAmir Vadai 17168f256622SPablo Neira Ayuso flow_rule_match_ipv6_addrs(rule, &match); 1717e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1718e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 17198f256622SPablo Neira Ayuso &match.mask->src, sizeof(match.mask->src)); 1720e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1721e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 17228f256622SPablo Neira Ayuso &match.key->src, sizeof(match.key->src)); 1723e3a2b7edSAmir Vadai 1724e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1725e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 17268f256622SPablo Neira Ayuso &match.mask->dst, sizeof(match.mask->dst)); 1727e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1728e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 17298f256622SPablo Neira Ayuso &match.key->dst, sizeof(match.key->dst)); 1730de0af0bfSRoi Dayan 17318f256622SPablo Neira Ayuso if (ipv6_addr_type(&match.mask->src) != IPV6_ADDR_ANY || 17328f256622SPablo Neira Ayuso ipv6_addr_type(&match.mask->dst) != IPV6_ADDR_ANY) 1733d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 1734e3a2b7edSAmir Vadai } 1735e3a2b7edSAmir Vadai 17368f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) { 17378f256622SPablo Neira Ayuso struct flow_match_ip match; 17381f97a526SOr Gerlitz 17398f256622SPablo Neira Ayuso flow_rule_match_ip(rule, &match); 17408f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, 17418f256622SPablo Neira Ayuso match.mask->tos & 0x3); 17428f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, 17438f256622SPablo Neira Ayuso match.key->tos & 0x3); 17441f97a526SOr Gerlitz 17458f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, 17468f256622SPablo Neira Ayuso match.mask->tos >> 2); 17478f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, 17488f256622SPablo Neira Ayuso match.key->tos >> 2); 17491f97a526SOr Gerlitz 17508f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, 17518f256622SPablo Neira Ayuso match.mask->ttl); 17528f256622SPablo Neira Ayuso MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, 17538f256622SPablo Neira Ayuso match.key->ttl); 17541f97a526SOr Gerlitz 17558f256622SPablo Neira Ayuso if (match.mask->ttl && 1756a8ade55fSOr Gerlitz !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, 1757e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 1758e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1759e98bedf5SEli Britstein "Matching on TTL is not supported"); 17601f97a526SOr Gerlitz return -EOPNOTSUPP; 1761e98bedf5SEli Britstein } 1762a8ade55fSOr Gerlitz 17638f256622SPablo Neira Ayuso if (match.mask->tos || match.mask->ttl) 1764d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 17651f97a526SOr Gerlitz } 17661f97a526SOr Gerlitz 176754782900SOr Gerlitz /* *** L3 attributes parsing up to here *** */ 176854782900SOr Gerlitz 17698f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) { 17708f256622SPablo Neira Ayuso struct flow_match_ports match; 17718f256622SPablo Neira Ayuso 17728f256622SPablo Neira Ayuso flow_rule_match_ports(rule, &match); 1773e3a2b7edSAmir Vadai switch (ip_proto) { 1774e3a2b7edSAmir Vadai case IPPROTO_TCP: 1775e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 17768f256622SPablo Neira Ayuso tcp_sport, ntohs(match.mask->src)); 1777e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 17788f256622SPablo Neira Ayuso tcp_sport, ntohs(match.key->src)); 1779e3a2b7edSAmir Vadai 1780e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 17818f256622SPablo Neira Ayuso tcp_dport, ntohs(match.mask->dst)); 1782e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 17838f256622SPablo Neira Ayuso tcp_dport, ntohs(match.key->dst)); 1784e3a2b7edSAmir Vadai break; 1785e3a2b7edSAmir Vadai 1786e3a2b7edSAmir Vadai case IPPROTO_UDP: 1787e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 17888f256622SPablo Neira Ayuso udp_sport, ntohs(match.mask->src)); 1789e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 17908f256622SPablo Neira Ayuso udp_sport, ntohs(match.key->src)); 1791e3a2b7edSAmir Vadai 1792e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 17938f256622SPablo Neira Ayuso udp_dport, ntohs(match.mask->dst)); 1794e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 17958f256622SPablo Neira Ayuso udp_dport, ntohs(match.key->dst)); 1796e3a2b7edSAmir Vadai break; 1797e3a2b7edSAmir Vadai default: 1798e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1799e98bedf5SEli Britstein "Only UDP and TCP transports are supported for L4 matching"); 1800e3a2b7edSAmir Vadai netdev_err(priv->netdev, 1801e3a2b7edSAmir Vadai "Only UDP and TCP transport are supported\n"); 1802e3a2b7edSAmir Vadai return -EINVAL; 1803e3a2b7edSAmir Vadai } 1804de0af0bfSRoi Dayan 18058f256622SPablo Neira Ayuso if (match.mask->src || match.mask->dst) 1806d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 1807e3a2b7edSAmir Vadai } 1808e3a2b7edSAmir Vadai 18098f256622SPablo Neira Ayuso if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) { 18108f256622SPablo Neira Ayuso struct flow_match_tcp match; 1811e77834ecSOr Gerlitz 18128f256622SPablo Neira Ayuso flow_rule_match_tcp(rule, &match); 1813e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags, 18148f256622SPablo Neira Ayuso ntohs(match.mask->flags)); 1815e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags, 18168f256622SPablo Neira Ayuso ntohs(match.key->flags)); 1817e77834ecSOr Gerlitz 18188f256622SPablo Neira Ayuso if (match.mask->flags) 1819d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 1820e77834ecSOr Gerlitz } 1821e77834ecSOr Gerlitz 1822e3a2b7edSAmir Vadai return 0; 1823e3a2b7edSAmir Vadai } 1824e3a2b7edSAmir Vadai 1825de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv, 182665ba8fb7SOr Gerlitz struct mlx5e_tc_flow *flow, 1827de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 182854c177caSOz Shlomo struct tc_cls_flower_offload *f, 182954c177caSOz Shlomo struct net_device *filter_dev) 1830de0af0bfSRoi Dayan { 1831e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1832de0af0bfSRoi Dayan struct mlx5_core_dev *dev = priv->mdev; 1833de0af0bfSRoi Dayan struct mlx5_eswitch *esw = dev->priv.eswitch; 18341d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 18356363651dSOr Gerlitz u8 match_level, tunnel_match_level = MLX5_MATCH_NONE; 18361d447a39SSaeed Mahameed struct mlx5_eswitch_rep *rep; 1837de0af0bfSRoi Dayan int err; 1838de0af0bfSRoi Dayan 18396363651dSOr Gerlitz err = __parse_cls_flower(priv, spec, f, filter_dev, &match_level, &tunnel_match_level); 1840de0af0bfSRoi Dayan 18411d447a39SSaeed Mahameed if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) { 18421d447a39SSaeed Mahameed rep = rpriv->rep; 1843b05af6aaSBodong Wang if (rep->vport != MLX5_VPORT_UPLINK && 18441d447a39SSaeed Mahameed (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE && 1845d708f902SOr Gerlitz esw->offloads.inline_mode < match_level)) { 1846e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1847e98bedf5SEli Britstein "Flow is not offloaded due to min inline setting"); 1848de0af0bfSRoi Dayan netdev_warn(priv->netdev, 1849de0af0bfSRoi Dayan "Flow is not offloaded due to min inline setting, required %d actual %d\n", 1850d708f902SOr Gerlitz match_level, esw->offloads.inline_mode); 1851de0af0bfSRoi Dayan return -EOPNOTSUPP; 1852de0af0bfSRoi Dayan } 1853de0af0bfSRoi Dayan } 1854de0af0bfSRoi Dayan 18556363651dSOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 185638aa51c1SOr Gerlitz flow->esw_attr->match_level = match_level; 18576363651dSOr Gerlitz flow->esw_attr->tunnel_match_level = tunnel_match_level; 18586363651dSOr Gerlitz } else { 185938aa51c1SOr Gerlitz flow->nic_attr->match_level = match_level; 18606363651dSOr Gerlitz } 186138aa51c1SOr Gerlitz 1862de0af0bfSRoi Dayan return err; 1863de0af0bfSRoi Dayan } 1864de0af0bfSRoi Dayan 1865d79b6df6SOr Gerlitz struct pedit_headers { 1866d79b6df6SOr Gerlitz struct ethhdr eth; 18670eb69bb9SEli Britstein struct vlan_hdr vlan; 1868d79b6df6SOr Gerlitz struct iphdr ip4; 1869d79b6df6SOr Gerlitz struct ipv6hdr ip6; 1870d79b6df6SOr Gerlitz struct tcphdr tcp; 1871d79b6df6SOr Gerlitz struct udphdr udp; 1872d79b6df6SOr Gerlitz }; 1873d79b6df6SOr Gerlitz 1874c500c86bSPablo Neira Ayuso struct pedit_headers_action { 1875c500c86bSPablo Neira Ayuso struct pedit_headers vals; 1876c500c86bSPablo Neira Ayuso struct pedit_headers masks; 1877c500c86bSPablo Neira Ayuso u32 pedits; 1878c500c86bSPablo Neira Ayuso }; 1879c500c86bSPablo Neira Ayuso 1880d79b6df6SOr Gerlitz static int pedit_header_offsets[] = { 188173867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth), 188273867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4), 188373867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6), 188473867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp), 188573867881SPablo Neira Ayuso [FLOW_ACT_MANGLE_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp), 1886d79b6df6SOr Gerlitz }; 1887d79b6df6SOr Gerlitz 1888d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype]) 1889d79b6df6SOr Gerlitz 1890d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset, 1891c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs) 1892d79b6df6SOr Gerlitz { 1893d79b6df6SOr Gerlitz u32 *curr_pmask, *curr_pval; 1894d79b6df6SOr Gerlitz 1895c500c86bSPablo Neira Ayuso curr_pmask = (u32 *)(pedit_header(&hdrs->masks, hdr_type) + offset); 1896c500c86bSPablo Neira Ayuso curr_pval = (u32 *)(pedit_header(&hdrs->vals, hdr_type) + offset); 1897d79b6df6SOr Gerlitz 1898d79b6df6SOr Gerlitz if (*curr_pmask & mask) /* disallow acting twice on the same location */ 1899d79b6df6SOr Gerlitz goto out_err; 1900d79b6df6SOr Gerlitz 1901d79b6df6SOr Gerlitz *curr_pmask |= mask; 1902d79b6df6SOr Gerlitz *curr_pval |= (val & mask); 1903d79b6df6SOr Gerlitz 1904d79b6df6SOr Gerlitz return 0; 1905d79b6df6SOr Gerlitz 1906d79b6df6SOr Gerlitz out_err: 1907d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1908d79b6df6SOr Gerlitz } 1909d79b6df6SOr Gerlitz 1910d79b6df6SOr Gerlitz struct mlx5_fields { 1911d79b6df6SOr Gerlitz u8 field; 1912d79b6df6SOr Gerlitz u8 size; 1913d79b6df6SOr Gerlitz u32 offset; 191427c11b6bSEli Britstein u32 match_offset; 1915d79b6df6SOr Gerlitz }; 1916d79b6df6SOr Gerlitz 191727c11b6bSEli Britstein #define OFFLOAD(fw_field, size, field, off, match_field) \ 191827c11b6bSEli Britstein {MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, \ 191927c11b6bSEli Britstein offsetof(struct pedit_headers, field) + (off), \ 192027c11b6bSEli Britstein MLX5_BYTE_OFF(fte_match_set_lyr_2_4, match_field)} 192127c11b6bSEli Britstein 192227c11b6bSEli Britstein static bool cmp_val_mask(void *valp, void *maskp, void *matchvalp, 192327c11b6bSEli Britstein void *matchmaskp, int size) 192427c11b6bSEli Britstein { 192527c11b6bSEli Britstein bool same = false; 192627c11b6bSEli Britstein 192727c11b6bSEli Britstein switch (size) { 192827c11b6bSEli Britstein case sizeof(u8): 192927c11b6bSEli Britstein same = ((*(u8 *)valp) & (*(u8 *)maskp)) == 193027c11b6bSEli Britstein ((*(u8 *)matchvalp) & (*(u8 *)matchmaskp)); 193127c11b6bSEli Britstein break; 193227c11b6bSEli Britstein case sizeof(u16): 193327c11b6bSEli Britstein same = ((*(u16 *)valp) & (*(u16 *)maskp)) == 193427c11b6bSEli Britstein ((*(u16 *)matchvalp) & (*(u16 *)matchmaskp)); 193527c11b6bSEli Britstein break; 193627c11b6bSEli Britstein case sizeof(u32): 193727c11b6bSEli Britstein same = ((*(u32 *)valp) & (*(u32 *)maskp)) == 193827c11b6bSEli Britstein ((*(u32 *)matchvalp) & (*(u32 *)matchmaskp)); 193927c11b6bSEli Britstein break; 194027c11b6bSEli Britstein } 194127c11b6bSEli Britstein 194227c11b6bSEli Britstein return same; 194327c11b6bSEli Britstein } 1944a8e4f0c4SOr Gerlitz 1945d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = { 194627c11b6bSEli Britstein OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0, dmac_47_16), 194727c11b6bSEli Britstein OFFLOAD(DMAC_15_0, 2, eth.h_dest[4], 0, dmac_15_0), 194827c11b6bSEli Britstein OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0, smac_47_16), 194927c11b6bSEli Britstein OFFLOAD(SMAC_15_0, 2, eth.h_source[4], 0, smac_15_0), 195027c11b6bSEli Britstein OFFLOAD(ETHERTYPE, 2, eth.h_proto, 0, ethertype), 195127c11b6bSEli Britstein OFFLOAD(FIRST_VID, 2, vlan.h_vlan_TCI, 0, first_vid), 1952d79b6df6SOr Gerlitz 195327c11b6bSEli Britstein OFFLOAD(IP_TTL, 1, ip4.ttl, 0, ttl_hoplimit), 195427c11b6bSEli Britstein OFFLOAD(SIPV4, 4, ip4.saddr, 0, src_ipv4_src_ipv6.ipv4_layout.ipv4), 195527c11b6bSEli Britstein OFFLOAD(DIPV4, 4, ip4.daddr, 0, dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 1956d79b6df6SOr Gerlitz 195727c11b6bSEli Britstein OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0, 195827c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[0]), 195927c11b6bSEli Britstein OFFLOAD(SIPV6_95_64, 4, ip6.saddr.s6_addr32[1], 0, 196027c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[4]), 196127c11b6bSEli Britstein OFFLOAD(SIPV6_63_32, 4, ip6.saddr.s6_addr32[2], 0, 196227c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[8]), 196327c11b6bSEli Britstein OFFLOAD(SIPV6_31_0, 4, ip6.saddr.s6_addr32[3], 0, 196427c11b6bSEli Britstein src_ipv4_src_ipv6.ipv6_layout.ipv6[12]), 196527c11b6bSEli Britstein OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0, 196627c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[0]), 196727c11b6bSEli Britstein OFFLOAD(DIPV6_95_64, 4, ip6.daddr.s6_addr32[1], 0, 196827c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[4]), 196927c11b6bSEli Britstein OFFLOAD(DIPV6_63_32, 4, ip6.daddr.s6_addr32[2], 0, 197027c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[8]), 197127c11b6bSEli Britstein OFFLOAD(DIPV6_31_0, 4, ip6.daddr.s6_addr32[3], 0, 197227c11b6bSEli Britstein dst_ipv4_dst_ipv6.ipv6_layout.ipv6[12]), 197327c11b6bSEli Britstein OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0, ttl_hoplimit), 1974d79b6df6SOr Gerlitz 197527c11b6bSEli Britstein OFFLOAD(TCP_SPORT, 2, tcp.source, 0, tcp_sport), 197627c11b6bSEli Britstein OFFLOAD(TCP_DPORT, 2, tcp.dest, 0, tcp_dport), 197727c11b6bSEli Britstein OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5, tcp_flags), 1978d79b6df6SOr Gerlitz 197927c11b6bSEli Britstein OFFLOAD(UDP_SPORT, 2, udp.source, 0, udp_sport), 198027c11b6bSEli Britstein OFFLOAD(UDP_DPORT, 2, udp.dest, 0, udp_dport), 1981d79b6df6SOr Gerlitz }; 1982d79b6df6SOr Gerlitz 1983218d05ceSTonghao Zhang /* On input attr->max_mod_hdr_actions tells how many HW actions can be parsed at 1984218d05ceSTonghao Zhang * max from the SW pedit action. On success, attr->num_mod_hdr_actions 1985218d05ceSTonghao Zhang * says how many HW actions were actually parsed. 1986d79b6df6SOr Gerlitz */ 1987c500c86bSPablo Neira Ayuso static int offload_pedit_fields(struct pedit_headers_action *hdrs, 1988e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 198927c11b6bSEli Britstein u32 *action_flags, 1990e98bedf5SEli Britstein struct netlink_ext_ack *extack) 1991d79b6df6SOr Gerlitz { 1992d79b6df6SOr Gerlitz struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals; 199327c11b6bSEli Britstein void *headers_c = get_match_headers_criteria(*action_flags, 199427c11b6bSEli Britstein &parse_attr->spec); 199527c11b6bSEli Britstein void *headers_v = get_match_headers_value(*action_flags, 199627c11b6bSEli Britstein &parse_attr->spec); 19972b64bebaSOr Gerlitz int i, action_size, nactions, max_actions, first, last, next_z; 1998d79b6df6SOr Gerlitz void *s_masks_p, *a_masks_p, *vals_p; 1999d79b6df6SOr Gerlitz struct mlx5_fields *f; 2000d79b6df6SOr Gerlitz u8 cmd, field_bsize; 2001e3ca4e05SOr Gerlitz u32 s_mask, a_mask; 2002d79b6df6SOr Gerlitz unsigned long mask; 20032b64bebaSOr Gerlitz __be32 mask_be32; 20042b64bebaSOr Gerlitz __be16 mask_be16; 2005d79b6df6SOr Gerlitz void *action; 2006d79b6df6SOr Gerlitz 200773867881SPablo Neira Ayuso set_masks = &hdrs[0].masks; 200873867881SPablo Neira Ayuso add_masks = &hdrs[1].masks; 200973867881SPablo Neira Ayuso set_vals = &hdrs[0].vals; 201073867881SPablo Neira Ayuso add_vals = &hdrs[1].vals; 2011d79b6df6SOr Gerlitz 2012d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 2013218d05ceSTonghao Zhang action = parse_attr->mod_hdr_actions + 2014218d05ceSTonghao Zhang parse_attr->num_mod_hdr_actions * action_size; 2015218d05ceSTonghao Zhang 2016218d05ceSTonghao Zhang max_actions = parse_attr->max_mod_hdr_actions; 2017218d05ceSTonghao Zhang nactions = parse_attr->num_mod_hdr_actions; 2018d79b6df6SOr Gerlitz 2019d79b6df6SOr Gerlitz for (i = 0; i < ARRAY_SIZE(fields); i++) { 202027c11b6bSEli Britstein bool skip; 202127c11b6bSEli Britstein 2022d79b6df6SOr Gerlitz f = &fields[i]; 2023d79b6df6SOr Gerlitz /* avoid seeing bits set from previous iterations */ 2024e3ca4e05SOr Gerlitz s_mask = 0; 2025e3ca4e05SOr Gerlitz a_mask = 0; 2026d79b6df6SOr Gerlitz 2027d79b6df6SOr Gerlitz s_masks_p = (void *)set_masks + f->offset; 2028d79b6df6SOr Gerlitz a_masks_p = (void *)add_masks + f->offset; 2029d79b6df6SOr Gerlitz 2030d79b6df6SOr Gerlitz memcpy(&s_mask, s_masks_p, f->size); 2031d79b6df6SOr Gerlitz memcpy(&a_mask, a_masks_p, f->size); 2032d79b6df6SOr Gerlitz 2033d79b6df6SOr Gerlitz if (!s_mask && !a_mask) /* nothing to offload here */ 2034d79b6df6SOr Gerlitz continue; 2035d79b6df6SOr Gerlitz 2036d79b6df6SOr Gerlitz if (s_mask && a_mask) { 2037e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2038e98bedf5SEli Britstein "can't set and add to the same HW field"); 2039d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field); 2040d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2041d79b6df6SOr Gerlitz } 2042d79b6df6SOr Gerlitz 2043d79b6df6SOr Gerlitz if (nactions == max_actions) { 2044e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2045e98bedf5SEli Britstein "too many pedit actions, can't offload"); 2046d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions); 2047d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2048d79b6df6SOr Gerlitz } 2049d79b6df6SOr Gerlitz 205027c11b6bSEli Britstein skip = false; 2051d79b6df6SOr Gerlitz if (s_mask) { 205227c11b6bSEli Britstein void *match_mask = headers_c + f->match_offset; 205327c11b6bSEli Britstein void *match_val = headers_v + f->match_offset; 205427c11b6bSEli Britstein 2055d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_SET; 2056d79b6df6SOr Gerlitz mask = s_mask; 2057d79b6df6SOr Gerlitz vals_p = (void *)set_vals + f->offset; 205827c11b6bSEli Britstein /* don't rewrite if we have a match on the same value */ 205927c11b6bSEli Britstein if (cmp_val_mask(vals_p, s_masks_p, match_val, 206027c11b6bSEli Britstein match_mask, f->size)) 206127c11b6bSEli Britstein skip = true; 2062d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 2063d79b6df6SOr Gerlitz memset(s_masks_p, 0, f->size); 2064d79b6df6SOr Gerlitz } else { 206527c11b6bSEli Britstein u32 zero = 0; 206627c11b6bSEli Britstein 2067d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_ADD; 2068d79b6df6SOr Gerlitz mask = a_mask; 2069d79b6df6SOr Gerlitz vals_p = (void *)add_vals + f->offset; 207027c11b6bSEli Britstein /* add 0 is no change */ 207127c11b6bSEli Britstein if (!memcmp(vals_p, &zero, f->size)) 207227c11b6bSEli Britstein skip = true; 2073d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 2074d79b6df6SOr Gerlitz memset(a_masks_p, 0, f->size); 2075d79b6df6SOr Gerlitz } 207627c11b6bSEli Britstein if (skip) 207727c11b6bSEli Britstein continue; 2078d79b6df6SOr Gerlitz 2079d79b6df6SOr Gerlitz field_bsize = f->size * BITS_PER_BYTE; 2080e3ca4e05SOr Gerlitz 20812b64bebaSOr Gerlitz if (field_bsize == 32) { 20822b64bebaSOr Gerlitz mask_be32 = *(__be32 *)&mask; 20832b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32)); 20842b64bebaSOr Gerlitz } else if (field_bsize == 16) { 20852b64bebaSOr Gerlitz mask_be16 = *(__be16 *)&mask; 20862b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16)); 20872b64bebaSOr Gerlitz } 20882b64bebaSOr Gerlitz 2089d79b6df6SOr Gerlitz first = find_first_bit(&mask, field_bsize); 20902b64bebaSOr Gerlitz next_z = find_next_zero_bit(&mask, field_bsize, first); 2091d79b6df6SOr Gerlitz last = find_last_bit(&mask, field_bsize); 20922b64bebaSOr Gerlitz if (first < next_z && next_z < last) { 2093e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2094e98bedf5SEli Britstein "rewrite of few sub-fields isn't supported"); 20952b64bebaSOr Gerlitz printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n", 2096d79b6df6SOr Gerlitz mask); 2097d79b6df6SOr Gerlitz return -EOPNOTSUPP; 2098d79b6df6SOr Gerlitz } 2099d79b6df6SOr Gerlitz 2100d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, action_type, cmd); 2101d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, field, f->field); 2102d79b6df6SOr Gerlitz 2103d79b6df6SOr Gerlitz if (cmd == MLX5_ACTION_TYPE_SET) { 21042b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, offset, first); 2105d79b6df6SOr Gerlitz /* length is num of bits to be written, zero means length of 32 */ 21062b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, length, (last - first + 1)); 2107d79b6df6SOr Gerlitz } 2108d79b6df6SOr Gerlitz 2109d79b6df6SOr Gerlitz if (field_bsize == 32) 21102b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first); 2111d79b6df6SOr Gerlitz else if (field_bsize == 16) 21122b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first); 2113d79b6df6SOr Gerlitz else if (field_bsize == 8) 21142b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first); 2115d79b6df6SOr Gerlitz 2116d79b6df6SOr Gerlitz action += action_size; 2117d79b6df6SOr Gerlitz nactions++; 2118d79b6df6SOr Gerlitz } 2119d79b6df6SOr Gerlitz 2120d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = nactions; 2121d79b6df6SOr Gerlitz return 0; 2122d79b6df6SOr Gerlitz } 2123d79b6df6SOr Gerlitz 21242cc1cb1dSTonghao Zhang static int mlx5e_flow_namespace_max_modify_action(struct mlx5_core_dev *mdev, 21252cc1cb1dSTonghao Zhang int namespace) 21262cc1cb1dSTonghao Zhang { 21272cc1cb1dSTonghao Zhang if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */ 21282cc1cb1dSTonghao Zhang return MLX5_CAP_ESW_FLOWTABLE_FDB(mdev, max_modify_header_actions); 21292cc1cb1dSTonghao Zhang else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */ 21302cc1cb1dSTonghao Zhang return MLX5_CAP_FLOWTABLE_NIC_RX(mdev, max_modify_header_actions); 21312cc1cb1dSTonghao Zhang } 21322cc1cb1dSTonghao Zhang 2133d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv, 2134c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 2135c500c86bSPablo Neira Ayuso int namespace, 2136d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 2137d79b6df6SOr Gerlitz { 2138d79b6df6SOr Gerlitz int nkeys, action_size, max_actions; 2139d79b6df6SOr Gerlitz 2140c500c86bSPablo Neira Ayuso nkeys = hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits + 2141c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits; 2142d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 2143d79b6df6SOr Gerlitz 21442cc1cb1dSTonghao Zhang max_actions = mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace); 2145d79b6df6SOr Gerlitz /* can get up to crazingly 16 HW actions in 32 bits pedit SW key */ 2146d79b6df6SOr Gerlitz max_actions = min(max_actions, nkeys * 16); 2147d79b6df6SOr Gerlitz 2148d79b6df6SOr Gerlitz parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL); 2149d79b6df6SOr Gerlitz if (!parse_attr->mod_hdr_actions) 2150d79b6df6SOr Gerlitz return -ENOMEM; 2151d79b6df6SOr Gerlitz 2152218d05ceSTonghao Zhang parse_attr->max_mod_hdr_actions = max_actions; 2153d79b6df6SOr Gerlitz return 0; 2154d79b6df6SOr Gerlitz } 2155d79b6df6SOr Gerlitz 2156d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {}; 2157d79b6df6SOr Gerlitz 2158d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv, 215973867881SPablo Neira Ayuso const struct flow_action_entry *act, int namespace, 2160e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 2161c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 2162e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2163d79b6df6SOr Gerlitz { 216473867881SPablo Neira Ayuso u8 cmd = (act->id == FLOW_ACTION_MANGLE) ? 0 : 1; 216573867881SPablo Neira Ayuso int err = -EOPNOTSUPP; 2166d79b6df6SOr Gerlitz u32 mask, val, offset; 216773867881SPablo Neira Ayuso u8 htype; 2168d79b6df6SOr Gerlitz 216973867881SPablo Neira Ayuso htype = act->mangle.htype; 2170d79b6df6SOr Gerlitz err = -EOPNOTSUPP; /* can't be all optimistic */ 2171d79b6df6SOr Gerlitz 217273867881SPablo Neira Ayuso if (htype == FLOW_ACT_MANGLE_UNSPEC) { 217373867881SPablo Neira Ayuso NL_SET_ERR_MSG_MOD(extack, "legacy pedit isn't offloaded"); 2174d79b6df6SOr Gerlitz goto out_err; 2175d79b6df6SOr Gerlitz } 2176d79b6df6SOr Gerlitz 21772cc1cb1dSTonghao Zhang if (!mlx5e_flow_namespace_max_modify_action(priv->mdev, namespace)) { 21782cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, 21792cc1cb1dSTonghao Zhang "The pedit offload action is not supported"); 21802cc1cb1dSTonghao Zhang goto out_err; 21812cc1cb1dSTonghao Zhang } 21822cc1cb1dSTonghao Zhang 218373867881SPablo Neira Ayuso mask = act->mangle.mask; 218473867881SPablo Neira Ayuso val = act->mangle.val; 218573867881SPablo Neira Ayuso offset = act->mangle.offset; 2186d79b6df6SOr Gerlitz 2187c500c86bSPablo Neira Ayuso err = set_pedit_val(htype, ~mask, val, offset, &hdrs[cmd]); 2188d79b6df6SOr Gerlitz if (err) 2189d79b6df6SOr Gerlitz goto out_err; 2190c500c86bSPablo Neira Ayuso 2191c500c86bSPablo Neira Ayuso hdrs[cmd].pedits++; 2192d79b6df6SOr Gerlitz 2193c500c86bSPablo Neira Ayuso return 0; 2194c500c86bSPablo Neira Ayuso out_err: 2195c500c86bSPablo Neira Ayuso return err; 2196c500c86bSPablo Neira Ayuso } 2197c500c86bSPablo Neira Ayuso 2198c500c86bSPablo Neira Ayuso static int alloc_tc_pedit_action(struct mlx5e_priv *priv, int namespace, 2199c500c86bSPablo Neira Ayuso struct mlx5e_tc_flow_parse_attr *parse_attr, 2200c500c86bSPablo Neira Ayuso struct pedit_headers_action *hdrs, 220127c11b6bSEli Britstein u32 *action_flags, 2202c500c86bSPablo Neira Ayuso struct netlink_ext_ack *extack) 2203c500c86bSPablo Neira Ayuso { 2204c500c86bSPablo Neira Ayuso struct pedit_headers *cmd_masks; 2205c500c86bSPablo Neira Ayuso int err; 2206c500c86bSPablo Neira Ayuso u8 cmd; 2207c500c86bSPablo Neira Ayuso 2208218d05ceSTonghao Zhang if (!parse_attr->mod_hdr_actions) { 2209c500c86bSPablo Neira Ayuso err = alloc_mod_hdr_actions(priv, hdrs, namespace, parse_attr); 2210d79b6df6SOr Gerlitz if (err) 2211d79b6df6SOr Gerlitz goto out_err; 2212218d05ceSTonghao Zhang } 2213d79b6df6SOr Gerlitz 221427c11b6bSEli Britstein err = offload_pedit_fields(hdrs, parse_attr, action_flags, extack); 2215d79b6df6SOr Gerlitz if (err < 0) 2216d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 2217d79b6df6SOr Gerlitz 2218d79b6df6SOr Gerlitz for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) { 2219c500c86bSPablo Neira Ayuso cmd_masks = &hdrs[cmd].masks; 2220d79b6df6SOr Gerlitz if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) { 2221e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2222e98bedf5SEli Britstein "attempt to offload an unsupported field"); 2223b3a433deSOr Gerlitz netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd); 2224d79b6df6SOr Gerlitz print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS, 2225d79b6df6SOr Gerlitz 16, 1, cmd_masks, sizeof(zero_masks), true); 2226d79b6df6SOr Gerlitz err = -EOPNOTSUPP; 2227d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 2228d79b6df6SOr Gerlitz } 2229d79b6df6SOr Gerlitz } 2230d79b6df6SOr Gerlitz 2231d79b6df6SOr Gerlitz return 0; 2232d79b6df6SOr Gerlitz 2233d79b6df6SOr Gerlitz out_dealloc_parsed_actions: 2234d79b6df6SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 2235d79b6df6SOr Gerlitz out_err: 2236d79b6df6SOr Gerlitz return err; 2237d79b6df6SOr Gerlitz } 2238d79b6df6SOr Gerlitz 2239e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv, 2240e98bedf5SEli Britstein u32 action, 2241e98bedf5SEli Britstein u32 update_flags, 2242e98bedf5SEli Britstein struct netlink_ext_ack *extack) 224326c02749SOr Gerlitz { 224426c02749SOr Gerlitz u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP | 224526c02749SOr Gerlitz TCA_CSUM_UPDATE_FLAG_UDP; 224626c02749SOr Gerlitz 224726c02749SOr Gerlitz /* The HW recalcs checksums only if re-writing headers */ 224826c02749SOr Gerlitz if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) { 2249e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2250e98bedf5SEli Britstein "TC csum action is only offloaded with pedit"); 225126c02749SOr Gerlitz netdev_warn(priv->netdev, 225226c02749SOr Gerlitz "TC csum action is only offloaded with pedit\n"); 225326c02749SOr Gerlitz return false; 225426c02749SOr Gerlitz } 225526c02749SOr Gerlitz 225626c02749SOr Gerlitz if (update_flags & ~prot_flags) { 2257e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2258e98bedf5SEli Britstein "can't offload TC csum action for some header/s"); 225926c02749SOr Gerlitz netdev_warn(priv->netdev, 226026c02749SOr Gerlitz "can't offload TC csum action for some header/s - flags %#x\n", 226126c02749SOr Gerlitz update_flags); 226226c02749SOr Gerlitz return false; 226326c02749SOr Gerlitz } 226426c02749SOr Gerlitz 226526c02749SOr Gerlitz return true; 226626c02749SOr Gerlitz } 226726c02749SOr Gerlitz 22688998576bSDmytro Linkin struct ip_ttl_word { 22698998576bSDmytro Linkin __u8 ttl; 22708998576bSDmytro Linkin __u8 protocol; 22718998576bSDmytro Linkin __sum16 check; 22728998576bSDmytro Linkin }; 22738998576bSDmytro Linkin 22748998576bSDmytro Linkin struct ipv6_hoplimit_word { 22758998576bSDmytro Linkin __be16 payload_len; 22768998576bSDmytro Linkin __u8 nexthdr; 22778998576bSDmytro Linkin __u8 hop_limit; 22788998576bSDmytro Linkin }; 22798998576bSDmytro Linkin 22808998576bSDmytro Linkin static bool is_action_keys_supported(const struct flow_action_entry *act) 22818998576bSDmytro Linkin { 22828998576bSDmytro Linkin u32 mask, offset; 22838998576bSDmytro Linkin u8 htype; 22848998576bSDmytro Linkin 22858998576bSDmytro Linkin htype = act->mangle.htype; 22868998576bSDmytro Linkin offset = act->mangle.offset; 22878998576bSDmytro Linkin mask = ~act->mangle.mask; 22888998576bSDmytro Linkin /* For IPv4 & IPv6 header check 4 byte word, 22898998576bSDmytro Linkin * to determine that modified fields 22908998576bSDmytro Linkin * are NOT ttl & hop_limit only. 22918998576bSDmytro Linkin */ 22928998576bSDmytro Linkin if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP4) { 22938998576bSDmytro Linkin struct ip_ttl_word *ttl_word = 22948998576bSDmytro Linkin (struct ip_ttl_word *)&mask; 22958998576bSDmytro Linkin 22968998576bSDmytro Linkin if (offset != offsetof(struct iphdr, ttl) || 22978998576bSDmytro Linkin ttl_word->protocol || 22988998576bSDmytro Linkin ttl_word->check) { 22998998576bSDmytro Linkin return true; 23008998576bSDmytro Linkin } 23018998576bSDmytro Linkin } else if (htype == FLOW_ACT_MANGLE_HDR_TYPE_IP6) { 23028998576bSDmytro Linkin struct ipv6_hoplimit_word *hoplimit_word = 23038998576bSDmytro Linkin (struct ipv6_hoplimit_word *)&mask; 23048998576bSDmytro Linkin 23058998576bSDmytro Linkin if (offset != offsetof(struct ipv6hdr, payload_len) || 23068998576bSDmytro Linkin hoplimit_word->payload_len || 23078998576bSDmytro Linkin hoplimit_word->nexthdr) { 23088998576bSDmytro Linkin return true; 23098998576bSDmytro Linkin } 23108998576bSDmytro Linkin } 23118998576bSDmytro Linkin return false; 23128998576bSDmytro Linkin } 23138998576bSDmytro Linkin 2314bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec, 231573867881SPablo Neira Ayuso struct flow_action *flow_action, 23161651925dSGuy Shattah u32 actions, 2317e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2318bdd66ac0SOr Gerlitz { 231973867881SPablo Neira Ayuso const struct flow_action_entry *act; 2320bdd66ac0SOr Gerlitz bool modify_ip_header; 2321bdd66ac0SOr Gerlitz void *headers_v; 2322bdd66ac0SOr Gerlitz u16 ethertype; 23238998576bSDmytro Linkin u8 ip_proto; 232473867881SPablo Neira Ayuso int i; 2325bdd66ac0SOr Gerlitz 23268377629eSEli Britstein headers_v = get_match_headers_value(actions, spec); 2327bdd66ac0SOr Gerlitz ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype); 2328bdd66ac0SOr Gerlitz 2329bdd66ac0SOr Gerlitz /* for non-IP we only re-write MACs, so we're okay */ 2330bdd66ac0SOr Gerlitz if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6) 2331bdd66ac0SOr Gerlitz goto out_ok; 2332bdd66ac0SOr Gerlitz 2333bdd66ac0SOr Gerlitz modify_ip_header = false; 233473867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 233573867881SPablo Neira Ayuso if (act->id != FLOW_ACTION_MANGLE && 233673867881SPablo Neira Ayuso act->id != FLOW_ACTION_ADD) 2337bdd66ac0SOr Gerlitz continue; 2338bdd66ac0SOr Gerlitz 23398998576bSDmytro Linkin if (is_action_keys_supported(act)) { 2340bdd66ac0SOr Gerlitz modify_ip_header = true; 2341bdd66ac0SOr Gerlitz break; 2342bdd66ac0SOr Gerlitz } 2343bdd66ac0SOr Gerlitz } 2344bdd66ac0SOr Gerlitz 2345bdd66ac0SOr Gerlitz ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol); 23461ccef350SJianbo Liu if (modify_ip_header && ip_proto != IPPROTO_TCP && 23471ccef350SJianbo Liu ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) { 2348e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2349e98bedf5SEli Britstein "can't offload re-write of non TCP/UDP"); 2350bdd66ac0SOr Gerlitz pr_info("can't offload re-write of ip proto %d\n", ip_proto); 2351bdd66ac0SOr Gerlitz return false; 2352bdd66ac0SOr Gerlitz } 2353bdd66ac0SOr Gerlitz 2354bdd66ac0SOr Gerlitz out_ok: 2355bdd66ac0SOr Gerlitz return true; 2356bdd66ac0SOr Gerlitz } 2357bdd66ac0SOr Gerlitz 2358bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv, 235973867881SPablo Neira Ayuso struct flow_action *flow_action, 2360bdd66ac0SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2361e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2362e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2363bdd66ac0SOr Gerlitz { 2364bdd66ac0SOr Gerlitz u32 actions; 2365bdd66ac0SOr Gerlitz 2366bdd66ac0SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 2367bdd66ac0SOr Gerlitz actions = flow->esw_attr->action; 2368bdd66ac0SOr Gerlitz else 2369bdd66ac0SOr Gerlitz actions = flow->nic_attr->action; 2370bdd66ac0SOr Gerlitz 23717e29392eSRoi Dayan if (flow->flags & MLX5E_TC_FLOW_EGRESS && 237235a605dbSEli Britstein !((actions & MLX5_FLOW_CONTEXT_ACTION_DECAP) || 237335a605dbSEli Britstein (actions & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP))) 23747e29392eSRoi Dayan return false; 23757e29392eSRoi Dayan 2376bdd66ac0SOr Gerlitz if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 237773867881SPablo Neira Ayuso return modify_header_match_supported(&parse_attr->spec, 2378a655fe9fSDavid S. Miller flow_action, actions, 2379e98bedf5SEli Britstein extack); 2380bdd66ac0SOr Gerlitz 2381bdd66ac0SOr Gerlitz return true; 2382bdd66ac0SOr Gerlitz } 2383bdd66ac0SOr Gerlitz 23845c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv) 23855c65c564SOr Gerlitz { 23865c65c564SOr Gerlitz struct mlx5_core_dev *fmdev, *pmdev; 2387816f6706SOr Gerlitz u64 fsystem_guid, psystem_guid; 23885c65c564SOr Gerlitz 23895c65c564SOr Gerlitz fmdev = priv->mdev; 23905c65c564SOr Gerlitz pmdev = peer_priv->mdev; 23915c65c564SOr Gerlitz 239259c9d35eSAlaa Hleihel fsystem_guid = mlx5_query_nic_system_image_guid(fmdev); 239359c9d35eSAlaa Hleihel psystem_guid = mlx5_query_nic_system_image_guid(pmdev); 23945c65c564SOr Gerlitz 2395816f6706SOr Gerlitz return (fsystem_guid == psystem_guid); 23965c65c564SOr Gerlitz } 23975c65c564SOr Gerlitz 2398bdc837eeSEli Britstein static int add_vlan_rewrite_action(struct mlx5e_priv *priv, int namespace, 2399bdc837eeSEli Britstein const struct flow_action_entry *act, 2400bdc837eeSEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 2401bdc837eeSEli Britstein struct pedit_headers_action *hdrs, 2402bdc837eeSEli Britstein u32 *action, struct netlink_ext_ack *extack) 2403bdc837eeSEli Britstein { 2404bdc837eeSEli Britstein u16 mask16 = VLAN_VID_MASK; 2405bdc837eeSEli Britstein u16 val16 = act->vlan.vid & VLAN_VID_MASK; 2406bdc837eeSEli Britstein const struct flow_action_entry pedit_act = { 2407bdc837eeSEli Britstein .id = FLOW_ACTION_MANGLE, 2408bdc837eeSEli Britstein .mangle.htype = FLOW_ACT_MANGLE_HDR_TYPE_ETH, 2409bdc837eeSEli Britstein .mangle.offset = offsetof(struct vlan_ethhdr, h_vlan_TCI), 2410bdc837eeSEli Britstein .mangle.mask = ~(u32)be16_to_cpu(*(__be16 *)&mask16), 2411bdc837eeSEli Britstein .mangle.val = (u32)be16_to_cpu(*(__be16 *)&val16), 2412bdc837eeSEli Britstein }; 24136fca9d1eSEli Britstein u8 match_prio_mask, match_prio_val; 2414bf2f3bcaSEli Britstein void *headers_c, *headers_v; 2415bdc837eeSEli Britstein int err; 2416bdc837eeSEli Britstein 2417bf2f3bcaSEli Britstein headers_c = get_match_headers_criteria(*action, &parse_attr->spec); 2418bf2f3bcaSEli Britstein headers_v = get_match_headers_value(*action, &parse_attr->spec); 2419bf2f3bcaSEli Britstein 2420bf2f3bcaSEli Britstein if (!(MLX5_GET(fte_match_set_lyr_2_4, headers_c, cvlan_tag) && 2421bf2f3bcaSEli Britstein MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag))) { 2422bf2f3bcaSEli Britstein NL_SET_ERR_MSG_MOD(extack, 2423bf2f3bcaSEli Britstein "VLAN rewrite action must have VLAN protocol match"); 2424bf2f3bcaSEli Britstein return -EOPNOTSUPP; 2425bf2f3bcaSEli Britstein } 2426bf2f3bcaSEli Britstein 24276fca9d1eSEli Britstein match_prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 24286fca9d1eSEli Britstein match_prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 24296fca9d1eSEli Britstein if (act->vlan.prio != (match_prio_val & match_prio_mask)) { 24306fca9d1eSEli Britstein NL_SET_ERR_MSG_MOD(extack, 24316fca9d1eSEli Britstein "Changing VLAN prio is not supported"); 2432bdc837eeSEli Britstein return -EOPNOTSUPP; 2433bdc837eeSEli Britstein } 2434bdc837eeSEli Britstein 2435bdc837eeSEli Britstein err = parse_tc_pedit_action(priv, &pedit_act, namespace, parse_attr, 2436bdc837eeSEli Britstein hdrs, NULL); 2437bdc837eeSEli Britstein *action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2438bdc837eeSEli Britstein 2439bdc837eeSEli Britstein return err; 2440bdc837eeSEli Britstein } 2441bdc837eeSEli Britstein 24420bac1194SEli Britstein static int 24430bac1194SEli Britstein add_vlan_prio_tag_rewrite_action(struct mlx5e_priv *priv, 24440bac1194SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 24450bac1194SEli Britstein struct pedit_headers_action *hdrs, 24460bac1194SEli Britstein u32 *action, struct netlink_ext_ack *extack) 24470bac1194SEli Britstein { 24480bac1194SEli Britstein const struct flow_action_entry prio_tag_act = { 24490bac1194SEli Britstein .vlan.vid = 0, 24500bac1194SEli Britstein .vlan.prio = 24510bac1194SEli Britstein MLX5_GET(fte_match_set_lyr_2_4, 24520bac1194SEli Britstein get_match_headers_value(*action, 24530bac1194SEli Britstein &parse_attr->spec), 24540bac1194SEli Britstein first_prio) & 24550bac1194SEli Britstein MLX5_GET(fte_match_set_lyr_2_4, 24560bac1194SEli Britstein get_match_headers_criteria(*action, 24570bac1194SEli Britstein &parse_attr->spec), 24580bac1194SEli Britstein first_prio), 24590bac1194SEli Britstein }; 24600bac1194SEli Britstein 24610bac1194SEli Britstein return add_vlan_rewrite_action(priv, MLX5_FLOW_NAMESPACE_FDB, 24620bac1194SEli Britstein &prio_tag_act, parse_attr, hdrs, action, 24630bac1194SEli Britstein extack); 24640bac1194SEli Britstein } 24650bac1194SEli Britstein 246673867881SPablo Neira Ayuso static int parse_tc_nic_actions(struct mlx5e_priv *priv, 246773867881SPablo Neira Ayuso struct flow_action *flow_action, 2468aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2469e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2470e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2471e3a2b7edSAmir Vadai { 2472aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 247373867881SPablo Neira Ayuso struct pedit_headers_action hdrs[2] = {}; 247473867881SPablo Neira Ayuso const struct flow_action_entry *act; 24751cab1cd7SOr Gerlitz u32 action = 0; 2476244cd96aSCong Wang int err, i; 2477e3a2b7edSAmir Vadai 247873867881SPablo Neira Ayuso if (!flow_action_has_entries(flow_action)) 2479e3a2b7edSAmir Vadai return -EINVAL; 2480e3a2b7edSAmir Vadai 24813bc4b7bfSOr Gerlitz attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG; 2482e3a2b7edSAmir Vadai 248373867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 248473867881SPablo Neira Ayuso switch (act->id) { 248573867881SPablo Neira Ayuso case FLOW_ACTION_DROP: 24861cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP; 2487aad7e08dSAmir Vadai if (MLX5_CAP_FLOWTABLE(priv->mdev, 2488aad7e08dSAmir Vadai flow_table_properties_nic_receive.flow_counter)) 24891cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 249073867881SPablo Neira Ayuso break; 249173867881SPablo Neira Ayuso case FLOW_ACTION_MANGLE: 249273867881SPablo Neira Ayuso case FLOW_ACTION_ADD: 249373867881SPablo Neira Ayuso err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_KERNEL, 2494c500c86bSPablo Neira Ayuso parse_attr, hdrs, extack); 24952f4fe4caSOr Gerlitz if (err) 24962f4fe4caSOr Gerlitz return err; 24972f4fe4caSOr Gerlitz 24981cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR | 24992f4fe4caSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 250073867881SPablo Neira Ayuso break; 2501bdc837eeSEli Britstein case FLOW_ACTION_VLAN_MANGLE: 2502bdc837eeSEli Britstein err = add_vlan_rewrite_action(priv, 2503bdc837eeSEli Britstein MLX5_FLOW_NAMESPACE_KERNEL, 2504bdc837eeSEli Britstein act, parse_attr, hdrs, 2505bdc837eeSEli Britstein &action, extack); 2506bdc837eeSEli Britstein if (err) 2507bdc837eeSEli Britstein return err; 2508bdc837eeSEli Britstein 2509bdc837eeSEli Britstein break; 251073867881SPablo Neira Ayuso case FLOW_ACTION_CSUM: 25111cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 251273867881SPablo Neira Ayuso act->csum_flags, 2513e98bedf5SEli Britstein extack)) 251473867881SPablo Neira Ayuso break; 251526c02749SOr Gerlitz 251626c02749SOr Gerlitz return -EOPNOTSUPP; 251773867881SPablo Neira Ayuso case FLOW_ACTION_REDIRECT: { 251873867881SPablo Neira Ayuso struct net_device *peer_dev = act->dev; 25195c65c564SOr Gerlitz 25205c65c564SOr Gerlitz if (priv->netdev->netdev_ops == peer_dev->netdev_ops && 25215c65c564SOr Gerlitz same_hw_devs(priv, netdev_priv(peer_dev))) { 252298b66cb1SEli Britstein parse_attr->mirred_ifindex[0] = peer_dev->ifindex; 25235c65c564SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_HAIRPIN; 25241cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 25255c65c564SOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 25265c65c564SOr Gerlitz } else { 2527e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2528e98bedf5SEli Britstein "device is not on same HW, can't offload"); 25295c65c564SOr Gerlitz netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n", 25305c65c564SOr Gerlitz peer_dev->name); 25315c65c564SOr Gerlitz return -EINVAL; 25325c65c564SOr Gerlitz } 25335c65c564SOr Gerlitz } 253473867881SPablo Neira Ayuso break; 253573867881SPablo Neira Ayuso case FLOW_ACTION_MARK: { 253673867881SPablo Neira Ayuso u32 mark = act->mark; 2537e3a2b7edSAmir Vadai 2538e3a2b7edSAmir Vadai if (mark & ~MLX5E_TC_FLOW_ID_MASK) { 2539e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2540e98bedf5SEli Britstein "Bad flow mark - only 16 bit is supported"); 2541e3a2b7edSAmir Vadai return -EINVAL; 2542e3a2b7edSAmir Vadai } 2543e3a2b7edSAmir Vadai 25443bc4b7bfSOr Gerlitz attr->flow_tag = mark; 25451cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 2546e3a2b7edSAmir Vadai } 254773867881SPablo Neira Ayuso break; 254873867881SPablo Neira Ayuso default: 25492cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported"); 25502cc1cb1dSTonghao Zhang return -EOPNOTSUPP; 2551e3a2b7edSAmir Vadai } 255273867881SPablo Neira Ayuso } 2553e3a2b7edSAmir Vadai 2554c500c86bSPablo Neira Ayuso if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits || 2555c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) { 2556c500c86bSPablo Neira Ayuso err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_KERNEL, 255727c11b6bSEli Britstein parse_attr, hdrs, &action, extack); 2558c500c86bSPablo Neira Ayuso if (err) 2559c500c86bSPablo Neira Ayuso return err; 256027c11b6bSEli Britstein /* in case all pedit actions are skipped, remove the MOD_HDR 256127c11b6bSEli Britstein * flag. 256227c11b6bSEli Britstein */ 256327c11b6bSEli Britstein if (parse_attr->num_mod_hdr_actions == 0) 256427c11b6bSEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2565c500c86bSPablo Neira Ayuso } 2566c500c86bSPablo Neira Ayuso 25671cab1cd7SOr Gerlitz attr->action = action; 256873867881SPablo Neira Ayuso if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack)) 2569bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 2570bdd66ac0SOr Gerlitz 2571e3a2b7edSAmir Vadai return 0; 2572e3a2b7edSAmir Vadai } 2573e3a2b7edSAmir Vadai 25747f1a546eSEli Britstein struct encap_key { 25757f1a546eSEli Britstein struct ip_tunnel_key *ip_tun_key; 25767f1a546eSEli Britstein int tunnel_type; 25777f1a546eSEli Britstein }; 25787f1a546eSEli Britstein 25797f1a546eSEli Britstein static inline int cmp_encap_info(struct encap_key *a, 25807f1a546eSEli Britstein struct encap_key *b) 2581a54e20b4SHadar Hen Zion { 25827f1a546eSEli Britstein return memcmp(a->ip_tun_key, b->ip_tun_key, sizeof(*a->ip_tun_key)) || 25837f1a546eSEli Britstein a->tunnel_type != b->tunnel_type; 2584a54e20b4SHadar Hen Zion } 2585a54e20b4SHadar Hen Zion 25867f1a546eSEli Britstein static inline int hash_encap_info(struct encap_key *key) 2587a54e20b4SHadar Hen Zion { 25887f1a546eSEli Britstein return jhash(key->ip_tun_key, sizeof(*key->ip_tun_key), 25897f1a546eSEli Britstein key->tunnel_type); 2590a54e20b4SHadar Hen Zion } 2591a54e20b4SHadar Hen Zion 2592a54e20b4SHadar Hen Zion 2593b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv, 2594b1d90e6bSRabie Loulou struct net_device *peer_netdev) 2595b1d90e6bSRabie Loulou { 2596b1d90e6bSRabie Loulou struct mlx5e_priv *peer_priv; 2597b1d90e6bSRabie Loulou 2598b1d90e6bSRabie Loulou peer_priv = netdev_priv(peer_netdev); 2599b1d90e6bSRabie Loulou 2600b1d90e6bSRabie Loulou return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) && 260168931c7dSRoi Dayan mlx5e_eswitch_rep(priv->netdev) && 260268931c7dSRoi Dayan mlx5e_eswitch_rep(peer_netdev) && 260368931c7dSRoi Dayan same_hw_devs(priv, peer_priv)); 2604b1d90e6bSRabie Loulou } 2605b1d90e6bSRabie Loulou 2606ce99f6b9SOr Gerlitz 260754c177caSOz Shlomo 2608a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv, 2609e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2610733d4f36SRoi Dayan struct net_device *mirred_dev, 2611733d4f36SRoi Dayan int out_index, 26128c4dc42bSEli Britstein struct netlink_ext_ack *extack, 26130ad060eeSRoi Dayan struct net_device **encap_dev, 26140ad060eeSRoi Dayan bool *encap_valid) 261503a9d11eSOr Gerlitz { 2616a54e20b4SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 261745247bf2SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 2618733d4f36SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 2619733d4f36SRoi Dayan struct ip_tunnel_info *tun_info; 26207f1a546eSEli Britstein struct encap_key key, e_key; 2621c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 2622733d4f36SRoi Dayan unsigned short family; 2623a54e20b4SHadar Hen Zion uintptr_t hash_key; 2624a54e20b4SHadar Hen Zion bool found = false; 262554c177caSOz Shlomo int err = 0; 2626a54e20b4SHadar Hen Zion 2627733d4f36SRoi Dayan parse_attr = attr->parse_attr; 2628733d4f36SRoi Dayan tun_info = &parse_attr->tun_info[out_index]; 2629733d4f36SRoi Dayan family = ip_tunnel_info_af(tun_info); 26307f1a546eSEli Britstein key.ip_tun_key = &tun_info->key; 26317f1a546eSEli Britstein key.tunnel_type = mlx5e_tc_tun_get_type(mirred_dev); 2632733d4f36SRoi Dayan 26337f1a546eSEli Britstein hash_key = hash_encap_info(&key); 2634a54e20b4SHadar Hen Zion 2635a54e20b4SHadar Hen Zion hash_for_each_possible_rcu(esw->offloads.encap_tbl, e, 2636a54e20b4SHadar Hen Zion encap_hlist, hash_key) { 26377f1a546eSEli Britstein e_key.ip_tun_key = &e->tun_info.key; 26387f1a546eSEli Britstein e_key.tunnel_type = e->tunnel_type; 26397f1a546eSEli Britstein if (!cmp_encap_info(&e_key, &key)) { 2640a54e20b4SHadar Hen Zion found = true; 2641a54e20b4SHadar Hen Zion break; 2642a54e20b4SHadar Hen Zion } 2643a54e20b4SHadar Hen Zion } 2644a54e20b4SHadar Hen Zion 2645b2812089SVlad Buslov /* must verify if encap is valid or not */ 264645247bf2SOr Gerlitz if (found) 264745247bf2SOr Gerlitz goto attach_flow; 2648a54e20b4SHadar Hen Zion 2649a54e20b4SHadar Hen Zion e = kzalloc(sizeof(*e), GFP_KERNEL); 2650a54e20b4SHadar Hen Zion if (!e) 2651a54e20b4SHadar Hen Zion return -ENOMEM; 2652a54e20b4SHadar Hen Zion 265376f7444dSOr Gerlitz e->tun_info = *tun_info; 2654101f4de9SOz Shlomo err = mlx5e_tc_tun_init_encap_attr(mirred_dev, priv, e, extack); 265554c177caSOz Shlomo if (err) 265654c177caSOz Shlomo goto out_err; 265754c177caSOz Shlomo 2658a54e20b4SHadar Hen Zion INIT_LIST_HEAD(&e->flows); 2659a54e20b4SHadar Hen Zion 2660ce99f6b9SOr Gerlitz if (family == AF_INET) 2661101f4de9SOz Shlomo err = mlx5e_tc_tun_create_header_ipv4(priv, mirred_dev, e); 2662ce99f6b9SOr Gerlitz else if (family == AF_INET6) 2663101f4de9SOz Shlomo err = mlx5e_tc_tun_create_header_ipv6(priv, mirred_dev, e); 2664ce99f6b9SOr Gerlitz 26650ad060eeSRoi Dayan if (err) 2666a54e20b4SHadar Hen Zion goto out_err; 2667a54e20b4SHadar Hen Zion 2668a54e20b4SHadar Hen Zion hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key); 2669a54e20b4SHadar Hen Zion 267045247bf2SOr Gerlitz attach_flow: 26718c4dc42bSEli Britstein list_add(&flow->encaps[out_index].list, &e->flows); 26728c4dc42bSEli Britstein flow->encaps[out_index].index = out_index; 267345247bf2SOr Gerlitz *encap_dev = e->out_dev; 26748c4dc42bSEli Britstein if (e->flags & MLX5_ENCAP_ENTRY_VALID) { 26758c4dc42bSEli Britstein attr->dests[out_index].encap_id = e->encap_id; 26768c4dc42bSEli Britstein attr->dests[out_index].flags |= MLX5_ESW_DEST_ENCAP_VALID; 26770ad060eeSRoi Dayan *encap_valid = true; 26788c4dc42bSEli Britstein } else { 26790ad060eeSRoi Dayan *encap_valid = false; 26808c4dc42bSEli Britstein } 268145247bf2SOr Gerlitz 2682232c0013SHadar Hen Zion return err; 2683a54e20b4SHadar Hen Zion 2684a54e20b4SHadar Hen Zion out_err: 2685a54e20b4SHadar Hen Zion kfree(e); 2686a54e20b4SHadar Hen Zion return err; 2687a54e20b4SHadar Hen Zion } 2688a54e20b4SHadar Hen Zion 26891482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv, 269073867881SPablo Neira Ayuso const struct flow_action_entry *act, 26911482bd3dSJianbo Liu struct mlx5_esw_flow_attr *attr, 26921482bd3dSJianbo Liu u32 *action) 26931482bd3dSJianbo Liu { 2694cc495188SJianbo Liu u8 vlan_idx = attr->total_vlan; 2695cc495188SJianbo Liu 2696cc495188SJianbo Liu if (vlan_idx >= MLX5_FS_VLAN_DEPTH) 26971482bd3dSJianbo Liu return -EOPNOTSUPP; 2698cc495188SJianbo Liu 269973867881SPablo Neira Ayuso switch (act->id) { 270073867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_POP: 2701cc495188SJianbo Liu if (vlan_idx) { 2702cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 2703cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 2704cc495188SJianbo Liu return -EOPNOTSUPP; 2705cc495188SJianbo Liu 2706cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2; 2707cc495188SJianbo Liu } else { 2708cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 2709cc495188SJianbo Liu } 271073867881SPablo Neira Ayuso break; 271173867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_PUSH: 271273867881SPablo Neira Ayuso attr->vlan_vid[vlan_idx] = act->vlan.vid; 271373867881SPablo Neira Ayuso attr->vlan_prio[vlan_idx] = act->vlan.prio; 271473867881SPablo Neira Ayuso attr->vlan_proto[vlan_idx] = act->vlan.proto; 2715cc495188SJianbo Liu if (!attr->vlan_proto[vlan_idx]) 2716cc495188SJianbo Liu attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q); 2717cc495188SJianbo Liu 2718cc495188SJianbo Liu if (vlan_idx) { 2719cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 2720cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 2721cc495188SJianbo Liu return -EOPNOTSUPP; 2722cc495188SJianbo Liu 2723cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2; 2724cc495188SJianbo Liu } else { 2725cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) && 272673867881SPablo Neira Ayuso (act->vlan.proto != htons(ETH_P_8021Q) || 272773867881SPablo Neira Ayuso act->vlan.prio)) 2728cc495188SJianbo Liu return -EOPNOTSUPP; 2729cc495188SJianbo Liu 2730cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH; 27311482bd3dSJianbo Liu } 273273867881SPablo Neira Ayuso break; 273373867881SPablo Neira Ayuso default: 2734bdc837eeSEli Britstein return -EINVAL; 27351482bd3dSJianbo Liu } 27361482bd3dSJianbo Liu 2737cc495188SJianbo Liu attr->total_vlan = vlan_idx + 1; 2738cc495188SJianbo Liu 27391482bd3dSJianbo Liu return 0; 27401482bd3dSJianbo Liu } 27411482bd3dSJianbo Liu 2742278748a9SEli Britstein static int add_vlan_push_action(struct mlx5e_priv *priv, 2743278748a9SEli Britstein struct mlx5_esw_flow_attr *attr, 2744278748a9SEli Britstein struct net_device **out_dev, 2745278748a9SEli Britstein u32 *action) 2746278748a9SEli Britstein { 2747278748a9SEli Britstein struct net_device *vlan_dev = *out_dev; 2748278748a9SEli Britstein struct flow_action_entry vlan_act = { 2749278748a9SEli Britstein .id = FLOW_ACTION_VLAN_PUSH, 2750278748a9SEli Britstein .vlan.vid = vlan_dev_vlan_id(vlan_dev), 2751278748a9SEli Britstein .vlan.proto = vlan_dev_vlan_proto(vlan_dev), 2752278748a9SEli Britstein .vlan.prio = 0, 2753278748a9SEli Britstein }; 2754278748a9SEli Britstein int err; 2755278748a9SEli Britstein 2756278748a9SEli Britstein err = parse_tc_vlan_action(priv, &vlan_act, attr, action); 2757278748a9SEli Britstein if (err) 2758278748a9SEli Britstein return err; 2759278748a9SEli Britstein 2760278748a9SEli Britstein *out_dev = dev_get_by_index_rcu(dev_net(vlan_dev), 2761278748a9SEli Britstein dev_get_iflink(vlan_dev)); 2762278748a9SEli Britstein if (is_vlan_dev(*out_dev)) 2763278748a9SEli Britstein err = add_vlan_push_action(priv, attr, out_dev, action); 2764278748a9SEli Britstein 2765278748a9SEli Britstein return err; 2766278748a9SEli Britstein } 2767278748a9SEli Britstein 276835a605dbSEli Britstein static int add_vlan_pop_action(struct mlx5e_priv *priv, 276935a605dbSEli Britstein struct mlx5_esw_flow_attr *attr, 277035a605dbSEli Britstein u32 *action) 277135a605dbSEli Britstein { 277235a605dbSEli Britstein int nest_level = vlan_get_encap_level(attr->parse_attr->filter_dev); 277335a605dbSEli Britstein struct flow_action_entry vlan_act = { 277435a605dbSEli Britstein .id = FLOW_ACTION_VLAN_POP, 277535a605dbSEli Britstein }; 277635a605dbSEli Britstein int err = 0; 277735a605dbSEli Britstein 277835a605dbSEli Britstein while (nest_level--) { 277935a605dbSEli Britstein err = parse_tc_vlan_action(priv, &vlan_act, attr, action); 278035a605dbSEli Britstein if (err) 278135a605dbSEli Britstein return err; 278235a605dbSEli Britstein } 278335a605dbSEli Britstein 278435a605dbSEli Britstein return err; 278535a605dbSEli Britstein } 278635a605dbSEli Britstein 278773867881SPablo Neira Ayuso static int parse_tc_fdb_actions(struct mlx5e_priv *priv, 278873867881SPablo Neira Ayuso struct flow_action *flow_action, 2789e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2790e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2791a54e20b4SHadar Hen Zion { 279273867881SPablo Neira Ayuso struct pedit_headers_action hdrs[2] = {}; 2793bf07aa73SPaul Blakey struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2794ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 27956f9af8ffSTonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr = attr->parse_attr; 27961d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 279773867881SPablo Neira Ayuso const struct ip_tunnel_info *info = NULL; 279873867881SPablo Neira Ayuso const struct flow_action_entry *act; 2799a54e20b4SHadar Hen Zion bool encap = false; 28001cab1cd7SOr Gerlitz u32 action = 0; 2801244cd96aSCong Wang int err, i; 280203a9d11eSOr Gerlitz 280373867881SPablo Neira Ayuso if (!flow_action_has_entries(flow_action)) 280403a9d11eSOr Gerlitz return -EINVAL; 280503a9d11eSOr Gerlitz 28061d447a39SSaeed Mahameed attr->in_rep = rpriv->rep; 280710ff5359SShahar Klein attr->in_mdev = priv->mdev; 280803a9d11eSOr Gerlitz 280973867881SPablo Neira Ayuso flow_action_for_each(i, act, flow_action) { 281073867881SPablo Neira Ayuso switch (act->id) { 281173867881SPablo Neira Ayuso case FLOW_ACTION_DROP: 28121cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP | 281303a9d11eSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 281473867881SPablo Neira Ayuso break; 281573867881SPablo Neira Ayuso case FLOW_ACTION_MANGLE: 281673867881SPablo Neira Ayuso case FLOW_ACTION_ADD: 281773867881SPablo Neira Ayuso err = parse_tc_pedit_action(priv, act, MLX5_FLOW_NAMESPACE_FDB, 2818c500c86bSPablo Neira Ayuso parse_attr, hdrs, extack); 2819d7e75a32SOr Gerlitz if (err) 2820d7e75a32SOr Gerlitz return err; 2821d7e75a32SOr Gerlitz 28221cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2823e85e02baSEli Britstein attr->split_count = attr->out_count; 282473867881SPablo Neira Ayuso break; 282573867881SPablo Neira Ayuso case FLOW_ACTION_CSUM: 28261cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 282773867881SPablo Neira Ayuso act->csum_flags, extack)) 282873867881SPablo Neira Ayuso break; 282926c02749SOr Gerlitz 283026c02749SOr Gerlitz return -EOPNOTSUPP; 283173867881SPablo Neira Ayuso case FLOW_ACTION_REDIRECT: 283273867881SPablo Neira Ayuso case FLOW_ACTION_MIRRED: { 283303a9d11eSOr Gerlitz struct mlx5e_priv *out_priv; 2834592d3651SChris Mi struct net_device *out_dev; 283503a9d11eSOr Gerlitz 283673867881SPablo Neira Ayuso out_dev = act->dev; 2837ef381359SOz Shlomo if (!out_dev) { 2838ef381359SOz Shlomo /* out_dev is NULL when filters with 2839ef381359SOz Shlomo * non-existing mirred device are replayed to 2840ef381359SOz Shlomo * the driver. 2841ef381359SOz Shlomo */ 2842ef381359SOz Shlomo return -EINVAL; 2843ef381359SOz Shlomo } 284403a9d11eSOr Gerlitz 2845592d3651SChris Mi if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) { 2846e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2847e98bedf5SEli Britstein "can't support more output ports, can't offload forwarding"); 2848592d3651SChris Mi pr_err("can't support more than %d output ports, can't offload forwarding\n", 2849592d3651SChris Mi attr->out_count); 2850592d3651SChris Mi return -EOPNOTSUPP; 2851592d3651SChris Mi } 2852592d3651SChris Mi 2853f493f155SEli Britstein action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 2854f493f155SEli Britstein MLX5_FLOW_CONTEXT_ACTION_COUNT; 28556dcfa234SFlorian Fainelli if (netdev_port_same_parent_id(priv->netdev, 2856b1d90e6bSRabie Loulou out_dev) || 2857b1d90e6bSRabie Loulou is_merged_eswitch_dev(priv, out_dev)) { 28587ba58ba7SRabie Loulou struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 28597ba58ba7SRabie Loulou struct net_device *uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH); 28607ba58ba7SRabie Loulou struct net_device *uplink_upper = netdev_master_upper_dev_get(uplink_dev); 28617ba58ba7SRabie Loulou 28627ba58ba7SRabie Loulou if (uplink_upper && 28637ba58ba7SRabie Loulou netif_is_lag_master(uplink_upper) && 28647ba58ba7SRabie Loulou uplink_upper == out_dev) 28657ba58ba7SRabie Loulou out_dev = uplink_dev; 28667ba58ba7SRabie Loulou 2867278748a9SEli Britstein if (is_vlan_dev(out_dev)) { 2868278748a9SEli Britstein err = add_vlan_push_action(priv, attr, 2869278748a9SEli Britstein &out_dev, 2870278748a9SEli Britstein &action); 2871278748a9SEli Britstein if (err) 2872278748a9SEli Britstein return err; 2873278748a9SEli Britstein } 287435a605dbSEli Britstein if (is_vlan_dev(parse_attr->filter_dev)) { 287535a605dbSEli Britstein err = add_vlan_pop_action(priv, attr, 287635a605dbSEli Britstein &action); 287735a605dbSEli Britstein if (err) 287835a605dbSEli Britstein return err; 287935a605dbSEli Britstein } 2880278748a9SEli Britstein 2881a0646c88SEli Britstein if (!mlx5e_eswitch_rep(out_dev)) 2882a0646c88SEli Britstein return -EOPNOTSUPP; 2883a0646c88SEli Britstein 288403a9d11eSOr Gerlitz out_priv = netdev_priv(out_dev); 28851d447a39SSaeed Mahameed rpriv = out_priv->ppriv; 2886df65a573SEli Britstein attr->dests[attr->out_count].rep = rpriv->rep; 2887df65a573SEli Britstein attr->dests[attr->out_count].mdev = out_priv->mdev; 2888df65a573SEli Britstein attr->out_count++; 2889a54e20b4SHadar Hen Zion } else if (encap) { 28908c4dc42bSEli Britstein parse_attr->mirred_ifindex[attr->out_count] = 28918c4dc42bSEli Britstein out_dev->ifindex; 28928c4dc42bSEli Britstein parse_attr->tun_info[attr->out_count] = *info; 28938c4dc42bSEli Britstein encap = false; 2894f493f155SEli Britstein attr->dests[attr->out_count].flags |= 2895f493f155SEli Britstein MLX5_ESW_DEST_ENCAP; 28961cc26d74SEli Britstein attr->out_count++; 2897df65a573SEli Britstein /* attr->dests[].rep is resolved when we 2898df65a573SEli Britstein * handle encap 2899df65a573SEli Britstein */ 2900ef381359SOz Shlomo } else if (parse_attr->filter_dev != priv->netdev) { 2901ef381359SOz Shlomo /* All mlx5 devices are called to configure 2902ef381359SOz Shlomo * high level device filters. Therefore, the 2903ef381359SOz Shlomo * *attempt* to install a filter on invalid 2904ef381359SOz Shlomo * eswitch should not trigger an explicit error 2905ef381359SOz Shlomo */ 2906ef381359SOz Shlomo return -EINVAL; 2907a54e20b4SHadar Hen Zion } else { 2908e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2909e98bedf5SEli Britstein "devices are not on same switch HW, can't offload forwarding"); 2910a54e20b4SHadar Hen Zion pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 2911a54e20b4SHadar Hen Zion priv->netdev->name, out_dev->name); 2912a54e20b4SHadar Hen Zion return -EINVAL; 2913a54e20b4SHadar Hen Zion } 2914a54e20b4SHadar Hen Zion } 291573867881SPablo Neira Ayuso break; 291673867881SPablo Neira Ayuso case FLOW_ACTION_TUNNEL_ENCAP: 291773867881SPablo Neira Ayuso info = act->tunnel; 2918a54e20b4SHadar Hen Zion if (info) 2919a54e20b4SHadar Hen Zion encap = true; 2920a54e20b4SHadar Hen Zion else 2921a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 292203a9d11eSOr Gerlitz 292373867881SPablo Neira Ayuso break; 292473867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_PUSH: 292573867881SPablo Neira Ayuso case FLOW_ACTION_VLAN_POP: 292676b496b1SEli Britstein if (act->id == FLOW_ACTION_VLAN_PUSH && 292776b496b1SEli Britstein (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP)) { 292876b496b1SEli Britstein /* Replace vlan pop+push with vlan modify */ 292976b496b1SEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 293076b496b1SEli Britstein err = add_vlan_rewrite_action(priv, 293176b496b1SEli Britstein MLX5_FLOW_NAMESPACE_FDB, 293276b496b1SEli Britstein act, parse_attr, hdrs, 293376b496b1SEli Britstein &action, extack); 293476b496b1SEli Britstein } else { 293573867881SPablo Neira Ayuso err = parse_tc_vlan_action(priv, act, attr, &action); 293676b496b1SEli Britstein } 29371482bd3dSJianbo Liu if (err) 29381482bd3dSJianbo Liu return err; 29391482bd3dSJianbo Liu 2940e85e02baSEli Britstein attr->split_count = attr->out_count; 294173867881SPablo Neira Ayuso break; 2942bdc837eeSEli Britstein case FLOW_ACTION_VLAN_MANGLE: 2943bdc837eeSEli Britstein err = add_vlan_rewrite_action(priv, 2944bdc837eeSEli Britstein MLX5_FLOW_NAMESPACE_FDB, 2945bdc837eeSEli Britstein act, parse_attr, hdrs, 2946bdc837eeSEli Britstein &action, extack); 2947bdc837eeSEli Britstein if (err) 2948bdc837eeSEli Britstein return err; 2949bdc837eeSEli Britstein 2950bdc837eeSEli Britstein attr->split_count = attr->out_count; 2951bdc837eeSEli Britstein break; 295273867881SPablo Neira Ayuso case FLOW_ACTION_TUNNEL_DECAP: 29531cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DECAP; 295473867881SPablo Neira Ayuso break; 295573867881SPablo Neira Ayuso case FLOW_ACTION_GOTO: { 295673867881SPablo Neira Ayuso u32 dest_chain = act->chain_index; 2957bf07aa73SPaul Blakey u32 max_chain = mlx5_eswitch_get_chain_range(esw); 2958bf07aa73SPaul Blakey 2959bf07aa73SPaul Blakey if (dest_chain <= attr->chain) { 2960bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Goto earlier chain isn't supported"); 2961bf07aa73SPaul Blakey return -EOPNOTSUPP; 2962bf07aa73SPaul Blakey } 2963bf07aa73SPaul Blakey if (dest_chain > max_chain) { 2964bf07aa73SPaul Blakey NL_SET_ERR_MSG(extack, "Requested destination chain is out of supported range"); 2965bf07aa73SPaul Blakey return -EOPNOTSUPP; 2966bf07aa73SPaul Blakey } 2967e88afe75SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 2968bf07aa73SPaul Blakey attr->dest_chain = dest_chain; 296973867881SPablo Neira Ayuso break; 2970bf07aa73SPaul Blakey } 297173867881SPablo Neira Ayuso default: 29722cc1cb1dSTonghao Zhang NL_SET_ERR_MSG_MOD(extack, "The offload action is not supported"); 29732cc1cb1dSTonghao Zhang return -EOPNOTSUPP; 297403a9d11eSOr Gerlitz } 297573867881SPablo Neira Ayuso } 2976bdd66ac0SOr Gerlitz 29770bac1194SEli Britstein if (MLX5_CAP_GEN(esw->dev, prio_tag_required) && 29780bac1194SEli Britstein action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) { 29790bac1194SEli Britstein /* For prio tag mode, replace vlan pop with rewrite vlan prio 29800bac1194SEli Britstein * tag rewrite. 29810bac1194SEli Britstein */ 29820bac1194SEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 29830bac1194SEli Britstein err = add_vlan_prio_tag_rewrite_action(priv, parse_attr, hdrs, 29840bac1194SEli Britstein &action, extack); 29850bac1194SEli Britstein if (err) 29860bac1194SEli Britstein return err; 29870bac1194SEli Britstein } 29880bac1194SEli Britstein 2989c500c86bSPablo Neira Ayuso if (hdrs[TCA_PEDIT_KEY_EX_CMD_SET].pedits || 2990c500c86bSPablo Neira Ayuso hdrs[TCA_PEDIT_KEY_EX_CMD_ADD].pedits) { 299184be899fSTonghao Zhang err = alloc_tc_pedit_action(priv, MLX5_FLOW_NAMESPACE_FDB, 299227c11b6bSEli Britstein parse_attr, hdrs, &action, extack); 2993c500c86bSPablo Neira Ayuso if (err) 2994c500c86bSPablo Neira Ayuso return err; 299527c11b6bSEli Britstein /* in case all pedit actions are skipped, remove the MOD_HDR 299627c11b6bSEli Britstein * flag. we might have set split_count either by pedit or 299727c11b6bSEli Britstein * pop/push. if there is no pop/push either, reset it too. 299827c11b6bSEli Britstein */ 299927c11b6bSEli Britstein if (parse_attr->num_mod_hdr_actions == 0) { 300027c11b6bSEli Britstein action &= ~MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 300127c11b6bSEli Britstein if (!((action & MLX5_FLOW_CONTEXT_ACTION_VLAN_POP) || 300227c11b6bSEli Britstein (action & MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH))) 300327c11b6bSEli Britstein attr->split_count = 0; 300427c11b6bSEli Britstein } 3005c500c86bSPablo Neira Ayuso } 3006c500c86bSPablo Neira Ayuso 30071cab1cd7SOr Gerlitz attr->action = action; 300873867881SPablo Neira Ayuso if (!actions_match_supported(priv, flow_action, parse_attr, flow, extack)) 3009bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 3010bdd66ac0SOr Gerlitz 3011e88afe75SOr Gerlitz if (attr->dest_chain) { 3012e88afe75SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 3013e88afe75SOr Gerlitz NL_SET_ERR_MSG(extack, "Mirroring goto chain rules isn't supported"); 3014e88afe75SOr Gerlitz return -EOPNOTSUPP; 3015e88afe75SOr Gerlitz } 3016e88afe75SOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 3017e88afe75SOr Gerlitz } 3018e88afe75SOr Gerlitz 3019e85e02baSEli Britstein if (attr->split_count > 0 && !mlx5_esw_has_fwd_fdb(priv->mdev)) { 3020e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 3021e98bedf5SEli Britstein "current firmware doesn't support split rule for port mirroring"); 3022592d3651SChris Mi netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n"); 3023592d3651SChris Mi return -EOPNOTSUPP; 3024592d3651SChris Mi } 3025592d3651SChris Mi 302631c8eba5SOr Gerlitz return 0; 302703a9d11eSOr Gerlitz } 302803a9d11eSOr Gerlitz 30295dbe906fSPaul Blakey static void get_flags(int flags, u16 *flow_flags) 303060bd4af8SOr Gerlitz { 30315dbe906fSPaul Blakey u16 __flow_flags = 0; 303260bd4af8SOr Gerlitz 303360bd4af8SOr Gerlitz if (flags & MLX5E_TC_INGRESS) 303460bd4af8SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_INGRESS; 303560bd4af8SOr Gerlitz if (flags & MLX5E_TC_EGRESS) 303660bd4af8SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_EGRESS; 303760bd4af8SOr Gerlitz 3038d9ee0491SOr Gerlitz if (flags & MLX5E_TC_ESW_OFFLOAD) 3039d9ee0491SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_ESWITCH; 3040d9ee0491SOr Gerlitz if (flags & MLX5E_TC_NIC_OFFLOAD) 3041d9ee0491SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_NIC; 3042d9ee0491SOr Gerlitz 304360bd4af8SOr Gerlitz *flow_flags = __flow_flags; 304460bd4af8SOr Gerlitz } 304560bd4af8SOr Gerlitz 304605866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = { 304705866c82SOr Gerlitz .head_offset = offsetof(struct mlx5e_tc_flow, node), 304805866c82SOr Gerlitz .key_offset = offsetof(struct mlx5e_tc_flow, cookie), 304905866c82SOr Gerlitz .key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie), 305005866c82SOr Gerlitz .automatic_shrinking = true, 305105866c82SOr Gerlitz }; 305205866c82SOr Gerlitz 3053d9ee0491SOr Gerlitz static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv, int flags) 305405866c82SOr Gerlitz { 3055655dc3d2SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3056655dc3d2SOr Gerlitz struct mlx5e_rep_priv *uplink_rpriv; 3057655dc3d2SOr Gerlitz 3058d9ee0491SOr Gerlitz if (flags & MLX5E_TC_ESW_OFFLOAD) { 3059655dc3d2SOr Gerlitz uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 3060ec1366c2SOz Shlomo return &uplink_rpriv->uplink_priv.tc_ht; 3061d9ee0491SOr Gerlitz } else /* NIC offload */ 306205866c82SOr Gerlitz return &priv->fs.tc.ht; 306305866c82SOr Gerlitz } 306405866c82SOr Gerlitz 306504de7ddaSRoi Dayan static bool is_peer_flow_needed(struct mlx5e_tc_flow *flow) 306604de7ddaSRoi Dayan { 30671418ddd9SAviv Heller struct mlx5_esw_flow_attr *attr = flow->esw_attr; 3068b05af6aaSBodong Wang bool is_rep_ingress = attr->in_rep->vport != MLX5_VPORT_UPLINK && 30691418ddd9SAviv Heller flow->flags & MLX5E_TC_FLOW_INGRESS; 30701418ddd9SAviv Heller bool act_is_encap = !!(attr->action & 30711418ddd9SAviv Heller MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT); 30721418ddd9SAviv Heller bool esw_paired = mlx5_devcom_is_paired(attr->in_mdev->priv.devcom, 30731418ddd9SAviv Heller MLX5_DEVCOM_ESW_OFFLOADS); 30741418ddd9SAviv Heller 307510fbb1cdSRoi Dayan if (!esw_paired) 307610fbb1cdSRoi Dayan return false; 307710fbb1cdSRoi Dayan 307810fbb1cdSRoi Dayan if ((mlx5_lag_is_sriov(attr->in_mdev) || 307910fbb1cdSRoi Dayan mlx5_lag_is_multipath(attr->in_mdev)) && 308010fbb1cdSRoi Dayan (is_rep_ingress || act_is_encap)) 308110fbb1cdSRoi Dayan return true; 308210fbb1cdSRoi Dayan 308310fbb1cdSRoi Dayan return false; 308404de7ddaSRoi Dayan } 308504de7ddaSRoi Dayan 3086a88780a9SRoi Dayan static int 3087a88780a9SRoi Dayan mlx5e_alloc_flow(struct mlx5e_priv *priv, int attr_size, 30885dbe906fSPaul Blakey struct tc_cls_flower_offload *f, u16 flow_flags, 3089a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr **__parse_attr, 3090a88780a9SRoi Dayan struct mlx5e_tc_flow **__flow) 3091e3a2b7edSAmir Vadai { 309217091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr; 30933bc4b7bfSOr Gerlitz struct mlx5e_tc_flow *flow; 3094a88780a9SRoi Dayan int err; 3095776b12b6SOr Gerlitz 309665ba8fb7SOr Gerlitz flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL); 30971b9a07eeSLeon Romanovsky parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL); 309817091853SOr Gerlitz if (!parse_attr || !flow) { 3099e3a2b7edSAmir Vadai err = -ENOMEM; 3100e3a2b7edSAmir Vadai goto err_free; 3101e3a2b7edSAmir Vadai } 3102e3a2b7edSAmir Vadai 3103e3a2b7edSAmir Vadai flow->cookie = f->cookie; 310465ba8fb7SOr Gerlitz flow->flags = flow_flags; 3105655dc3d2SOr Gerlitz flow->priv = priv; 3106e3a2b7edSAmir Vadai 3107a88780a9SRoi Dayan *__flow = flow; 3108a88780a9SRoi Dayan *__parse_attr = parse_attr; 3109a88780a9SRoi Dayan 3110a88780a9SRoi Dayan return 0; 3111a88780a9SRoi Dayan 3112a88780a9SRoi Dayan err_free: 3113a88780a9SRoi Dayan kfree(flow); 3114a88780a9SRoi Dayan kvfree(parse_attr); 3115a88780a9SRoi Dayan return err; 3116adb4c123SOr Gerlitz } 3117adb4c123SOr Gerlitz 3118988ab9c7STonghao Zhang static void 3119988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(struct mlx5_esw_flow_attr *esw_attr, 3120988ab9c7STonghao Zhang struct mlx5e_priv *priv, 3121988ab9c7STonghao Zhang struct mlx5e_tc_flow_parse_attr *parse_attr, 3122988ab9c7STonghao Zhang struct tc_cls_flower_offload *f, 3123988ab9c7STonghao Zhang struct mlx5_eswitch_rep *in_rep, 3124988ab9c7STonghao Zhang struct mlx5_core_dev *in_mdev) 3125988ab9c7STonghao Zhang { 3126988ab9c7STonghao Zhang struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 3127988ab9c7STonghao Zhang 3128988ab9c7STonghao Zhang esw_attr->parse_attr = parse_attr; 3129988ab9c7STonghao Zhang esw_attr->chain = f->common.chain_index; 3130988ab9c7STonghao Zhang esw_attr->prio = TC_H_MAJ(f->common.prio) >> 16; 3131988ab9c7STonghao Zhang 3132988ab9c7STonghao Zhang esw_attr->in_rep = in_rep; 3133988ab9c7STonghao Zhang esw_attr->in_mdev = in_mdev; 3134988ab9c7STonghao Zhang 3135988ab9c7STonghao Zhang if (MLX5_CAP_ESW(esw->dev, counter_eswitch_affinity) == 3136988ab9c7STonghao Zhang MLX5_COUNTER_SOURCE_ESWITCH) 3137988ab9c7STonghao Zhang esw_attr->counter_dev = in_mdev; 3138988ab9c7STonghao Zhang else 3139988ab9c7STonghao Zhang esw_attr->counter_dev = priv->mdev; 3140988ab9c7STonghao Zhang } 3141988ab9c7STonghao Zhang 314271129676SJason Gunthorpe static struct mlx5e_tc_flow * 314304de7ddaSRoi Dayan __mlx5e_add_fdb_flow(struct mlx5e_priv *priv, 3144a88780a9SRoi Dayan struct tc_cls_flower_offload *f, 31455dbe906fSPaul Blakey u16 flow_flags, 3146d11afc26SOz Shlomo struct net_device *filter_dev, 314704de7ddaSRoi Dayan struct mlx5_eswitch_rep *in_rep, 314871129676SJason Gunthorpe struct mlx5_core_dev *in_mdev) 3149a88780a9SRoi Dayan { 315073867881SPablo Neira Ayuso struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f); 3151a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3152a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 3153a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3154a88780a9SRoi Dayan int attr_size, err; 3155a88780a9SRoi Dayan 3156a88780a9SRoi Dayan flow_flags |= MLX5E_TC_FLOW_ESWITCH; 3157a88780a9SRoi Dayan attr_size = sizeof(struct mlx5_esw_flow_attr); 3158a88780a9SRoi Dayan err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags, 3159a88780a9SRoi Dayan &parse_attr, &flow); 3160a88780a9SRoi Dayan if (err) 3161a88780a9SRoi Dayan goto out; 3162988ab9c7STonghao Zhang 3163d11afc26SOz Shlomo parse_attr->filter_dev = filter_dev; 3164988ab9c7STonghao Zhang mlx5e_flow_esw_attr_init(flow->esw_attr, 3165988ab9c7STonghao Zhang priv, parse_attr, 3166988ab9c7STonghao Zhang f, in_rep, in_mdev); 3167988ab9c7STonghao Zhang 316854c177caSOz Shlomo err = parse_cls_flower(flow->priv, flow, &parse_attr->spec, 316954c177caSOz Shlomo f, filter_dev); 3170d11afc26SOz Shlomo if (err) 3171d11afc26SOz Shlomo goto err_free; 3172a88780a9SRoi Dayan 31736f9af8ffSTonghao Zhang err = parse_tc_fdb_actions(priv, &rule->action, flow, extack); 3174a88780a9SRoi Dayan if (err) 3175a88780a9SRoi Dayan goto err_free; 3176a88780a9SRoi Dayan 31777040632dSTonghao Zhang err = mlx5e_tc_add_fdb_flow(priv, flow, extack); 3178ef06c9eeSRoi Dayan if (err) { 3179ef06c9eeSRoi Dayan if (!(err == -ENETUNREACH && mlx5_lag_is_multipath(in_mdev))) 3180aa0cbbaeSOr Gerlitz goto err_free; 31815c40348cSOr Gerlitz 3182b4a23329SRoi Dayan add_unready_flow(flow); 3183ef06c9eeSRoi Dayan } 3184ef06c9eeSRoi Dayan 318571129676SJason Gunthorpe return flow; 3186e3a2b7edSAmir Vadai 3187e3a2b7edSAmir Vadai err_free: 3188232c0013SHadar Hen Zion kfree(flow); 3189a88780a9SRoi Dayan kvfree(parse_attr); 3190a88780a9SRoi Dayan out: 319171129676SJason Gunthorpe return ERR_PTR(err); 3192a88780a9SRoi Dayan } 3193a88780a9SRoi Dayan 319404de7ddaSRoi Dayan static int mlx5e_tc_add_fdb_peer_flow(struct tc_cls_flower_offload *f, 319595dc1902SRoi Dayan struct mlx5e_tc_flow *flow, 319695dc1902SRoi Dayan u16 flow_flags) 319704de7ddaSRoi Dayan { 319804de7ddaSRoi Dayan struct mlx5e_priv *priv = flow->priv, *peer_priv; 319904de7ddaSRoi Dayan struct mlx5_eswitch *esw = priv->mdev->priv.eswitch, *peer_esw; 320004de7ddaSRoi Dayan struct mlx5_devcom *devcom = priv->mdev->priv.devcom; 320104de7ddaSRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 320204de7ddaSRoi Dayan struct mlx5e_rep_priv *peer_urpriv; 320304de7ddaSRoi Dayan struct mlx5e_tc_flow *peer_flow; 320404de7ddaSRoi Dayan struct mlx5_core_dev *in_mdev; 320504de7ddaSRoi Dayan int err = 0; 320604de7ddaSRoi Dayan 320704de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 320804de7ddaSRoi Dayan if (!peer_esw) 320904de7ddaSRoi Dayan return -ENODEV; 321004de7ddaSRoi Dayan 321104de7ddaSRoi Dayan peer_urpriv = mlx5_eswitch_get_uplink_priv(peer_esw, REP_ETH); 321204de7ddaSRoi Dayan peer_priv = netdev_priv(peer_urpriv->netdev); 321304de7ddaSRoi Dayan 321404de7ddaSRoi Dayan /* in_mdev is assigned of which the packet originated from. 321504de7ddaSRoi Dayan * So packets redirected to uplink use the same mdev of the 321604de7ddaSRoi Dayan * original flow and packets redirected from uplink use the 321704de7ddaSRoi Dayan * peer mdev. 321804de7ddaSRoi Dayan */ 3219b05af6aaSBodong Wang if (flow->esw_attr->in_rep->vport == MLX5_VPORT_UPLINK) 322004de7ddaSRoi Dayan in_mdev = peer_priv->mdev; 322104de7ddaSRoi Dayan else 322204de7ddaSRoi Dayan in_mdev = priv->mdev; 322304de7ddaSRoi Dayan 322404de7ddaSRoi Dayan parse_attr = flow->esw_attr->parse_attr; 322595dc1902SRoi Dayan peer_flow = __mlx5e_add_fdb_flow(peer_priv, f, flow_flags, 322604de7ddaSRoi Dayan parse_attr->filter_dev, 322771129676SJason Gunthorpe flow->esw_attr->in_rep, in_mdev); 322871129676SJason Gunthorpe if (IS_ERR(peer_flow)) { 322971129676SJason Gunthorpe err = PTR_ERR(peer_flow); 323004de7ddaSRoi Dayan goto out; 323171129676SJason Gunthorpe } 323204de7ddaSRoi Dayan 323304de7ddaSRoi Dayan flow->peer_flow = peer_flow; 323404de7ddaSRoi Dayan flow->flags |= MLX5E_TC_FLOW_DUP; 323504de7ddaSRoi Dayan mutex_lock(&esw->offloads.peer_mutex); 323604de7ddaSRoi Dayan list_add_tail(&flow->peer, &esw->offloads.peer_flows); 323704de7ddaSRoi Dayan mutex_unlock(&esw->offloads.peer_mutex); 323804de7ddaSRoi Dayan 323904de7ddaSRoi Dayan out: 324004de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 324104de7ddaSRoi Dayan return err; 324204de7ddaSRoi Dayan } 324304de7ddaSRoi Dayan 324404de7ddaSRoi Dayan static int 324504de7ddaSRoi Dayan mlx5e_add_fdb_flow(struct mlx5e_priv *priv, 324604de7ddaSRoi Dayan struct tc_cls_flower_offload *f, 324704de7ddaSRoi Dayan u16 flow_flags, 324804de7ddaSRoi Dayan struct net_device *filter_dev, 324904de7ddaSRoi Dayan struct mlx5e_tc_flow **__flow) 325004de7ddaSRoi Dayan { 325104de7ddaSRoi Dayan struct mlx5e_rep_priv *rpriv = priv->ppriv; 325204de7ddaSRoi Dayan struct mlx5_eswitch_rep *in_rep = rpriv->rep; 325304de7ddaSRoi Dayan struct mlx5_core_dev *in_mdev = priv->mdev; 325404de7ddaSRoi Dayan struct mlx5e_tc_flow *flow; 325504de7ddaSRoi Dayan int err; 325604de7ddaSRoi Dayan 325771129676SJason Gunthorpe flow = __mlx5e_add_fdb_flow(priv, f, flow_flags, filter_dev, in_rep, 325871129676SJason Gunthorpe in_mdev); 325971129676SJason Gunthorpe if (IS_ERR(flow)) 326071129676SJason Gunthorpe return PTR_ERR(flow); 326104de7ddaSRoi Dayan 326204de7ddaSRoi Dayan if (is_peer_flow_needed(flow)) { 326395dc1902SRoi Dayan err = mlx5e_tc_add_fdb_peer_flow(f, flow, flow_flags); 326404de7ddaSRoi Dayan if (err) { 326504de7ddaSRoi Dayan mlx5e_tc_del_fdb_flow(priv, flow); 326604de7ddaSRoi Dayan goto out; 326704de7ddaSRoi Dayan } 326804de7ddaSRoi Dayan } 326904de7ddaSRoi Dayan 327004de7ddaSRoi Dayan *__flow = flow; 327104de7ddaSRoi Dayan 327204de7ddaSRoi Dayan return 0; 327304de7ddaSRoi Dayan 327404de7ddaSRoi Dayan out: 327504de7ddaSRoi Dayan return err; 327604de7ddaSRoi Dayan } 327704de7ddaSRoi Dayan 3278a88780a9SRoi Dayan static int 3279a88780a9SRoi Dayan mlx5e_add_nic_flow(struct mlx5e_priv *priv, 3280a88780a9SRoi Dayan struct tc_cls_flower_offload *f, 32815dbe906fSPaul Blakey u16 flow_flags, 3282d11afc26SOz Shlomo struct net_device *filter_dev, 3283a88780a9SRoi Dayan struct mlx5e_tc_flow **__flow) 3284a88780a9SRoi Dayan { 328573867881SPablo Neira Ayuso struct flow_rule *rule = tc_cls_flower_offload_flow_rule(f); 3286a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3287a88780a9SRoi Dayan struct mlx5e_tc_flow_parse_attr *parse_attr; 3288a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3289a88780a9SRoi Dayan int attr_size, err; 3290a88780a9SRoi Dayan 3291bf07aa73SPaul Blakey /* multi-chain not supported for NIC rules */ 3292bf07aa73SPaul Blakey if (!tc_cls_can_offload_and_chain0(priv->netdev, &f->common)) 3293bf07aa73SPaul Blakey return -EOPNOTSUPP; 3294bf07aa73SPaul Blakey 3295a88780a9SRoi Dayan flow_flags |= MLX5E_TC_FLOW_NIC; 3296a88780a9SRoi Dayan attr_size = sizeof(struct mlx5_nic_flow_attr); 3297a88780a9SRoi Dayan err = mlx5e_alloc_flow(priv, attr_size, f, flow_flags, 3298a88780a9SRoi Dayan &parse_attr, &flow); 3299a88780a9SRoi Dayan if (err) 3300a88780a9SRoi Dayan goto out; 3301a88780a9SRoi Dayan 3302d11afc26SOz Shlomo parse_attr->filter_dev = filter_dev; 330354c177caSOz Shlomo err = parse_cls_flower(flow->priv, flow, &parse_attr->spec, 330454c177caSOz Shlomo f, filter_dev); 3305d11afc26SOz Shlomo if (err) 3306d11afc26SOz Shlomo goto err_free; 3307d11afc26SOz Shlomo 330873867881SPablo Neira Ayuso err = parse_tc_nic_actions(priv, &rule->action, parse_attr, flow, extack); 3309a88780a9SRoi Dayan if (err) 3310a88780a9SRoi Dayan goto err_free; 3311a88780a9SRoi Dayan 3312a88780a9SRoi Dayan err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack); 3313a88780a9SRoi Dayan if (err) 3314a88780a9SRoi Dayan goto err_free; 3315a88780a9SRoi Dayan 3316a88780a9SRoi Dayan flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 3317a88780a9SRoi Dayan kvfree(parse_attr); 3318a88780a9SRoi Dayan *__flow = flow; 3319a88780a9SRoi Dayan 3320a88780a9SRoi Dayan return 0; 3321a88780a9SRoi Dayan 3322a88780a9SRoi Dayan err_free: 3323a88780a9SRoi Dayan kfree(flow); 3324a88780a9SRoi Dayan kvfree(parse_attr); 3325a88780a9SRoi Dayan out: 3326a88780a9SRoi Dayan return err; 3327a88780a9SRoi Dayan } 3328a88780a9SRoi Dayan 3329a88780a9SRoi Dayan static int 3330a88780a9SRoi Dayan mlx5e_tc_add_flow(struct mlx5e_priv *priv, 3331a88780a9SRoi Dayan struct tc_cls_flower_offload *f, 3332a88780a9SRoi Dayan int flags, 3333d11afc26SOz Shlomo struct net_device *filter_dev, 3334a88780a9SRoi Dayan struct mlx5e_tc_flow **flow) 3335a88780a9SRoi Dayan { 3336a88780a9SRoi Dayan struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 33375dbe906fSPaul Blakey u16 flow_flags; 3338a88780a9SRoi Dayan int err; 3339a88780a9SRoi Dayan 3340a88780a9SRoi Dayan get_flags(flags, &flow_flags); 3341a88780a9SRoi Dayan 3342bf07aa73SPaul Blakey if (!tc_can_offload_extack(priv->netdev, f->common.extack)) 3343bf07aa73SPaul Blakey return -EOPNOTSUPP; 3344bf07aa73SPaul Blakey 3345a88780a9SRoi Dayan if (esw && esw->mode == SRIOV_OFFLOADS) 3346d11afc26SOz Shlomo err = mlx5e_add_fdb_flow(priv, f, flow_flags, 3347d11afc26SOz Shlomo filter_dev, flow); 3348a88780a9SRoi Dayan else 3349d11afc26SOz Shlomo err = mlx5e_add_nic_flow(priv, f, flow_flags, 3350d11afc26SOz Shlomo filter_dev, flow); 3351a88780a9SRoi Dayan 3352a88780a9SRoi Dayan return err; 3353a88780a9SRoi Dayan } 3354a88780a9SRoi Dayan 335571d82d2aSOz Shlomo int mlx5e_configure_flower(struct net_device *dev, struct mlx5e_priv *priv, 3356a88780a9SRoi Dayan struct tc_cls_flower_offload *f, int flags) 3357a88780a9SRoi Dayan { 3358a88780a9SRoi Dayan struct netlink_ext_ack *extack = f->common.extack; 3359d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 3360a88780a9SRoi Dayan struct mlx5e_tc_flow *flow; 3361a88780a9SRoi Dayan int err = 0; 3362a88780a9SRoi Dayan 3363a88780a9SRoi Dayan flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 3364a88780a9SRoi Dayan if (flow) { 3365a88780a9SRoi Dayan NL_SET_ERR_MSG_MOD(extack, 3366a88780a9SRoi Dayan "flow cookie already exists, ignoring"); 3367a88780a9SRoi Dayan netdev_warn_once(priv->netdev, 3368a88780a9SRoi Dayan "flow cookie %lx already exists, ignoring\n", 3369a88780a9SRoi Dayan f->cookie); 33700e1c1a2fSVlad Buslov err = -EEXIST; 3371a88780a9SRoi Dayan goto out; 3372a88780a9SRoi Dayan } 3373a88780a9SRoi Dayan 3374d11afc26SOz Shlomo err = mlx5e_tc_add_flow(priv, f, flags, dev, &flow); 3375a88780a9SRoi Dayan if (err) 3376a88780a9SRoi Dayan goto out; 3377a88780a9SRoi Dayan 3378a88780a9SRoi Dayan err = rhashtable_insert_fast(tc_ht, &flow->node, tc_ht_params); 3379a88780a9SRoi Dayan if (err) 3380a88780a9SRoi Dayan goto err_free; 3381a88780a9SRoi Dayan 3382a88780a9SRoi Dayan return 0; 3383a88780a9SRoi Dayan 3384a88780a9SRoi Dayan err_free: 3385a88780a9SRoi Dayan mlx5e_tc_del_flow(priv, flow); 3386a88780a9SRoi Dayan kfree(flow); 3387a88780a9SRoi Dayan out: 3388e3a2b7edSAmir Vadai return err; 3389e3a2b7edSAmir Vadai } 3390e3a2b7edSAmir Vadai 33918f8ae895SOr Gerlitz #define DIRECTION_MASK (MLX5E_TC_INGRESS | MLX5E_TC_EGRESS) 33928f8ae895SOr Gerlitz #define FLOW_DIRECTION_MASK (MLX5E_TC_FLOW_INGRESS | MLX5E_TC_FLOW_EGRESS) 33938f8ae895SOr Gerlitz 33948f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags) 33958f8ae895SOr Gerlitz { 33968f8ae895SOr Gerlitz if ((flow->flags & FLOW_DIRECTION_MASK) == (flags & DIRECTION_MASK)) 33978f8ae895SOr Gerlitz return true; 33988f8ae895SOr Gerlitz 33998f8ae895SOr Gerlitz return false; 34008f8ae895SOr Gerlitz } 34018f8ae895SOr Gerlitz 340271d82d2aSOz Shlomo int mlx5e_delete_flower(struct net_device *dev, struct mlx5e_priv *priv, 340360bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 3404e3a2b7edSAmir Vadai { 3405d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 3406e3a2b7edSAmir Vadai struct mlx5e_tc_flow *flow; 3407e3a2b7edSAmir Vadai 340805866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 34098f8ae895SOr Gerlitz if (!flow || !same_flow_direction(flow, flags)) 3410e3a2b7edSAmir Vadai return -EINVAL; 3411e3a2b7edSAmir Vadai 341205866c82SOr Gerlitz rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params); 3413e3a2b7edSAmir Vadai 3414961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 3415e3a2b7edSAmir Vadai 3416e3a2b7edSAmir Vadai kfree(flow); 3417e3a2b7edSAmir Vadai 3418e3a2b7edSAmir Vadai return 0; 3419e3a2b7edSAmir Vadai } 3420e3a2b7edSAmir Vadai 342171d82d2aSOz Shlomo int mlx5e_stats_flower(struct net_device *dev, struct mlx5e_priv *priv, 342260bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 3423aad7e08dSAmir Vadai { 342404de7ddaSRoi Dayan struct mlx5_devcom *devcom = priv->mdev->priv.devcom; 3425d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 342604de7ddaSRoi Dayan struct mlx5_eswitch *peer_esw; 3427aad7e08dSAmir Vadai struct mlx5e_tc_flow *flow; 3428aad7e08dSAmir Vadai struct mlx5_fc *counter; 3429316d5f72SRoi Dayan u64 lastuse = 0; 3430316d5f72SRoi Dayan u64 packets = 0; 3431316d5f72SRoi Dayan u64 bytes = 0; 3432aad7e08dSAmir Vadai 343305866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 34348f8ae895SOr Gerlitz if (!flow || !same_flow_direction(flow, flags)) 3435aad7e08dSAmir Vadai return -EINVAL; 3436aad7e08dSAmir Vadai 3437316d5f72SRoi Dayan if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 3438b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 3439aad7e08dSAmir Vadai if (!counter) 3440aad7e08dSAmir Vadai return 0; 3441aad7e08dSAmir Vadai 3442aad7e08dSAmir Vadai mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 3443316d5f72SRoi Dayan } 3444aad7e08dSAmir Vadai 3445316d5f72SRoi Dayan /* Under multipath it's possible for one rule to be currently 3446316d5f72SRoi Dayan * un-offloaded while the other rule is offloaded. 3447316d5f72SRoi Dayan */ 344804de7ddaSRoi Dayan peer_esw = mlx5_devcom_get_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 344904de7ddaSRoi Dayan if (!peer_esw) 345004de7ddaSRoi Dayan goto out; 345104de7ddaSRoi Dayan 345204de7ddaSRoi Dayan if ((flow->flags & MLX5E_TC_FLOW_DUP) && 345304de7ddaSRoi Dayan (flow->peer_flow->flags & MLX5E_TC_FLOW_OFFLOADED)) { 345404de7ddaSRoi Dayan u64 bytes2; 345504de7ddaSRoi Dayan u64 packets2; 345604de7ddaSRoi Dayan u64 lastuse2; 345704de7ddaSRoi Dayan 345804de7ddaSRoi Dayan counter = mlx5e_tc_get_counter(flow->peer_flow); 3459316d5f72SRoi Dayan if (!counter) 3460316d5f72SRoi Dayan goto no_peer_counter; 346104de7ddaSRoi Dayan mlx5_fc_query_cached(counter, &bytes2, &packets2, &lastuse2); 346204de7ddaSRoi Dayan 346304de7ddaSRoi Dayan bytes += bytes2; 346404de7ddaSRoi Dayan packets += packets2; 346504de7ddaSRoi Dayan lastuse = max_t(u64, lastuse, lastuse2); 346604de7ddaSRoi Dayan } 346704de7ddaSRoi Dayan 3468316d5f72SRoi Dayan no_peer_counter: 346904de7ddaSRoi Dayan mlx5_devcom_release_peer_data(devcom, MLX5_DEVCOM_ESW_OFFLOADS); 347004de7ddaSRoi Dayan out: 34713b1903efSPablo Neira Ayuso flow_stats_update(&f->stats, bytes, packets, lastuse); 3472fed06ee8SOr Gerlitz 3473aad7e08dSAmir Vadai return 0; 3474aad7e08dSAmir Vadai } 3475aad7e08dSAmir Vadai 34764d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv, 34774d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv) 34784d8fcf21SAlaa Hleihel { 34794d8fcf21SAlaa Hleihel struct mlx5_core_dev *peer_mdev = peer_priv->mdev; 34804d8fcf21SAlaa Hleihel struct mlx5e_hairpin_entry *hpe; 34814d8fcf21SAlaa Hleihel u16 peer_vhca_id; 34824d8fcf21SAlaa Hleihel int bkt; 34834d8fcf21SAlaa Hleihel 34844d8fcf21SAlaa Hleihel if (!same_hw_devs(priv, peer_priv)) 34854d8fcf21SAlaa Hleihel return; 34864d8fcf21SAlaa Hleihel 34874d8fcf21SAlaa Hleihel peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 34884d8fcf21SAlaa Hleihel 34894d8fcf21SAlaa Hleihel hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) { 34904d8fcf21SAlaa Hleihel if (hpe->peer_vhca_id == peer_vhca_id) 34914d8fcf21SAlaa Hleihel hpe->hp->pair->peer_gone = true; 34924d8fcf21SAlaa Hleihel } 34934d8fcf21SAlaa Hleihel } 34944d8fcf21SAlaa Hleihel 34954d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this, 34964d8fcf21SAlaa Hleihel unsigned long event, void *ptr) 34974d8fcf21SAlaa Hleihel { 34984d8fcf21SAlaa Hleihel struct net_device *ndev = netdev_notifier_info_to_dev(ptr); 34994d8fcf21SAlaa Hleihel struct mlx5e_flow_steering *fs; 35004d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv; 35014d8fcf21SAlaa Hleihel struct mlx5e_tc_table *tc; 35024d8fcf21SAlaa Hleihel struct mlx5e_priv *priv; 35034d8fcf21SAlaa Hleihel 35044d8fcf21SAlaa Hleihel if (ndev->netdev_ops != &mlx5e_netdev_ops || 35054d8fcf21SAlaa Hleihel event != NETDEV_UNREGISTER || 35064d8fcf21SAlaa Hleihel ndev->reg_state == NETREG_REGISTERED) 35074d8fcf21SAlaa Hleihel return NOTIFY_DONE; 35084d8fcf21SAlaa Hleihel 35094d8fcf21SAlaa Hleihel tc = container_of(this, struct mlx5e_tc_table, netdevice_nb); 35104d8fcf21SAlaa Hleihel fs = container_of(tc, struct mlx5e_flow_steering, tc); 35114d8fcf21SAlaa Hleihel priv = container_of(fs, struct mlx5e_priv, fs); 35124d8fcf21SAlaa Hleihel peer_priv = netdev_priv(ndev); 35134d8fcf21SAlaa Hleihel if (priv == peer_priv || 35144d8fcf21SAlaa Hleihel !(priv->netdev->features & NETIF_F_HW_TC)) 35154d8fcf21SAlaa Hleihel return NOTIFY_DONE; 35164d8fcf21SAlaa Hleihel 35174d8fcf21SAlaa Hleihel mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv); 35184d8fcf21SAlaa Hleihel 35194d8fcf21SAlaa Hleihel return NOTIFY_DONE; 35204d8fcf21SAlaa Hleihel } 35214d8fcf21SAlaa Hleihel 3522655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv) 3523e8f887acSAmir Vadai { 3524acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 35254d8fcf21SAlaa Hleihel int err; 3526e8f887acSAmir Vadai 352711c9c548SOr Gerlitz hash_init(tc->mod_hdr_tbl); 35285c65c564SOr Gerlitz hash_init(tc->hairpin_tbl); 352911c9c548SOr Gerlitz 35304d8fcf21SAlaa Hleihel err = rhashtable_init(&tc->ht, &tc_ht_params); 35314d8fcf21SAlaa Hleihel if (err) 35324d8fcf21SAlaa Hleihel return err; 35334d8fcf21SAlaa Hleihel 35344d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event; 35354d8fcf21SAlaa Hleihel if (register_netdevice_notifier(&tc->netdevice_nb)) { 35364d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = NULL; 35374d8fcf21SAlaa Hleihel mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n"); 35384d8fcf21SAlaa Hleihel } 35394d8fcf21SAlaa Hleihel 35404d8fcf21SAlaa Hleihel return err; 3541e8f887acSAmir Vadai } 3542e8f887acSAmir Vadai 3543e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg) 3544e8f887acSAmir Vadai { 3545e8f887acSAmir Vadai struct mlx5e_tc_flow *flow = ptr; 3546655dc3d2SOr Gerlitz struct mlx5e_priv *priv = flow->priv; 3547e8f887acSAmir Vadai 3548961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 3549e8f887acSAmir Vadai kfree(flow); 3550e8f887acSAmir Vadai } 3551e8f887acSAmir Vadai 3552655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv) 3553e8f887acSAmir Vadai { 3554acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 3555e8f887acSAmir Vadai 35564d8fcf21SAlaa Hleihel if (tc->netdevice_nb.notifier_call) 35574d8fcf21SAlaa Hleihel unregister_netdevice_notifier(&tc->netdevice_nb); 35584d8fcf21SAlaa Hleihel 3559d9ee0491SOr Gerlitz rhashtable_destroy(&tc->ht); 3560e8f887acSAmir Vadai 3561acff797cSMaor Gottlieb if (!IS_ERR_OR_NULL(tc->t)) { 3562acff797cSMaor Gottlieb mlx5_destroy_flow_table(tc->t); 3563acff797cSMaor Gottlieb tc->t = NULL; 3564e8f887acSAmir Vadai } 3565e8f887acSAmir Vadai } 3566655dc3d2SOr Gerlitz 3567655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht) 3568655dc3d2SOr Gerlitz { 3569655dc3d2SOr Gerlitz return rhashtable_init(tc_ht, &tc_ht_params); 3570655dc3d2SOr Gerlitz } 3571655dc3d2SOr Gerlitz 3572655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht) 3573655dc3d2SOr Gerlitz { 3574655dc3d2SOr Gerlitz rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL); 3575655dc3d2SOr Gerlitz } 357601252a27SOr Gerlitz 3577d9ee0491SOr Gerlitz int mlx5e_tc_num_filters(struct mlx5e_priv *priv, int flags) 357801252a27SOr Gerlitz { 3579d9ee0491SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv, flags); 358001252a27SOr Gerlitz 358101252a27SOr Gerlitz return atomic_read(&tc_ht->nelems); 358201252a27SOr Gerlitz } 358304de7ddaSRoi Dayan 358404de7ddaSRoi Dayan void mlx5e_tc_clean_fdb_peer_flows(struct mlx5_eswitch *esw) 358504de7ddaSRoi Dayan { 358604de7ddaSRoi Dayan struct mlx5e_tc_flow *flow, *tmp; 358704de7ddaSRoi Dayan 358804de7ddaSRoi Dayan list_for_each_entry_safe(flow, tmp, &esw->offloads.peer_flows, peer) 358904de7ddaSRoi Dayan __mlx5e_tc_del_fdb_peer_flow(flow); 359004de7ddaSRoi Dayan } 3591b4a23329SRoi Dayan 3592b4a23329SRoi Dayan void mlx5e_tc_reoffload_flows_work(struct work_struct *work) 3593b4a23329SRoi Dayan { 3594b4a23329SRoi Dayan struct mlx5_rep_uplink_priv *rpriv = 3595b4a23329SRoi Dayan container_of(work, struct mlx5_rep_uplink_priv, 3596b4a23329SRoi Dayan reoffload_flows_work); 3597b4a23329SRoi Dayan struct mlx5e_tc_flow *flow, *tmp; 3598b4a23329SRoi Dayan 3599b4a23329SRoi Dayan rtnl_lock(); 3600b4a23329SRoi Dayan list_for_each_entry_safe(flow, tmp, &rpriv->unready_flows, unready) { 3601b4a23329SRoi Dayan if (!mlx5e_tc_add_fdb_flow(flow->priv, flow, NULL)) 3602b4a23329SRoi Dayan remove_unready_flow(flow); 3603b4a23329SRoi Dayan } 3604b4a23329SRoi Dayan rtnl_unlock(); 3605b4a23329SRoi Dayan } 3606