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/switchdev.h> 4203a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h> 43776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h> 44bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h> 45d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h> 4626c02749SOr Gerlitz #include <net/tc_act/tc_csum.h> 47a54e20b4SHadar Hen Zion #include <net/vxlan.h> 48f6dfb4c3SHadar Hen Zion #include <net/arp.h> 49e8f887acSAmir Vadai #include "en.h" 501d447a39SSaeed Mahameed #include "en_rep.h" 51232c0013SHadar Hen Zion #include "en_tc.h" 5203a9d11eSOr Gerlitz #include "eswitch.h" 53bbd00f7eSHadar Hen Zion #include "vxlan.h" 543f6d08d1SOr Gerlitz #include "fs_core.h" 552c81bfd5SHuy Nguyen #include "en/port.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; 643bc4b7bfSOr Gerlitz }; 653bc4b7bfSOr Gerlitz 6660bd4af8SOr Gerlitz #define MLX5E_TC_FLOW_BASE (MLX5E_TC_LAST_EXPORTED_BIT + 1) 6760bd4af8SOr Gerlitz 6865ba8fb7SOr Gerlitz enum { 6960bd4af8SOr Gerlitz MLX5E_TC_FLOW_INGRESS = MLX5E_TC_INGRESS, 7060bd4af8SOr Gerlitz MLX5E_TC_FLOW_EGRESS = MLX5E_TC_EGRESS, 7160bd4af8SOr Gerlitz MLX5E_TC_FLOW_ESWITCH = BIT(MLX5E_TC_FLOW_BASE), 7260bd4af8SOr Gerlitz MLX5E_TC_FLOW_NIC = BIT(MLX5E_TC_FLOW_BASE + 1), 7360bd4af8SOr Gerlitz MLX5E_TC_FLOW_OFFLOADED = BIT(MLX5E_TC_FLOW_BASE + 2), 7460bd4af8SOr Gerlitz MLX5E_TC_FLOW_HAIRPIN = BIT(MLX5E_TC_FLOW_BASE + 3), 7560bd4af8SOr Gerlitz MLX5E_TC_FLOW_HAIRPIN_RSS = BIT(MLX5E_TC_FLOW_BASE + 4), 7665ba8fb7SOr Gerlitz }; 7765ba8fb7SOr Gerlitz 78e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1 79e4ad91f2SChris Mi 80e8f887acSAmir Vadai struct mlx5e_tc_flow { 81e8f887acSAmir Vadai struct rhash_head node; 82655dc3d2SOr Gerlitz struct mlx5e_priv *priv; 83e8f887acSAmir Vadai u64 cookie; 8465ba8fb7SOr Gerlitz u8 flags; 85e4ad91f2SChris Mi struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1]; 8611c9c548SOr Gerlitz struct list_head encap; /* flows sharing the same encap ID */ 8711c9c548SOr Gerlitz struct list_head mod_hdr; /* flows sharing the same mod hdr ID */ 885c65c564SOr Gerlitz struct list_head hairpin; /* flows sharing the same hairpin */ 893bc4b7bfSOr Gerlitz union { 90ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr esw_attr[0]; 913bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr nic_attr[0]; 923bc4b7bfSOr Gerlitz }; 93e8f887acSAmir Vadai }; 94e8f887acSAmir Vadai 9517091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr { 963c37745eSOr Gerlitz struct ip_tunnel_info tun_info; 9717091853SOr Gerlitz struct mlx5_flow_spec spec; 98d79b6df6SOr Gerlitz int num_mod_hdr_actions; 99d79b6df6SOr Gerlitz void *mod_hdr_actions; 1003c37745eSOr Gerlitz int mirred_ifindex; 10117091853SOr Gerlitz }; 10217091853SOr Gerlitz 103a54e20b4SHadar Hen Zion enum { 104a54e20b4SHadar Hen Zion MLX5_HEADER_TYPE_VXLAN = 0x0, 105a54e20b4SHadar Hen Zion MLX5_HEADER_TYPE_NVGRE = 0x1, 106a54e20b4SHadar Hen Zion }; 107a54e20b4SHadar Hen Zion 108acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4 109b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16) 110e8f887acSAmir Vadai 11177ab67b7SOr Gerlitz struct mlx5e_hairpin { 11277ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 11377ab67b7SOr Gerlitz 11477ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev; 1153f6d08d1SOr Gerlitz struct mlx5e_priv *func_priv; 11677ab67b7SOr Gerlitz u32 tdn; 11777ab67b7SOr Gerlitz u32 tirn; 1183f6d08d1SOr Gerlitz 1193f6d08d1SOr Gerlitz int num_channels; 1203f6d08d1SOr Gerlitz struct mlx5e_rqt indir_rqt; 1213f6d08d1SOr Gerlitz u32 indir_tirn[MLX5E_NUM_INDIR_TIRS]; 1223f6d08d1SOr Gerlitz struct mlx5e_ttc_table ttc; 12377ab67b7SOr Gerlitz }; 12477ab67b7SOr Gerlitz 1255c65c564SOr Gerlitz struct mlx5e_hairpin_entry { 1265c65c564SOr Gerlitz /* a node of a hash table which keeps all the hairpin entries */ 1275c65c564SOr Gerlitz struct hlist_node hairpin_hlist; 1285c65c564SOr Gerlitz 1295c65c564SOr Gerlitz /* flows sharing the same hairpin */ 1305c65c564SOr Gerlitz struct list_head flows; 1315c65c564SOr Gerlitz 132d8822868SOr Gerlitz u16 peer_vhca_id; 133106be53bSOr Gerlitz u8 prio; 1345c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 1355c65c564SOr Gerlitz }; 1365c65c564SOr Gerlitz 13711c9c548SOr Gerlitz struct mod_hdr_key { 13811c9c548SOr Gerlitz int num_actions; 13911c9c548SOr Gerlitz void *actions; 14011c9c548SOr Gerlitz }; 14111c9c548SOr Gerlitz 14211c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry { 14311c9c548SOr Gerlitz /* a node of a hash table which keeps all the mod_hdr entries */ 14411c9c548SOr Gerlitz struct hlist_node mod_hdr_hlist; 14511c9c548SOr Gerlitz 14611c9c548SOr Gerlitz /* flows sharing the same mod_hdr entry */ 14711c9c548SOr Gerlitz struct list_head flows; 14811c9c548SOr Gerlitz 14911c9c548SOr Gerlitz struct mod_hdr_key key; 15011c9c548SOr Gerlitz 15111c9c548SOr Gerlitz u32 mod_hdr_id; 15211c9c548SOr Gerlitz }; 15311c9c548SOr Gerlitz 15411c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto) 15511c9c548SOr Gerlitz 15611c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key) 15711c9c548SOr Gerlitz { 15811c9c548SOr Gerlitz return jhash(key->actions, 15911c9c548SOr Gerlitz key->num_actions * MLX5_MH_ACT_SZ, 0); 16011c9c548SOr Gerlitz } 16111c9c548SOr Gerlitz 16211c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a, 16311c9c548SOr Gerlitz struct mod_hdr_key *b) 16411c9c548SOr Gerlitz { 16511c9c548SOr Gerlitz if (a->num_actions != b->num_actions) 16611c9c548SOr Gerlitz return 1; 16711c9c548SOr Gerlitz 16811c9c548SOr Gerlitz return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ); 16911c9c548SOr Gerlitz } 17011c9c548SOr Gerlitz 17111c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv, 17211c9c548SOr Gerlitz struct mlx5e_tc_flow *flow, 17311c9c548SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 17411c9c548SOr Gerlitz { 17511c9c548SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 17611c9c548SOr Gerlitz int num_actions, actions_size, namespace, err; 17711c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 17811c9c548SOr Gerlitz struct mod_hdr_key key; 17911c9c548SOr Gerlitz bool found = false; 18011c9c548SOr Gerlitz u32 hash_key; 18111c9c548SOr Gerlitz 18211c9c548SOr Gerlitz num_actions = parse_attr->num_mod_hdr_actions; 18311c9c548SOr Gerlitz actions_size = MLX5_MH_ACT_SZ * num_actions; 18411c9c548SOr Gerlitz 18511c9c548SOr Gerlitz key.actions = parse_attr->mod_hdr_actions; 18611c9c548SOr Gerlitz key.num_actions = num_actions; 18711c9c548SOr Gerlitz 18811c9c548SOr Gerlitz hash_key = hash_mod_hdr_info(&key); 18911c9c548SOr Gerlitz 19011c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 19111c9c548SOr Gerlitz namespace = MLX5_FLOW_NAMESPACE_FDB; 19211c9c548SOr Gerlitz hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh, 19311c9c548SOr Gerlitz mod_hdr_hlist, hash_key) { 19411c9c548SOr Gerlitz if (!cmp_mod_hdr_info(&mh->key, &key)) { 19511c9c548SOr Gerlitz found = true; 19611c9c548SOr Gerlitz break; 19711c9c548SOr Gerlitz } 19811c9c548SOr Gerlitz } 19911c9c548SOr Gerlitz } else { 20011c9c548SOr Gerlitz namespace = MLX5_FLOW_NAMESPACE_KERNEL; 20111c9c548SOr Gerlitz hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh, 20211c9c548SOr Gerlitz mod_hdr_hlist, hash_key) { 20311c9c548SOr Gerlitz if (!cmp_mod_hdr_info(&mh->key, &key)) { 20411c9c548SOr Gerlitz found = true; 20511c9c548SOr Gerlitz break; 20611c9c548SOr Gerlitz } 20711c9c548SOr Gerlitz } 20811c9c548SOr Gerlitz } 20911c9c548SOr Gerlitz 21011c9c548SOr Gerlitz if (found) 21111c9c548SOr Gerlitz goto attach_flow; 21211c9c548SOr Gerlitz 21311c9c548SOr Gerlitz mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL); 21411c9c548SOr Gerlitz if (!mh) 21511c9c548SOr Gerlitz return -ENOMEM; 21611c9c548SOr Gerlitz 21711c9c548SOr Gerlitz mh->key.actions = (void *)mh + sizeof(*mh); 21811c9c548SOr Gerlitz memcpy(mh->key.actions, key.actions, actions_size); 21911c9c548SOr Gerlitz mh->key.num_actions = num_actions; 22011c9c548SOr Gerlitz INIT_LIST_HEAD(&mh->flows); 22111c9c548SOr Gerlitz 22211c9c548SOr Gerlitz err = mlx5_modify_header_alloc(priv->mdev, namespace, 22311c9c548SOr Gerlitz mh->key.num_actions, 22411c9c548SOr Gerlitz mh->key.actions, 22511c9c548SOr Gerlitz &mh->mod_hdr_id); 22611c9c548SOr Gerlitz if (err) 22711c9c548SOr Gerlitz goto out_err; 22811c9c548SOr Gerlitz 22911c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 23011c9c548SOr Gerlitz hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key); 23111c9c548SOr Gerlitz else 23211c9c548SOr Gerlitz hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key); 23311c9c548SOr Gerlitz 23411c9c548SOr Gerlitz attach_flow: 23511c9c548SOr Gerlitz list_add(&flow->mod_hdr, &mh->flows); 23611c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 23711c9c548SOr Gerlitz flow->esw_attr->mod_hdr_id = mh->mod_hdr_id; 23811c9c548SOr Gerlitz else 23911c9c548SOr Gerlitz flow->nic_attr->mod_hdr_id = mh->mod_hdr_id; 24011c9c548SOr Gerlitz 24111c9c548SOr Gerlitz return 0; 24211c9c548SOr Gerlitz 24311c9c548SOr Gerlitz out_err: 24411c9c548SOr Gerlitz kfree(mh); 24511c9c548SOr Gerlitz return err; 24611c9c548SOr Gerlitz } 24711c9c548SOr Gerlitz 24811c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv, 24911c9c548SOr Gerlitz struct mlx5e_tc_flow *flow) 25011c9c548SOr Gerlitz { 25111c9c548SOr Gerlitz struct list_head *next = flow->mod_hdr.next; 25211c9c548SOr Gerlitz 25311c9c548SOr Gerlitz list_del(&flow->mod_hdr); 25411c9c548SOr Gerlitz 25511c9c548SOr Gerlitz if (list_empty(next)) { 25611c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 25711c9c548SOr Gerlitz 25811c9c548SOr Gerlitz mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows); 25911c9c548SOr Gerlitz 26011c9c548SOr Gerlitz mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id); 26111c9c548SOr Gerlitz hash_del(&mh->mod_hdr_hlist); 26211c9c548SOr Gerlitz kfree(mh); 26311c9c548SOr Gerlitz } 26411c9c548SOr Gerlitz } 26511c9c548SOr Gerlitz 26677ab67b7SOr Gerlitz static 26777ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex) 26877ab67b7SOr Gerlitz { 26977ab67b7SOr Gerlitz struct net_device *netdev; 27077ab67b7SOr Gerlitz struct mlx5e_priv *priv; 27177ab67b7SOr Gerlitz 27277ab67b7SOr Gerlitz netdev = __dev_get_by_index(net, ifindex); 27377ab67b7SOr Gerlitz priv = netdev_priv(netdev); 27477ab67b7SOr Gerlitz return priv->mdev; 27577ab67b7SOr Gerlitz } 27677ab67b7SOr Gerlitz 27777ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp) 27877ab67b7SOr Gerlitz { 27977ab67b7SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0}; 28077ab67b7SOr Gerlitz void *tirc; 28177ab67b7SOr Gerlitz int err; 28277ab67b7SOr Gerlitz 28377ab67b7SOr Gerlitz err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn); 28477ab67b7SOr Gerlitz if (err) 28577ab67b7SOr Gerlitz goto alloc_tdn_err; 28677ab67b7SOr Gerlitz 28777ab67b7SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 28877ab67b7SOr Gerlitz 28977ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT); 290ddae74acSOr Gerlitz MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]); 29177ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 29277ab67b7SOr Gerlitz 29377ab67b7SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn); 29477ab67b7SOr Gerlitz if (err) 29577ab67b7SOr Gerlitz goto create_tir_err; 29677ab67b7SOr Gerlitz 29777ab67b7SOr Gerlitz return 0; 29877ab67b7SOr Gerlitz 29977ab67b7SOr Gerlitz create_tir_err: 30077ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 30177ab67b7SOr Gerlitz alloc_tdn_err: 30277ab67b7SOr Gerlitz return err; 30377ab67b7SOr Gerlitz } 30477ab67b7SOr Gerlitz 30577ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp) 30677ab67b7SOr Gerlitz { 30777ab67b7SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->tirn); 30877ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 30977ab67b7SOr Gerlitz } 31077ab67b7SOr Gerlitz 3113f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc) 3123f6d08d1SOr Gerlitz { 3133f6d08d1SOr Gerlitz u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn; 3143f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3153f6d08d1SOr Gerlitz int i, ix, sz = MLX5E_INDIR_RQT_SIZE; 3163f6d08d1SOr Gerlitz 3173f6d08d1SOr Gerlitz mlx5e_build_default_indir_rqt(indirection_rqt, sz, 3183f6d08d1SOr Gerlitz hp->num_channels); 3193f6d08d1SOr Gerlitz 3203f6d08d1SOr Gerlitz for (i = 0; i < sz; i++) { 3213f6d08d1SOr Gerlitz ix = i; 3223f6d08d1SOr Gerlitz if (priv->channels.params.rss_hfunc == ETH_RSS_HASH_XOR) 3233f6d08d1SOr Gerlitz ix = mlx5e_bits_invert(i, ilog2(sz)); 3243f6d08d1SOr Gerlitz ix = indirection_rqt[ix]; 3253f6d08d1SOr Gerlitz rqn = hp->pair->rqn[ix]; 3263f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rq_num[i], rqn); 3273f6d08d1SOr Gerlitz } 3283f6d08d1SOr Gerlitz } 3293f6d08d1SOr Gerlitz 3303f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp) 3313f6d08d1SOr Gerlitz { 3323f6d08d1SOr Gerlitz int inlen, err, sz = MLX5E_INDIR_RQT_SIZE; 3333f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3343f6d08d1SOr Gerlitz struct mlx5_core_dev *mdev = priv->mdev; 3353f6d08d1SOr Gerlitz void *rqtc; 3363f6d08d1SOr Gerlitz u32 *in; 3373f6d08d1SOr Gerlitz 3383f6d08d1SOr Gerlitz inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz; 3393f6d08d1SOr Gerlitz in = kvzalloc(inlen, GFP_KERNEL); 3403f6d08d1SOr Gerlitz if (!in) 3413f6d08d1SOr Gerlitz return -ENOMEM; 3423f6d08d1SOr Gerlitz 3433f6d08d1SOr Gerlitz rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context); 3443f6d08d1SOr Gerlitz 3453f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_actual_size, sz); 3463f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_max_size, sz); 3473f6d08d1SOr Gerlitz 3483f6d08d1SOr Gerlitz mlx5e_hairpin_fill_rqt_rqns(hp, rqtc); 3493f6d08d1SOr Gerlitz 3503f6d08d1SOr Gerlitz err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn); 3513f6d08d1SOr Gerlitz if (!err) 3523f6d08d1SOr Gerlitz hp->indir_rqt.enabled = true; 3533f6d08d1SOr Gerlitz 3543f6d08d1SOr Gerlitz kvfree(in); 3553f6d08d1SOr Gerlitz return err; 3563f6d08d1SOr Gerlitz } 3573f6d08d1SOr Gerlitz 3583f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp) 3593f6d08d1SOr Gerlitz { 3603f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3613f6d08d1SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)]; 3623f6d08d1SOr Gerlitz int tt, i, err; 3633f6d08d1SOr Gerlitz void *tirc; 3643f6d08d1SOr Gerlitz 3653f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) { 3663f6d08d1SOr Gerlitz memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in)); 3673f6d08d1SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 3683f6d08d1SOr Gerlitz 3693f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 3703f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT); 3713f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn); 3723f6d08d1SOr Gerlitz mlx5e_build_indir_tir_ctx_hash(&priv->channels.params, tt, tirc, false); 3733f6d08d1SOr Gerlitz 3743f6d08d1SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, 3753f6d08d1SOr Gerlitz MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]); 3763f6d08d1SOr Gerlitz if (err) { 3773f6d08d1SOr Gerlitz mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err); 3783f6d08d1SOr Gerlitz goto err_destroy_tirs; 3793f6d08d1SOr Gerlitz } 3803f6d08d1SOr Gerlitz } 3813f6d08d1SOr Gerlitz return 0; 3823f6d08d1SOr Gerlitz 3833f6d08d1SOr Gerlitz err_destroy_tirs: 3843f6d08d1SOr Gerlitz for (i = 0; i < tt; i++) 3853f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]); 3863f6d08d1SOr Gerlitz return err; 3873f6d08d1SOr Gerlitz } 3883f6d08d1SOr Gerlitz 3893f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp) 3903f6d08d1SOr Gerlitz { 3913f6d08d1SOr Gerlitz int tt; 3923f6d08d1SOr Gerlitz 3933f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 3943f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]); 3953f6d08d1SOr Gerlitz } 3963f6d08d1SOr Gerlitz 3973f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp, 3983f6d08d1SOr Gerlitz struct ttc_params *ttc_params) 3993f6d08d1SOr Gerlitz { 4003f6d08d1SOr Gerlitz struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr; 4013f6d08d1SOr Gerlitz int tt; 4023f6d08d1SOr Gerlitz 4033f6d08d1SOr Gerlitz memset(ttc_params, 0, sizeof(*ttc_params)); 4043f6d08d1SOr Gerlitz 4053f6d08d1SOr Gerlitz ttc_params->any_tt_tirn = hp->tirn; 4063f6d08d1SOr Gerlitz 4073f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 4083f6d08d1SOr Gerlitz ttc_params->indir_tirn[tt] = hp->indir_tirn[tt]; 4093f6d08d1SOr Gerlitz 4103f6d08d1SOr Gerlitz ft_attr->max_fte = MLX5E_NUM_TT; 4113f6d08d1SOr Gerlitz ft_attr->level = MLX5E_TC_TTC_FT_LEVEL; 4123f6d08d1SOr Gerlitz ft_attr->prio = MLX5E_TC_PRIO; 4133f6d08d1SOr Gerlitz } 4143f6d08d1SOr Gerlitz 4153f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp) 4163f6d08d1SOr Gerlitz { 4173f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4183f6d08d1SOr Gerlitz struct ttc_params ttc_params; 4193f6d08d1SOr Gerlitz int err; 4203f6d08d1SOr Gerlitz 4213f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_rqt(hp); 4223f6d08d1SOr Gerlitz if (err) 4233f6d08d1SOr Gerlitz return err; 4243f6d08d1SOr Gerlitz 4253f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_tirs(hp); 4263f6d08d1SOr Gerlitz if (err) 4273f6d08d1SOr Gerlitz goto err_create_indirect_tirs; 4283f6d08d1SOr Gerlitz 4293f6d08d1SOr Gerlitz mlx5e_hairpin_set_ttc_params(hp, &ttc_params); 4303f6d08d1SOr Gerlitz err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc); 4313f6d08d1SOr Gerlitz if (err) 4323f6d08d1SOr Gerlitz goto err_create_ttc_table; 4333f6d08d1SOr Gerlitz 4343f6d08d1SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n", 4353f6d08d1SOr Gerlitz hp->num_channels, hp->ttc.ft.t->id); 4363f6d08d1SOr Gerlitz 4373f6d08d1SOr Gerlitz return 0; 4383f6d08d1SOr Gerlitz 4393f6d08d1SOr Gerlitz err_create_ttc_table: 4403f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 4413f6d08d1SOr Gerlitz err_create_indirect_tirs: 4423f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 4433f6d08d1SOr Gerlitz 4443f6d08d1SOr Gerlitz return err; 4453f6d08d1SOr Gerlitz } 4463f6d08d1SOr Gerlitz 4473f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp) 4483f6d08d1SOr Gerlitz { 4493f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4503f6d08d1SOr Gerlitz 4513f6d08d1SOr Gerlitz mlx5e_destroy_ttc_table(priv, &hp->ttc); 4523f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 4533f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 4543f6d08d1SOr Gerlitz } 4553f6d08d1SOr Gerlitz 45677ab67b7SOr Gerlitz static struct mlx5e_hairpin * 45777ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params, 45877ab67b7SOr Gerlitz int peer_ifindex) 45977ab67b7SOr Gerlitz { 46077ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev, *peer_mdev; 46177ab67b7SOr Gerlitz struct mlx5e_hairpin *hp; 46277ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 46377ab67b7SOr Gerlitz int err; 46477ab67b7SOr Gerlitz 46577ab67b7SOr Gerlitz hp = kzalloc(sizeof(*hp), GFP_KERNEL); 46677ab67b7SOr Gerlitz if (!hp) 46777ab67b7SOr Gerlitz return ERR_PTR(-ENOMEM); 46877ab67b7SOr Gerlitz 46977ab67b7SOr Gerlitz func_mdev = priv->mdev; 47077ab67b7SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 47177ab67b7SOr Gerlitz 47277ab67b7SOr Gerlitz pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params); 47377ab67b7SOr Gerlitz if (IS_ERR(pair)) { 47477ab67b7SOr Gerlitz err = PTR_ERR(pair); 47577ab67b7SOr Gerlitz goto create_pair_err; 47677ab67b7SOr Gerlitz } 47777ab67b7SOr Gerlitz hp->pair = pair; 47877ab67b7SOr Gerlitz hp->func_mdev = func_mdev; 4793f6d08d1SOr Gerlitz hp->func_priv = priv; 4803f6d08d1SOr Gerlitz hp->num_channels = params->num_channels; 48177ab67b7SOr Gerlitz 48277ab67b7SOr Gerlitz err = mlx5e_hairpin_create_transport(hp); 48377ab67b7SOr Gerlitz if (err) 48477ab67b7SOr Gerlitz goto create_transport_err; 48577ab67b7SOr Gerlitz 4863f6d08d1SOr Gerlitz if (hp->num_channels > 1) { 4873f6d08d1SOr Gerlitz err = mlx5e_hairpin_rss_init(hp); 4883f6d08d1SOr Gerlitz if (err) 4893f6d08d1SOr Gerlitz goto rss_init_err; 4903f6d08d1SOr Gerlitz } 4913f6d08d1SOr Gerlitz 49277ab67b7SOr Gerlitz return hp; 49377ab67b7SOr Gerlitz 4943f6d08d1SOr Gerlitz rss_init_err: 4953f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 49677ab67b7SOr Gerlitz create_transport_err: 49777ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 49877ab67b7SOr Gerlitz create_pair_err: 49977ab67b7SOr Gerlitz kfree(hp); 50077ab67b7SOr Gerlitz return ERR_PTR(err); 50177ab67b7SOr Gerlitz } 50277ab67b7SOr Gerlitz 50377ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp) 50477ab67b7SOr Gerlitz { 5053f6d08d1SOr Gerlitz if (hp->num_channels > 1) 5063f6d08d1SOr Gerlitz mlx5e_hairpin_rss_cleanup(hp); 50777ab67b7SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 50877ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 50977ab67b7SOr Gerlitz kvfree(hp); 51077ab67b7SOr Gerlitz } 51177ab67b7SOr Gerlitz 512106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio) 513106be53bSOr Gerlitz { 514106be53bSOr Gerlitz return (peer_vhca_id << 16 | prio); 515106be53bSOr Gerlitz } 516106be53bSOr Gerlitz 5175c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv, 518106be53bSOr Gerlitz u16 peer_vhca_id, u8 prio) 5195c65c564SOr Gerlitz { 5205c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 521106be53bSOr Gerlitz u32 hash_key = hash_hairpin_info(peer_vhca_id, prio); 5225c65c564SOr Gerlitz 5235c65c564SOr Gerlitz hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe, 524106be53bSOr Gerlitz hairpin_hlist, hash_key) { 525106be53bSOr Gerlitz if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio) 5265c65c564SOr Gerlitz return hpe; 5275c65c564SOr Gerlitz } 5285c65c564SOr Gerlitz 5295c65c564SOr Gerlitz return NULL; 5305c65c564SOr Gerlitz } 5315c65c564SOr Gerlitz 532106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8 533106be53bSOr Gerlitz 534106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv, 535106be53bSOr Gerlitz struct mlx5_flow_spec *spec, u8 *match_prio) 536106be53bSOr Gerlitz { 537106be53bSOr Gerlitz void *headers_c, *headers_v; 538106be53bSOr Gerlitz u8 prio_val, prio_mask = 0; 539106be53bSOr Gerlitz bool vlan_present; 540106be53bSOr Gerlitz 541106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB 542106be53bSOr Gerlitz if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) { 543106be53bSOr Gerlitz netdev_warn(priv->netdev, 544106be53bSOr Gerlitz "only PCP trust state supported for hairpin\n"); 545106be53bSOr Gerlitz return -EOPNOTSUPP; 546106be53bSOr Gerlitz } 547106be53bSOr Gerlitz #endif 548106be53bSOr Gerlitz headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers); 549106be53bSOr Gerlitz headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers); 550106be53bSOr Gerlitz 551106be53bSOr Gerlitz vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag); 552106be53bSOr Gerlitz if (vlan_present) { 553106be53bSOr Gerlitz prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 554106be53bSOr Gerlitz prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 555106be53bSOr Gerlitz } 556106be53bSOr Gerlitz 557106be53bSOr Gerlitz if (!vlan_present || !prio_mask) { 558106be53bSOr Gerlitz prio_val = UNKNOWN_MATCH_PRIO; 559106be53bSOr Gerlitz } else if (prio_mask != 0x7) { 560106be53bSOr Gerlitz netdev_warn(priv->netdev, 561106be53bSOr Gerlitz "masked priority match not supported for hairpin\n"); 562106be53bSOr Gerlitz return -EOPNOTSUPP; 563106be53bSOr Gerlitz } 564106be53bSOr Gerlitz 565106be53bSOr Gerlitz *match_prio = prio_val; 566106be53bSOr Gerlitz return 0; 567106be53bSOr Gerlitz } 568106be53bSOr Gerlitz 5695c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv, 5705c65c564SOr Gerlitz struct mlx5e_tc_flow *flow, 5715c65c564SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 5725c65c564SOr Gerlitz { 5735c65c564SOr Gerlitz int peer_ifindex = parse_attr->mirred_ifindex; 5745c65c564SOr Gerlitz struct mlx5_hairpin_params params; 575d8822868SOr Gerlitz struct mlx5_core_dev *peer_mdev; 5765c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 5775c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 5783f6d08d1SOr Gerlitz u64 link_speed64; 5793f6d08d1SOr Gerlitz u32 link_speed; 580106be53bSOr Gerlitz u8 match_prio; 581d8822868SOr Gerlitz u16 peer_id; 5825c65c564SOr Gerlitz int err; 5835c65c564SOr Gerlitz 584d8822868SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 585d8822868SOr Gerlitz if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) { 5865c65c564SOr Gerlitz netdev_warn(priv->netdev, "hairpin is not supported\n"); 5875c65c564SOr Gerlitz return -EOPNOTSUPP; 5885c65c564SOr Gerlitz } 5895c65c564SOr Gerlitz 590d8822868SOr Gerlitz peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 591106be53bSOr Gerlitz err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio); 592106be53bSOr Gerlitz if (err) 593106be53bSOr Gerlitz return err; 594106be53bSOr Gerlitz hpe = mlx5e_hairpin_get(priv, peer_id, match_prio); 5955c65c564SOr Gerlitz if (hpe) 5965c65c564SOr Gerlitz goto attach_flow; 5975c65c564SOr Gerlitz 5985c65c564SOr Gerlitz hpe = kzalloc(sizeof(*hpe), GFP_KERNEL); 5995c65c564SOr Gerlitz if (!hpe) 6005c65c564SOr Gerlitz return -ENOMEM; 6015c65c564SOr Gerlitz 6025c65c564SOr Gerlitz INIT_LIST_HEAD(&hpe->flows); 603d8822868SOr Gerlitz hpe->peer_vhca_id = peer_id; 604106be53bSOr Gerlitz hpe->prio = match_prio; 6055c65c564SOr Gerlitz 6065c65c564SOr Gerlitz params.log_data_size = 15; 6075c65c564SOr Gerlitz params.log_data_size = min_t(u8, params.log_data_size, 6085c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz)); 6095c65c564SOr Gerlitz params.log_data_size = max_t(u8, params.log_data_size, 6105c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz)); 6115c65c564SOr Gerlitz 612eb9180f7SOr Gerlitz params.log_num_packets = params.log_data_size - 613eb9180f7SOr Gerlitz MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev); 614eb9180f7SOr Gerlitz params.log_num_packets = min_t(u8, params.log_num_packets, 615eb9180f7SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets)); 616eb9180f7SOr Gerlitz 617eb9180f7SOr Gerlitz params.q_counter = priv->q_counter; 6183f6d08d1SOr Gerlitz /* set hairpin pair per each 50Gbs share of the link */ 6192c81bfd5SHuy Nguyen mlx5e_port_max_linkspeed(priv->mdev, &link_speed); 6203f6d08d1SOr Gerlitz link_speed = max_t(u32, link_speed, 50000); 6213f6d08d1SOr Gerlitz link_speed64 = link_speed; 6223f6d08d1SOr Gerlitz do_div(link_speed64, 50000); 6233f6d08d1SOr Gerlitz params.num_channels = link_speed64; 6243f6d08d1SOr Gerlitz 6255c65c564SOr Gerlitz hp = mlx5e_hairpin_create(priv, ¶ms, peer_ifindex); 6265c65c564SOr Gerlitz if (IS_ERR(hp)) { 6275c65c564SOr Gerlitz err = PTR_ERR(hp); 6285c65c564SOr Gerlitz goto create_hairpin_err; 6295c65c564SOr Gerlitz } 6305c65c564SOr Gerlitz 631eb9180f7SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n", 632ddae74acSOr Gerlitz hp->tirn, hp->pair->rqn[0], hp->pair->peer_mdev->priv.name, 633eb9180f7SOr Gerlitz hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets); 6345c65c564SOr Gerlitz 6355c65c564SOr Gerlitz hpe->hp = hp; 636106be53bSOr Gerlitz hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist, 637106be53bSOr Gerlitz hash_hairpin_info(peer_id, match_prio)); 6385c65c564SOr Gerlitz 6395c65c564SOr Gerlitz attach_flow: 6403f6d08d1SOr Gerlitz if (hpe->hp->num_channels > 1) { 6413f6d08d1SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_HAIRPIN_RSS; 6423f6d08d1SOr Gerlitz flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t; 6433f6d08d1SOr Gerlitz } else { 6445c65c564SOr Gerlitz flow->nic_attr->hairpin_tirn = hpe->hp->tirn; 6453f6d08d1SOr Gerlitz } 6465c65c564SOr Gerlitz list_add(&flow->hairpin, &hpe->flows); 6473f6d08d1SOr Gerlitz 6485c65c564SOr Gerlitz return 0; 6495c65c564SOr Gerlitz 6505c65c564SOr Gerlitz create_hairpin_err: 6515c65c564SOr Gerlitz kfree(hpe); 6525c65c564SOr Gerlitz return err; 6535c65c564SOr Gerlitz } 6545c65c564SOr Gerlitz 6555c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv, 6565c65c564SOr Gerlitz struct mlx5e_tc_flow *flow) 6575c65c564SOr Gerlitz { 6585c65c564SOr Gerlitz struct list_head *next = flow->hairpin.next; 6595c65c564SOr Gerlitz 6605c65c564SOr Gerlitz list_del(&flow->hairpin); 6615c65c564SOr Gerlitz 6625c65c564SOr Gerlitz /* no more hairpin flows for us, release the hairpin pair */ 6635c65c564SOr Gerlitz if (list_empty(next)) { 6645c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 6655c65c564SOr Gerlitz 6665c65c564SOr Gerlitz hpe = list_entry(next, struct mlx5e_hairpin_entry, flows); 6675c65c564SOr Gerlitz 6685c65c564SOr Gerlitz netdev_dbg(priv->netdev, "del hairpin: peer %s\n", 6695c65c564SOr Gerlitz hpe->hp->pair->peer_mdev->priv.name); 6705c65c564SOr Gerlitz 6715c65c564SOr Gerlitz mlx5e_hairpin_destroy(hpe->hp); 6725c65c564SOr Gerlitz hash_del(&hpe->hairpin_hlist); 6735c65c564SOr Gerlitz kfree(hpe); 6745c65c564SOr Gerlitz } 6755c65c564SOr Gerlitz } 6765c65c564SOr Gerlitz 67774491de9SMark Bloch static struct mlx5_flow_handle * 67874491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv, 67917091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 680aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow) 681e8f887acSAmir Vadai { 682aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 683aad7e08dSAmir Vadai struct mlx5_core_dev *dev = priv->mdev; 6845c65c564SOr Gerlitz struct mlx5_flow_destination dest[2] = {}; 68566958ed9SHadar Hen Zion struct mlx5_flow_act flow_act = { 6863bc4b7bfSOr Gerlitz .action = attr->action, 687a9db0ecfSMatan Barak .has_flow_tag = true, 6883bc4b7bfSOr Gerlitz .flow_tag = attr->flow_tag, 68966958ed9SHadar Hen Zion .encap_id = 0, 69066958ed9SHadar Hen Zion }; 691aad7e08dSAmir Vadai struct mlx5_fc *counter = NULL; 69274491de9SMark Bloch struct mlx5_flow_handle *rule; 693e8f887acSAmir Vadai bool table_created = false; 6945c65c564SOr Gerlitz int err, dest_ix = 0; 695e8f887acSAmir Vadai 6965c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) { 6975c65c564SOr Gerlitz err = mlx5e_hairpin_flow_add(priv, flow, parse_attr); 6985c65c564SOr Gerlitz if (err) { 6995c65c564SOr Gerlitz rule = ERR_PTR(err); 7005c65c564SOr Gerlitz goto err_add_hairpin_flow; 7015c65c564SOr Gerlitz } 7023f6d08d1SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN_RSS) { 7033f6d08d1SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 7043f6d08d1SOr Gerlitz dest[dest_ix].ft = attr->hairpin_ft; 7053f6d08d1SOr Gerlitz } else { 7065c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR; 7075c65c564SOr Gerlitz dest[dest_ix].tir_num = attr->hairpin_tirn; 7083f6d08d1SOr Gerlitz } 7093f6d08d1SOr Gerlitz dest_ix++; 7103f6d08d1SOr Gerlitz } else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 7115c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 7125c65c564SOr Gerlitz dest[dest_ix].ft = priv->fs.vlan.ft.t; 7135c65c564SOr Gerlitz dest_ix++; 7145c65c564SOr Gerlitz } 715aad7e08dSAmir Vadai 7165c65c564SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 7175c65c564SOr Gerlitz counter = mlx5_fc_create(dev, true); 7185c65c564SOr Gerlitz if (IS_ERR(counter)) { 7195c65c564SOr Gerlitz rule = ERR_CAST(counter); 7205c65c564SOr Gerlitz goto err_fc_create; 7215c65c564SOr Gerlitz } 7225c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER; 7235c65c564SOr Gerlitz dest[dest_ix].counter = counter; 7245c65c564SOr Gerlitz dest_ix++; 725aad7e08dSAmir Vadai } 726aad7e08dSAmir Vadai 7272f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 7283099eb5aSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 729d7e75a32SOr Gerlitz flow_act.modify_id = attr->mod_hdr_id; 7302f4fe4caSOr Gerlitz kfree(parse_attr->mod_hdr_actions); 7312f4fe4caSOr Gerlitz if (err) { 7322f4fe4caSOr Gerlitz rule = ERR_PTR(err); 7332f4fe4caSOr Gerlitz goto err_create_mod_hdr_id; 7342f4fe4caSOr Gerlitz } 7352f4fe4caSOr Gerlitz } 7362f4fe4caSOr Gerlitz 737acff797cSMaor Gottlieb if (IS_ERR_OR_NULL(priv->fs.tc.t)) { 73821b9c144SOr Gerlitz int tc_grp_size, tc_tbl_size; 73921b9c144SOr Gerlitz u32 max_flow_counter; 74021b9c144SOr Gerlitz 74121b9c144SOr Gerlitz max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) | 74221b9c144SOr Gerlitz MLX5_CAP_GEN(dev, max_flow_counter_15_0); 74321b9c144SOr Gerlitz 74421b9c144SOr Gerlitz tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE); 74521b9c144SOr Gerlitz 74621b9c144SOr Gerlitz tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS, 74721b9c144SOr Gerlitz BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size))); 74821b9c144SOr Gerlitz 749acff797cSMaor Gottlieb priv->fs.tc.t = 750acff797cSMaor Gottlieb mlx5_create_auto_grouped_flow_table(priv->fs.ns, 751acff797cSMaor Gottlieb MLX5E_TC_PRIO, 75221b9c144SOr Gerlitz tc_tbl_size, 753acff797cSMaor Gottlieb MLX5E_TC_TABLE_NUM_GROUPS, 7543f6d08d1SOr Gerlitz MLX5E_TC_FT_LEVEL, 0); 755acff797cSMaor Gottlieb if (IS_ERR(priv->fs.tc.t)) { 756e8f887acSAmir Vadai netdev_err(priv->netdev, 757e8f887acSAmir Vadai "Failed to create tc offload table\n"); 758aad7e08dSAmir Vadai rule = ERR_CAST(priv->fs.tc.t); 759aad7e08dSAmir Vadai goto err_create_ft; 760e8f887acSAmir Vadai } 761e8f887acSAmir Vadai 762e8f887acSAmir Vadai table_created = true; 763e8f887acSAmir Vadai } 764e8f887acSAmir Vadai 76538aa51c1SOr Gerlitz if (attr->match_level != MLX5_MATCH_NONE) 76617091853SOr Gerlitz parse_attr->spec.match_criteria_enable = MLX5_MATCH_OUTER_HEADERS; 76738aa51c1SOr Gerlitz 76817091853SOr Gerlitz rule = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec, 7695c65c564SOr Gerlitz &flow_act, dest, dest_ix); 770e8f887acSAmir Vadai 771aad7e08dSAmir Vadai if (IS_ERR(rule)) 772aad7e08dSAmir Vadai goto err_add_rule; 773aad7e08dSAmir Vadai 774aad7e08dSAmir Vadai return rule; 775aad7e08dSAmir Vadai 776aad7e08dSAmir Vadai err_add_rule: 777aad7e08dSAmir Vadai if (table_created) { 778acff797cSMaor Gottlieb mlx5_destroy_flow_table(priv->fs.tc.t); 779acff797cSMaor Gottlieb priv->fs.tc.t = NULL; 780e8f887acSAmir Vadai } 781aad7e08dSAmir Vadai err_create_ft: 7822f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 7833099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 7842f4fe4caSOr Gerlitz err_create_mod_hdr_id: 785aad7e08dSAmir Vadai mlx5_fc_destroy(dev, counter); 7865c65c564SOr Gerlitz err_fc_create: 7875c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) 7885c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 7895c65c564SOr Gerlitz err_add_hairpin_flow: 790e8f887acSAmir Vadai return rule; 791e8f887acSAmir Vadai } 792e8f887acSAmir Vadai 793d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv, 794d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 795d85cdccbSOr Gerlitz { 796513f8f7fSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 797d85cdccbSOr Gerlitz struct mlx5_fc *counter = NULL; 798d85cdccbSOr Gerlitz 799e4ad91f2SChris Mi counter = mlx5_flow_rule_counter(flow->rule[0]); 800e4ad91f2SChris Mi mlx5_del_flow_rules(flow->rule[0]); 801d85cdccbSOr Gerlitz mlx5_fc_destroy(priv->mdev, counter); 802d85cdccbSOr Gerlitz 803b3a433deSOr Gerlitz if (!mlx5e_tc_num_filters(priv) && priv->fs.tc.t) { 804d85cdccbSOr Gerlitz mlx5_destroy_flow_table(priv->fs.tc.t); 805d85cdccbSOr Gerlitz priv->fs.tc.t = NULL; 806d85cdccbSOr Gerlitz } 8072f4fe4caSOr Gerlitz 808513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 8093099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 8105c65c564SOr Gerlitz 8115c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) 8125c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 813d85cdccbSOr Gerlitz } 814d85cdccbSOr Gerlitz 815aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 816aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow); 817aa0cbbaeSOr Gerlitz 8183c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv, 8193c37745eSOr Gerlitz struct ip_tunnel_info *tun_info, 8203c37745eSOr Gerlitz struct net_device *mirred_dev, 8213c37745eSOr Gerlitz struct net_device **encap_dev, 8223c37745eSOr Gerlitz struct mlx5e_tc_flow *flow); 8233c37745eSOr Gerlitz 82474491de9SMark Bloch static struct mlx5_flow_handle * 82574491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv, 82617091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 827aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow) 828adb4c123SOr Gerlitz { 829adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 830aa0cbbaeSOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 8313c37745eSOr Gerlitz struct net_device *out_dev, *encap_dev = NULL; 8323c37745eSOr Gerlitz struct mlx5_flow_handle *rule = NULL; 8333c37745eSOr Gerlitz struct mlx5e_rep_priv *rpriv; 8343c37745eSOr Gerlitz struct mlx5e_priv *out_priv; 8358b32580dSOr Gerlitz int err; 8368b32580dSOr Gerlitz 8373c37745eSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_ENCAP) { 8383c37745eSOr Gerlitz out_dev = __dev_get_by_index(dev_net(priv->netdev), 8393c37745eSOr Gerlitz attr->parse_attr->mirred_ifindex); 8403c37745eSOr Gerlitz err = mlx5e_attach_encap(priv, &parse_attr->tun_info, 8413c37745eSOr Gerlitz out_dev, &encap_dev, flow); 8423c37745eSOr Gerlitz if (err) { 8433c37745eSOr Gerlitz rule = ERR_PTR(err); 8443c37745eSOr Gerlitz if (err != -EAGAIN) 8453c37745eSOr Gerlitz goto err_attach_encap; 8463c37745eSOr Gerlitz } 8473c37745eSOr Gerlitz out_priv = netdev_priv(encap_dev); 8483c37745eSOr Gerlitz rpriv = out_priv->ppriv; 849592d3651SChris Mi attr->out_rep[attr->out_count] = rpriv->rep; 850592d3651SChris Mi attr->out_mdev[attr->out_count++] = out_priv->mdev; 8513c37745eSOr Gerlitz } 8523c37745eSOr Gerlitz 8538b32580dSOr Gerlitz err = mlx5_eswitch_add_vlan_action(esw, attr); 854aa0cbbaeSOr Gerlitz if (err) { 855aa0cbbaeSOr Gerlitz rule = ERR_PTR(err); 856aa0cbbaeSOr Gerlitz goto err_add_vlan; 857adb4c123SOr Gerlitz } 858adb4c123SOr Gerlitz 859d7e75a32SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 8601a9527bbSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 861d7e75a32SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 862d7e75a32SOr Gerlitz if (err) { 863d7e75a32SOr Gerlitz rule = ERR_PTR(err); 864d7e75a32SOr Gerlitz goto err_mod_hdr; 865d7e75a32SOr Gerlitz } 866d7e75a32SOr Gerlitz } 867d7e75a32SOr Gerlitz 8683c37745eSOr Gerlitz /* we get here if (1) there's no error (rule being null) or when 8693c37745eSOr Gerlitz * (2) there's an encap action and we're on -EAGAIN (no valid neigh) 8703c37745eSOr Gerlitz */ 8713c37745eSOr Gerlitz if (rule != ERR_PTR(-EAGAIN)) { 872aa0cbbaeSOr Gerlitz rule = mlx5_eswitch_add_offloaded_rule(esw, &parse_attr->spec, attr); 873aa0cbbaeSOr Gerlitz if (IS_ERR(rule)) 874aa0cbbaeSOr Gerlitz goto err_add_rule; 875e4ad91f2SChris Mi 876e4ad91f2SChris Mi if (attr->mirror_count) { 877e4ad91f2SChris Mi flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, &parse_attr->spec, attr); 878e4ad91f2SChris Mi if (IS_ERR(flow->rule[1])) 879e4ad91f2SChris Mi goto err_fwd_rule; 880e4ad91f2SChris Mi } 8813c37745eSOr Gerlitz } 882aa0cbbaeSOr Gerlitz return rule; 883aa0cbbaeSOr Gerlitz 884e4ad91f2SChris Mi err_fwd_rule: 885e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, rule, attr); 886e4ad91f2SChris Mi rule = flow->rule[1]; 887aa0cbbaeSOr Gerlitz err_add_rule: 888513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 8891a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 890d7e75a32SOr Gerlitz err_mod_hdr: 891aa0cbbaeSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 892aa0cbbaeSOr Gerlitz err_add_vlan: 893aa0cbbaeSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_ENCAP) 894aa0cbbaeSOr Gerlitz mlx5e_detach_encap(priv, flow); 8953c37745eSOr Gerlitz err_attach_encap: 896aa0cbbaeSOr Gerlitz return rule; 897aa0cbbaeSOr Gerlitz } 898d85cdccbSOr Gerlitz 899d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv, 900d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 901d85cdccbSOr Gerlitz { 902d85cdccbSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 903d7e75a32SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 904d85cdccbSOr Gerlitz 905232c0013SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 906232c0013SHadar Hen Zion flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED; 907e4ad91f2SChris Mi if (attr->mirror_count) 908e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[1], attr); 909e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr); 910232c0013SHadar Hen Zion } 911d85cdccbSOr Gerlitz 912513f8f7fSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 913d85cdccbSOr Gerlitz 914513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_ENCAP) { 915d85cdccbSOr Gerlitz mlx5e_detach_encap(priv, flow); 916513f8f7fSOr Gerlitz kvfree(attr->parse_attr); 917232c0013SHadar Hen Zion } 918d7e75a32SOr Gerlitz 919513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 9201a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 921d85cdccbSOr Gerlitz } 922d85cdccbSOr Gerlitz 923232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv, 924232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 925232c0013SHadar Hen Zion { 9263c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 9273c37745eSOr Gerlitz struct mlx5_esw_flow_attr *esw_attr; 928232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 929232c0013SHadar Hen Zion int err; 930232c0013SHadar Hen Zion 931232c0013SHadar Hen Zion err = mlx5_encap_alloc(priv->mdev, e->tunnel_type, 932232c0013SHadar Hen Zion e->encap_size, e->encap_header, 933232c0013SHadar Hen Zion &e->encap_id); 934232c0013SHadar Hen Zion if (err) { 935232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n", 936232c0013SHadar Hen Zion err); 937232c0013SHadar Hen Zion return; 938232c0013SHadar Hen Zion } 939232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 940f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(priv); 941232c0013SHadar Hen Zion 942232c0013SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 9433c37745eSOr Gerlitz esw_attr = flow->esw_attr; 9443c37745eSOr Gerlitz esw_attr->encap_id = e->encap_id; 945e4ad91f2SChris Mi flow->rule[0] = mlx5_eswitch_add_offloaded_rule(esw, &esw_attr->parse_attr->spec, esw_attr); 946e4ad91f2SChris Mi if (IS_ERR(flow->rule[0])) { 947e4ad91f2SChris Mi err = PTR_ERR(flow->rule[0]); 948232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n", 949232c0013SHadar Hen Zion err); 950232c0013SHadar Hen Zion continue; 951232c0013SHadar Hen Zion } 952e4ad91f2SChris Mi 953e4ad91f2SChris Mi if (esw_attr->mirror_count) { 954e4ad91f2SChris Mi flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, &esw_attr->parse_attr->spec, esw_attr); 955e4ad91f2SChris Mi if (IS_ERR(flow->rule[1])) { 956e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], esw_attr); 957e4ad91f2SChris Mi err = PTR_ERR(flow->rule[1]); 958e4ad91f2SChris Mi mlx5_core_warn(priv->mdev, "Failed to update cached mirror flow, %d\n", 959e4ad91f2SChris Mi err); 960e4ad91f2SChris Mi continue; 961e4ad91f2SChris Mi } 962e4ad91f2SChris Mi } 963e4ad91f2SChris Mi 964232c0013SHadar Hen Zion flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 965232c0013SHadar Hen Zion } 966232c0013SHadar Hen Zion } 967232c0013SHadar Hen Zion 968232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv, 969232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 970232c0013SHadar Hen Zion { 9713c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 972232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 973232c0013SHadar Hen Zion 974232c0013SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 975232c0013SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 976e4ad91f2SChris Mi struct mlx5_esw_flow_attr *attr = flow->esw_attr; 977e4ad91f2SChris Mi 978232c0013SHadar Hen Zion flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED; 979e4ad91f2SChris Mi if (attr->mirror_count) 980e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[1], attr); 981e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr); 982232c0013SHadar Hen Zion } 983232c0013SHadar Hen Zion } 984232c0013SHadar Hen Zion 985232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) { 986232c0013SHadar Hen Zion e->flags &= ~MLX5_ENCAP_ENTRY_VALID; 987232c0013SHadar Hen Zion mlx5_encap_dealloc(priv->mdev, e->encap_id); 988232c0013SHadar Hen Zion } 989232c0013SHadar Hen Zion } 990232c0013SHadar Hen Zion 991f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe) 992f6dfb4c3SHadar Hen Zion { 993f6dfb4c3SHadar Hen Zion struct mlx5e_neigh *m_neigh = &nhe->m_neigh; 994f6dfb4c3SHadar Hen Zion u64 bytes, packets, lastuse = 0; 995f6dfb4c3SHadar Hen Zion struct mlx5e_tc_flow *flow; 996f6dfb4c3SHadar Hen Zion struct mlx5e_encap_entry *e; 997f6dfb4c3SHadar Hen Zion struct mlx5_fc *counter; 998f6dfb4c3SHadar Hen Zion struct neigh_table *tbl; 999f6dfb4c3SHadar Hen Zion bool neigh_used = false; 1000f6dfb4c3SHadar Hen Zion struct neighbour *n; 1001f6dfb4c3SHadar Hen Zion 1002f6dfb4c3SHadar Hen Zion if (m_neigh->family == AF_INET) 1003f6dfb4c3SHadar Hen Zion tbl = &arp_tbl; 1004f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6) 1005f6dfb4c3SHadar Hen Zion else if (m_neigh->family == AF_INET6) 1006423c9db2SOr Gerlitz tbl = &nd_tbl; 1007f6dfb4c3SHadar Hen Zion #endif 1008f6dfb4c3SHadar Hen Zion else 1009f6dfb4c3SHadar Hen Zion return; 1010f6dfb4c3SHadar Hen Zion 1011f6dfb4c3SHadar Hen Zion list_for_each_entry(e, &nhe->encap_list, encap_list) { 1012f6dfb4c3SHadar Hen Zion if (!(e->flags & MLX5_ENCAP_ENTRY_VALID)) 1013f6dfb4c3SHadar Hen Zion continue; 1014f6dfb4c3SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 1015f6dfb4c3SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 1016e4ad91f2SChris Mi counter = mlx5_flow_rule_counter(flow->rule[0]); 1017f6dfb4c3SHadar Hen Zion mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 1018f6dfb4c3SHadar Hen Zion if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) { 1019f6dfb4c3SHadar Hen Zion neigh_used = true; 1020f6dfb4c3SHadar Hen Zion break; 1021f6dfb4c3SHadar Hen Zion } 1022f6dfb4c3SHadar Hen Zion } 1023f6dfb4c3SHadar Hen Zion } 1024e36d4810SRoi Dayan if (neigh_used) 1025e36d4810SRoi Dayan break; 1026f6dfb4c3SHadar Hen Zion } 1027f6dfb4c3SHadar Hen Zion 1028f6dfb4c3SHadar Hen Zion if (neigh_used) { 1029f6dfb4c3SHadar Hen Zion nhe->reported_lastuse = jiffies; 1030f6dfb4c3SHadar Hen Zion 1031f6dfb4c3SHadar Hen Zion /* find the relevant neigh according to the cached device and 1032f6dfb4c3SHadar Hen Zion * dst ip pair 1033f6dfb4c3SHadar Hen Zion */ 1034f6dfb4c3SHadar Hen Zion n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev); 1035c7f7ba8dSRoi Dayan if (!n) 1036f6dfb4c3SHadar Hen Zion return; 1037f6dfb4c3SHadar Hen Zion 1038f6dfb4c3SHadar Hen Zion neigh_event_send(n, NULL); 1039f6dfb4c3SHadar Hen Zion neigh_release(n); 1040f6dfb4c3SHadar Hen Zion } 1041f6dfb4c3SHadar Hen Zion } 1042f6dfb4c3SHadar Hen Zion 1043d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 1044d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 1045d85cdccbSOr Gerlitz { 10465067b602SRoi Dayan struct list_head *next = flow->encap.next; 10475067b602SRoi Dayan 10485067b602SRoi Dayan list_del(&flow->encap); 10495067b602SRoi Dayan if (list_empty(next)) { 1050c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 10515067b602SRoi Dayan 1052c1ae1152SOr Gerlitz e = list_entry(next, struct mlx5e_encap_entry, flows); 1053232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 1054232c0013SHadar Hen Zion 1055232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 10565067b602SRoi Dayan mlx5_encap_dealloc(priv->mdev, e->encap_id); 1057232c0013SHadar Hen Zion 1058cdc5a7f3SOr Gerlitz hash_del_rcu(&e->encap_hlist); 1059232c0013SHadar Hen Zion kfree(e->encap_header); 10605067b602SRoi Dayan kfree(e); 10615067b602SRoi Dayan } 10625067b602SRoi Dayan } 10635067b602SRoi Dayan 1064e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv, 1065961e8979SRoi Dayan struct mlx5e_tc_flow *flow) 1066e8f887acSAmir Vadai { 1067d85cdccbSOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 1068d85cdccbSOr Gerlitz mlx5e_tc_del_fdb_flow(priv, flow); 1069d85cdccbSOr Gerlitz else 1070d85cdccbSOr Gerlitz mlx5e_tc_del_nic_flow(priv, flow); 1071e8f887acSAmir Vadai } 1072e8f887acSAmir Vadai 1073bbd00f7eSHadar Hen Zion static void parse_vxlan_attr(struct mlx5_flow_spec *spec, 1074bbd00f7eSHadar Hen Zion struct tc_cls_flower_offload *f) 1075bbd00f7eSHadar Hen Zion { 1076bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1077bbd00f7eSHadar Hen Zion outer_headers); 1078bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1079bbd00f7eSHadar Hen Zion outer_headers); 1080bbd00f7eSHadar Hen Zion void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1081bbd00f7eSHadar Hen Zion misc_parameters); 1082bbd00f7eSHadar Hen Zion void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1083bbd00f7eSHadar Hen Zion misc_parameters); 1084bbd00f7eSHadar Hen Zion 1085bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ip_protocol); 1086bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, IPPROTO_UDP); 1087bbd00f7eSHadar Hen Zion 1088bbd00f7eSHadar Hen Zion if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_KEYID)) { 1089bbd00f7eSHadar Hen Zion struct flow_dissector_key_keyid *key = 1090bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1091bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_KEYID, 1092bbd00f7eSHadar Hen Zion f->key); 1093bbd00f7eSHadar Hen Zion struct flow_dissector_key_keyid *mask = 1094bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1095bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_KEYID, 1096bbd00f7eSHadar Hen Zion f->mask); 1097bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_misc, misc_c, vxlan_vni, 1098bbd00f7eSHadar Hen Zion be32_to_cpu(mask->keyid)); 1099bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_misc, misc_v, vxlan_vni, 1100bbd00f7eSHadar Hen Zion be32_to_cpu(key->keyid)); 1101bbd00f7eSHadar Hen Zion } 1102bbd00f7eSHadar Hen Zion } 1103bbd00f7eSHadar Hen Zion 1104bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv, 1105bbd00f7eSHadar Hen Zion struct mlx5_flow_spec *spec, 1106bbd00f7eSHadar Hen Zion struct tc_cls_flower_offload *f) 1107bbd00f7eSHadar Hen Zion { 1108bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1109bbd00f7eSHadar Hen Zion outer_headers); 1110bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1111bbd00f7eSHadar Hen Zion outer_headers); 1112bbd00f7eSHadar Hen Zion 11132e72eb43SOr Gerlitz struct flow_dissector_key_control *enc_control = 11142e72eb43SOr Gerlitz skb_flow_dissector_target(f->dissector, 11152e72eb43SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_CONTROL, 11162e72eb43SOr Gerlitz f->key); 11172e72eb43SOr Gerlitz 1118bbd00f7eSHadar Hen Zion if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_PORTS)) { 1119bbd00f7eSHadar Hen Zion struct flow_dissector_key_ports *key = 1120bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1121bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_PORTS, 1122bbd00f7eSHadar Hen Zion f->key); 1123bbd00f7eSHadar Hen Zion struct flow_dissector_key_ports *mask = 1124bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1125bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_PORTS, 1126bbd00f7eSHadar Hen Zion f->mask); 11271ad9a00aSPaul Blakey struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 1128a4b97ab4SMark Bloch struct mlx5e_rep_priv *uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 11295ed99fb4SMark Bloch struct net_device *up_dev = uplink_rpriv->netdev; 11301ad9a00aSPaul Blakey struct mlx5e_priv *up_priv = netdev_priv(up_dev); 1131bbd00f7eSHadar Hen Zion 1132bbd00f7eSHadar Hen Zion /* Full udp dst port must be given */ 1133bbd00f7eSHadar Hen Zion if (memchr_inv(&mask->dst, 0xff, sizeof(mask->dst))) 11342fcd82e9SOr Gerlitz goto vxlan_match_offload_err; 1135bbd00f7eSHadar Hen Zion 11361ad9a00aSPaul Blakey if (mlx5e_vxlan_lookup_port(up_priv, be16_to_cpu(key->dst)) && 1137bbd00f7eSHadar Hen Zion MLX5_CAP_ESW(priv->mdev, vxlan_encap_decap)) 1138bbd00f7eSHadar Hen Zion parse_vxlan_attr(spec, f); 11392fcd82e9SOr Gerlitz else { 11402fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 11412fcd82e9SOr Gerlitz "%d isn't an offloaded vxlan udp dport\n", be16_to_cpu(key->dst)); 1142bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 11432fcd82e9SOr Gerlitz } 1144bbd00f7eSHadar Hen Zion 1145bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1146bbd00f7eSHadar Hen Zion udp_dport, ntohs(mask->dst)); 1147bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1148bbd00f7eSHadar Hen Zion udp_dport, ntohs(key->dst)); 1149bbd00f7eSHadar Hen Zion 1150cd377663SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1151cd377663SOr Gerlitz udp_sport, ntohs(mask->src)); 1152cd377663SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1153cd377663SOr Gerlitz udp_sport, ntohs(key->src)); 1154bbd00f7eSHadar Hen Zion } else { /* udp dst port must be given */ 11552fcd82e9SOr Gerlitz vxlan_match_offload_err: 11562fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 11572fcd82e9SOr Gerlitz "IP tunnel decap offload supported only for vxlan, must set UDP dport\n"); 1158bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1159bbd00f7eSHadar Hen Zion } 1160bbd00f7eSHadar Hen Zion 11612e72eb43SOr Gerlitz if (enc_control->addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 1162bbd00f7eSHadar Hen Zion struct flow_dissector_key_ipv4_addrs *key = 1163bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1164bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS, 1165bbd00f7eSHadar Hen Zion f->key); 1166bbd00f7eSHadar Hen Zion struct flow_dissector_key_ipv4_addrs *mask = 1167bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1168bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS, 1169bbd00f7eSHadar Hen Zion f->mask); 1170bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1171bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 1172bbd00f7eSHadar Hen Zion ntohl(mask->src)); 1173bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1174bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 1175bbd00f7eSHadar Hen Zion ntohl(key->src)); 1176bbd00f7eSHadar Hen Zion 1177bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1178bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 1179bbd00f7eSHadar Hen Zion ntohl(mask->dst)); 1180bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1181bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 1182bbd00f7eSHadar Hen Zion ntohl(key->dst)); 1183bbd00f7eSHadar Hen Zion 1184bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 1185bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP); 118619f44401SOr Gerlitz } else if (enc_control->addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 118719f44401SOr Gerlitz struct flow_dissector_key_ipv6_addrs *key = 118819f44401SOr Gerlitz skb_flow_dissector_target(f->dissector, 118919f44401SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS, 119019f44401SOr Gerlitz f->key); 119119f44401SOr Gerlitz struct flow_dissector_key_ipv6_addrs *mask = 119219f44401SOr Gerlitz skb_flow_dissector_target(f->dissector, 119319f44401SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS, 119419f44401SOr Gerlitz f->mask); 119519f44401SOr Gerlitz 119619f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 119719f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 119819f44401SOr Gerlitz &mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 119919f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 120019f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 120119f44401SOr Gerlitz &key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 120219f44401SOr Gerlitz 120319f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 120419f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 120519f44401SOr Gerlitz &mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 120619f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 120719f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 120819f44401SOr Gerlitz &key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 120919f44401SOr Gerlitz 121019f44401SOr Gerlitz MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 121119f44401SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6); 12122e72eb43SOr Gerlitz } 1213bbd00f7eSHadar Hen Zion 1214bbd00f7eSHadar Hen Zion /* Enforce DMAC when offloading incoming tunneled flows. 1215bbd00f7eSHadar Hen Zion * Flow counters require a match on the DMAC. 1216bbd00f7eSHadar Hen Zion */ 1217bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16); 1218bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0); 1219bbd00f7eSHadar Hen Zion ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1220bbd00f7eSHadar Hen Zion dmac_47_16), priv->netdev->dev_addr); 1221bbd00f7eSHadar Hen Zion 1222bbd00f7eSHadar Hen Zion /* let software handle IP fragments */ 1223bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 1224bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0); 1225bbd00f7eSHadar Hen Zion 1226bbd00f7eSHadar Hen Zion return 0; 1227bbd00f7eSHadar Hen Zion } 1228bbd00f7eSHadar Hen Zion 1229de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv, 1230de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 1231de0af0bfSRoi Dayan struct tc_cls_flower_offload *f, 1232d708f902SOr Gerlitz u8 *match_level) 1233e3a2b7edSAmir Vadai { 1234c5bb1730SMaor Gottlieb void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1235c5bb1730SMaor Gottlieb outer_headers); 1236c5bb1730SMaor Gottlieb void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1237c5bb1730SMaor Gottlieb outer_headers); 1238699e96ddSJianbo Liu void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1239699e96ddSJianbo Liu misc_parameters); 1240699e96ddSJianbo Liu void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1241699e96ddSJianbo Liu misc_parameters); 1242e3a2b7edSAmir Vadai u16 addr_type = 0; 1243e3a2b7edSAmir Vadai u8 ip_proto = 0; 1244e3a2b7edSAmir Vadai 1245d708f902SOr Gerlitz *match_level = MLX5_MATCH_NONE; 1246de0af0bfSRoi Dayan 1247e3a2b7edSAmir Vadai if (f->dissector->used_keys & 1248e3a2b7edSAmir Vadai ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) | 1249e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_BASIC) | 1250e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) | 1251095b6cfdSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_VLAN) | 1252699e96ddSJianbo Liu BIT(FLOW_DISSECTOR_KEY_CVLAN) | 1253e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) | 1254e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) | 1255bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_PORTS) | 1256bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) | 1257bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) | 1258bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) | 1259bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_PORTS) | 1260e77834ecSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) | 1261fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_TCP) | 1262fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_IP))) { 1263e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n", 1264e3a2b7edSAmir Vadai f->dissector->used_keys); 1265e3a2b7edSAmir Vadai return -EOPNOTSUPP; 1266e3a2b7edSAmir Vadai } 1267e3a2b7edSAmir Vadai 1268bbd00f7eSHadar Hen Zion if ((dissector_uses_key(f->dissector, 1269bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) || 1270bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_KEYID) || 1271bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_PORTS)) && 1272bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_CONTROL)) { 1273bbd00f7eSHadar Hen Zion struct flow_dissector_key_control *key = 1274bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1275bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_CONTROL, 1276bbd00f7eSHadar Hen Zion f->key); 1277bbd00f7eSHadar Hen Zion switch (key->addr_type) { 1278bbd00f7eSHadar Hen Zion case FLOW_DISSECTOR_KEY_IPV4_ADDRS: 127919f44401SOr Gerlitz case FLOW_DISSECTOR_KEY_IPV6_ADDRS: 1280bbd00f7eSHadar Hen Zion if (parse_tunnel_attr(priv, spec, f)) 1281bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1282bbd00f7eSHadar Hen Zion break; 1283bbd00f7eSHadar Hen Zion default: 1284bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1285bbd00f7eSHadar Hen Zion } 1286bbd00f7eSHadar Hen Zion 1287bbd00f7eSHadar Hen Zion /* In decap flow, header pointers should point to the inner 1288bbd00f7eSHadar Hen Zion * headers, outer header were already set by parse_tunnel_attr 1289bbd00f7eSHadar Hen Zion */ 1290bbd00f7eSHadar Hen Zion headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1291bbd00f7eSHadar Hen Zion inner_headers); 1292bbd00f7eSHadar Hen Zion headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1293bbd00f7eSHadar Hen Zion inner_headers); 1294bbd00f7eSHadar Hen Zion } 1295bbd00f7eSHadar Hen Zion 1296e3a2b7edSAmir Vadai if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ETH_ADDRS)) { 1297e3a2b7edSAmir Vadai struct flow_dissector_key_eth_addrs *key = 1298e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1299e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_ETH_ADDRS, 1300e3a2b7edSAmir Vadai f->key); 1301e3a2b7edSAmir Vadai struct flow_dissector_key_eth_addrs *mask = 1302e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1303e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_ETH_ADDRS, 1304e3a2b7edSAmir Vadai f->mask); 1305e3a2b7edSAmir Vadai 1306e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1307e3a2b7edSAmir Vadai dmac_47_16), 1308e3a2b7edSAmir Vadai mask->dst); 1309e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1310e3a2b7edSAmir Vadai dmac_47_16), 1311e3a2b7edSAmir Vadai key->dst); 1312e3a2b7edSAmir Vadai 1313e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1314e3a2b7edSAmir Vadai smac_47_16), 1315e3a2b7edSAmir Vadai mask->src); 1316e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1317e3a2b7edSAmir Vadai smac_47_16), 1318e3a2b7edSAmir Vadai key->src); 131954782900SOr Gerlitz 132054782900SOr Gerlitz if (!is_zero_ether_addr(mask->src) || !is_zero_ether_addr(mask->dst)) 1321d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1322e3a2b7edSAmir Vadai } 1323e3a2b7edSAmir Vadai 1324095b6cfdSOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_VLAN)) { 1325095b6cfdSOr Gerlitz struct flow_dissector_key_vlan *key = 1326095b6cfdSOr Gerlitz skb_flow_dissector_target(f->dissector, 1327095b6cfdSOr Gerlitz FLOW_DISSECTOR_KEY_VLAN, 1328095b6cfdSOr Gerlitz f->key); 1329095b6cfdSOr Gerlitz struct flow_dissector_key_vlan *mask = 1330095b6cfdSOr Gerlitz skb_flow_dissector_target(f->dissector, 1331095b6cfdSOr Gerlitz FLOW_DISSECTOR_KEY_VLAN, 1332095b6cfdSOr Gerlitz f->mask); 1333699e96ddSJianbo Liu if (mask->vlan_id || mask->vlan_priority || mask->vlan_tpid) { 1334699e96ddSJianbo Liu if (key->vlan_tpid == htons(ETH_P_8021AD)) { 1335699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1336699e96ddSJianbo Liu svlan_tag, 1); 1337699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1338699e96ddSJianbo Liu svlan_tag, 1); 1339699e96ddSJianbo Liu } else { 1340699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1341699e96ddSJianbo Liu cvlan_tag, 1); 1342699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1343699e96ddSJianbo Liu cvlan_tag, 1); 1344699e96ddSJianbo Liu } 1345095b6cfdSOr Gerlitz 1346095b6cfdSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid, mask->vlan_id); 1347095b6cfdSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid, key->vlan_id); 1348358d79a4SOr Gerlitz 1349358d79a4SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio, mask->vlan_priority); 1350358d79a4SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio, key->vlan_priority); 135154782900SOr Gerlitz 1352d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1353095b6cfdSOr Gerlitz } 1354095b6cfdSOr Gerlitz } 1355095b6cfdSOr Gerlitz 1356699e96ddSJianbo Liu if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_CVLAN)) { 1357699e96ddSJianbo Liu struct flow_dissector_key_vlan *key = 1358699e96ddSJianbo Liu skb_flow_dissector_target(f->dissector, 1359699e96ddSJianbo Liu FLOW_DISSECTOR_KEY_CVLAN, 1360699e96ddSJianbo Liu f->key); 1361699e96ddSJianbo Liu struct flow_dissector_key_vlan *mask = 1362699e96ddSJianbo Liu skb_flow_dissector_target(f->dissector, 1363699e96ddSJianbo Liu FLOW_DISSECTOR_KEY_CVLAN, 1364699e96ddSJianbo Liu f->mask); 1365699e96ddSJianbo Liu if (mask->vlan_id || mask->vlan_priority || mask->vlan_tpid) { 1366699e96ddSJianbo Liu if (key->vlan_tpid == htons(ETH_P_8021AD)) { 1367699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1368699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1369699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1370699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1371699e96ddSJianbo Liu } else { 1372699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1373699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1374699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1375699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1376699e96ddSJianbo Liu } 1377699e96ddSJianbo Liu 1378699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid, 1379699e96ddSJianbo Liu mask->vlan_id); 1380699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid, 1381699e96ddSJianbo Liu key->vlan_id); 1382699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio, 1383699e96ddSJianbo Liu mask->vlan_priority); 1384699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio, 1385699e96ddSJianbo Liu key->vlan_priority); 1386699e96ddSJianbo Liu 1387699e96ddSJianbo Liu *match_level = MLX5_MATCH_L2; 1388699e96ddSJianbo Liu } 1389699e96ddSJianbo Liu } 1390699e96ddSJianbo Liu 139154782900SOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_BASIC)) { 139254782900SOr Gerlitz struct flow_dissector_key_basic *key = 139354782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 139454782900SOr Gerlitz FLOW_DISSECTOR_KEY_BASIC, 139554782900SOr Gerlitz f->key); 139654782900SOr Gerlitz struct flow_dissector_key_basic *mask = 139754782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 139854782900SOr Gerlitz FLOW_DISSECTOR_KEY_BASIC, 139954782900SOr Gerlitz f->mask); 140054782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype, 140154782900SOr Gerlitz ntohs(mask->n_proto)); 140254782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 140354782900SOr Gerlitz ntohs(key->n_proto)); 140454782900SOr Gerlitz 140554782900SOr Gerlitz if (mask->n_proto) 1406d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 140754782900SOr Gerlitz } 140854782900SOr Gerlitz 140954782900SOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_CONTROL)) { 141054782900SOr Gerlitz struct flow_dissector_key_control *key = 141154782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 141254782900SOr Gerlitz FLOW_DISSECTOR_KEY_CONTROL, 141354782900SOr Gerlitz f->key); 141454782900SOr Gerlitz 141554782900SOr Gerlitz struct flow_dissector_key_control *mask = 141654782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 141754782900SOr Gerlitz FLOW_DISSECTOR_KEY_CONTROL, 141854782900SOr Gerlitz f->mask); 141954782900SOr Gerlitz addr_type = key->addr_type; 142054782900SOr Gerlitz 142154782900SOr Gerlitz /* the HW doesn't support frag first/later */ 142254782900SOr Gerlitz if (mask->flags & FLOW_DIS_FIRST_FRAG) 142354782900SOr Gerlitz return -EOPNOTSUPP; 142454782900SOr Gerlitz 142554782900SOr Gerlitz if (mask->flags & FLOW_DIS_IS_FRAGMENT) { 142654782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 142754782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 142854782900SOr Gerlitz key->flags & FLOW_DIS_IS_FRAGMENT); 142954782900SOr Gerlitz 143054782900SOr Gerlitz /* the HW doesn't need L3 inline to match on frag=no */ 143154782900SOr Gerlitz if (!(key->flags & FLOW_DIS_IS_FRAGMENT)) 1432d708f902SOr Gerlitz *match_level = MLX5_INLINE_MODE_L2; 143354782900SOr Gerlitz /* *** L2 attributes parsing up to here *** */ 143454782900SOr Gerlitz else 1435d708f902SOr Gerlitz *match_level = MLX5_INLINE_MODE_IP; 143654782900SOr Gerlitz } 143754782900SOr Gerlitz } 143854782900SOr Gerlitz 143954782900SOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_BASIC)) { 144054782900SOr Gerlitz struct flow_dissector_key_basic *key = 144154782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 144254782900SOr Gerlitz FLOW_DISSECTOR_KEY_BASIC, 144354782900SOr Gerlitz f->key); 144454782900SOr Gerlitz struct flow_dissector_key_basic *mask = 144554782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 144654782900SOr Gerlitz FLOW_DISSECTOR_KEY_BASIC, 144754782900SOr Gerlitz f->mask); 144854782900SOr Gerlitz ip_proto = key->ip_proto; 144954782900SOr Gerlitz 145054782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol, 145154782900SOr Gerlitz mask->ip_proto); 145254782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, 145354782900SOr Gerlitz key->ip_proto); 145454782900SOr Gerlitz 145554782900SOr Gerlitz if (mask->ip_proto) 1456d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 145754782900SOr Gerlitz } 145854782900SOr Gerlitz 1459e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 1460e3a2b7edSAmir Vadai struct flow_dissector_key_ipv4_addrs *key = 1461e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1462e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV4_ADDRS, 1463e3a2b7edSAmir Vadai f->key); 1464e3a2b7edSAmir Vadai struct flow_dissector_key_ipv4_addrs *mask = 1465e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1466e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV4_ADDRS, 1467e3a2b7edSAmir Vadai f->mask); 1468e3a2b7edSAmir Vadai 1469e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1470e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 1471e3a2b7edSAmir Vadai &mask->src, sizeof(mask->src)); 1472e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1473e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 1474e3a2b7edSAmir Vadai &key->src, sizeof(key->src)); 1475e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1476e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 1477e3a2b7edSAmir Vadai &mask->dst, sizeof(mask->dst)); 1478e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1479e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 1480e3a2b7edSAmir Vadai &key->dst, sizeof(key->dst)); 1481de0af0bfSRoi Dayan 1482de0af0bfSRoi Dayan if (mask->src || mask->dst) 1483d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 1484e3a2b7edSAmir Vadai } 1485e3a2b7edSAmir Vadai 1486e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 1487e3a2b7edSAmir Vadai struct flow_dissector_key_ipv6_addrs *key = 1488e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1489e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV6_ADDRS, 1490e3a2b7edSAmir Vadai f->key); 1491e3a2b7edSAmir Vadai struct flow_dissector_key_ipv6_addrs *mask = 1492e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1493e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV6_ADDRS, 1494e3a2b7edSAmir Vadai f->mask); 1495e3a2b7edSAmir Vadai 1496e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1497e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 1498e3a2b7edSAmir Vadai &mask->src, sizeof(mask->src)); 1499e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1500e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 1501e3a2b7edSAmir Vadai &key->src, sizeof(key->src)); 1502e3a2b7edSAmir Vadai 1503e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1504e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 1505e3a2b7edSAmir Vadai &mask->dst, sizeof(mask->dst)); 1506e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1507e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 1508e3a2b7edSAmir Vadai &key->dst, sizeof(key->dst)); 1509de0af0bfSRoi Dayan 1510de0af0bfSRoi Dayan if (ipv6_addr_type(&mask->src) != IPV6_ADDR_ANY || 1511de0af0bfSRoi Dayan ipv6_addr_type(&mask->dst) != IPV6_ADDR_ANY) 1512d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 1513e3a2b7edSAmir Vadai } 1514e3a2b7edSAmir Vadai 15151f97a526SOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_IP)) { 15161f97a526SOr Gerlitz struct flow_dissector_key_ip *key = 15171f97a526SOr Gerlitz skb_flow_dissector_target(f->dissector, 15181f97a526SOr Gerlitz FLOW_DISSECTOR_KEY_IP, 15191f97a526SOr Gerlitz f->key); 15201f97a526SOr Gerlitz struct flow_dissector_key_ip *mask = 15211f97a526SOr Gerlitz skb_flow_dissector_target(f->dissector, 15221f97a526SOr Gerlitz FLOW_DISSECTOR_KEY_IP, 15231f97a526SOr Gerlitz f->mask); 15241f97a526SOr Gerlitz 15251f97a526SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, mask->tos & 0x3); 15261f97a526SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, key->tos & 0x3); 15271f97a526SOr Gerlitz 15281f97a526SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, mask->tos >> 2); 15291f97a526SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, key->tos >> 2); 15301f97a526SOr Gerlitz 1531a8ade55fSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, mask->ttl); 1532a8ade55fSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, key->ttl); 15331f97a526SOr Gerlitz 1534a8ade55fSOr Gerlitz if (mask->ttl && 1535a8ade55fSOr Gerlitz !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, 1536a8ade55fSOr Gerlitz ft_field_support.outer_ipv4_ttl)) 15371f97a526SOr Gerlitz return -EOPNOTSUPP; 1538a8ade55fSOr Gerlitz 1539a8ade55fSOr Gerlitz if (mask->tos || mask->ttl) 1540d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 15411f97a526SOr Gerlitz } 15421f97a526SOr Gerlitz 154354782900SOr Gerlitz /* *** L3 attributes parsing up to here *** */ 154454782900SOr Gerlitz 1545e3a2b7edSAmir Vadai if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_PORTS)) { 1546e3a2b7edSAmir Vadai struct flow_dissector_key_ports *key = 1547e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1548e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_PORTS, 1549e3a2b7edSAmir Vadai f->key); 1550e3a2b7edSAmir Vadai struct flow_dissector_key_ports *mask = 1551e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1552e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_PORTS, 1553e3a2b7edSAmir Vadai f->mask); 1554e3a2b7edSAmir Vadai switch (ip_proto) { 1555e3a2b7edSAmir Vadai case IPPROTO_TCP: 1556e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1557e3a2b7edSAmir Vadai tcp_sport, ntohs(mask->src)); 1558e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1559e3a2b7edSAmir Vadai tcp_sport, ntohs(key->src)); 1560e3a2b7edSAmir Vadai 1561e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1562e3a2b7edSAmir Vadai tcp_dport, ntohs(mask->dst)); 1563e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1564e3a2b7edSAmir Vadai tcp_dport, ntohs(key->dst)); 1565e3a2b7edSAmir Vadai break; 1566e3a2b7edSAmir Vadai 1567e3a2b7edSAmir Vadai case IPPROTO_UDP: 1568e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1569e3a2b7edSAmir Vadai udp_sport, ntohs(mask->src)); 1570e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1571e3a2b7edSAmir Vadai udp_sport, ntohs(key->src)); 1572e3a2b7edSAmir Vadai 1573e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1574e3a2b7edSAmir Vadai udp_dport, ntohs(mask->dst)); 1575e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1576e3a2b7edSAmir Vadai udp_dport, ntohs(key->dst)); 1577e3a2b7edSAmir Vadai break; 1578e3a2b7edSAmir Vadai default: 1579e3a2b7edSAmir Vadai netdev_err(priv->netdev, 1580e3a2b7edSAmir Vadai "Only UDP and TCP transport are supported\n"); 1581e3a2b7edSAmir Vadai return -EINVAL; 1582e3a2b7edSAmir Vadai } 1583de0af0bfSRoi Dayan 1584de0af0bfSRoi Dayan if (mask->src || mask->dst) 1585d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 1586e3a2b7edSAmir Vadai } 1587e3a2b7edSAmir Vadai 1588e77834ecSOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_TCP)) { 1589e77834ecSOr Gerlitz struct flow_dissector_key_tcp *key = 1590e77834ecSOr Gerlitz skb_flow_dissector_target(f->dissector, 1591e77834ecSOr Gerlitz FLOW_DISSECTOR_KEY_TCP, 1592e77834ecSOr Gerlitz f->key); 1593e77834ecSOr Gerlitz struct flow_dissector_key_tcp *mask = 1594e77834ecSOr Gerlitz skb_flow_dissector_target(f->dissector, 1595e77834ecSOr Gerlitz FLOW_DISSECTOR_KEY_TCP, 1596e77834ecSOr Gerlitz f->mask); 1597e77834ecSOr Gerlitz 1598e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags, 1599e77834ecSOr Gerlitz ntohs(mask->flags)); 1600e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags, 1601e77834ecSOr Gerlitz ntohs(key->flags)); 1602e77834ecSOr Gerlitz 1603e77834ecSOr Gerlitz if (mask->flags) 1604d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 1605e77834ecSOr Gerlitz } 1606e77834ecSOr Gerlitz 1607e3a2b7edSAmir Vadai return 0; 1608e3a2b7edSAmir Vadai } 1609e3a2b7edSAmir Vadai 1610de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv, 161165ba8fb7SOr Gerlitz struct mlx5e_tc_flow *flow, 1612de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 1613de0af0bfSRoi Dayan struct tc_cls_flower_offload *f) 1614de0af0bfSRoi Dayan { 1615de0af0bfSRoi Dayan struct mlx5_core_dev *dev = priv->mdev; 1616de0af0bfSRoi Dayan struct mlx5_eswitch *esw = dev->priv.eswitch; 16171d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 16181d447a39SSaeed Mahameed struct mlx5_eswitch_rep *rep; 1619d708f902SOr Gerlitz u8 match_level; 1620de0af0bfSRoi Dayan int err; 1621de0af0bfSRoi Dayan 1622d708f902SOr Gerlitz err = __parse_cls_flower(priv, spec, f, &match_level); 1623de0af0bfSRoi Dayan 16241d447a39SSaeed Mahameed if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) { 16251d447a39SSaeed Mahameed rep = rpriv->rep; 16261d447a39SSaeed Mahameed if (rep->vport != FDB_UPLINK_VPORT && 16271d447a39SSaeed Mahameed (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE && 1628d708f902SOr Gerlitz esw->offloads.inline_mode < match_level)) { 1629de0af0bfSRoi Dayan netdev_warn(priv->netdev, 1630de0af0bfSRoi Dayan "Flow is not offloaded due to min inline setting, required %d actual %d\n", 1631d708f902SOr Gerlitz match_level, esw->offloads.inline_mode); 1632de0af0bfSRoi Dayan return -EOPNOTSUPP; 1633de0af0bfSRoi Dayan } 1634de0af0bfSRoi Dayan } 1635de0af0bfSRoi Dayan 163638aa51c1SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 163738aa51c1SOr Gerlitz flow->esw_attr->match_level = match_level; 163838aa51c1SOr Gerlitz else 163938aa51c1SOr Gerlitz flow->nic_attr->match_level = match_level; 164038aa51c1SOr Gerlitz 1641de0af0bfSRoi Dayan return err; 1642de0af0bfSRoi Dayan } 1643de0af0bfSRoi Dayan 1644d79b6df6SOr Gerlitz struct pedit_headers { 1645d79b6df6SOr Gerlitz struct ethhdr eth; 1646d79b6df6SOr Gerlitz struct iphdr ip4; 1647d79b6df6SOr Gerlitz struct ipv6hdr ip6; 1648d79b6df6SOr Gerlitz struct tcphdr tcp; 1649d79b6df6SOr Gerlitz struct udphdr udp; 1650d79b6df6SOr Gerlitz }; 1651d79b6df6SOr Gerlitz 1652d79b6df6SOr Gerlitz static int pedit_header_offsets[] = { 1653d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth), 1654d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4), 1655d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6), 1656d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp), 1657d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp), 1658d79b6df6SOr Gerlitz }; 1659d79b6df6SOr Gerlitz 1660d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype]) 1661d79b6df6SOr Gerlitz 1662d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset, 1663d79b6df6SOr Gerlitz struct pedit_headers *masks, 1664d79b6df6SOr Gerlitz struct pedit_headers *vals) 1665d79b6df6SOr Gerlitz { 1666d79b6df6SOr Gerlitz u32 *curr_pmask, *curr_pval; 1667d79b6df6SOr Gerlitz 1668d79b6df6SOr Gerlitz if (hdr_type >= __PEDIT_HDR_TYPE_MAX) 1669d79b6df6SOr Gerlitz goto out_err; 1670d79b6df6SOr Gerlitz 1671d79b6df6SOr Gerlitz curr_pmask = (u32 *)(pedit_header(masks, hdr_type) + offset); 1672d79b6df6SOr Gerlitz curr_pval = (u32 *)(pedit_header(vals, hdr_type) + offset); 1673d79b6df6SOr Gerlitz 1674d79b6df6SOr Gerlitz if (*curr_pmask & mask) /* disallow acting twice on the same location */ 1675d79b6df6SOr Gerlitz goto out_err; 1676d79b6df6SOr Gerlitz 1677d79b6df6SOr Gerlitz *curr_pmask |= mask; 1678d79b6df6SOr Gerlitz *curr_pval |= (val & mask); 1679d79b6df6SOr Gerlitz 1680d79b6df6SOr Gerlitz return 0; 1681d79b6df6SOr Gerlitz 1682d79b6df6SOr Gerlitz out_err: 1683d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1684d79b6df6SOr Gerlitz } 1685d79b6df6SOr Gerlitz 1686d79b6df6SOr Gerlitz struct mlx5_fields { 1687d79b6df6SOr Gerlitz u8 field; 1688d79b6df6SOr Gerlitz u8 size; 1689d79b6df6SOr Gerlitz u32 offset; 1690d79b6df6SOr Gerlitz }; 1691d79b6df6SOr Gerlitz 1692a8e4f0c4SOr Gerlitz #define OFFLOAD(fw_field, size, field, off) \ 1693a8e4f0c4SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, offsetof(struct pedit_headers, field) + (off)} 1694a8e4f0c4SOr Gerlitz 1695d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = { 1696a8e4f0c4SOr Gerlitz OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0), 1697a8e4f0c4SOr Gerlitz OFFLOAD(DMAC_15_0, 2, eth.h_dest[4], 0), 1698a8e4f0c4SOr Gerlitz OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0), 1699a8e4f0c4SOr Gerlitz OFFLOAD(SMAC_15_0, 2, eth.h_source[4], 0), 1700a8e4f0c4SOr Gerlitz OFFLOAD(ETHERTYPE, 2, eth.h_proto, 0), 1701d79b6df6SOr Gerlitz 1702a8e4f0c4SOr Gerlitz OFFLOAD(IP_TTL, 1, ip4.ttl, 0), 1703a8e4f0c4SOr Gerlitz OFFLOAD(SIPV4, 4, ip4.saddr, 0), 1704a8e4f0c4SOr Gerlitz OFFLOAD(DIPV4, 4, ip4.daddr, 0), 1705d79b6df6SOr Gerlitz 1706a8e4f0c4SOr Gerlitz OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0), 1707a8e4f0c4SOr Gerlitz OFFLOAD(SIPV6_95_64, 4, ip6.saddr.s6_addr32[1], 0), 1708a8e4f0c4SOr Gerlitz OFFLOAD(SIPV6_63_32, 4, ip6.saddr.s6_addr32[2], 0), 1709a8e4f0c4SOr Gerlitz OFFLOAD(SIPV6_31_0, 4, ip6.saddr.s6_addr32[3], 0), 1710a8e4f0c4SOr Gerlitz OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0), 1711a8e4f0c4SOr Gerlitz OFFLOAD(DIPV6_95_64, 4, ip6.daddr.s6_addr32[1], 0), 1712a8e4f0c4SOr Gerlitz OFFLOAD(DIPV6_63_32, 4, ip6.daddr.s6_addr32[2], 0), 1713a8e4f0c4SOr Gerlitz OFFLOAD(DIPV6_31_0, 4, ip6.daddr.s6_addr32[3], 0), 17140c0316f5SOr Gerlitz OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0), 1715d79b6df6SOr Gerlitz 1716a8e4f0c4SOr Gerlitz OFFLOAD(TCP_SPORT, 2, tcp.source, 0), 1717a8e4f0c4SOr Gerlitz OFFLOAD(TCP_DPORT, 2, tcp.dest, 0), 1718a8e4f0c4SOr Gerlitz OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5), 1719d79b6df6SOr Gerlitz 1720a8e4f0c4SOr Gerlitz OFFLOAD(UDP_SPORT, 2, udp.source, 0), 1721a8e4f0c4SOr Gerlitz OFFLOAD(UDP_DPORT, 2, udp.dest, 0), 1722d79b6df6SOr Gerlitz }; 1723d79b6df6SOr Gerlitz 1724d79b6df6SOr Gerlitz /* On input attr->num_mod_hdr_actions tells how many HW actions can be parsed at 1725d79b6df6SOr Gerlitz * max from the SW pedit action. On success, it says how many HW actions were 1726d79b6df6SOr Gerlitz * actually parsed. 1727d79b6df6SOr Gerlitz */ 1728d79b6df6SOr Gerlitz static int offload_pedit_fields(struct pedit_headers *masks, 1729d79b6df6SOr Gerlitz struct pedit_headers *vals, 1730d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 1731d79b6df6SOr Gerlitz { 1732d79b6df6SOr Gerlitz struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals; 17332b64bebaSOr Gerlitz int i, action_size, nactions, max_actions, first, last, next_z; 1734d79b6df6SOr Gerlitz void *s_masks_p, *a_masks_p, *vals_p; 1735d79b6df6SOr Gerlitz struct mlx5_fields *f; 1736d79b6df6SOr Gerlitz u8 cmd, field_bsize; 1737e3ca4e05SOr Gerlitz u32 s_mask, a_mask; 1738d79b6df6SOr Gerlitz unsigned long mask; 17392b64bebaSOr Gerlitz __be32 mask_be32; 17402b64bebaSOr Gerlitz __be16 mask_be16; 1741d79b6df6SOr Gerlitz void *action; 1742d79b6df6SOr Gerlitz 1743d79b6df6SOr Gerlitz set_masks = &masks[TCA_PEDIT_KEY_EX_CMD_SET]; 1744d79b6df6SOr Gerlitz add_masks = &masks[TCA_PEDIT_KEY_EX_CMD_ADD]; 1745d79b6df6SOr Gerlitz set_vals = &vals[TCA_PEDIT_KEY_EX_CMD_SET]; 1746d79b6df6SOr Gerlitz add_vals = &vals[TCA_PEDIT_KEY_EX_CMD_ADD]; 1747d79b6df6SOr Gerlitz 1748d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 1749d79b6df6SOr Gerlitz action = parse_attr->mod_hdr_actions; 1750d79b6df6SOr Gerlitz max_actions = parse_attr->num_mod_hdr_actions; 1751d79b6df6SOr Gerlitz nactions = 0; 1752d79b6df6SOr Gerlitz 1753d79b6df6SOr Gerlitz for (i = 0; i < ARRAY_SIZE(fields); i++) { 1754d79b6df6SOr Gerlitz f = &fields[i]; 1755d79b6df6SOr Gerlitz /* avoid seeing bits set from previous iterations */ 1756e3ca4e05SOr Gerlitz s_mask = 0; 1757e3ca4e05SOr Gerlitz a_mask = 0; 1758d79b6df6SOr Gerlitz 1759d79b6df6SOr Gerlitz s_masks_p = (void *)set_masks + f->offset; 1760d79b6df6SOr Gerlitz a_masks_p = (void *)add_masks + f->offset; 1761d79b6df6SOr Gerlitz 1762d79b6df6SOr Gerlitz memcpy(&s_mask, s_masks_p, f->size); 1763d79b6df6SOr Gerlitz memcpy(&a_mask, a_masks_p, f->size); 1764d79b6df6SOr Gerlitz 1765d79b6df6SOr Gerlitz if (!s_mask && !a_mask) /* nothing to offload here */ 1766d79b6df6SOr Gerlitz continue; 1767d79b6df6SOr Gerlitz 1768d79b6df6SOr Gerlitz if (s_mask && a_mask) { 1769d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field); 1770d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1771d79b6df6SOr Gerlitz } 1772d79b6df6SOr Gerlitz 1773d79b6df6SOr Gerlitz if (nactions == max_actions) { 1774d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions); 1775d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1776d79b6df6SOr Gerlitz } 1777d79b6df6SOr Gerlitz 1778d79b6df6SOr Gerlitz if (s_mask) { 1779d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_SET; 1780d79b6df6SOr Gerlitz mask = s_mask; 1781d79b6df6SOr Gerlitz vals_p = (void *)set_vals + f->offset; 1782d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 1783d79b6df6SOr Gerlitz memset(s_masks_p, 0, f->size); 1784d79b6df6SOr Gerlitz } else { 1785d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_ADD; 1786d79b6df6SOr Gerlitz mask = a_mask; 1787d79b6df6SOr Gerlitz vals_p = (void *)add_vals + f->offset; 1788d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 1789d79b6df6SOr Gerlitz memset(a_masks_p, 0, f->size); 1790d79b6df6SOr Gerlitz } 1791d79b6df6SOr Gerlitz 1792d79b6df6SOr Gerlitz field_bsize = f->size * BITS_PER_BYTE; 1793e3ca4e05SOr Gerlitz 17942b64bebaSOr Gerlitz if (field_bsize == 32) { 17952b64bebaSOr Gerlitz mask_be32 = *(__be32 *)&mask; 17962b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32)); 17972b64bebaSOr Gerlitz } else if (field_bsize == 16) { 17982b64bebaSOr Gerlitz mask_be16 = *(__be16 *)&mask; 17992b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16)); 18002b64bebaSOr Gerlitz } 18012b64bebaSOr Gerlitz 1802d79b6df6SOr Gerlitz first = find_first_bit(&mask, field_bsize); 18032b64bebaSOr Gerlitz next_z = find_next_zero_bit(&mask, field_bsize, first); 1804d79b6df6SOr Gerlitz last = find_last_bit(&mask, field_bsize); 18052b64bebaSOr Gerlitz if (first < next_z && next_z < last) { 18062b64bebaSOr Gerlitz printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n", 1807d79b6df6SOr Gerlitz mask); 1808d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1809d79b6df6SOr Gerlitz } 1810d79b6df6SOr Gerlitz 1811d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, action_type, cmd); 1812d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, field, f->field); 1813d79b6df6SOr Gerlitz 1814d79b6df6SOr Gerlitz if (cmd == MLX5_ACTION_TYPE_SET) { 18152b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, offset, first); 1816d79b6df6SOr Gerlitz /* length is num of bits to be written, zero means length of 32 */ 18172b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, length, (last - first + 1)); 1818d79b6df6SOr Gerlitz } 1819d79b6df6SOr Gerlitz 1820d79b6df6SOr Gerlitz if (field_bsize == 32) 18212b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first); 1822d79b6df6SOr Gerlitz else if (field_bsize == 16) 18232b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first); 1824d79b6df6SOr Gerlitz else if (field_bsize == 8) 18252b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first); 1826d79b6df6SOr Gerlitz 1827d79b6df6SOr Gerlitz action += action_size; 1828d79b6df6SOr Gerlitz nactions++; 1829d79b6df6SOr Gerlitz } 1830d79b6df6SOr Gerlitz 1831d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = nactions; 1832d79b6df6SOr Gerlitz return 0; 1833d79b6df6SOr Gerlitz } 1834d79b6df6SOr Gerlitz 1835d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv, 1836d79b6df6SOr Gerlitz const struct tc_action *a, int namespace, 1837d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 1838d79b6df6SOr Gerlitz { 1839d79b6df6SOr Gerlitz int nkeys, action_size, max_actions; 1840d79b6df6SOr Gerlitz 1841d79b6df6SOr Gerlitz nkeys = tcf_pedit_nkeys(a); 1842d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 1843d79b6df6SOr Gerlitz 1844d79b6df6SOr Gerlitz if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */ 1845d79b6df6SOr Gerlitz max_actions = MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, max_modify_header_actions); 1846d79b6df6SOr Gerlitz else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */ 1847d79b6df6SOr Gerlitz max_actions = MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, max_modify_header_actions); 1848d79b6df6SOr Gerlitz 1849d79b6df6SOr Gerlitz /* can get up to crazingly 16 HW actions in 32 bits pedit SW key */ 1850d79b6df6SOr Gerlitz max_actions = min(max_actions, nkeys * 16); 1851d79b6df6SOr Gerlitz 1852d79b6df6SOr Gerlitz parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL); 1853d79b6df6SOr Gerlitz if (!parse_attr->mod_hdr_actions) 1854d79b6df6SOr Gerlitz return -ENOMEM; 1855d79b6df6SOr Gerlitz 1856d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = max_actions; 1857d79b6df6SOr Gerlitz return 0; 1858d79b6df6SOr Gerlitz } 1859d79b6df6SOr Gerlitz 1860d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {}; 1861d79b6df6SOr Gerlitz 1862d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv, 1863d79b6df6SOr Gerlitz const struct tc_action *a, int namespace, 1864d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 1865d79b6df6SOr Gerlitz { 1866d79b6df6SOr Gerlitz struct pedit_headers masks[__PEDIT_CMD_MAX], vals[__PEDIT_CMD_MAX], *cmd_masks; 1867d79b6df6SOr Gerlitz int nkeys, i, err = -EOPNOTSUPP; 1868d79b6df6SOr Gerlitz u32 mask, val, offset; 1869d79b6df6SOr Gerlitz u8 cmd, htype; 1870d79b6df6SOr Gerlitz 1871d79b6df6SOr Gerlitz nkeys = tcf_pedit_nkeys(a); 1872d79b6df6SOr Gerlitz 1873d79b6df6SOr Gerlitz memset(masks, 0, sizeof(struct pedit_headers) * __PEDIT_CMD_MAX); 1874d79b6df6SOr Gerlitz memset(vals, 0, sizeof(struct pedit_headers) * __PEDIT_CMD_MAX); 1875d79b6df6SOr Gerlitz 1876d79b6df6SOr Gerlitz for (i = 0; i < nkeys; i++) { 1877d79b6df6SOr Gerlitz htype = tcf_pedit_htype(a, i); 1878d79b6df6SOr Gerlitz cmd = tcf_pedit_cmd(a, i); 1879d79b6df6SOr Gerlitz err = -EOPNOTSUPP; /* can't be all optimistic */ 1880d79b6df6SOr Gerlitz 1881d79b6df6SOr Gerlitz if (htype == TCA_PEDIT_KEY_EX_HDR_TYPE_NETWORK) { 1882b3a433deSOr Gerlitz netdev_warn(priv->netdev, "legacy pedit isn't offloaded\n"); 1883d79b6df6SOr Gerlitz goto out_err; 1884d79b6df6SOr Gerlitz } 1885d79b6df6SOr Gerlitz 1886d79b6df6SOr Gerlitz if (cmd != TCA_PEDIT_KEY_EX_CMD_SET && cmd != TCA_PEDIT_KEY_EX_CMD_ADD) { 1887b3a433deSOr Gerlitz netdev_warn(priv->netdev, "pedit cmd %d isn't offloaded\n", cmd); 1888d79b6df6SOr Gerlitz goto out_err; 1889d79b6df6SOr Gerlitz } 1890d79b6df6SOr Gerlitz 1891d79b6df6SOr Gerlitz mask = tcf_pedit_mask(a, i); 1892d79b6df6SOr Gerlitz val = tcf_pedit_val(a, i); 1893d79b6df6SOr Gerlitz offset = tcf_pedit_offset(a, i); 1894d79b6df6SOr Gerlitz 1895d79b6df6SOr Gerlitz err = set_pedit_val(htype, ~mask, val, offset, &masks[cmd], &vals[cmd]); 1896d79b6df6SOr Gerlitz if (err) 1897d79b6df6SOr Gerlitz goto out_err; 1898d79b6df6SOr Gerlitz } 1899d79b6df6SOr Gerlitz 1900d79b6df6SOr Gerlitz err = alloc_mod_hdr_actions(priv, a, namespace, parse_attr); 1901d79b6df6SOr Gerlitz if (err) 1902d79b6df6SOr Gerlitz goto out_err; 1903d79b6df6SOr Gerlitz 1904d79b6df6SOr Gerlitz err = offload_pedit_fields(masks, vals, parse_attr); 1905d79b6df6SOr Gerlitz if (err < 0) 1906d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 1907d79b6df6SOr Gerlitz 1908d79b6df6SOr Gerlitz for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) { 1909d79b6df6SOr Gerlitz cmd_masks = &masks[cmd]; 1910d79b6df6SOr Gerlitz if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) { 1911b3a433deSOr Gerlitz netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd); 1912d79b6df6SOr Gerlitz print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS, 1913d79b6df6SOr Gerlitz 16, 1, cmd_masks, sizeof(zero_masks), true); 1914d79b6df6SOr Gerlitz err = -EOPNOTSUPP; 1915d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 1916d79b6df6SOr Gerlitz } 1917d79b6df6SOr Gerlitz } 1918d79b6df6SOr Gerlitz 1919d79b6df6SOr Gerlitz return 0; 1920d79b6df6SOr Gerlitz 1921d79b6df6SOr Gerlitz out_dealloc_parsed_actions: 1922d79b6df6SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 1923d79b6df6SOr Gerlitz out_err: 1924d79b6df6SOr Gerlitz return err; 1925d79b6df6SOr Gerlitz } 1926d79b6df6SOr Gerlitz 192726c02749SOr Gerlitz static bool csum_offload_supported(struct mlx5e_priv *priv, u32 action, u32 update_flags) 192826c02749SOr Gerlitz { 192926c02749SOr Gerlitz u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP | 193026c02749SOr Gerlitz TCA_CSUM_UPDATE_FLAG_UDP; 193126c02749SOr Gerlitz 193226c02749SOr Gerlitz /* The HW recalcs checksums only if re-writing headers */ 193326c02749SOr Gerlitz if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) { 193426c02749SOr Gerlitz netdev_warn(priv->netdev, 193526c02749SOr Gerlitz "TC csum action is only offloaded with pedit\n"); 193626c02749SOr Gerlitz return false; 193726c02749SOr Gerlitz } 193826c02749SOr Gerlitz 193926c02749SOr Gerlitz if (update_flags & ~prot_flags) { 194026c02749SOr Gerlitz netdev_warn(priv->netdev, 194126c02749SOr Gerlitz "can't offload TC csum action for some header/s - flags %#x\n", 194226c02749SOr Gerlitz update_flags); 194326c02749SOr Gerlitz return false; 194426c02749SOr Gerlitz } 194526c02749SOr Gerlitz 194626c02749SOr Gerlitz return true; 194726c02749SOr Gerlitz } 194826c02749SOr Gerlitz 1949bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec, 1950bdd66ac0SOr Gerlitz struct tcf_exts *exts) 1951bdd66ac0SOr Gerlitz { 1952bdd66ac0SOr Gerlitz const struct tc_action *a; 1953bdd66ac0SOr Gerlitz bool modify_ip_header; 1954bdd66ac0SOr Gerlitz LIST_HEAD(actions); 1955bdd66ac0SOr Gerlitz u8 htype, ip_proto; 1956bdd66ac0SOr Gerlitz void *headers_v; 1957bdd66ac0SOr Gerlitz u16 ethertype; 1958bdd66ac0SOr Gerlitz int nkeys, i; 1959bdd66ac0SOr Gerlitz 1960bdd66ac0SOr Gerlitz headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers); 1961bdd66ac0SOr Gerlitz ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype); 1962bdd66ac0SOr Gerlitz 1963bdd66ac0SOr Gerlitz /* for non-IP we only re-write MACs, so we're okay */ 1964bdd66ac0SOr Gerlitz if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6) 1965bdd66ac0SOr Gerlitz goto out_ok; 1966bdd66ac0SOr Gerlitz 1967bdd66ac0SOr Gerlitz modify_ip_header = false; 1968bdd66ac0SOr Gerlitz tcf_exts_to_list(exts, &actions); 1969bdd66ac0SOr Gerlitz list_for_each_entry(a, &actions, list) { 1970bdd66ac0SOr Gerlitz if (!is_tcf_pedit(a)) 1971bdd66ac0SOr Gerlitz continue; 1972bdd66ac0SOr Gerlitz 1973bdd66ac0SOr Gerlitz nkeys = tcf_pedit_nkeys(a); 1974bdd66ac0SOr Gerlitz for (i = 0; i < nkeys; i++) { 1975bdd66ac0SOr Gerlitz htype = tcf_pedit_htype(a, i); 1976bdd66ac0SOr Gerlitz if (htype == TCA_PEDIT_KEY_EX_HDR_TYPE_IP4 || 1977bdd66ac0SOr Gerlitz htype == TCA_PEDIT_KEY_EX_HDR_TYPE_IP6) { 1978bdd66ac0SOr Gerlitz modify_ip_header = true; 1979bdd66ac0SOr Gerlitz break; 1980bdd66ac0SOr Gerlitz } 1981bdd66ac0SOr Gerlitz } 1982bdd66ac0SOr Gerlitz } 1983bdd66ac0SOr Gerlitz 1984bdd66ac0SOr Gerlitz ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol); 19851ccef350SJianbo Liu if (modify_ip_header && ip_proto != IPPROTO_TCP && 19861ccef350SJianbo Liu ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) { 1987bdd66ac0SOr Gerlitz pr_info("can't offload re-write of ip proto %d\n", ip_proto); 1988bdd66ac0SOr Gerlitz return false; 1989bdd66ac0SOr Gerlitz } 1990bdd66ac0SOr Gerlitz 1991bdd66ac0SOr Gerlitz out_ok: 1992bdd66ac0SOr Gerlitz return true; 1993bdd66ac0SOr Gerlitz } 1994bdd66ac0SOr Gerlitz 1995bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv, 1996bdd66ac0SOr Gerlitz struct tcf_exts *exts, 1997bdd66ac0SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 1998bdd66ac0SOr Gerlitz struct mlx5e_tc_flow *flow) 1999bdd66ac0SOr Gerlitz { 2000bdd66ac0SOr Gerlitz u32 actions; 2001bdd66ac0SOr Gerlitz 2002bdd66ac0SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 2003bdd66ac0SOr Gerlitz actions = flow->esw_attr->action; 2004bdd66ac0SOr Gerlitz else 2005bdd66ac0SOr Gerlitz actions = flow->nic_attr->action; 2006bdd66ac0SOr Gerlitz 2007bdd66ac0SOr Gerlitz if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 2008bdd66ac0SOr Gerlitz return modify_header_match_supported(&parse_attr->spec, exts); 2009bdd66ac0SOr Gerlitz 2010bdd66ac0SOr Gerlitz return true; 2011bdd66ac0SOr Gerlitz } 2012bdd66ac0SOr Gerlitz 20135c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv) 20145c65c564SOr Gerlitz { 20155c65c564SOr Gerlitz struct mlx5_core_dev *fmdev, *pmdev; 20165c65c564SOr Gerlitz u16 func_id, peer_id; 20175c65c564SOr Gerlitz 20185c65c564SOr Gerlitz fmdev = priv->mdev; 20195c65c564SOr Gerlitz pmdev = peer_priv->mdev; 20205c65c564SOr Gerlitz 20215c65c564SOr Gerlitz func_id = (u16)((fmdev->pdev->bus->number << 8) | PCI_SLOT(fmdev->pdev->devfn)); 20225c65c564SOr Gerlitz peer_id = (u16)((pmdev->pdev->bus->number << 8) | PCI_SLOT(pmdev->pdev->devfn)); 20235c65c564SOr Gerlitz 20245c65c564SOr Gerlitz return (func_id == peer_id); 20255c65c564SOr Gerlitz } 20265c65c564SOr Gerlitz 20275c40348cSOr Gerlitz static int parse_tc_nic_actions(struct mlx5e_priv *priv, struct tcf_exts *exts, 2028aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2029aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow) 2030e3a2b7edSAmir Vadai { 2031aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 2032e3a2b7edSAmir Vadai const struct tc_action *a; 203322dc13c8SWANG Cong LIST_HEAD(actions); 20341cab1cd7SOr Gerlitz u32 action = 0; 20352f4fe4caSOr Gerlitz int err; 2036e3a2b7edSAmir Vadai 20373bcc0cecSJiri Pirko if (!tcf_exts_has_actions(exts)) 2038e3a2b7edSAmir Vadai return -EINVAL; 2039e3a2b7edSAmir Vadai 20403bc4b7bfSOr Gerlitz attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG; 2041e3a2b7edSAmir Vadai 204222dc13c8SWANG Cong tcf_exts_to_list(exts, &actions); 204322dc13c8SWANG Cong list_for_each_entry(a, &actions, list) { 2044e3a2b7edSAmir Vadai if (is_tcf_gact_shot(a)) { 20451cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP; 2046aad7e08dSAmir Vadai if (MLX5_CAP_FLOWTABLE(priv->mdev, 2047aad7e08dSAmir Vadai flow_table_properties_nic_receive.flow_counter)) 20481cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 2049e3a2b7edSAmir Vadai continue; 2050e3a2b7edSAmir Vadai } 2051e3a2b7edSAmir Vadai 20522f4fe4caSOr Gerlitz if (is_tcf_pedit(a)) { 20532f4fe4caSOr Gerlitz err = parse_tc_pedit_action(priv, a, MLX5_FLOW_NAMESPACE_KERNEL, 20542f4fe4caSOr Gerlitz parse_attr); 20552f4fe4caSOr Gerlitz if (err) 20562f4fe4caSOr Gerlitz return err; 20572f4fe4caSOr Gerlitz 20581cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR | 20592f4fe4caSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 20602f4fe4caSOr Gerlitz continue; 20612f4fe4caSOr Gerlitz } 20622f4fe4caSOr Gerlitz 206326c02749SOr Gerlitz if (is_tcf_csum(a)) { 20641cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 206526c02749SOr Gerlitz tcf_csum_update_flags(a))) 206626c02749SOr Gerlitz continue; 206726c02749SOr Gerlitz 206826c02749SOr Gerlitz return -EOPNOTSUPP; 206926c02749SOr Gerlitz } 207026c02749SOr Gerlitz 20715c65c564SOr Gerlitz if (is_tcf_mirred_egress_redirect(a)) { 20725c65c564SOr Gerlitz struct net_device *peer_dev = tcf_mirred_dev(a); 20735c65c564SOr Gerlitz 20745c65c564SOr Gerlitz if (priv->netdev->netdev_ops == peer_dev->netdev_ops && 20755c65c564SOr Gerlitz same_hw_devs(priv, netdev_priv(peer_dev))) { 20765c65c564SOr Gerlitz parse_attr->mirred_ifindex = peer_dev->ifindex; 20775c65c564SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_HAIRPIN; 20781cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 20795c65c564SOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 20805c65c564SOr Gerlitz } else { 20815c65c564SOr Gerlitz netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n", 20825c65c564SOr Gerlitz peer_dev->name); 20835c65c564SOr Gerlitz return -EINVAL; 20845c65c564SOr Gerlitz } 20855c65c564SOr Gerlitz continue; 20865c65c564SOr Gerlitz } 20875c65c564SOr Gerlitz 2088e3a2b7edSAmir Vadai if (is_tcf_skbedit_mark(a)) { 2089e3a2b7edSAmir Vadai u32 mark = tcf_skbedit_mark(a); 2090e3a2b7edSAmir Vadai 2091e3a2b7edSAmir Vadai if (mark & ~MLX5E_TC_FLOW_ID_MASK) { 2092e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Bad flow mark - only 16 bit is supported: 0x%x\n", 2093e3a2b7edSAmir Vadai mark); 2094e3a2b7edSAmir Vadai return -EINVAL; 2095e3a2b7edSAmir Vadai } 2096e3a2b7edSAmir Vadai 20973bc4b7bfSOr Gerlitz attr->flow_tag = mark; 20981cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 2099e3a2b7edSAmir Vadai continue; 2100e3a2b7edSAmir Vadai } 2101e3a2b7edSAmir Vadai 2102e3a2b7edSAmir Vadai return -EINVAL; 2103e3a2b7edSAmir Vadai } 2104e3a2b7edSAmir Vadai 21051cab1cd7SOr Gerlitz attr->action = action; 2106bdd66ac0SOr Gerlitz if (!actions_match_supported(priv, exts, parse_attr, flow)) 2107bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 2108bdd66ac0SOr Gerlitz 2109e3a2b7edSAmir Vadai return 0; 2110e3a2b7edSAmir Vadai } 2111e3a2b7edSAmir Vadai 211276f7444dSOr Gerlitz static inline int cmp_encap_info(struct ip_tunnel_key *a, 211376f7444dSOr Gerlitz struct ip_tunnel_key *b) 2114a54e20b4SHadar Hen Zion { 2115a54e20b4SHadar Hen Zion return memcmp(a, b, sizeof(*a)); 2116a54e20b4SHadar Hen Zion } 2117a54e20b4SHadar Hen Zion 211876f7444dSOr Gerlitz static inline int hash_encap_info(struct ip_tunnel_key *key) 2119a54e20b4SHadar Hen Zion { 212076f7444dSOr Gerlitz return jhash(key, sizeof(*key), 0); 2121a54e20b4SHadar Hen Zion } 2122a54e20b4SHadar Hen Zion 2123a54e20b4SHadar Hen Zion static int mlx5e_route_lookup_ipv4(struct mlx5e_priv *priv, 2124a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 2125a54e20b4SHadar Hen Zion struct net_device **out_dev, 2126a54e20b4SHadar Hen Zion struct flowi4 *fl4, 2127a54e20b4SHadar Hen Zion struct neighbour **out_n, 2128a54e20b4SHadar Hen Zion int *out_ttl) 2129a54e20b4SHadar Hen Zion { 21303e621b19SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 21315ed99fb4SMark Bloch struct mlx5e_rep_priv *uplink_rpriv; 2132a54e20b4SHadar Hen Zion struct rtable *rt; 2133a54e20b4SHadar Hen Zion struct neighbour *n = NULL; 2134a54e20b4SHadar Hen Zion 2135a54e20b4SHadar Hen Zion #if IS_ENABLED(CONFIG_INET) 2136abeffce9SArnd Bergmann int ret; 2137abeffce9SArnd Bergmann 2138a54e20b4SHadar Hen Zion rt = ip_route_output_key(dev_net(mirred_dev), fl4); 2139abeffce9SArnd Bergmann ret = PTR_ERR_OR_ZERO(rt); 2140abeffce9SArnd Bergmann if (ret) 2141abeffce9SArnd Bergmann return ret; 2142a54e20b4SHadar Hen Zion #else 2143a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 2144a54e20b4SHadar Hen Zion #endif 2145a4b97ab4SMark Bloch uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 21463e621b19SHadar Hen Zion /* if the egress device isn't on the same HW e-switch, we use the uplink */ 21473e621b19SHadar Hen Zion if (!switchdev_port_same_parent_id(priv->netdev, rt->dst.dev)) 21485ed99fb4SMark Bloch *out_dev = uplink_rpriv->netdev; 21493e621b19SHadar Hen Zion else 21503e621b19SHadar Hen Zion *out_dev = rt->dst.dev; 2151a54e20b4SHadar Hen Zion 215275c33da8SOr Gerlitz *out_ttl = ip4_dst_hoplimit(&rt->dst); 2153a54e20b4SHadar Hen Zion n = dst_neigh_lookup(&rt->dst, &fl4->daddr); 2154a54e20b4SHadar Hen Zion ip_rt_put(rt); 2155a54e20b4SHadar Hen Zion if (!n) 2156a54e20b4SHadar Hen Zion return -ENOMEM; 2157a54e20b4SHadar Hen Zion 2158a54e20b4SHadar Hen Zion *out_n = n; 2159a54e20b4SHadar Hen Zion return 0; 2160a54e20b4SHadar Hen Zion } 2161a54e20b4SHadar Hen Zion 2162b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv, 2163b1d90e6bSRabie Loulou struct net_device *peer_netdev) 2164b1d90e6bSRabie Loulou { 2165b1d90e6bSRabie Loulou struct mlx5e_priv *peer_priv; 2166b1d90e6bSRabie Loulou 2167b1d90e6bSRabie Loulou peer_priv = netdev_priv(peer_netdev); 2168b1d90e6bSRabie Loulou 2169b1d90e6bSRabie Loulou return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) && 2170b1d90e6bSRabie Loulou (priv->netdev->netdev_ops == peer_netdev->netdev_ops) && 2171b1d90e6bSRabie Loulou same_hw_devs(priv, peer_priv) && 2172b1d90e6bSRabie Loulou MLX5_VPORT_MANAGER(peer_priv->mdev) && 2173b1d90e6bSRabie Loulou (peer_priv->mdev->priv.eswitch->mode == SRIOV_OFFLOADS)); 2174b1d90e6bSRabie Loulou } 2175b1d90e6bSRabie Loulou 2176ce99f6b9SOr Gerlitz static int mlx5e_route_lookup_ipv6(struct mlx5e_priv *priv, 2177ce99f6b9SOr Gerlitz struct net_device *mirred_dev, 2178ce99f6b9SOr Gerlitz struct net_device **out_dev, 2179ce99f6b9SOr Gerlitz struct flowi6 *fl6, 2180ce99f6b9SOr Gerlitz struct neighbour **out_n, 2181ce99f6b9SOr Gerlitz int *out_ttl) 2182ce99f6b9SOr Gerlitz { 2183ce99f6b9SOr Gerlitz struct neighbour *n = NULL; 2184ce99f6b9SOr Gerlitz struct dst_entry *dst; 2185ce99f6b9SOr Gerlitz 2186ce99f6b9SOr Gerlitz #if IS_ENABLED(CONFIG_INET) && IS_ENABLED(CONFIG_IPV6) 218774bd5d56SArnd Bergmann struct mlx5e_rep_priv *uplink_rpriv; 2188ce99f6b9SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2189ce99f6b9SOr Gerlitz int ret; 2190ce99f6b9SOr Gerlitz 219108820528SPaul Blakey ret = ipv6_stub->ipv6_dst_lookup(dev_net(mirred_dev), NULL, &dst, 219208820528SPaul Blakey fl6); 219308820528SPaul Blakey if (ret < 0) 2194ce99f6b9SOr Gerlitz return ret; 2195ce99f6b9SOr Gerlitz 2196ce99f6b9SOr Gerlitz *out_ttl = ip6_dst_hoplimit(dst); 2197ce99f6b9SOr Gerlitz 2198a4b97ab4SMark Bloch uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 2199ce99f6b9SOr Gerlitz /* if the egress device isn't on the same HW e-switch, we use the uplink */ 2200ce99f6b9SOr Gerlitz if (!switchdev_port_same_parent_id(priv->netdev, dst->dev)) 22015ed99fb4SMark Bloch *out_dev = uplink_rpriv->netdev; 2202ce99f6b9SOr Gerlitz else 2203ce99f6b9SOr Gerlitz *out_dev = dst->dev; 2204ce99f6b9SOr Gerlitz #else 2205ce99f6b9SOr Gerlitz return -EOPNOTSUPP; 2206ce99f6b9SOr Gerlitz #endif 2207ce99f6b9SOr Gerlitz 2208ce99f6b9SOr Gerlitz n = dst_neigh_lookup(dst, &fl6->daddr); 2209ce99f6b9SOr Gerlitz dst_release(dst); 2210ce99f6b9SOr Gerlitz if (!n) 2211ce99f6b9SOr Gerlitz return -ENOMEM; 2212ce99f6b9SOr Gerlitz 2213ce99f6b9SOr Gerlitz *out_n = n; 2214ce99f6b9SOr Gerlitz return 0; 2215ce99f6b9SOr Gerlitz } 2216ce99f6b9SOr Gerlitz 221732f3671fSOr Gerlitz static void gen_vxlan_header_ipv4(struct net_device *out_dev, 221832f3671fSOr Gerlitz char buf[], int encap_size, 2219a54e20b4SHadar Hen Zion unsigned char h_dest[ETH_ALEN], 2220a54e20b4SHadar Hen Zion int ttl, 2221a54e20b4SHadar Hen Zion __be32 daddr, 2222a54e20b4SHadar Hen Zion __be32 saddr, 2223a54e20b4SHadar Hen Zion __be16 udp_dst_port, 2224a54e20b4SHadar Hen Zion __be32 vx_vni) 2225a54e20b4SHadar Hen Zion { 2226a54e20b4SHadar Hen Zion struct ethhdr *eth = (struct ethhdr *)buf; 2227a54e20b4SHadar Hen Zion struct iphdr *ip = (struct iphdr *)((char *)eth + sizeof(struct ethhdr)); 2228a54e20b4SHadar Hen Zion struct udphdr *udp = (struct udphdr *)((char *)ip + sizeof(struct iphdr)); 2229a54e20b4SHadar Hen Zion struct vxlanhdr *vxh = (struct vxlanhdr *)((char *)udp + sizeof(struct udphdr)); 2230a54e20b4SHadar Hen Zion 2231a54e20b4SHadar Hen Zion memset(buf, 0, encap_size); 2232a54e20b4SHadar Hen Zion 2233a54e20b4SHadar Hen Zion ether_addr_copy(eth->h_dest, h_dest); 2234a54e20b4SHadar Hen Zion ether_addr_copy(eth->h_source, out_dev->dev_addr); 2235a54e20b4SHadar Hen Zion eth->h_proto = htons(ETH_P_IP); 2236a54e20b4SHadar Hen Zion 2237a54e20b4SHadar Hen Zion ip->daddr = daddr; 2238a54e20b4SHadar Hen Zion ip->saddr = saddr; 2239a54e20b4SHadar Hen Zion 2240a54e20b4SHadar Hen Zion ip->ttl = ttl; 2241a54e20b4SHadar Hen Zion ip->protocol = IPPROTO_UDP; 2242a54e20b4SHadar Hen Zion ip->version = 0x4; 2243a54e20b4SHadar Hen Zion ip->ihl = 0x5; 2244a54e20b4SHadar Hen Zion 2245a54e20b4SHadar Hen Zion udp->dest = udp_dst_port; 2246a54e20b4SHadar Hen Zion vxh->vx_flags = VXLAN_HF_VNI; 2247a54e20b4SHadar Hen Zion vxh->vx_vni = vxlan_vni_field(vx_vni); 2248a54e20b4SHadar Hen Zion } 2249a54e20b4SHadar Hen Zion 2250225aabafSOr Gerlitz static void gen_vxlan_header_ipv6(struct net_device *out_dev, 2251225aabafSOr Gerlitz char buf[], int encap_size, 2252ce99f6b9SOr Gerlitz unsigned char h_dest[ETH_ALEN], 2253ce99f6b9SOr Gerlitz int ttl, 2254ce99f6b9SOr Gerlitz struct in6_addr *daddr, 2255ce99f6b9SOr Gerlitz struct in6_addr *saddr, 2256ce99f6b9SOr Gerlitz __be16 udp_dst_port, 2257ce99f6b9SOr Gerlitz __be32 vx_vni) 2258ce99f6b9SOr Gerlitz { 2259ce99f6b9SOr Gerlitz struct ethhdr *eth = (struct ethhdr *)buf; 2260ce99f6b9SOr Gerlitz struct ipv6hdr *ip6h = (struct ipv6hdr *)((char *)eth + sizeof(struct ethhdr)); 2261ce99f6b9SOr Gerlitz struct udphdr *udp = (struct udphdr *)((char *)ip6h + sizeof(struct ipv6hdr)); 2262ce99f6b9SOr Gerlitz struct vxlanhdr *vxh = (struct vxlanhdr *)((char *)udp + sizeof(struct udphdr)); 2263ce99f6b9SOr Gerlitz 2264ce99f6b9SOr Gerlitz memset(buf, 0, encap_size); 2265ce99f6b9SOr Gerlitz 2266ce99f6b9SOr Gerlitz ether_addr_copy(eth->h_dest, h_dest); 2267ce99f6b9SOr Gerlitz ether_addr_copy(eth->h_source, out_dev->dev_addr); 2268ce99f6b9SOr Gerlitz eth->h_proto = htons(ETH_P_IPV6); 2269ce99f6b9SOr Gerlitz 2270ce99f6b9SOr Gerlitz ip6_flow_hdr(ip6h, 0, 0); 2271ce99f6b9SOr Gerlitz /* the HW fills up ipv6 payload len */ 2272ce99f6b9SOr Gerlitz ip6h->nexthdr = IPPROTO_UDP; 2273ce99f6b9SOr Gerlitz ip6h->hop_limit = ttl; 2274ce99f6b9SOr Gerlitz ip6h->daddr = *daddr; 2275ce99f6b9SOr Gerlitz ip6h->saddr = *saddr; 2276ce99f6b9SOr Gerlitz 2277ce99f6b9SOr Gerlitz udp->dest = udp_dst_port; 2278ce99f6b9SOr Gerlitz vxh->vx_flags = VXLAN_HF_VNI; 2279ce99f6b9SOr Gerlitz vxh->vx_vni = vxlan_vni_field(vx_vni); 2280ce99f6b9SOr Gerlitz } 2281ce99f6b9SOr Gerlitz 2282a54e20b4SHadar Hen Zion static int mlx5e_create_encap_header_ipv4(struct mlx5e_priv *priv, 2283a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 22841a8552bdSHadar Hen Zion struct mlx5e_encap_entry *e) 2285a54e20b4SHadar Hen Zion { 2286a54e20b4SHadar Hen Zion int max_encap_size = MLX5_CAP_ESW(priv->mdev, max_encap_header_size); 228732f3671fSOr Gerlitz int ipv4_encap_size = ETH_HLEN + sizeof(struct iphdr) + VXLAN_HLEN; 228876f7444dSOr Gerlitz struct ip_tunnel_key *tun_key = &e->tun_info.key; 22891a8552bdSHadar Hen Zion struct net_device *out_dev; 2290a42485ebSOr Gerlitz struct neighbour *n = NULL; 2291a54e20b4SHadar Hen Zion struct flowi4 fl4 = {}; 2292a54e20b4SHadar Hen Zion char *encap_header; 229332f3671fSOr Gerlitz int ttl, err; 2294033354d5SHadar Hen Zion u8 nud_state; 2295a54e20b4SHadar Hen Zion 229632f3671fSOr Gerlitz if (max_encap_size < ipv4_encap_size) { 229732f3671fSOr Gerlitz mlx5_core_warn(priv->mdev, "encap size %d too big, max supported is %d\n", 229832f3671fSOr Gerlitz ipv4_encap_size, max_encap_size); 229932f3671fSOr Gerlitz return -EOPNOTSUPP; 230032f3671fSOr Gerlitz } 230132f3671fSOr Gerlitz 230232f3671fSOr Gerlitz encap_header = kzalloc(ipv4_encap_size, GFP_KERNEL); 2303a54e20b4SHadar Hen Zion if (!encap_header) 2304a54e20b4SHadar Hen Zion return -ENOMEM; 2305a54e20b4SHadar Hen Zion 2306a54e20b4SHadar Hen Zion switch (e->tunnel_type) { 2307a54e20b4SHadar Hen Zion case MLX5_HEADER_TYPE_VXLAN: 2308a54e20b4SHadar Hen Zion fl4.flowi4_proto = IPPROTO_UDP; 230976f7444dSOr Gerlitz fl4.fl4_dport = tun_key->tp_dst; 2310a54e20b4SHadar Hen Zion break; 2311a54e20b4SHadar Hen Zion default: 2312a54e20b4SHadar Hen Zion err = -EOPNOTSUPP; 2313ace74321SPaul Blakey goto free_encap; 2314a54e20b4SHadar Hen Zion } 23159a941117SOr Gerlitz fl4.flowi4_tos = tun_key->tos; 231676f7444dSOr Gerlitz fl4.daddr = tun_key->u.ipv4.dst; 23179a941117SOr Gerlitz fl4.saddr = tun_key->u.ipv4.src; 2318a54e20b4SHadar Hen Zion 23191a8552bdSHadar Hen Zion err = mlx5e_route_lookup_ipv4(priv, mirred_dev, &out_dev, 23209a941117SOr Gerlitz &fl4, &n, &ttl); 2321a54e20b4SHadar Hen Zion if (err) 2322ace74321SPaul Blakey goto free_encap; 2323a54e20b4SHadar Hen Zion 2324232c0013SHadar Hen Zion /* used by mlx5e_detach_encap to lookup a neigh hash table 2325232c0013SHadar Hen Zion * entry in the neigh hash table when a user deletes a rule 2326232c0013SHadar Hen Zion */ 2327232c0013SHadar Hen Zion e->m_neigh.dev = n->dev; 2328f6dfb4c3SHadar Hen Zion e->m_neigh.family = n->ops->family; 2329232c0013SHadar Hen Zion memcpy(&e->m_neigh.dst_ip, n->primary_key, n->tbl->key_len); 2330232c0013SHadar Hen Zion e->out_dev = out_dev; 2331232c0013SHadar Hen Zion 2332232c0013SHadar Hen Zion /* It's importent to add the neigh to the hash table before checking 2333232c0013SHadar Hen Zion * the neigh validity state. So if we'll get a notification, in case the 2334232c0013SHadar Hen Zion * neigh changes it's validity state, we would find the relevant neigh 2335232c0013SHadar Hen Zion * in the hash. 2336232c0013SHadar Hen Zion */ 2337232c0013SHadar Hen Zion err = mlx5e_rep_encap_entry_attach(netdev_priv(out_dev), e); 2338232c0013SHadar Hen Zion if (err) 2339ace74321SPaul Blakey goto free_encap; 2340232c0013SHadar Hen Zion 2341033354d5SHadar Hen Zion read_lock_bh(&n->lock); 2342033354d5SHadar Hen Zion nud_state = n->nud_state; 2343033354d5SHadar Hen Zion ether_addr_copy(e->h_dest, n->ha); 2344033354d5SHadar Hen Zion read_unlock_bh(&n->lock); 2345033354d5SHadar Hen Zion 2346a54e20b4SHadar Hen Zion switch (e->tunnel_type) { 2347a54e20b4SHadar Hen Zion case MLX5_HEADER_TYPE_VXLAN: 23481a8552bdSHadar Hen Zion gen_vxlan_header_ipv4(out_dev, encap_header, 234932f3671fSOr Gerlitz ipv4_encap_size, e->h_dest, ttl, 23509a941117SOr Gerlitz fl4.daddr, 23519a941117SOr Gerlitz fl4.saddr, tun_key->tp_dst, 235276f7444dSOr Gerlitz tunnel_id_to_key32(tun_key->tun_id)); 2353a54e20b4SHadar Hen Zion break; 2354a54e20b4SHadar Hen Zion default: 2355a54e20b4SHadar Hen Zion err = -EOPNOTSUPP; 2356232c0013SHadar Hen Zion goto destroy_neigh_entry; 2357232c0013SHadar Hen Zion } 2358232c0013SHadar Hen Zion e->encap_size = ipv4_encap_size; 2359232c0013SHadar Hen Zion e->encap_header = encap_header; 2360232c0013SHadar Hen Zion 2361232c0013SHadar Hen Zion if (!(nud_state & NUD_VALID)) { 2362232c0013SHadar Hen Zion neigh_event_send(n, NULL); 236327902f08SWei Yongjun err = -EAGAIN; 236427902f08SWei Yongjun goto out; 2365a54e20b4SHadar Hen Zion } 2366a54e20b4SHadar Hen Zion 2367a54e20b4SHadar Hen Zion err = mlx5_encap_alloc(priv->mdev, e->tunnel_type, 236832f3671fSOr Gerlitz ipv4_encap_size, encap_header, &e->encap_id); 2369232c0013SHadar Hen Zion if (err) 2370232c0013SHadar Hen Zion goto destroy_neigh_entry; 2371232c0013SHadar Hen Zion 2372232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 2373f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(netdev_priv(out_dev)); 2374a42485ebSOr Gerlitz neigh_release(n); 2375232c0013SHadar Hen Zion return err; 2376232c0013SHadar Hen Zion 2377232c0013SHadar Hen Zion destroy_neigh_entry: 2378232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 2379ace74321SPaul Blakey free_encap: 2380a54e20b4SHadar Hen Zion kfree(encap_header); 2381ace74321SPaul Blakey out: 2382232c0013SHadar Hen Zion if (n) 2383232c0013SHadar Hen Zion neigh_release(n); 2384a54e20b4SHadar Hen Zion return err; 2385a54e20b4SHadar Hen Zion } 2386a54e20b4SHadar Hen Zion 2387ce99f6b9SOr Gerlitz static int mlx5e_create_encap_header_ipv6(struct mlx5e_priv *priv, 2388ce99f6b9SOr Gerlitz struct net_device *mirred_dev, 23891a8552bdSHadar Hen Zion struct mlx5e_encap_entry *e) 2390ce99f6b9SOr Gerlitz { 2391ce99f6b9SOr Gerlitz int max_encap_size = MLX5_CAP_ESW(priv->mdev, max_encap_header_size); 2392225aabafSOr Gerlitz int ipv6_encap_size = ETH_HLEN + sizeof(struct ipv6hdr) + VXLAN_HLEN; 2393ce99f6b9SOr Gerlitz struct ip_tunnel_key *tun_key = &e->tun_info.key; 23941a8552bdSHadar Hen Zion struct net_device *out_dev; 2395ce99f6b9SOr Gerlitz struct neighbour *n = NULL; 2396ce99f6b9SOr Gerlitz struct flowi6 fl6 = {}; 2397ce99f6b9SOr Gerlitz char *encap_header; 2398225aabafSOr Gerlitz int err, ttl = 0; 2399033354d5SHadar Hen Zion u8 nud_state; 2400ce99f6b9SOr Gerlitz 2401225aabafSOr Gerlitz if (max_encap_size < ipv6_encap_size) { 2402225aabafSOr Gerlitz mlx5_core_warn(priv->mdev, "encap size %d too big, max supported is %d\n", 2403225aabafSOr Gerlitz ipv6_encap_size, max_encap_size); 2404225aabafSOr Gerlitz return -EOPNOTSUPP; 2405225aabafSOr Gerlitz } 2406225aabafSOr Gerlitz 2407225aabafSOr Gerlitz encap_header = kzalloc(ipv6_encap_size, GFP_KERNEL); 2408ce99f6b9SOr Gerlitz if (!encap_header) 2409ce99f6b9SOr Gerlitz return -ENOMEM; 2410ce99f6b9SOr Gerlitz 2411ce99f6b9SOr Gerlitz switch (e->tunnel_type) { 2412ce99f6b9SOr Gerlitz case MLX5_HEADER_TYPE_VXLAN: 2413ce99f6b9SOr Gerlitz fl6.flowi6_proto = IPPROTO_UDP; 2414ce99f6b9SOr Gerlitz fl6.fl6_dport = tun_key->tp_dst; 2415ce99f6b9SOr Gerlitz break; 2416ce99f6b9SOr Gerlitz default: 2417ce99f6b9SOr Gerlitz err = -EOPNOTSUPP; 2418ace74321SPaul Blakey goto free_encap; 2419ce99f6b9SOr Gerlitz } 2420ce99f6b9SOr Gerlitz 2421ce99f6b9SOr Gerlitz fl6.flowlabel = ip6_make_flowinfo(RT_TOS(tun_key->tos), tun_key->label); 2422ce99f6b9SOr Gerlitz fl6.daddr = tun_key->u.ipv6.dst; 2423ce99f6b9SOr Gerlitz fl6.saddr = tun_key->u.ipv6.src; 2424ce99f6b9SOr Gerlitz 24251a8552bdSHadar Hen Zion err = mlx5e_route_lookup_ipv6(priv, mirred_dev, &out_dev, 2426ce99f6b9SOr Gerlitz &fl6, &n, &ttl); 2427ce99f6b9SOr Gerlitz if (err) 2428ace74321SPaul Blakey goto free_encap; 2429ce99f6b9SOr Gerlitz 2430232c0013SHadar Hen Zion /* used by mlx5e_detach_encap to lookup a neigh hash table 2431232c0013SHadar Hen Zion * entry in the neigh hash table when a user deletes a rule 2432232c0013SHadar Hen Zion */ 2433232c0013SHadar Hen Zion e->m_neigh.dev = n->dev; 2434f6dfb4c3SHadar Hen Zion e->m_neigh.family = n->ops->family; 2435232c0013SHadar Hen Zion memcpy(&e->m_neigh.dst_ip, n->primary_key, n->tbl->key_len); 2436232c0013SHadar Hen Zion e->out_dev = out_dev; 2437232c0013SHadar Hen Zion 2438232c0013SHadar Hen Zion /* It's importent to add the neigh to the hash table before checking 2439232c0013SHadar Hen Zion * the neigh validity state. So if we'll get a notification, in case the 2440232c0013SHadar Hen Zion * neigh changes it's validity state, we would find the relevant neigh 2441232c0013SHadar Hen Zion * in the hash. 2442232c0013SHadar Hen Zion */ 2443232c0013SHadar Hen Zion err = mlx5e_rep_encap_entry_attach(netdev_priv(out_dev), e); 2444232c0013SHadar Hen Zion if (err) 2445ace74321SPaul Blakey goto free_encap; 2446232c0013SHadar Hen Zion 2447033354d5SHadar Hen Zion read_lock_bh(&n->lock); 2448033354d5SHadar Hen Zion nud_state = n->nud_state; 2449033354d5SHadar Hen Zion ether_addr_copy(e->h_dest, n->ha); 2450033354d5SHadar Hen Zion read_unlock_bh(&n->lock); 2451033354d5SHadar Hen Zion 2452ce99f6b9SOr Gerlitz switch (e->tunnel_type) { 2453ce99f6b9SOr Gerlitz case MLX5_HEADER_TYPE_VXLAN: 24541a8552bdSHadar Hen Zion gen_vxlan_header_ipv6(out_dev, encap_header, 2455225aabafSOr Gerlitz ipv6_encap_size, e->h_dest, ttl, 2456ce99f6b9SOr Gerlitz &fl6.daddr, 2457ce99f6b9SOr Gerlitz &fl6.saddr, tun_key->tp_dst, 2458ce99f6b9SOr Gerlitz tunnel_id_to_key32(tun_key->tun_id)); 2459ce99f6b9SOr Gerlitz break; 2460ce99f6b9SOr Gerlitz default: 2461ce99f6b9SOr Gerlitz err = -EOPNOTSUPP; 2462232c0013SHadar Hen Zion goto destroy_neigh_entry; 2463232c0013SHadar Hen Zion } 2464232c0013SHadar Hen Zion 2465232c0013SHadar Hen Zion e->encap_size = ipv6_encap_size; 2466232c0013SHadar Hen Zion e->encap_header = encap_header; 2467232c0013SHadar Hen Zion 2468232c0013SHadar Hen Zion if (!(nud_state & NUD_VALID)) { 2469232c0013SHadar Hen Zion neigh_event_send(n, NULL); 247027902f08SWei Yongjun err = -EAGAIN; 247127902f08SWei Yongjun goto out; 2472ce99f6b9SOr Gerlitz } 2473ce99f6b9SOr Gerlitz 2474ce99f6b9SOr Gerlitz err = mlx5_encap_alloc(priv->mdev, e->tunnel_type, 2475225aabafSOr Gerlitz ipv6_encap_size, encap_header, &e->encap_id); 2476232c0013SHadar Hen Zion if (err) 2477232c0013SHadar Hen Zion goto destroy_neigh_entry; 2478232c0013SHadar Hen Zion 2479232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 2480f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(netdev_priv(out_dev)); 2481ce99f6b9SOr Gerlitz neigh_release(n); 2482232c0013SHadar Hen Zion return err; 2483232c0013SHadar Hen Zion 2484232c0013SHadar Hen Zion destroy_neigh_entry: 2485232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 2486ace74321SPaul Blakey free_encap: 2487ce99f6b9SOr Gerlitz kfree(encap_header); 2488ace74321SPaul Blakey out: 2489232c0013SHadar Hen Zion if (n) 2490232c0013SHadar Hen Zion neigh_release(n); 2491ce99f6b9SOr Gerlitz return err; 2492ce99f6b9SOr Gerlitz } 2493ce99f6b9SOr Gerlitz 2494a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv, 2495a54e20b4SHadar Hen Zion struct ip_tunnel_info *tun_info, 2496a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 249745247bf2SOr Gerlitz struct net_device **encap_dev, 249845247bf2SOr Gerlitz struct mlx5e_tc_flow *flow) 249903a9d11eSOr Gerlitz { 2500a54e20b4SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2501a4b97ab4SMark Bloch struct mlx5e_rep_priv *uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, 2502a4b97ab4SMark Bloch REP_ETH); 25035ed99fb4SMark Bloch struct net_device *up_dev = uplink_rpriv->netdev; 2504a54e20b4SHadar Hen Zion unsigned short family = ip_tunnel_info_af(tun_info); 250545247bf2SOr Gerlitz struct mlx5e_priv *up_priv = netdev_priv(up_dev); 250645247bf2SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 2507a54e20b4SHadar Hen Zion struct ip_tunnel_key *key = &tun_info->key; 2508c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 250945247bf2SOr Gerlitz int tunnel_type, err = 0; 2510a54e20b4SHadar Hen Zion uintptr_t hash_key; 2511a54e20b4SHadar Hen Zion bool found = false; 2512a54e20b4SHadar Hen Zion 25132fcd82e9SOr Gerlitz /* udp dst port must be set */ 2514a54e20b4SHadar Hen Zion if (!memchr_inv(&key->tp_dst, 0, sizeof(key->tp_dst))) 25152fcd82e9SOr Gerlitz goto vxlan_encap_offload_err; 2516a54e20b4SHadar Hen Zion 2517cd377663SOr Gerlitz /* setting udp src port isn't supported */ 25182fcd82e9SOr Gerlitz if (memchr_inv(&key->tp_src, 0, sizeof(key->tp_src))) { 25192fcd82e9SOr Gerlitz vxlan_encap_offload_err: 25202fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 25212fcd82e9SOr Gerlitz "must set udp dst port and not set udp src port\n"); 2522cd377663SOr Gerlitz return -EOPNOTSUPP; 25232fcd82e9SOr Gerlitz } 2524cd377663SOr Gerlitz 25251ad9a00aSPaul Blakey if (mlx5e_vxlan_lookup_port(up_priv, be16_to_cpu(key->tp_dst)) && 2526a54e20b4SHadar Hen Zion MLX5_CAP_ESW(priv->mdev, vxlan_encap_decap)) { 2527a54e20b4SHadar Hen Zion tunnel_type = MLX5_HEADER_TYPE_VXLAN; 2528a54e20b4SHadar Hen Zion } else { 25292fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 25302fcd82e9SOr Gerlitz "%d isn't an offloaded vxlan udp dport\n", be16_to_cpu(key->tp_dst)); 2531a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 2532a54e20b4SHadar Hen Zion } 2533a54e20b4SHadar Hen Zion 253476f7444dSOr Gerlitz hash_key = hash_encap_info(key); 2535a54e20b4SHadar Hen Zion 2536a54e20b4SHadar Hen Zion hash_for_each_possible_rcu(esw->offloads.encap_tbl, e, 2537a54e20b4SHadar Hen Zion encap_hlist, hash_key) { 253876f7444dSOr Gerlitz if (!cmp_encap_info(&e->tun_info.key, key)) { 2539a54e20b4SHadar Hen Zion found = true; 2540a54e20b4SHadar Hen Zion break; 2541a54e20b4SHadar Hen Zion } 2542a54e20b4SHadar Hen Zion } 2543a54e20b4SHadar Hen Zion 2544b2812089SVlad Buslov /* must verify if encap is valid or not */ 254545247bf2SOr Gerlitz if (found) 254645247bf2SOr Gerlitz goto attach_flow; 2547a54e20b4SHadar Hen Zion 2548a54e20b4SHadar Hen Zion e = kzalloc(sizeof(*e), GFP_KERNEL); 2549a54e20b4SHadar Hen Zion if (!e) 2550a54e20b4SHadar Hen Zion return -ENOMEM; 2551a54e20b4SHadar Hen Zion 255276f7444dSOr Gerlitz e->tun_info = *tun_info; 2553a54e20b4SHadar Hen Zion e->tunnel_type = tunnel_type; 2554a54e20b4SHadar Hen Zion INIT_LIST_HEAD(&e->flows); 2555a54e20b4SHadar Hen Zion 2556ce99f6b9SOr Gerlitz if (family == AF_INET) 25571a8552bdSHadar Hen Zion err = mlx5e_create_encap_header_ipv4(priv, mirred_dev, e); 2558ce99f6b9SOr Gerlitz else if (family == AF_INET6) 25591a8552bdSHadar Hen Zion err = mlx5e_create_encap_header_ipv6(priv, mirred_dev, e); 2560ce99f6b9SOr Gerlitz 2561232c0013SHadar Hen Zion if (err && err != -EAGAIN) 2562a54e20b4SHadar Hen Zion goto out_err; 2563a54e20b4SHadar Hen Zion 2564a54e20b4SHadar Hen Zion hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key); 2565a54e20b4SHadar Hen Zion 256645247bf2SOr Gerlitz attach_flow: 256745247bf2SOr Gerlitz list_add(&flow->encap, &e->flows); 256845247bf2SOr Gerlitz *encap_dev = e->out_dev; 2569232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 257045247bf2SOr Gerlitz attr->encap_id = e->encap_id; 2571b2812089SVlad Buslov else 2572b2812089SVlad Buslov err = -EAGAIN; 257345247bf2SOr Gerlitz 2574232c0013SHadar Hen Zion return err; 2575a54e20b4SHadar Hen Zion 2576a54e20b4SHadar Hen Zion out_err: 2577a54e20b4SHadar Hen Zion kfree(e); 2578a54e20b4SHadar Hen Zion return err; 2579a54e20b4SHadar Hen Zion } 2580a54e20b4SHadar Hen Zion 25811482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv, 25821482bd3dSJianbo Liu const struct tc_action *a, 25831482bd3dSJianbo Liu struct mlx5_esw_flow_attr *attr, 25841482bd3dSJianbo Liu u32 *action) 25851482bd3dSJianbo Liu { 2586cc495188SJianbo Liu u8 vlan_idx = attr->total_vlan; 2587cc495188SJianbo Liu 2588cc495188SJianbo Liu if (vlan_idx >= MLX5_FS_VLAN_DEPTH) 25891482bd3dSJianbo Liu return -EOPNOTSUPP; 2590cc495188SJianbo Liu 2591cc495188SJianbo Liu if (tcf_vlan_action(a) == TCA_VLAN_ACT_POP) { 2592cc495188SJianbo Liu if (vlan_idx) { 2593cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 2594cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 2595cc495188SJianbo Liu return -EOPNOTSUPP; 2596cc495188SJianbo Liu 2597cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2; 2598cc495188SJianbo Liu } else { 2599cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 2600cc495188SJianbo Liu } 2601cc495188SJianbo Liu } else if (tcf_vlan_action(a) == TCA_VLAN_ACT_PUSH) { 2602cc495188SJianbo Liu attr->vlan_vid[vlan_idx] = tcf_vlan_push_vid(a); 2603cc495188SJianbo Liu attr->vlan_prio[vlan_idx] = tcf_vlan_push_prio(a); 2604cc495188SJianbo Liu attr->vlan_proto[vlan_idx] = tcf_vlan_push_proto(a); 2605cc495188SJianbo Liu if (!attr->vlan_proto[vlan_idx]) 2606cc495188SJianbo Liu attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q); 2607cc495188SJianbo Liu 2608cc495188SJianbo Liu if (vlan_idx) { 2609cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 2610cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 2611cc495188SJianbo Liu return -EOPNOTSUPP; 2612cc495188SJianbo Liu 2613cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2; 2614cc495188SJianbo Liu } else { 2615cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) && 2616cc495188SJianbo Liu (tcf_vlan_push_proto(a) != htons(ETH_P_8021Q) || 2617cc495188SJianbo Liu tcf_vlan_push_prio(a))) 2618cc495188SJianbo Liu return -EOPNOTSUPP; 2619cc495188SJianbo Liu 2620cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH; 26211482bd3dSJianbo Liu } 26221482bd3dSJianbo Liu } else { /* action is TCA_VLAN_ACT_MODIFY */ 26231482bd3dSJianbo Liu return -EOPNOTSUPP; 26241482bd3dSJianbo Liu } 26251482bd3dSJianbo Liu 2626cc495188SJianbo Liu attr->total_vlan = vlan_idx + 1; 2627cc495188SJianbo Liu 26281482bd3dSJianbo Liu return 0; 26291482bd3dSJianbo Liu } 26301482bd3dSJianbo Liu 2631a54e20b4SHadar Hen Zion static int parse_tc_fdb_actions(struct mlx5e_priv *priv, struct tcf_exts *exts, 2632d7e75a32SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2633a54e20b4SHadar Hen Zion struct mlx5e_tc_flow *flow) 2634a54e20b4SHadar Hen Zion { 2635ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 26361d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 2637a54e20b4SHadar Hen Zion struct ip_tunnel_info *info = NULL; 263803a9d11eSOr Gerlitz const struct tc_action *a; 263922dc13c8SWANG Cong LIST_HEAD(actions); 2640a54e20b4SHadar Hen Zion bool encap = false; 26411cab1cd7SOr Gerlitz u32 action = 0; 26421482bd3dSJianbo Liu int err; 264303a9d11eSOr Gerlitz 26443bcc0cecSJiri Pirko if (!tcf_exts_has_actions(exts)) 264503a9d11eSOr Gerlitz return -EINVAL; 264603a9d11eSOr Gerlitz 26471d447a39SSaeed Mahameed attr->in_rep = rpriv->rep; 264810ff5359SShahar Klein attr->in_mdev = priv->mdev; 264903a9d11eSOr Gerlitz 265022dc13c8SWANG Cong tcf_exts_to_list(exts, &actions); 265122dc13c8SWANG Cong list_for_each_entry(a, &actions, list) { 265203a9d11eSOr Gerlitz if (is_tcf_gact_shot(a)) { 26531cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP | 265403a9d11eSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 265503a9d11eSOr Gerlitz continue; 265603a9d11eSOr Gerlitz } 265703a9d11eSOr Gerlitz 2658d7e75a32SOr Gerlitz if (is_tcf_pedit(a)) { 2659d7e75a32SOr Gerlitz err = parse_tc_pedit_action(priv, a, MLX5_FLOW_NAMESPACE_FDB, 2660d7e75a32SOr Gerlitz parse_attr); 2661d7e75a32SOr Gerlitz if (err) 2662d7e75a32SOr Gerlitz return err; 2663d7e75a32SOr Gerlitz 26641cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2665592d3651SChris Mi attr->mirror_count = attr->out_count; 2666d7e75a32SOr Gerlitz continue; 2667d7e75a32SOr Gerlitz } 2668d7e75a32SOr Gerlitz 266926c02749SOr Gerlitz if (is_tcf_csum(a)) { 26701cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 267126c02749SOr Gerlitz tcf_csum_update_flags(a))) 267226c02749SOr Gerlitz continue; 267326c02749SOr Gerlitz 267426c02749SOr Gerlitz return -EOPNOTSUPP; 267526c02749SOr Gerlitz } 267626c02749SOr Gerlitz 2677592d3651SChris Mi if (is_tcf_mirred_egress_redirect(a) || is_tcf_mirred_egress_mirror(a)) { 267803a9d11eSOr Gerlitz struct mlx5e_priv *out_priv; 2679592d3651SChris Mi struct net_device *out_dev; 268003a9d11eSOr Gerlitz 26819f8a739eSCong Wang out_dev = tcf_mirred_dev(a); 268203a9d11eSOr Gerlitz 2683592d3651SChris Mi if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) { 2684592d3651SChris Mi pr_err("can't support more than %d output ports, can't offload forwarding\n", 2685592d3651SChris Mi attr->out_count); 2686592d3651SChris Mi return -EOPNOTSUPP; 2687592d3651SChris Mi } 2688592d3651SChris Mi 2689a54e20b4SHadar Hen Zion if (switchdev_port_same_parent_id(priv->netdev, 2690b1d90e6bSRabie Loulou out_dev) || 2691b1d90e6bSRabie Loulou is_merged_eswitch_dev(priv, out_dev)) { 26921cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 2693e37a79e5SMark Bloch MLX5_FLOW_CONTEXT_ACTION_COUNT; 269403a9d11eSOr Gerlitz out_priv = netdev_priv(out_dev); 26951d447a39SSaeed Mahameed rpriv = out_priv->ppriv; 2696592d3651SChris Mi attr->out_rep[attr->out_count] = rpriv->rep; 2697592d3651SChris Mi attr->out_mdev[attr->out_count++] = out_priv->mdev; 2698a54e20b4SHadar Hen Zion } else if (encap) { 26999f8a739eSCong Wang parse_attr->mirred_ifindex = out_dev->ifindex; 27003c37745eSOr Gerlitz parse_attr->tun_info = *info; 27013c37745eSOr Gerlitz attr->parse_attr = parse_attr; 27021cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_ENCAP | 2703a54e20b4SHadar Hen Zion MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 2704a54e20b4SHadar Hen Zion MLX5_FLOW_CONTEXT_ACTION_COUNT; 27053c37745eSOr Gerlitz /* attr->out_rep is resolved when we handle encap */ 2706a54e20b4SHadar Hen Zion } else { 2707a54e20b4SHadar Hen Zion pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 2708a54e20b4SHadar Hen Zion priv->netdev->name, out_dev->name); 2709a54e20b4SHadar Hen Zion return -EINVAL; 2710a54e20b4SHadar Hen Zion } 2711a54e20b4SHadar Hen Zion continue; 2712a54e20b4SHadar Hen Zion } 2713a54e20b4SHadar Hen Zion 2714a54e20b4SHadar Hen Zion if (is_tcf_tunnel_set(a)) { 2715a54e20b4SHadar Hen Zion info = tcf_tunnel_info(a); 2716a54e20b4SHadar Hen Zion if (info) 2717a54e20b4SHadar Hen Zion encap = true; 2718a54e20b4SHadar Hen Zion else 2719a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 2720592d3651SChris Mi attr->mirror_count = attr->out_count; 272103a9d11eSOr Gerlitz continue; 272203a9d11eSOr Gerlitz } 272303a9d11eSOr Gerlitz 27248b32580dSOr Gerlitz if (is_tcf_vlan(a)) { 27251482bd3dSJianbo Liu err = parse_tc_vlan_action(priv, a, attr, &action); 27261482bd3dSJianbo Liu 27271482bd3dSJianbo Liu if (err) 27281482bd3dSJianbo Liu return err; 27291482bd3dSJianbo Liu 2730592d3651SChris Mi attr->mirror_count = attr->out_count; 27318b32580dSOr Gerlitz continue; 27328b32580dSOr Gerlitz } 27338b32580dSOr Gerlitz 2734bbd00f7eSHadar Hen Zion if (is_tcf_tunnel_release(a)) { 27351cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DECAP; 2736bbd00f7eSHadar Hen Zion continue; 2737bbd00f7eSHadar Hen Zion } 2738bbd00f7eSHadar Hen Zion 273903a9d11eSOr Gerlitz return -EINVAL; 274003a9d11eSOr Gerlitz } 2741bdd66ac0SOr Gerlitz 27421cab1cd7SOr Gerlitz attr->action = action; 2743bdd66ac0SOr Gerlitz if (!actions_match_supported(priv, exts, parse_attr, flow)) 2744bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 2745bdd66ac0SOr Gerlitz 2746592d3651SChris Mi if (attr->out_count > 1 && !mlx5_esw_has_fwd_fdb(priv->mdev)) { 2747592d3651SChris Mi netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n"); 2748592d3651SChris Mi return -EOPNOTSUPP; 2749592d3651SChris Mi } 2750592d3651SChris Mi 275131c8eba5SOr Gerlitz return 0; 275203a9d11eSOr Gerlitz } 275303a9d11eSOr Gerlitz 275460bd4af8SOr Gerlitz static void get_flags(int flags, u8 *flow_flags) 275560bd4af8SOr Gerlitz { 275660bd4af8SOr Gerlitz u8 __flow_flags = 0; 275760bd4af8SOr Gerlitz 275860bd4af8SOr Gerlitz if (flags & MLX5E_TC_INGRESS) 275960bd4af8SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_INGRESS; 276060bd4af8SOr Gerlitz if (flags & MLX5E_TC_EGRESS) 276160bd4af8SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_EGRESS; 276260bd4af8SOr Gerlitz 276360bd4af8SOr Gerlitz *flow_flags = __flow_flags; 276460bd4af8SOr Gerlitz } 276560bd4af8SOr Gerlitz 276605866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = { 276705866c82SOr Gerlitz .head_offset = offsetof(struct mlx5e_tc_flow, node), 276805866c82SOr Gerlitz .key_offset = offsetof(struct mlx5e_tc_flow, cookie), 276905866c82SOr Gerlitz .key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie), 277005866c82SOr Gerlitz .automatic_shrinking = true, 277105866c82SOr Gerlitz }; 277205866c82SOr Gerlitz 277305866c82SOr Gerlitz static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv) 277405866c82SOr Gerlitz { 2775655dc3d2SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2776655dc3d2SOr Gerlitz struct mlx5e_rep_priv *uplink_rpriv; 2777655dc3d2SOr Gerlitz 2778655dc3d2SOr Gerlitz if (MLX5_VPORT_MANAGER(priv->mdev) && esw->mode == SRIOV_OFFLOADS) { 2779655dc3d2SOr Gerlitz uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 2780655dc3d2SOr Gerlitz return &uplink_rpriv->tc_ht; 2781655dc3d2SOr Gerlitz } else 278205866c82SOr Gerlitz return &priv->fs.tc.ht; 278305866c82SOr Gerlitz } 278405866c82SOr Gerlitz 27855fd9fc4eSJiri Pirko int mlx5e_configure_flower(struct mlx5e_priv *priv, 278660bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 2787e3a2b7edSAmir Vadai { 2788adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 278917091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr; 279005866c82SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv); 27913bc4b7bfSOr Gerlitz struct mlx5e_tc_flow *flow; 27923bc4b7bfSOr Gerlitz int attr_size, err = 0; 279365ba8fb7SOr Gerlitz u8 flow_flags = 0; 2794e3a2b7edSAmir Vadai 279560bd4af8SOr Gerlitz get_flags(flags, &flow_flags); 279660bd4af8SOr Gerlitz 27978f8ae895SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 27988f8ae895SOr Gerlitz if (flow) { 27998f8ae895SOr Gerlitz netdev_warn_once(priv->netdev, "flow cookie %lx already exists, ignoring\n", f->cookie); 28008f8ae895SOr Gerlitz return 0; 28018f8ae895SOr Gerlitz } 28028f8ae895SOr Gerlitz 280365ba8fb7SOr Gerlitz if (esw && esw->mode == SRIOV_OFFLOADS) { 280460bd4af8SOr Gerlitz flow_flags |= MLX5E_TC_FLOW_ESWITCH; 280565ba8fb7SOr Gerlitz attr_size = sizeof(struct mlx5_esw_flow_attr); 28063bc4b7bfSOr Gerlitz } else { 280760bd4af8SOr Gerlitz flow_flags |= MLX5E_TC_FLOW_NIC; 28083bc4b7bfSOr Gerlitz attr_size = sizeof(struct mlx5_nic_flow_attr); 280965ba8fb7SOr Gerlitz } 2810776b12b6SOr Gerlitz 281165ba8fb7SOr Gerlitz flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL); 28121b9a07eeSLeon Romanovsky parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL); 281317091853SOr Gerlitz if (!parse_attr || !flow) { 2814e3a2b7edSAmir Vadai err = -ENOMEM; 2815e3a2b7edSAmir Vadai goto err_free; 2816e3a2b7edSAmir Vadai } 2817e3a2b7edSAmir Vadai 2818e3a2b7edSAmir Vadai flow->cookie = f->cookie; 281965ba8fb7SOr Gerlitz flow->flags = flow_flags; 2820655dc3d2SOr Gerlitz flow->priv = priv; 2821e3a2b7edSAmir Vadai 282217091853SOr Gerlitz err = parse_cls_flower(priv, flow, &parse_attr->spec, f); 2823e3a2b7edSAmir Vadai if (err < 0) 2824e3a2b7edSAmir Vadai goto err_free; 2825e3a2b7edSAmir Vadai 282665ba8fb7SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 2827d7e75a32SOr Gerlitz err = parse_tc_fdb_actions(priv, f->exts, parse_attr, flow); 2828adb4c123SOr Gerlitz if (err < 0) 28293c37745eSOr Gerlitz goto err_free; 2830e4ad91f2SChris Mi flow->rule[0] = mlx5e_tc_add_fdb_flow(priv, parse_attr, flow); 2831adb4c123SOr Gerlitz } else { 2832aa0cbbaeSOr Gerlitz err = parse_tc_nic_actions(priv, f->exts, parse_attr, flow); 2833e3a2b7edSAmir Vadai if (err < 0) 2834e3a2b7edSAmir Vadai goto err_free; 2835e4ad91f2SChris Mi flow->rule[0] = mlx5e_tc_add_nic_flow(priv, parse_attr, flow); 2836adb4c123SOr Gerlitz } 2837adb4c123SOr Gerlitz 2838e4ad91f2SChris Mi if (IS_ERR(flow->rule[0])) { 2839e4ad91f2SChris Mi err = PTR_ERR(flow->rule[0]); 28403c37745eSOr Gerlitz if (err != -EAGAIN) 2841aa0cbbaeSOr Gerlitz goto err_free; 28425c40348cSOr Gerlitz } 28435c40348cSOr Gerlitz 28443c37745eSOr Gerlitz if (err != -EAGAIN) 28450b67a38fSHadar Hen Zion flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 28463c37745eSOr Gerlitz 2847af1607c3SJianbo Liu if (!(flow->flags & MLX5E_TC_FLOW_ESWITCH) || 2848232c0013SHadar Hen Zion !(flow->esw_attr->action & MLX5_FLOW_CONTEXT_ACTION_ENCAP)) 2849232c0013SHadar Hen Zion kvfree(parse_attr); 2850e3a2b7edSAmir Vadai 285105866c82SOr Gerlitz err = rhashtable_insert_fast(tc_ht, &flow->node, tc_ht_params); 2852af1607c3SJianbo Liu if (err) { 28535e86397aSOr Gerlitz mlx5e_tc_del_flow(priv, flow); 2854af1607c3SJianbo Liu kfree(flow); 2855af1607c3SJianbo Liu } 2856af1607c3SJianbo Liu 2857af1607c3SJianbo Liu return err; 2858e3a2b7edSAmir Vadai 2859e3a2b7edSAmir Vadai err_free: 286017091853SOr Gerlitz kvfree(parse_attr); 2861232c0013SHadar Hen Zion kfree(flow); 2862e3a2b7edSAmir Vadai return err; 2863e3a2b7edSAmir Vadai } 2864e3a2b7edSAmir Vadai 28658f8ae895SOr Gerlitz #define DIRECTION_MASK (MLX5E_TC_INGRESS | MLX5E_TC_EGRESS) 28668f8ae895SOr Gerlitz #define FLOW_DIRECTION_MASK (MLX5E_TC_FLOW_INGRESS | MLX5E_TC_FLOW_EGRESS) 28678f8ae895SOr Gerlitz 28688f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags) 28698f8ae895SOr Gerlitz { 28708f8ae895SOr Gerlitz if ((flow->flags & FLOW_DIRECTION_MASK) == (flags & DIRECTION_MASK)) 28718f8ae895SOr Gerlitz return true; 28728f8ae895SOr Gerlitz 28738f8ae895SOr Gerlitz return false; 28748f8ae895SOr Gerlitz } 28758f8ae895SOr Gerlitz 2876e3a2b7edSAmir Vadai int mlx5e_delete_flower(struct mlx5e_priv *priv, 287760bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 2878e3a2b7edSAmir Vadai { 287905866c82SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv); 2880e3a2b7edSAmir Vadai struct mlx5e_tc_flow *flow; 2881e3a2b7edSAmir Vadai 288205866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 28838f8ae895SOr Gerlitz if (!flow || !same_flow_direction(flow, flags)) 2884e3a2b7edSAmir Vadai return -EINVAL; 2885e3a2b7edSAmir Vadai 288605866c82SOr Gerlitz rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params); 2887e3a2b7edSAmir Vadai 2888961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 2889e3a2b7edSAmir Vadai 2890e3a2b7edSAmir Vadai kfree(flow); 2891e3a2b7edSAmir Vadai 2892e3a2b7edSAmir Vadai return 0; 2893e3a2b7edSAmir Vadai } 2894e3a2b7edSAmir Vadai 2895aad7e08dSAmir Vadai int mlx5e_stats_flower(struct mlx5e_priv *priv, 289660bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 2897aad7e08dSAmir Vadai { 289805866c82SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv); 2899aad7e08dSAmir Vadai struct mlx5e_tc_flow *flow; 2900aad7e08dSAmir Vadai struct mlx5_fc *counter; 2901aad7e08dSAmir Vadai u64 bytes; 2902aad7e08dSAmir Vadai u64 packets; 2903aad7e08dSAmir Vadai u64 lastuse; 2904aad7e08dSAmir Vadai 290505866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 29068f8ae895SOr Gerlitz if (!flow || !same_flow_direction(flow, flags)) 2907aad7e08dSAmir Vadai return -EINVAL; 2908aad7e08dSAmir Vadai 29090b67a38fSHadar Hen Zion if (!(flow->flags & MLX5E_TC_FLOW_OFFLOADED)) 29100b67a38fSHadar Hen Zion return 0; 29110b67a38fSHadar Hen Zion 2912e4ad91f2SChris Mi counter = mlx5_flow_rule_counter(flow->rule[0]); 2913aad7e08dSAmir Vadai if (!counter) 2914aad7e08dSAmir Vadai return 0; 2915aad7e08dSAmir Vadai 2916aad7e08dSAmir Vadai mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 2917aad7e08dSAmir Vadai 2918d897a638SJakub Kicinski tcf_exts_stats_update(f->exts, bytes, packets, lastuse); 2919fed06ee8SOr Gerlitz 2920aad7e08dSAmir Vadai return 0; 2921aad7e08dSAmir Vadai } 2922aad7e08dSAmir Vadai 2923655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv) 2924e8f887acSAmir Vadai { 2925acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 2926e8f887acSAmir Vadai 292711c9c548SOr Gerlitz hash_init(tc->mod_hdr_tbl); 29285c65c564SOr Gerlitz hash_init(tc->hairpin_tbl); 292911c9c548SOr Gerlitz 293005866c82SOr Gerlitz return rhashtable_init(&tc->ht, &tc_ht_params); 2931e8f887acSAmir Vadai } 2932e8f887acSAmir Vadai 2933e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg) 2934e8f887acSAmir Vadai { 2935e8f887acSAmir Vadai struct mlx5e_tc_flow *flow = ptr; 2936655dc3d2SOr Gerlitz struct mlx5e_priv *priv = flow->priv; 2937e8f887acSAmir Vadai 2938961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 2939e8f887acSAmir Vadai kfree(flow); 2940e8f887acSAmir Vadai } 2941e8f887acSAmir Vadai 2942655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv) 2943e8f887acSAmir Vadai { 2944acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 2945e8f887acSAmir Vadai 2946655dc3d2SOr Gerlitz rhashtable_free_and_destroy(&tc->ht, _mlx5e_tc_del_flow, NULL); 2947e8f887acSAmir Vadai 2948acff797cSMaor Gottlieb if (!IS_ERR_OR_NULL(tc->t)) { 2949acff797cSMaor Gottlieb mlx5_destroy_flow_table(tc->t); 2950acff797cSMaor Gottlieb tc->t = NULL; 2951e8f887acSAmir Vadai } 2952e8f887acSAmir Vadai } 2953655dc3d2SOr Gerlitz 2954655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht) 2955655dc3d2SOr Gerlitz { 2956655dc3d2SOr Gerlitz return rhashtable_init(tc_ht, &tc_ht_params); 2957655dc3d2SOr Gerlitz } 2958655dc3d2SOr Gerlitz 2959655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht) 2960655dc3d2SOr Gerlitz { 2961655dc3d2SOr Gerlitz rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL); 2962655dc3d2SOr Gerlitz } 296301252a27SOr Gerlitz 296401252a27SOr Gerlitz int mlx5e_tc_num_filters(struct mlx5e_priv *priv) 296501252a27SOr Gerlitz { 296601252a27SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv); 296701252a27SOr Gerlitz 296801252a27SOr Gerlitz return atomic_read(&tc_ht->nelems); 296901252a27SOr Gerlitz } 2970