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" 53358aa5ceSSaeed Mahameed #include "lib/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; 64b8aee822SMark Bloch struct mlx5_fc *counter; 653bc4b7bfSOr Gerlitz }; 663bc4b7bfSOr Gerlitz 6760bd4af8SOr Gerlitz #define MLX5E_TC_FLOW_BASE (MLX5E_TC_LAST_EXPORTED_BIT + 1) 6860bd4af8SOr Gerlitz 6965ba8fb7SOr Gerlitz enum { 7060bd4af8SOr Gerlitz MLX5E_TC_FLOW_INGRESS = MLX5E_TC_INGRESS, 7160bd4af8SOr Gerlitz MLX5E_TC_FLOW_EGRESS = MLX5E_TC_EGRESS, 7260bd4af8SOr Gerlitz MLX5E_TC_FLOW_ESWITCH = BIT(MLX5E_TC_FLOW_BASE), 7360bd4af8SOr Gerlitz MLX5E_TC_FLOW_NIC = BIT(MLX5E_TC_FLOW_BASE + 1), 7460bd4af8SOr Gerlitz MLX5E_TC_FLOW_OFFLOADED = BIT(MLX5E_TC_FLOW_BASE + 2), 7560bd4af8SOr Gerlitz MLX5E_TC_FLOW_HAIRPIN = BIT(MLX5E_TC_FLOW_BASE + 3), 7660bd4af8SOr Gerlitz MLX5E_TC_FLOW_HAIRPIN_RSS = BIT(MLX5E_TC_FLOW_BASE + 4), 7765ba8fb7SOr Gerlitz }; 7865ba8fb7SOr Gerlitz 79e4ad91f2SChris Mi #define MLX5E_TC_MAX_SPLITS 1 80e4ad91f2SChris Mi 81e8f887acSAmir Vadai struct mlx5e_tc_flow { 82e8f887acSAmir Vadai struct rhash_head node; 83655dc3d2SOr Gerlitz struct mlx5e_priv *priv; 84e8f887acSAmir Vadai u64 cookie; 8565ba8fb7SOr Gerlitz u8 flags; 86e4ad91f2SChris Mi struct mlx5_flow_handle *rule[MLX5E_TC_MAX_SPLITS + 1]; 8711c9c548SOr Gerlitz struct list_head encap; /* flows sharing the same encap ID */ 8811c9c548SOr Gerlitz struct list_head mod_hdr; /* flows sharing the same mod hdr ID */ 895c65c564SOr Gerlitz struct list_head hairpin; /* flows sharing the same hairpin */ 903bc4b7bfSOr Gerlitz union { 91ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr esw_attr[0]; 923bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr nic_attr[0]; 933bc4b7bfSOr Gerlitz }; 94e8f887acSAmir Vadai }; 95e8f887acSAmir Vadai 9617091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr { 973c37745eSOr Gerlitz struct ip_tunnel_info tun_info; 9817091853SOr Gerlitz struct mlx5_flow_spec spec; 99d79b6df6SOr Gerlitz int num_mod_hdr_actions; 100d79b6df6SOr Gerlitz void *mod_hdr_actions; 1013c37745eSOr Gerlitz int mirred_ifindex; 10217091853SOr Gerlitz }; 10317091853SOr Gerlitz 104acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4 105b3a433deSOr Gerlitz #define MLX5E_TC_TABLE_MAX_GROUP_SIZE BIT(16) 106e8f887acSAmir Vadai 10777ab67b7SOr Gerlitz struct mlx5e_hairpin { 10877ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 10977ab67b7SOr Gerlitz 11077ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev; 1113f6d08d1SOr Gerlitz struct mlx5e_priv *func_priv; 11277ab67b7SOr Gerlitz u32 tdn; 11377ab67b7SOr Gerlitz u32 tirn; 1143f6d08d1SOr Gerlitz 1153f6d08d1SOr Gerlitz int num_channels; 1163f6d08d1SOr Gerlitz struct mlx5e_rqt indir_rqt; 1173f6d08d1SOr Gerlitz u32 indir_tirn[MLX5E_NUM_INDIR_TIRS]; 1183f6d08d1SOr Gerlitz struct mlx5e_ttc_table ttc; 11977ab67b7SOr Gerlitz }; 12077ab67b7SOr Gerlitz 1215c65c564SOr Gerlitz struct mlx5e_hairpin_entry { 1225c65c564SOr Gerlitz /* a node of a hash table which keeps all the hairpin entries */ 1235c65c564SOr Gerlitz struct hlist_node hairpin_hlist; 1245c65c564SOr Gerlitz 1255c65c564SOr Gerlitz /* flows sharing the same hairpin */ 1265c65c564SOr Gerlitz struct list_head flows; 1275c65c564SOr Gerlitz 128d8822868SOr Gerlitz u16 peer_vhca_id; 129106be53bSOr Gerlitz u8 prio; 1305c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 1315c65c564SOr Gerlitz }; 1325c65c564SOr Gerlitz 13311c9c548SOr Gerlitz struct mod_hdr_key { 13411c9c548SOr Gerlitz int num_actions; 13511c9c548SOr Gerlitz void *actions; 13611c9c548SOr Gerlitz }; 13711c9c548SOr Gerlitz 13811c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry { 13911c9c548SOr Gerlitz /* a node of a hash table which keeps all the mod_hdr entries */ 14011c9c548SOr Gerlitz struct hlist_node mod_hdr_hlist; 14111c9c548SOr Gerlitz 14211c9c548SOr Gerlitz /* flows sharing the same mod_hdr entry */ 14311c9c548SOr Gerlitz struct list_head flows; 14411c9c548SOr Gerlitz 14511c9c548SOr Gerlitz struct mod_hdr_key key; 14611c9c548SOr Gerlitz 14711c9c548SOr Gerlitz u32 mod_hdr_id; 14811c9c548SOr Gerlitz }; 14911c9c548SOr Gerlitz 15011c9c548SOr Gerlitz #define MLX5_MH_ACT_SZ MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto) 15111c9c548SOr Gerlitz 15211c9c548SOr Gerlitz static inline u32 hash_mod_hdr_info(struct mod_hdr_key *key) 15311c9c548SOr Gerlitz { 15411c9c548SOr Gerlitz return jhash(key->actions, 15511c9c548SOr Gerlitz key->num_actions * MLX5_MH_ACT_SZ, 0); 15611c9c548SOr Gerlitz } 15711c9c548SOr Gerlitz 15811c9c548SOr Gerlitz static inline int cmp_mod_hdr_info(struct mod_hdr_key *a, 15911c9c548SOr Gerlitz struct mod_hdr_key *b) 16011c9c548SOr Gerlitz { 16111c9c548SOr Gerlitz if (a->num_actions != b->num_actions) 16211c9c548SOr Gerlitz return 1; 16311c9c548SOr Gerlitz 16411c9c548SOr Gerlitz return memcmp(a->actions, b->actions, a->num_actions * MLX5_MH_ACT_SZ); 16511c9c548SOr Gerlitz } 16611c9c548SOr Gerlitz 16711c9c548SOr Gerlitz static int mlx5e_attach_mod_hdr(struct mlx5e_priv *priv, 16811c9c548SOr Gerlitz struct mlx5e_tc_flow *flow, 16911c9c548SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 17011c9c548SOr Gerlitz { 17111c9c548SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 17211c9c548SOr Gerlitz int num_actions, actions_size, namespace, err; 17311c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 17411c9c548SOr Gerlitz struct mod_hdr_key key; 17511c9c548SOr Gerlitz bool found = false; 17611c9c548SOr Gerlitz u32 hash_key; 17711c9c548SOr Gerlitz 17811c9c548SOr Gerlitz num_actions = parse_attr->num_mod_hdr_actions; 17911c9c548SOr Gerlitz actions_size = MLX5_MH_ACT_SZ * num_actions; 18011c9c548SOr Gerlitz 18111c9c548SOr Gerlitz key.actions = parse_attr->mod_hdr_actions; 18211c9c548SOr Gerlitz key.num_actions = num_actions; 18311c9c548SOr Gerlitz 18411c9c548SOr Gerlitz hash_key = hash_mod_hdr_info(&key); 18511c9c548SOr Gerlitz 18611c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 18711c9c548SOr Gerlitz namespace = MLX5_FLOW_NAMESPACE_FDB; 18811c9c548SOr Gerlitz hash_for_each_possible(esw->offloads.mod_hdr_tbl, mh, 18911c9c548SOr Gerlitz mod_hdr_hlist, hash_key) { 19011c9c548SOr Gerlitz if (!cmp_mod_hdr_info(&mh->key, &key)) { 19111c9c548SOr Gerlitz found = true; 19211c9c548SOr Gerlitz break; 19311c9c548SOr Gerlitz } 19411c9c548SOr Gerlitz } 19511c9c548SOr Gerlitz } else { 19611c9c548SOr Gerlitz namespace = MLX5_FLOW_NAMESPACE_KERNEL; 19711c9c548SOr Gerlitz hash_for_each_possible(priv->fs.tc.mod_hdr_tbl, mh, 19811c9c548SOr Gerlitz mod_hdr_hlist, hash_key) { 19911c9c548SOr Gerlitz if (!cmp_mod_hdr_info(&mh->key, &key)) { 20011c9c548SOr Gerlitz found = true; 20111c9c548SOr Gerlitz break; 20211c9c548SOr Gerlitz } 20311c9c548SOr Gerlitz } 20411c9c548SOr Gerlitz } 20511c9c548SOr Gerlitz 20611c9c548SOr Gerlitz if (found) 20711c9c548SOr Gerlitz goto attach_flow; 20811c9c548SOr Gerlitz 20911c9c548SOr Gerlitz mh = kzalloc(sizeof(*mh) + actions_size, GFP_KERNEL); 21011c9c548SOr Gerlitz if (!mh) 21111c9c548SOr Gerlitz return -ENOMEM; 21211c9c548SOr Gerlitz 21311c9c548SOr Gerlitz mh->key.actions = (void *)mh + sizeof(*mh); 21411c9c548SOr Gerlitz memcpy(mh->key.actions, key.actions, actions_size); 21511c9c548SOr Gerlitz mh->key.num_actions = num_actions; 21611c9c548SOr Gerlitz INIT_LIST_HEAD(&mh->flows); 21711c9c548SOr Gerlitz 21811c9c548SOr Gerlitz err = mlx5_modify_header_alloc(priv->mdev, namespace, 21911c9c548SOr Gerlitz mh->key.num_actions, 22011c9c548SOr Gerlitz mh->key.actions, 22111c9c548SOr Gerlitz &mh->mod_hdr_id); 22211c9c548SOr Gerlitz if (err) 22311c9c548SOr Gerlitz goto out_err; 22411c9c548SOr Gerlitz 22511c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 22611c9c548SOr Gerlitz hash_add(esw->offloads.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key); 22711c9c548SOr Gerlitz else 22811c9c548SOr Gerlitz hash_add(priv->fs.tc.mod_hdr_tbl, &mh->mod_hdr_hlist, hash_key); 22911c9c548SOr Gerlitz 23011c9c548SOr Gerlitz attach_flow: 23111c9c548SOr Gerlitz list_add(&flow->mod_hdr, &mh->flows); 23211c9c548SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 23311c9c548SOr Gerlitz flow->esw_attr->mod_hdr_id = mh->mod_hdr_id; 23411c9c548SOr Gerlitz else 23511c9c548SOr Gerlitz flow->nic_attr->mod_hdr_id = mh->mod_hdr_id; 23611c9c548SOr Gerlitz 23711c9c548SOr Gerlitz return 0; 23811c9c548SOr Gerlitz 23911c9c548SOr Gerlitz out_err: 24011c9c548SOr Gerlitz kfree(mh); 24111c9c548SOr Gerlitz return err; 24211c9c548SOr Gerlitz } 24311c9c548SOr Gerlitz 24411c9c548SOr Gerlitz static void mlx5e_detach_mod_hdr(struct mlx5e_priv *priv, 24511c9c548SOr Gerlitz struct mlx5e_tc_flow *flow) 24611c9c548SOr Gerlitz { 24711c9c548SOr Gerlitz struct list_head *next = flow->mod_hdr.next; 24811c9c548SOr Gerlitz 24911c9c548SOr Gerlitz list_del(&flow->mod_hdr); 25011c9c548SOr Gerlitz 25111c9c548SOr Gerlitz if (list_empty(next)) { 25211c9c548SOr Gerlitz struct mlx5e_mod_hdr_entry *mh; 25311c9c548SOr Gerlitz 25411c9c548SOr Gerlitz mh = list_entry(next, struct mlx5e_mod_hdr_entry, flows); 25511c9c548SOr Gerlitz 25611c9c548SOr Gerlitz mlx5_modify_header_dealloc(priv->mdev, mh->mod_hdr_id); 25711c9c548SOr Gerlitz hash_del(&mh->mod_hdr_hlist); 25811c9c548SOr Gerlitz kfree(mh); 25911c9c548SOr Gerlitz } 26011c9c548SOr Gerlitz } 26111c9c548SOr Gerlitz 26277ab67b7SOr Gerlitz static 26377ab67b7SOr Gerlitz struct mlx5_core_dev *mlx5e_hairpin_get_mdev(struct net *net, int ifindex) 26477ab67b7SOr Gerlitz { 26577ab67b7SOr Gerlitz struct net_device *netdev; 26677ab67b7SOr Gerlitz struct mlx5e_priv *priv; 26777ab67b7SOr Gerlitz 26877ab67b7SOr Gerlitz netdev = __dev_get_by_index(net, ifindex); 26977ab67b7SOr Gerlitz priv = netdev_priv(netdev); 27077ab67b7SOr Gerlitz return priv->mdev; 27177ab67b7SOr Gerlitz } 27277ab67b7SOr Gerlitz 27377ab67b7SOr Gerlitz static int mlx5e_hairpin_create_transport(struct mlx5e_hairpin *hp) 27477ab67b7SOr Gerlitz { 27577ab67b7SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)] = {0}; 27677ab67b7SOr Gerlitz void *tirc; 27777ab67b7SOr Gerlitz int err; 27877ab67b7SOr Gerlitz 27977ab67b7SOr Gerlitz err = mlx5_core_alloc_transport_domain(hp->func_mdev, &hp->tdn); 28077ab67b7SOr Gerlitz if (err) 28177ab67b7SOr Gerlitz goto alloc_tdn_err; 28277ab67b7SOr Gerlitz 28377ab67b7SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 28477ab67b7SOr Gerlitz 28577ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_DIRECT); 286ddae74acSOr Gerlitz MLX5_SET(tirc, tirc, inline_rqn, hp->pair->rqn[0]); 28777ab67b7SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 28877ab67b7SOr Gerlitz 28977ab67b7SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, MLX5_ST_SZ_BYTES(create_tir_in), &hp->tirn); 29077ab67b7SOr Gerlitz if (err) 29177ab67b7SOr Gerlitz goto create_tir_err; 29277ab67b7SOr Gerlitz 29377ab67b7SOr Gerlitz return 0; 29477ab67b7SOr Gerlitz 29577ab67b7SOr Gerlitz create_tir_err: 29677ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 29777ab67b7SOr Gerlitz alloc_tdn_err: 29877ab67b7SOr Gerlitz return err; 29977ab67b7SOr Gerlitz } 30077ab67b7SOr Gerlitz 30177ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy_transport(struct mlx5e_hairpin *hp) 30277ab67b7SOr Gerlitz { 30377ab67b7SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->tirn); 30477ab67b7SOr Gerlitz mlx5_core_dealloc_transport_domain(hp->func_mdev, hp->tdn); 30577ab67b7SOr Gerlitz } 30677ab67b7SOr Gerlitz 3073f6d08d1SOr Gerlitz static void mlx5e_hairpin_fill_rqt_rqns(struct mlx5e_hairpin *hp, void *rqtc) 3083f6d08d1SOr Gerlitz { 3093f6d08d1SOr Gerlitz u32 indirection_rqt[MLX5E_INDIR_RQT_SIZE], rqn; 3103f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3113f6d08d1SOr Gerlitz int i, ix, sz = MLX5E_INDIR_RQT_SIZE; 3123f6d08d1SOr Gerlitz 3133f6d08d1SOr Gerlitz mlx5e_build_default_indir_rqt(indirection_rqt, sz, 3143f6d08d1SOr Gerlitz hp->num_channels); 3153f6d08d1SOr Gerlitz 3163f6d08d1SOr Gerlitz for (i = 0; i < sz; i++) { 3173f6d08d1SOr Gerlitz ix = i; 3183f6d08d1SOr Gerlitz if (priv->channels.params.rss_hfunc == ETH_RSS_HASH_XOR) 3193f6d08d1SOr Gerlitz ix = mlx5e_bits_invert(i, ilog2(sz)); 3203f6d08d1SOr Gerlitz ix = indirection_rqt[ix]; 3213f6d08d1SOr Gerlitz rqn = hp->pair->rqn[ix]; 3223f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rq_num[i], rqn); 3233f6d08d1SOr Gerlitz } 3243f6d08d1SOr Gerlitz } 3253f6d08d1SOr Gerlitz 3263f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_rqt(struct mlx5e_hairpin *hp) 3273f6d08d1SOr Gerlitz { 3283f6d08d1SOr Gerlitz int inlen, err, sz = MLX5E_INDIR_RQT_SIZE; 3293f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3303f6d08d1SOr Gerlitz struct mlx5_core_dev *mdev = priv->mdev; 3313f6d08d1SOr Gerlitz void *rqtc; 3323f6d08d1SOr Gerlitz u32 *in; 3333f6d08d1SOr Gerlitz 3343f6d08d1SOr Gerlitz inlen = MLX5_ST_SZ_BYTES(create_rqt_in) + sizeof(u32) * sz; 3353f6d08d1SOr Gerlitz in = kvzalloc(inlen, GFP_KERNEL); 3363f6d08d1SOr Gerlitz if (!in) 3373f6d08d1SOr Gerlitz return -ENOMEM; 3383f6d08d1SOr Gerlitz 3393f6d08d1SOr Gerlitz rqtc = MLX5_ADDR_OF(create_rqt_in, in, rqt_context); 3403f6d08d1SOr Gerlitz 3413f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_actual_size, sz); 3423f6d08d1SOr Gerlitz MLX5_SET(rqtc, rqtc, rqt_max_size, sz); 3433f6d08d1SOr Gerlitz 3443f6d08d1SOr Gerlitz mlx5e_hairpin_fill_rqt_rqns(hp, rqtc); 3453f6d08d1SOr Gerlitz 3463f6d08d1SOr Gerlitz err = mlx5_core_create_rqt(mdev, in, inlen, &hp->indir_rqt.rqtn); 3473f6d08d1SOr Gerlitz if (!err) 3483f6d08d1SOr Gerlitz hp->indir_rqt.enabled = true; 3493f6d08d1SOr Gerlitz 3503f6d08d1SOr Gerlitz kvfree(in); 3513f6d08d1SOr Gerlitz return err; 3523f6d08d1SOr Gerlitz } 3533f6d08d1SOr Gerlitz 3543f6d08d1SOr Gerlitz static int mlx5e_hairpin_create_indirect_tirs(struct mlx5e_hairpin *hp) 3553f6d08d1SOr Gerlitz { 3563f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 3573f6d08d1SOr Gerlitz u32 in[MLX5_ST_SZ_DW(create_tir_in)]; 3583f6d08d1SOr Gerlitz int tt, i, err; 3593f6d08d1SOr Gerlitz void *tirc; 3603f6d08d1SOr Gerlitz 3613f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) { 3623f6d08d1SOr Gerlitz memset(in, 0, MLX5_ST_SZ_BYTES(create_tir_in)); 3633f6d08d1SOr Gerlitz tirc = MLX5_ADDR_OF(create_tir_in, in, ctx); 3643f6d08d1SOr Gerlitz 3653f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, transport_domain, hp->tdn); 3663f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, disp_type, MLX5_TIRC_DISP_TYPE_INDIRECT); 3673f6d08d1SOr Gerlitz MLX5_SET(tirc, tirc, indirect_table, hp->indir_rqt.rqtn); 3683f6d08d1SOr Gerlitz mlx5e_build_indir_tir_ctx_hash(&priv->channels.params, tt, tirc, false); 3693f6d08d1SOr Gerlitz 3703f6d08d1SOr Gerlitz err = mlx5_core_create_tir(hp->func_mdev, in, 3713f6d08d1SOr Gerlitz MLX5_ST_SZ_BYTES(create_tir_in), &hp->indir_tirn[tt]); 3723f6d08d1SOr Gerlitz if (err) { 3733f6d08d1SOr Gerlitz mlx5_core_warn(hp->func_mdev, "create indirect tirs failed, %d\n", err); 3743f6d08d1SOr Gerlitz goto err_destroy_tirs; 3753f6d08d1SOr Gerlitz } 3763f6d08d1SOr Gerlitz } 3773f6d08d1SOr Gerlitz return 0; 3783f6d08d1SOr Gerlitz 3793f6d08d1SOr Gerlitz err_destroy_tirs: 3803f6d08d1SOr Gerlitz for (i = 0; i < tt; i++) 3813f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[i]); 3823f6d08d1SOr Gerlitz return err; 3833f6d08d1SOr Gerlitz } 3843f6d08d1SOr Gerlitz 3853f6d08d1SOr Gerlitz static void mlx5e_hairpin_destroy_indirect_tirs(struct mlx5e_hairpin *hp) 3863f6d08d1SOr Gerlitz { 3873f6d08d1SOr Gerlitz int tt; 3883f6d08d1SOr Gerlitz 3893f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 3903f6d08d1SOr Gerlitz mlx5_core_destroy_tir(hp->func_mdev, hp->indir_tirn[tt]); 3913f6d08d1SOr Gerlitz } 3923f6d08d1SOr Gerlitz 3933f6d08d1SOr Gerlitz static void mlx5e_hairpin_set_ttc_params(struct mlx5e_hairpin *hp, 3943f6d08d1SOr Gerlitz struct ttc_params *ttc_params) 3953f6d08d1SOr Gerlitz { 3963f6d08d1SOr Gerlitz struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr; 3973f6d08d1SOr Gerlitz int tt; 3983f6d08d1SOr Gerlitz 3993f6d08d1SOr Gerlitz memset(ttc_params, 0, sizeof(*ttc_params)); 4003f6d08d1SOr Gerlitz 4013f6d08d1SOr Gerlitz ttc_params->any_tt_tirn = hp->tirn; 4023f6d08d1SOr Gerlitz 4033f6d08d1SOr Gerlitz for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++) 4043f6d08d1SOr Gerlitz ttc_params->indir_tirn[tt] = hp->indir_tirn[tt]; 4053f6d08d1SOr Gerlitz 4063f6d08d1SOr Gerlitz ft_attr->max_fte = MLX5E_NUM_TT; 4073f6d08d1SOr Gerlitz ft_attr->level = MLX5E_TC_TTC_FT_LEVEL; 4083f6d08d1SOr Gerlitz ft_attr->prio = MLX5E_TC_PRIO; 4093f6d08d1SOr Gerlitz } 4103f6d08d1SOr Gerlitz 4113f6d08d1SOr Gerlitz static int mlx5e_hairpin_rss_init(struct mlx5e_hairpin *hp) 4123f6d08d1SOr Gerlitz { 4133f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4143f6d08d1SOr Gerlitz struct ttc_params ttc_params; 4153f6d08d1SOr Gerlitz int err; 4163f6d08d1SOr Gerlitz 4173f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_rqt(hp); 4183f6d08d1SOr Gerlitz if (err) 4193f6d08d1SOr Gerlitz return err; 4203f6d08d1SOr Gerlitz 4213f6d08d1SOr Gerlitz err = mlx5e_hairpin_create_indirect_tirs(hp); 4223f6d08d1SOr Gerlitz if (err) 4233f6d08d1SOr Gerlitz goto err_create_indirect_tirs; 4243f6d08d1SOr Gerlitz 4253f6d08d1SOr Gerlitz mlx5e_hairpin_set_ttc_params(hp, &ttc_params); 4263f6d08d1SOr Gerlitz err = mlx5e_create_ttc_table(priv, &ttc_params, &hp->ttc); 4273f6d08d1SOr Gerlitz if (err) 4283f6d08d1SOr Gerlitz goto err_create_ttc_table; 4293f6d08d1SOr Gerlitz 4303f6d08d1SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: using %d channels rss ttc table id %x\n", 4313f6d08d1SOr Gerlitz hp->num_channels, hp->ttc.ft.t->id); 4323f6d08d1SOr Gerlitz 4333f6d08d1SOr Gerlitz return 0; 4343f6d08d1SOr Gerlitz 4353f6d08d1SOr Gerlitz err_create_ttc_table: 4363f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 4373f6d08d1SOr Gerlitz err_create_indirect_tirs: 4383f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 4393f6d08d1SOr Gerlitz 4403f6d08d1SOr Gerlitz return err; 4413f6d08d1SOr Gerlitz } 4423f6d08d1SOr Gerlitz 4433f6d08d1SOr Gerlitz static void mlx5e_hairpin_rss_cleanup(struct mlx5e_hairpin *hp) 4443f6d08d1SOr Gerlitz { 4453f6d08d1SOr Gerlitz struct mlx5e_priv *priv = hp->func_priv; 4463f6d08d1SOr Gerlitz 4473f6d08d1SOr Gerlitz mlx5e_destroy_ttc_table(priv, &hp->ttc); 4483f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_indirect_tirs(hp); 4493f6d08d1SOr Gerlitz mlx5e_destroy_rqt(priv, &hp->indir_rqt); 4503f6d08d1SOr Gerlitz } 4513f6d08d1SOr Gerlitz 45277ab67b7SOr Gerlitz static struct mlx5e_hairpin * 45377ab67b7SOr Gerlitz mlx5e_hairpin_create(struct mlx5e_priv *priv, struct mlx5_hairpin_params *params, 45477ab67b7SOr Gerlitz int peer_ifindex) 45577ab67b7SOr Gerlitz { 45677ab67b7SOr Gerlitz struct mlx5_core_dev *func_mdev, *peer_mdev; 45777ab67b7SOr Gerlitz struct mlx5e_hairpin *hp; 45877ab67b7SOr Gerlitz struct mlx5_hairpin *pair; 45977ab67b7SOr Gerlitz int err; 46077ab67b7SOr Gerlitz 46177ab67b7SOr Gerlitz hp = kzalloc(sizeof(*hp), GFP_KERNEL); 46277ab67b7SOr Gerlitz if (!hp) 46377ab67b7SOr Gerlitz return ERR_PTR(-ENOMEM); 46477ab67b7SOr Gerlitz 46577ab67b7SOr Gerlitz func_mdev = priv->mdev; 46677ab67b7SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 46777ab67b7SOr Gerlitz 46877ab67b7SOr Gerlitz pair = mlx5_core_hairpin_create(func_mdev, peer_mdev, params); 46977ab67b7SOr Gerlitz if (IS_ERR(pair)) { 47077ab67b7SOr Gerlitz err = PTR_ERR(pair); 47177ab67b7SOr Gerlitz goto create_pair_err; 47277ab67b7SOr Gerlitz } 47377ab67b7SOr Gerlitz hp->pair = pair; 47477ab67b7SOr Gerlitz hp->func_mdev = func_mdev; 4753f6d08d1SOr Gerlitz hp->func_priv = priv; 4763f6d08d1SOr Gerlitz hp->num_channels = params->num_channels; 47777ab67b7SOr Gerlitz 47877ab67b7SOr Gerlitz err = mlx5e_hairpin_create_transport(hp); 47977ab67b7SOr Gerlitz if (err) 48077ab67b7SOr Gerlitz goto create_transport_err; 48177ab67b7SOr Gerlitz 4823f6d08d1SOr Gerlitz if (hp->num_channels > 1) { 4833f6d08d1SOr Gerlitz err = mlx5e_hairpin_rss_init(hp); 4843f6d08d1SOr Gerlitz if (err) 4853f6d08d1SOr Gerlitz goto rss_init_err; 4863f6d08d1SOr Gerlitz } 4873f6d08d1SOr Gerlitz 48877ab67b7SOr Gerlitz return hp; 48977ab67b7SOr Gerlitz 4903f6d08d1SOr Gerlitz rss_init_err: 4913f6d08d1SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 49277ab67b7SOr Gerlitz create_transport_err: 49377ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 49477ab67b7SOr Gerlitz create_pair_err: 49577ab67b7SOr Gerlitz kfree(hp); 49677ab67b7SOr Gerlitz return ERR_PTR(err); 49777ab67b7SOr Gerlitz } 49877ab67b7SOr Gerlitz 49977ab67b7SOr Gerlitz static void mlx5e_hairpin_destroy(struct mlx5e_hairpin *hp) 50077ab67b7SOr Gerlitz { 5013f6d08d1SOr Gerlitz if (hp->num_channels > 1) 5023f6d08d1SOr Gerlitz mlx5e_hairpin_rss_cleanup(hp); 50377ab67b7SOr Gerlitz mlx5e_hairpin_destroy_transport(hp); 50477ab67b7SOr Gerlitz mlx5_core_hairpin_destroy(hp->pair); 50577ab67b7SOr Gerlitz kvfree(hp); 50677ab67b7SOr Gerlitz } 50777ab67b7SOr Gerlitz 508106be53bSOr Gerlitz static inline u32 hash_hairpin_info(u16 peer_vhca_id, u8 prio) 509106be53bSOr Gerlitz { 510106be53bSOr Gerlitz return (peer_vhca_id << 16 | prio); 511106be53bSOr Gerlitz } 512106be53bSOr Gerlitz 5135c65c564SOr Gerlitz static struct mlx5e_hairpin_entry *mlx5e_hairpin_get(struct mlx5e_priv *priv, 514106be53bSOr Gerlitz u16 peer_vhca_id, u8 prio) 5155c65c564SOr Gerlitz { 5165c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 517106be53bSOr Gerlitz u32 hash_key = hash_hairpin_info(peer_vhca_id, prio); 5185c65c564SOr Gerlitz 5195c65c564SOr Gerlitz hash_for_each_possible(priv->fs.tc.hairpin_tbl, hpe, 520106be53bSOr Gerlitz hairpin_hlist, hash_key) { 521106be53bSOr Gerlitz if (hpe->peer_vhca_id == peer_vhca_id && hpe->prio == prio) 5225c65c564SOr Gerlitz return hpe; 5235c65c564SOr Gerlitz } 5245c65c564SOr Gerlitz 5255c65c564SOr Gerlitz return NULL; 5265c65c564SOr Gerlitz } 5275c65c564SOr Gerlitz 528106be53bSOr Gerlitz #define UNKNOWN_MATCH_PRIO 8 529106be53bSOr Gerlitz 530106be53bSOr Gerlitz static int mlx5e_hairpin_get_prio(struct mlx5e_priv *priv, 531e98bedf5SEli Britstein struct mlx5_flow_spec *spec, u8 *match_prio, 532e98bedf5SEli Britstein struct netlink_ext_ack *extack) 533106be53bSOr Gerlitz { 534106be53bSOr Gerlitz void *headers_c, *headers_v; 535106be53bSOr Gerlitz u8 prio_val, prio_mask = 0; 536106be53bSOr Gerlitz bool vlan_present; 537106be53bSOr Gerlitz 538106be53bSOr Gerlitz #ifdef CONFIG_MLX5_CORE_EN_DCB 539106be53bSOr Gerlitz if (priv->dcbx_dp.trust_state != MLX5_QPTS_TRUST_PCP) { 540e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 541e98bedf5SEli Britstein "only PCP trust state supported for hairpin"); 542106be53bSOr Gerlitz return -EOPNOTSUPP; 543106be53bSOr Gerlitz } 544106be53bSOr Gerlitz #endif 545106be53bSOr Gerlitz headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, outer_headers); 546106be53bSOr Gerlitz headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers); 547106be53bSOr Gerlitz 548106be53bSOr Gerlitz vlan_present = MLX5_GET(fte_match_set_lyr_2_4, headers_v, cvlan_tag); 549106be53bSOr Gerlitz if (vlan_present) { 550106be53bSOr Gerlitz prio_mask = MLX5_GET(fte_match_set_lyr_2_4, headers_c, first_prio); 551106be53bSOr Gerlitz prio_val = MLX5_GET(fte_match_set_lyr_2_4, headers_v, first_prio); 552106be53bSOr Gerlitz } 553106be53bSOr Gerlitz 554106be53bSOr Gerlitz if (!vlan_present || !prio_mask) { 555106be53bSOr Gerlitz prio_val = UNKNOWN_MATCH_PRIO; 556106be53bSOr Gerlitz } else if (prio_mask != 0x7) { 557e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 558e98bedf5SEli Britstein "masked priority match not supported for hairpin"); 559106be53bSOr Gerlitz return -EOPNOTSUPP; 560106be53bSOr Gerlitz } 561106be53bSOr Gerlitz 562106be53bSOr Gerlitz *match_prio = prio_val; 563106be53bSOr Gerlitz return 0; 564106be53bSOr Gerlitz } 565106be53bSOr Gerlitz 5665c65c564SOr Gerlitz static int mlx5e_hairpin_flow_add(struct mlx5e_priv *priv, 5675c65c564SOr Gerlitz struct mlx5e_tc_flow *flow, 568e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 569e98bedf5SEli Britstein struct netlink_ext_ack *extack) 5705c65c564SOr Gerlitz { 5715c65c564SOr Gerlitz int peer_ifindex = parse_attr->mirred_ifindex; 5725c65c564SOr Gerlitz struct mlx5_hairpin_params params; 573d8822868SOr Gerlitz struct mlx5_core_dev *peer_mdev; 5745c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 5755c65c564SOr Gerlitz struct mlx5e_hairpin *hp; 5763f6d08d1SOr Gerlitz u64 link_speed64; 5773f6d08d1SOr Gerlitz u32 link_speed; 578106be53bSOr Gerlitz u8 match_prio; 579d8822868SOr Gerlitz u16 peer_id; 5805c65c564SOr Gerlitz int err; 5815c65c564SOr Gerlitz 582d8822868SOr Gerlitz peer_mdev = mlx5e_hairpin_get_mdev(dev_net(priv->netdev), peer_ifindex); 583d8822868SOr Gerlitz if (!MLX5_CAP_GEN(priv->mdev, hairpin) || !MLX5_CAP_GEN(peer_mdev, hairpin)) { 584e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "hairpin is not supported"); 5855c65c564SOr Gerlitz return -EOPNOTSUPP; 5865c65c564SOr Gerlitz } 5875c65c564SOr Gerlitz 588d8822868SOr Gerlitz peer_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 589e98bedf5SEli Britstein err = mlx5e_hairpin_get_prio(priv, &parse_attr->spec, &match_prio, 590e98bedf5SEli Britstein extack); 591106be53bSOr Gerlitz if (err) 592106be53bSOr Gerlitz return err; 593106be53bSOr Gerlitz hpe = mlx5e_hairpin_get(priv, peer_id, match_prio); 5945c65c564SOr Gerlitz if (hpe) 5955c65c564SOr Gerlitz goto attach_flow; 5965c65c564SOr Gerlitz 5975c65c564SOr Gerlitz hpe = kzalloc(sizeof(*hpe), GFP_KERNEL); 5985c65c564SOr Gerlitz if (!hpe) 5995c65c564SOr Gerlitz return -ENOMEM; 6005c65c564SOr Gerlitz 6015c65c564SOr Gerlitz INIT_LIST_HEAD(&hpe->flows); 602d8822868SOr Gerlitz hpe->peer_vhca_id = peer_id; 603106be53bSOr Gerlitz hpe->prio = match_prio; 6045c65c564SOr Gerlitz 6055c65c564SOr Gerlitz params.log_data_size = 15; 6065c65c564SOr Gerlitz params.log_data_size = min_t(u8, params.log_data_size, 6075c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_wq_data_sz)); 6085c65c564SOr Gerlitz params.log_data_size = max_t(u8, params.log_data_size, 6095c65c564SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_min_hairpin_wq_data_sz)); 6105c65c564SOr Gerlitz 611eb9180f7SOr Gerlitz params.log_num_packets = params.log_data_size - 612eb9180f7SOr Gerlitz MLX5_MPWRQ_MIN_LOG_STRIDE_SZ(priv->mdev); 613eb9180f7SOr Gerlitz params.log_num_packets = min_t(u8, params.log_num_packets, 614eb9180f7SOr Gerlitz MLX5_CAP_GEN(priv->mdev, log_max_hairpin_num_packets)); 615eb9180f7SOr Gerlitz 616eb9180f7SOr Gerlitz params.q_counter = priv->q_counter; 6173f6d08d1SOr Gerlitz /* set hairpin pair per each 50Gbs share of the link */ 6182c81bfd5SHuy Nguyen mlx5e_port_max_linkspeed(priv->mdev, &link_speed); 6193f6d08d1SOr Gerlitz link_speed = max_t(u32, link_speed, 50000); 6203f6d08d1SOr Gerlitz link_speed64 = link_speed; 6213f6d08d1SOr Gerlitz do_div(link_speed64, 50000); 6223f6d08d1SOr Gerlitz params.num_channels = link_speed64; 6233f6d08d1SOr Gerlitz 6245c65c564SOr Gerlitz hp = mlx5e_hairpin_create(priv, ¶ms, peer_ifindex); 6255c65c564SOr Gerlitz if (IS_ERR(hp)) { 6265c65c564SOr Gerlitz err = PTR_ERR(hp); 6275c65c564SOr Gerlitz goto create_hairpin_err; 6285c65c564SOr Gerlitz } 6295c65c564SOr Gerlitz 630eb9180f7SOr Gerlitz netdev_dbg(priv->netdev, "add hairpin: tirn %x rqn %x peer %s sqn %x prio %d (log) data %d packets %d\n", 631ddae74acSOr Gerlitz hp->tirn, hp->pair->rqn[0], hp->pair->peer_mdev->priv.name, 632eb9180f7SOr Gerlitz hp->pair->sqn[0], match_prio, params.log_data_size, params.log_num_packets); 6335c65c564SOr Gerlitz 6345c65c564SOr Gerlitz hpe->hp = hp; 635106be53bSOr Gerlitz hash_add(priv->fs.tc.hairpin_tbl, &hpe->hairpin_hlist, 636106be53bSOr Gerlitz hash_hairpin_info(peer_id, match_prio)); 6375c65c564SOr Gerlitz 6385c65c564SOr Gerlitz attach_flow: 6393f6d08d1SOr Gerlitz if (hpe->hp->num_channels > 1) { 6403f6d08d1SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_HAIRPIN_RSS; 6413f6d08d1SOr Gerlitz flow->nic_attr->hairpin_ft = hpe->hp->ttc.ft.t; 6423f6d08d1SOr Gerlitz } else { 6435c65c564SOr Gerlitz flow->nic_attr->hairpin_tirn = hpe->hp->tirn; 6443f6d08d1SOr Gerlitz } 6455c65c564SOr Gerlitz list_add(&flow->hairpin, &hpe->flows); 6463f6d08d1SOr Gerlitz 6475c65c564SOr Gerlitz return 0; 6485c65c564SOr Gerlitz 6495c65c564SOr Gerlitz create_hairpin_err: 6505c65c564SOr Gerlitz kfree(hpe); 6515c65c564SOr Gerlitz return err; 6525c65c564SOr Gerlitz } 6535c65c564SOr Gerlitz 6545c65c564SOr Gerlitz static void mlx5e_hairpin_flow_del(struct mlx5e_priv *priv, 6555c65c564SOr Gerlitz struct mlx5e_tc_flow *flow) 6565c65c564SOr Gerlitz { 6575c65c564SOr Gerlitz struct list_head *next = flow->hairpin.next; 6585c65c564SOr Gerlitz 6595c65c564SOr Gerlitz list_del(&flow->hairpin); 6605c65c564SOr Gerlitz 6615c65c564SOr Gerlitz /* no more hairpin flows for us, release the hairpin pair */ 6625c65c564SOr Gerlitz if (list_empty(next)) { 6635c65c564SOr Gerlitz struct mlx5e_hairpin_entry *hpe; 6645c65c564SOr Gerlitz 6655c65c564SOr Gerlitz hpe = list_entry(next, struct mlx5e_hairpin_entry, flows); 6665c65c564SOr Gerlitz 6675c65c564SOr Gerlitz netdev_dbg(priv->netdev, "del hairpin: peer %s\n", 6685c65c564SOr Gerlitz hpe->hp->pair->peer_mdev->priv.name); 6695c65c564SOr Gerlitz 6705c65c564SOr Gerlitz mlx5e_hairpin_destroy(hpe->hp); 6715c65c564SOr Gerlitz hash_del(&hpe->hairpin_hlist); 6725c65c564SOr Gerlitz kfree(hpe); 6735c65c564SOr Gerlitz } 6745c65c564SOr Gerlitz } 6755c65c564SOr Gerlitz 676c83954abSRabie Loulou static int 67774491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv, 67817091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 679e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 680e98bedf5SEli Britstein struct netlink_ext_ack *extack) 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, 68960786f09SMark Bloch .reformat_id = 0, 69066958ed9SHadar Hen Zion }; 691aad7e08dSAmir Vadai struct mlx5_fc *counter = NULL; 692e8f887acSAmir Vadai bool table_created = false; 6935c65c564SOr Gerlitz int err, dest_ix = 0; 694e8f887acSAmir Vadai 6955c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) { 696e98bedf5SEli Britstein err = mlx5e_hairpin_flow_add(priv, flow, parse_attr, extack); 6975c65c564SOr Gerlitz if (err) { 6985c65c564SOr Gerlitz goto err_add_hairpin_flow; 6995c65c564SOr Gerlitz } 7003f6d08d1SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN_RSS) { 7013f6d08d1SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 7023f6d08d1SOr Gerlitz dest[dest_ix].ft = attr->hairpin_ft; 7033f6d08d1SOr Gerlitz } else { 7045c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_TIR; 7055c65c564SOr Gerlitz dest[dest_ix].tir_num = attr->hairpin_tirn; 7063f6d08d1SOr Gerlitz } 7073f6d08d1SOr Gerlitz dest_ix++; 7083f6d08d1SOr Gerlitz } else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 7095c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 7105c65c564SOr Gerlitz dest[dest_ix].ft = priv->fs.vlan.ft.t; 7115c65c564SOr Gerlitz dest_ix++; 7125c65c564SOr Gerlitz } 713aad7e08dSAmir Vadai 7145c65c564SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 7155c65c564SOr Gerlitz counter = mlx5_fc_create(dev, true); 7165c65c564SOr Gerlitz if (IS_ERR(counter)) { 717c83954abSRabie Loulou err = PTR_ERR(counter); 7185c65c564SOr Gerlitz goto err_fc_create; 7195c65c564SOr Gerlitz } 7205c65c564SOr Gerlitz dest[dest_ix].type = MLX5_FLOW_DESTINATION_TYPE_COUNTER; 721171c7625SMark Bloch dest[dest_ix].counter_id = mlx5_fc_id(counter); 7225c65c564SOr Gerlitz dest_ix++; 723b8aee822SMark Bloch attr->counter = counter; 724aad7e08dSAmir Vadai } 725aad7e08dSAmir Vadai 7262f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 7273099eb5aSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 728d7e75a32SOr Gerlitz flow_act.modify_id = attr->mod_hdr_id; 7292f4fe4caSOr Gerlitz kfree(parse_attr->mod_hdr_actions); 730c83954abSRabie Loulou if (err) 7312f4fe4caSOr Gerlitz goto err_create_mod_hdr_id; 7322f4fe4caSOr Gerlitz } 7332f4fe4caSOr Gerlitz 734acff797cSMaor Gottlieb if (IS_ERR_OR_NULL(priv->fs.tc.t)) { 73521b9c144SOr Gerlitz int tc_grp_size, tc_tbl_size; 73621b9c144SOr Gerlitz u32 max_flow_counter; 73721b9c144SOr Gerlitz 73821b9c144SOr Gerlitz max_flow_counter = (MLX5_CAP_GEN(dev, max_flow_counter_31_16) << 16) | 73921b9c144SOr Gerlitz MLX5_CAP_GEN(dev, max_flow_counter_15_0); 74021b9c144SOr Gerlitz 74121b9c144SOr Gerlitz tc_grp_size = min_t(int, max_flow_counter, MLX5E_TC_TABLE_MAX_GROUP_SIZE); 74221b9c144SOr Gerlitz 74321b9c144SOr Gerlitz tc_tbl_size = min_t(int, tc_grp_size * MLX5E_TC_TABLE_NUM_GROUPS, 74421b9c144SOr Gerlitz BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev, log_max_ft_size))); 74521b9c144SOr Gerlitz 746acff797cSMaor Gottlieb priv->fs.tc.t = 747acff797cSMaor Gottlieb mlx5_create_auto_grouped_flow_table(priv->fs.ns, 748acff797cSMaor Gottlieb MLX5E_TC_PRIO, 74921b9c144SOr Gerlitz tc_tbl_size, 750acff797cSMaor Gottlieb MLX5E_TC_TABLE_NUM_GROUPS, 7513f6d08d1SOr Gerlitz MLX5E_TC_FT_LEVEL, 0); 752acff797cSMaor Gottlieb if (IS_ERR(priv->fs.tc.t)) { 753e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 754e98bedf5SEli Britstein "Failed to create tc offload table\n"); 755e8f887acSAmir Vadai netdev_err(priv->netdev, 756e8f887acSAmir Vadai "Failed to create tc offload table\n"); 757c83954abSRabie Loulou err = PTR_ERR(priv->fs.tc.t); 758aad7e08dSAmir Vadai goto err_create_ft; 759e8f887acSAmir Vadai } 760e8f887acSAmir Vadai 761e8f887acSAmir Vadai table_created = true; 762e8f887acSAmir Vadai } 763e8f887acSAmir Vadai 76438aa51c1SOr Gerlitz if (attr->match_level != MLX5_MATCH_NONE) 76517091853SOr Gerlitz parse_attr->spec.match_criteria_enable = MLX5_MATCH_OUTER_HEADERS; 76638aa51c1SOr Gerlitz 767c83954abSRabie Loulou flow->rule[0] = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec, 7685c65c564SOr Gerlitz &flow_act, dest, dest_ix); 769e8f887acSAmir Vadai 770c83954abSRabie Loulou if (IS_ERR(flow->rule[0])) { 771c83954abSRabie Loulou err = PTR_ERR(flow->rule[0]); 772aad7e08dSAmir Vadai goto err_add_rule; 773c83954abSRabie Loulou } 774aad7e08dSAmir Vadai 775c83954abSRabie Loulou return 0; 776aad7e08dSAmir Vadai 777aad7e08dSAmir Vadai err_add_rule: 778aad7e08dSAmir Vadai if (table_created) { 779acff797cSMaor Gottlieb mlx5_destroy_flow_table(priv->fs.tc.t); 780acff797cSMaor Gottlieb priv->fs.tc.t = NULL; 781e8f887acSAmir Vadai } 782aad7e08dSAmir Vadai err_create_ft: 7832f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 7843099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 7852f4fe4caSOr Gerlitz err_create_mod_hdr_id: 786aad7e08dSAmir Vadai mlx5_fc_destroy(dev, counter); 7875c65c564SOr Gerlitz err_fc_create: 7885c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) 7895c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 7905c65c564SOr Gerlitz err_add_hairpin_flow: 791c83954abSRabie Loulou return err; 792e8f887acSAmir Vadai } 793e8f887acSAmir Vadai 794d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv, 795d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 796d85cdccbSOr Gerlitz { 797513f8f7fSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 798d85cdccbSOr Gerlitz struct mlx5_fc *counter = NULL; 799d85cdccbSOr Gerlitz 800b8aee822SMark Bloch counter = attr->counter; 801e4ad91f2SChris Mi mlx5_del_flow_rules(flow->rule[0]); 802d85cdccbSOr Gerlitz mlx5_fc_destroy(priv->mdev, counter); 803d85cdccbSOr Gerlitz 804b3a433deSOr Gerlitz if (!mlx5e_tc_num_filters(priv) && priv->fs.tc.t) { 805d85cdccbSOr Gerlitz mlx5_destroy_flow_table(priv->fs.tc.t); 806d85cdccbSOr Gerlitz priv->fs.tc.t = NULL; 807d85cdccbSOr Gerlitz } 8082f4fe4caSOr Gerlitz 809513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 8103099eb5aSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 8115c65c564SOr Gerlitz 8125c65c564SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_HAIRPIN) 8135c65c564SOr Gerlitz mlx5e_hairpin_flow_del(priv, flow); 814d85cdccbSOr Gerlitz } 815d85cdccbSOr Gerlitz 816aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 817aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow); 818aa0cbbaeSOr Gerlitz 8193c37745eSOr Gerlitz static int mlx5e_attach_encap(struct mlx5e_priv *priv, 8203c37745eSOr Gerlitz struct ip_tunnel_info *tun_info, 8213c37745eSOr Gerlitz struct net_device *mirred_dev, 8223c37745eSOr Gerlitz struct net_device **encap_dev, 823e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 824e98bedf5SEli Britstein struct netlink_ext_ack *extack); 8253c37745eSOr Gerlitz 826c83954abSRabie Loulou static int 82774491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv, 82817091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 829e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 830e98bedf5SEli Britstein struct netlink_ext_ack *extack) 831adb4c123SOr Gerlitz { 832adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 833aa0cbbaeSOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 8343c37745eSOr Gerlitz struct net_device *out_dev, *encap_dev = NULL; 835b8aee822SMark Bloch struct mlx5_fc *counter = NULL; 8363c37745eSOr Gerlitz struct mlx5e_rep_priv *rpriv; 8373c37745eSOr Gerlitz struct mlx5e_priv *out_priv; 838c83954abSRabie Loulou int err = 0, encap_err = 0; 8398b32580dSOr Gerlitz 84060786f09SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT) { 8413c37745eSOr Gerlitz out_dev = __dev_get_by_index(dev_net(priv->netdev), 8423c37745eSOr Gerlitz attr->parse_attr->mirred_ifindex); 843c83954abSRabie Loulou encap_err = mlx5e_attach_encap(priv, &parse_attr->tun_info, 844c83954abSRabie Loulou out_dev, &encap_dev, flow, 845c83954abSRabie Loulou extack); 846c83954abSRabie Loulou if (encap_err && encap_err != -EAGAIN) { 847c83954abSRabie Loulou err = encap_err; 8483c37745eSOr Gerlitz goto err_attach_encap; 8493c37745eSOr Gerlitz } 8503c37745eSOr Gerlitz out_priv = netdev_priv(encap_dev); 8513c37745eSOr Gerlitz rpriv = out_priv->ppriv; 852592d3651SChris Mi attr->out_rep[attr->out_count] = rpriv->rep; 853592d3651SChris Mi attr->out_mdev[attr->out_count++] = out_priv->mdev; 8543c37745eSOr Gerlitz } 8553c37745eSOr Gerlitz 8568b32580dSOr Gerlitz err = mlx5_eswitch_add_vlan_action(esw, attr); 857c83954abSRabie Loulou if (err) 858aa0cbbaeSOr Gerlitz goto err_add_vlan; 859adb4c123SOr Gerlitz 860d7e75a32SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 8611a9527bbSOr Gerlitz err = mlx5e_attach_mod_hdr(priv, flow, parse_attr); 862d7e75a32SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 863c83954abSRabie Loulou if (err) 864d7e75a32SOr Gerlitz goto err_mod_hdr; 865d7e75a32SOr Gerlitz } 866d7e75a32SOr Gerlitz 867b8aee822SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 868b8aee822SMark Bloch counter = mlx5_fc_create(esw->dev, true); 869b8aee822SMark Bloch if (IS_ERR(counter)) { 870c83954abSRabie Loulou err = PTR_ERR(counter); 871b8aee822SMark Bloch goto err_create_counter; 872b8aee822SMark Bloch } 873b8aee822SMark Bloch 874b8aee822SMark Bloch attr->counter = counter; 875b8aee822SMark Bloch } 876b8aee822SMark Bloch 877c83954abSRabie Loulou /* we get here if (1) there's no error or when 8783c37745eSOr Gerlitz * (2) there's an encap action and we're on -EAGAIN (no valid neigh) 8793c37745eSOr Gerlitz */ 880c83954abSRabie Loulou if (encap_err != -EAGAIN) { 881c83954abSRabie Loulou flow->rule[0] = mlx5_eswitch_add_offloaded_rule(esw, &parse_attr->spec, attr); 882c83954abSRabie Loulou if (IS_ERR(flow->rule[0])) { 883c83954abSRabie Loulou err = PTR_ERR(flow->rule[0]); 884aa0cbbaeSOr Gerlitz goto err_add_rule; 885c83954abSRabie Loulou } 886e4ad91f2SChris Mi 887e4ad91f2SChris Mi if (attr->mirror_count) { 888e4ad91f2SChris Mi flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, &parse_attr->spec, attr); 889c83954abSRabie Loulou if (IS_ERR(flow->rule[1])) { 890c83954abSRabie Loulou err = PTR_ERR(flow->rule[1]); 891e4ad91f2SChris Mi goto err_fwd_rule; 892e4ad91f2SChris Mi } 8933c37745eSOr Gerlitz } 894c83954abSRabie Loulou } 895c83954abSRabie Loulou 896c83954abSRabie Loulou return encap_err; 897aa0cbbaeSOr Gerlitz 898e4ad91f2SChris Mi err_fwd_rule: 899c83954abSRabie Loulou mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr); 900aa0cbbaeSOr Gerlitz err_add_rule: 901b8aee822SMark Bloch mlx5_fc_destroy(esw->dev, counter); 902b8aee822SMark Bloch err_create_counter: 903513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 9041a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 905d7e75a32SOr Gerlitz err_mod_hdr: 906aa0cbbaeSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 907aa0cbbaeSOr Gerlitz err_add_vlan: 90860786f09SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT) 909aa0cbbaeSOr Gerlitz mlx5e_detach_encap(priv, flow); 9103c37745eSOr Gerlitz err_attach_encap: 911c83954abSRabie Loulou return err; 912aa0cbbaeSOr Gerlitz } 913d85cdccbSOr Gerlitz 914d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv, 915d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 916d85cdccbSOr Gerlitz { 917d85cdccbSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 918d7e75a32SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 919d85cdccbSOr Gerlitz 920232c0013SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 921232c0013SHadar Hen Zion flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED; 922e4ad91f2SChris Mi if (attr->mirror_count) 923e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[1], attr); 924e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr); 925232c0013SHadar Hen Zion } 926d85cdccbSOr Gerlitz 927513f8f7fSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 928d85cdccbSOr Gerlitz 92960786f09SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT) { 930d85cdccbSOr Gerlitz mlx5e_detach_encap(priv, flow); 931513f8f7fSOr Gerlitz kvfree(attr->parse_attr); 932232c0013SHadar Hen Zion } 933d7e75a32SOr Gerlitz 934513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 9351a9527bbSOr Gerlitz mlx5e_detach_mod_hdr(priv, flow); 936b8aee822SMark Bloch 937b8aee822SMark Bloch if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) 938b8aee822SMark Bloch mlx5_fc_destroy(esw->dev, attr->counter); 939d85cdccbSOr Gerlitz } 940d85cdccbSOr Gerlitz 941232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv, 942232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 943232c0013SHadar Hen Zion { 9443c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 9453c37745eSOr Gerlitz struct mlx5_esw_flow_attr *esw_attr; 946232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 947232c0013SHadar Hen Zion int err; 948232c0013SHadar Hen Zion 94960786f09SMark Bloch err = mlx5_packet_reformat_alloc(priv->mdev, e->tunnel_type, 950232c0013SHadar Hen Zion e->encap_size, e->encap_header, 95131ca3648SMark Bloch MLX5_FLOW_NAMESPACE_FDB, 952232c0013SHadar Hen Zion &e->encap_id); 953232c0013SHadar Hen Zion if (err) { 954232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n", 955232c0013SHadar Hen Zion err); 956232c0013SHadar Hen Zion return; 957232c0013SHadar Hen Zion } 958232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 959f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(priv); 960232c0013SHadar Hen Zion 961232c0013SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 9623c37745eSOr Gerlitz esw_attr = flow->esw_attr; 9633c37745eSOr Gerlitz esw_attr->encap_id = e->encap_id; 964e4ad91f2SChris Mi flow->rule[0] = mlx5_eswitch_add_offloaded_rule(esw, &esw_attr->parse_attr->spec, esw_attr); 965e4ad91f2SChris Mi if (IS_ERR(flow->rule[0])) { 966e4ad91f2SChris Mi err = PTR_ERR(flow->rule[0]); 967232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n", 968232c0013SHadar Hen Zion err); 969232c0013SHadar Hen Zion continue; 970232c0013SHadar Hen Zion } 971e4ad91f2SChris Mi 972e4ad91f2SChris Mi if (esw_attr->mirror_count) { 973e4ad91f2SChris Mi flow->rule[1] = mlx5_eswitch_add_fwd_rule(esw, &esw_attr->parse_attr->spec, esw_attr); 974e4ad91f2SChris Mi if (IS_ERR(flow->rule[1])) { 975e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], esw_attr); 976e4ad91f2SChris Mi err = PTR_ERR(flow->rule[1]); 977e4ad91f2SChris Mi mlx5_core_warn(priv->mdev, "Failed to update cached mirror flow, %d\n", 978e4ad91f2SChris Mi err); 979e4ad91f2SChris Mi continue; 980e4ad91f2SChris Mi } 981e4ad91f2SChris Mi } 982e4ad91f2SChris Mi 983232c0013SHadar Hen Zion flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 984232c0013SHadar Hen Zion } 985232c0013SHadar Hen Zion } 986232c0013SHadar Hen Zion 987232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv, 988232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 989232c0013SHadar Hen Zion { 9903c37745eSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 991232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 992232c0013SHadar Hen Zion 993232c0013SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 994232c0013SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 995e4ad91f2SChris Mi struct mlx5_esw_flow_attr *attr = flow->esw_attr; 996e4ad91f2SChris Mi 997232c0013SHadar Hen Zion flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED; 998e4ad91f2SChris Mi if (attr->mirror_count) 999e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[1], attr); 1000e4ad91f2SChris Mi mlx5_eswitch_del_offloaded_rule(esw, flow->rule[0], attr); 1001232c0013SHadar Hen Zion } 1002232c0013SHadar Hen Zion } 1003232c0013SHadar Hen Zion 1004232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) { 1005232c0013SHadar Hen Zion e->flags &= ~MLX5_ENCAP_ENTRY_VALID; 100660786f09SMark Bloch mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id); 1007232c0013SHadar Hen Zion } 1008232c0013SHadar Hen Zion } 1009232c0013SHadar Hen Zion 1010b8aee822SMark Bloch static struct mlx5_fc *mlx5e_tc_get_counter(struct mlx5e_tc_flow *flow) 1011b8aee822SMark Bloch { 1012b8aee822SMark Bloch if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 1013b8aee822SMark Bloch return flow->esw_attr->counter; 1014b8aee822SMark Bloch else 1015b8aee822SMark Bloch return flow->nic_attr->counter; 1016b8aee822SMark Bloch } 1017b8aee822SMark Bloch 1018f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe) 1019f6dfb4c3SHadar Hen Zion { 1020f6dfb4c3SHadar Hen Zion struct mlx5e_neigh *m_neigh = &nhe->m_neigh; 1021f6dfb4c3SHadar Hen Zion u64 bytes, packets, lastuse = 0; 1022f6dfb4c3SHadar Hen Zion struct mlx5e_tc_flow *flow; 1023f6dfb4c3SHadar Hen Zion struct mlx5e_encap_entry *e; 1024f6dfb4c3SHadar Hen Zion struct mlx5_fc *counter; 1025f6dfb4c3SHadar Hen Zion struct neigh_table *tbl; 1026f6dfb4c3SHadar Hen Zion bool neigh_used = false; 1027f6dfb4c3SHadar Hen Zion struct neighbour *n; 1028f6dfb4c3SHadar Hen Zion 1029f6dfb4c3SHadar Hen Zion if (m_neigh->family == AF_INET) 1030f6dfb4c3SHadar Hen Zion tbl = &arp_tbl; 1031f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6) 1032f6dfb4c3SHadar Hen Zion else if (m_neigh->family == AF_INET6) 1033423c9db2SOr Gerlitz tbl = &nd_tbl; 1034f6dfb4c3SHadar Hen Zion #endif 1035f6dfb4c3SHadar Hen Zion else 1036f6dfb4c3SHadar Hen Zion return; 1037f6dfb4c3SHadar Hen Zion 1038f6dfb4c3SHadar Hen Zion list_for_each_entry(e, &nhe->encap_list, encap_list) { 1039f6dfb4c3SHadar Hen Zion if (!(e->flags & MLX5_ENCAP_ENTRY_VALID)) 1040f6dfb4c3SHadar Hen Zion continue; 1041f6dfb4c3SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 1042f6dfb4c3SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 1043b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 1044f6dfb4c3SHadar Hen Zion mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 1045f6dfb4c3SHadar Hen Zion if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) { 1046f6dfb4c3SHadar Hen Zion neigh_used = true; 1047f6dfb4c3SHadar Hen Zion break; 1048f6dfb4c3SHadar Hen Zion } 1049f6dfb4c3SHadar Hen Zion } 1050f6dfb4c3SHadar Hen Zion } 1051e36d4810SRoi Dayan if (neigh_used) 1052e36d4810SRoi Dayan break; 1053f6dfb4c3SHadar Hen Zion } 1054f6dfb4c3SHadar Hen Zion 1055f6dfb4c3SHadar Hen Zion if (neigh_used) { 1056f6dfb4c3SHadar Hen Zion nhe->reported_lastuse = jiffies; 1057f6dfb4c3SHadar Hen Zion 1058f6dfb4c3SHadar Hen Zion /* find the relevant neigh according to the cached device and 1059f6dfb4c3SHadar Hen Zion * dst ip pair 1060f6dfb4c3SHadar Hen Zion */ 1061f6dfb4c3SHadar Hen Zion n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev); 1062c7f7ba8dSRoi Dayan if (!n) 1063f6dfb4c3SHadar Hen Zion return; 1064f6dfb4c3SHadar Hen Zion 1065f6dfb4c3SHadar Hen Zion neigh_event_send(n, NULL); 1066f6dfb4c3SHadar Hen Zion neigh_release(n); 1067f6dfb4c3SHadar Hen Zion } 1068f6dfb4c3SHadar Hen Zion } 1069f6dfb4c3SHadar Hen Zion 1070d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 1071d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 1072d85cdccbSOr Gerlitz { 10735067b602SRoi Dayan struct list_head *next = flow->encap.next; 10745067b602SRoi Dayan 10755067b602SRoi Dayan list_del(&flow->encap); 10765067b602SRoi Dayan if (list_empty(next)) { 1077c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 10785067b602SRoi Dayan 1079c1ae1152SOr Gerlitz e = list_entry(next, struct mlx5e_encap_entry, flows); 1080232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 1081232c0013SHadar Hen Zion 1082232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 108360786f09SMark Bloch mlx5_packet_reformat_dealloc(priv->mdev, e->encap_id); 1084232c0013SHadar Hen Zion 1085cdc5a7f3SOr Gerlitz hash_del_rcu(&e->encap_hlist); 1086232c0013SHadar Hen Zion kfree(e->encap_header); 10875067b602SRoi Dayan kfree(e); 10885067b602SRoi Dayan } 10895067b602SRoi Dayan } 10905067b602SRoi Dayan 1091e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv, 1092961e8979SRoi Dayan struct mlx5e_tc_flow *flow) 1093e8f887acSAmir Vadai { 1094d85cdccbSOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 1095d85cdccbSOr Gerlitz mlx5e_tc_del_fdb_flow(priv, flow); 1096d85cdccbSOr Gerlitz else 1097d85cdccbSOr Gerlitz mlx5e_tc_del_nic_flow(priv, flow); 1098e8f887acSAmir Vadai } 1099e8f887acSAmir Vadai 1100bbd00f7eSHadar Hen Zion static void parse_vxlan_attr(struct mlx5_flow_spec *spec, 1101bbd00f7eSHadar Hen Zion struct tc_cls_flower_offload *f) 1102bbd00f7eSHadar Hen Zion { 1103bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1104bbd00f7eSHadar Hen Zion outer_headers); 1105bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1106bbd00f7eSHadar Hen Zion outer_headers); 1107bbd00f7eSHadar Hen Zion void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1108bbd00f7eSHadar Hen Zion misc_parameters); 1109bbd00f7eSHadar Hen Zion void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1110bbd00f7eSHadar Hen Zion misc_parameters); 1111bbd00f7eSHadar Hen Zion 1112bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ip_protocol); 1113bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, IPPROTO_UDP); 1114bbd00f7eSHadar Hen Zion 1115bbd00f7eSHadar Hen Zion if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_KEYID)) { 1116bbd00f7eSHadar Hen Zion struct flow_dissector_key_keyid *key = 1117bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1118bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_KEYID, 1119bbd00f7eSHadar Hen Zion f->key); 1120bbd00f7eSHadar Hen Zion struct flow_dissector_key_keyid *mask = 1121bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1122bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_KEYID, 1123bbd00f7eSHadar Hen Zion f->mask); 1124bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_misc, misc_c, vxlan_vni, 1125bbd00f7eSHadar Hen Zion be32_to_cpu(mask->keyid)); 1126bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_misc, misc_v, vxlan_vni, 1127bbd00f7eSHadar Hen Zion be32_to_cpu(key->keyid)); 1128bbd00f7eSHadar Hen Zion } 1129bbd00f7eSHadar Hen Zion } 1130bbd00f7eSHadar Hen Zion 1131bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv, 1132bbd00f7eSHadar Hen Zion struct mlx5_flow_spec *spec, 1133bbd00f7eSHadar Hen Zion struct tc_cls_flower_offload *f) 1134bbd00f7eSHadar Hen Zion { 1135e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1136bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1137bbd00f7eSHadar Hen Zion outer_headers); 1138bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1139bbd00f7eSHadar Hen Zion outer_headers); 1140bbd00f7eSHadar Hen Zion 11412e72eb43SOr Gerlitz struct flow_dissector_key_control *enc_control = 11422e72eb43SOr Gerlitz skb_flow_dissector_target(f->dissector, 11432e72eb43SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_CONTROL, 11442e72eb43SOr Gerlitz f->key); 11452e72eb43SOr Gerlitz 1146bbd00f7eSHadar Hen Zion if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_PORTS)) { 1147bbd00f7eSHadar Hen Zion struct flow_dissector_key_ports *key = 1148bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1149bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_PORTS, 1150bbd00f7eSHadar Hen Zion f->key); 1151bbd00f7eSHadar Hen Zion struct flow_dissector_key_ports *mask = 1152bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1153bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_PORTS, 1154bbd00f7eSHadar Hen Zion f->mask); 1155bbd00f7eSHadar Hen Zion 1156bbd00f7eSHadar Hen Zion /* Full udp dst port must be given */ 1157bbd00f7eSHadar Hen Zion if (memchr_inv(&mask->dst, 0xff, sizeof(mask->dst))) 11582fcd82e9SOr Gerlitz goto vxlan_match_offload_err; 1159bbd00f7eSHadar Hen Zion 1160a3e67366SSaeed Mahameed if (mlx5_vxlan_lookup_port(priv->mdev->vxlan, be16_to_cpu(key->dst)) && 1161bbd00f7eSHadar Hen Zion MLX5_CAP_ESW(priv->mdev, vxlan_encap_decap)) 1162bbd00f7eSHadar Hen Zion parse_vxlan_attr(spec, f); 11632fcd82e9SOr Gerlitz else { 1164e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1165e98bedf5SEli Britstein "port isn't an offloaded vxlan udp dport"); 11662fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 11672fcd82e9SOr Gerlitz "%d isn't an offloaded vxlan udp dport\n", be16_to_cpu(key->dst)); 1168bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 11692fcd82e9SOr Gerlitz } 1170bbd00f7eSHadar Hen Zion 1171bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1172bbd00f7eSHadar Hen Zion udp_dport, ntohs(mask->dst)); 1173bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1174bbd00f7eSHadar Hen Zion udp_dport, ntohs(key->dst)); 1175bbd00f7eSHadar Hen Zion 1176cd377663SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1177cd377663SOr Gerlitz udp_sport, ntohs(mask->src)); 1178cd377663SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1179cd377663SOr Gerlitz udp_sport, ntohs(key->src)); 1180bbd00f7eSHadar Hen Zion } else { /* udp dst port must be given */ 11812fcd82e9SOr Gerlitz vxlan_match_offload_err: 1182e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1183e98bedf5SEli Britstein "IP tunnel decap offload supported only for vxlan, must set UDP dport"); 11842fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 11852fcd82e9SOr Gerlitz "IP tunnel decap offload supported only for vxlan, must set UDP dport\n"); 1186bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1187bbd00f7eSHadar Hen Zion } 1188bbd00f7eSHadar Hen Zion 11892e72eb43SOr Gerlitz if (enc_control->addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 1190bbd00f7eSHadar Hen Zion struct flow_dissector_key_ipv4_addrs *key = 1191bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1192bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS, 1193bbd00f7eSHadar Hen Zion f->key); 1194bbd00f7eSHadar Hen Zion struct flow_dissector_key_ipv4_addrs *mask = 1195bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1196bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS, 1197bbd00f7eSHadar Hen Zion f->mask); 1198bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1199bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 1200bbd00f7eSHadar Hen Zion ntohl(mask->src)); 1201bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1202bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 1203bbd00f7eSHadar Hen Zion ntohl(key->src)); 1204bbd00f7eSHadar Hen Zion 1205bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1206bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 1207bbd00f7eSHadar Hen Zion ntohl(mask->dst)); 1208bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1209bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 1210bbd00f7eSHadar Hen Zion ntohl(key->dst)); 1211bbd00f7eSHadar Hen Zion 1212bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 1213bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP); 121419f44401SOr Gerlitz } else if (enc_control->addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 121519f44401SOr Gerlitz struct flow_dissector_key_ipv6_addrs *key = 121619f44401SOr Gerlitz skb_flow_dissector_target(f->dissector, 121719f44401SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS, 121819f44401SOr Gerlitz f->key); 121919f44401SOr Gerlitz struct flow_dissector_key_ipv6_addrs *mask = 122019f44401SOr Gerlitz skb_flow_dissector_target(f->dissector, 122119f44401SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS, 122219f44401SOr Gerlitz f->mask); 122319f44401SOr Gerlitz 122419f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 122519f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 122619f44401SOr Gerlitz &mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 122719f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 122819f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 122919f44401SOr Gerlitz &key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 123019f44401SOr Gerlitz 123119f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 123219f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 123319f44401SOr Gerlitz &mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 123419f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 123519f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 123619f44401SOr Gerlitz &key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 123719f44401SOr Gerlitz 123819f44401SOr Gerlitz MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 123919f44401SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6); 12402e72eb43SOr Gerlitz } 1241bbd00f7eSHadar Hen Zion 1242bcef735cSOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_IP)) { 1243bcef735cSOr Gerlitz struct flow_dissector_key_ip *key = 1244bcef735cSOr Gerlitz skb_flow_dissector_target(f->dissector, 1245bcef735cSOr Gerlitz FLOW_DISSECTOR_KEY_ENC_IP, 1246bcef735cSOr Gerlitz f->key); 1247bcef735cSOr Gerlitz struct flow_dissector_key_ip *mask = 1248bcef735cSOr Gerlitz skb_flow_dissector_target(f->dissector, 1249bcef735cSOr Gerlitz FLOW_DISSECTOR_KEY_ENC_IP, 1250bcef735cSOr Gerlitz f->mask); 1251bcef735cSOr Gerlitz 1252bcef735cSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, mask->tos & 0x3); 1253bcef735cSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, key->tos & 0x3); 1254bcef735cSOr Gerlitz 1255bcef735cSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, mask->tos >> 2); 1256bcef735cSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, key->tos >> 2); 1257bcef735cSOr Gerlitz 1258bcef735cSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, mask->ttl); 1259bcef735cSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, key->ttl); 1260e98bedf5SEli Britstein 1261e98bedf5SEli Britstein if (mask->ttl && 1262e98bedf5SEli Britstein !MLX5_CAP_ESW_FLOWTABLE_FDB 1263e98bedf5SEli Britstein (priv->mdev, 1264e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 1265e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1266e98bedf5SEli Britstein "Matching on TTL is not supported"); 1267e98bedf5SEli Britstein return -EOPNOTSUPP; 1268e98bedf5SEli Britstein } 1269e98bedf5SEli Britstein 1270bcef735cSOr Gerlitz } 1271bcef735cSOr Gerlitz 1272bbd00f7eSHadar Hen Zion /* Enforce DMAC when offloading incoming tunneled flows. 1273bbd00f7eSHadar Hen Zion * Flow counters require a match on the DMAC. 1274bbd00f7eSHadar Hen Zion */ 1275bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16); 1276bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0); 1277bbd00f7eSHadar Hen Zion ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1278bbd00f7eSHadar Hen Zion dmac_47_16), priv->netdev->dev_addr); 1279bbd00f7eSHadar Hen Zion 1280bbd00f7eSHadar Hen Zion /* let software handle IP fragments */ 1281bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 1282bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0); 1283bbd00f7eSHadar Hen Zion 1284bbd00f7eSHadar Hen Zion return 0; 1285bbd00f7eSHadar Hen Zion } 1286bbd00f7eSHadar Hen Zion 1287de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv, 1288de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 1289de0af0bfSRoi Dayan struct tc_cls_flower_offload *f, 1290d708f902SOr Gerlitz u8 *match_level) 1291e3a2b7edSAmir Vadai { 1292e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1293c5bb1730SMaor Gottlieb void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1294c5bb1730SMaor Gottlieb outer_headers); 1295c5bb1730SMaor Gottlieb void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1296c5bb1730SMaor Gottlieb outer_headers); 1297699e96ddSJianbo Liu void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1298699e96ddSJianbo Liu misc_parameters); 1299699e96ddSJianbo Liu void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1300699e96ddSJianbo Liu misc_parameters); 1301e3a2b7edSAmir Vadai u16 addr_type = 0; 1302e3a2b7edSAmir Vadai u8 ip_proto = 0; 1303e3a2b7edSAmir Vadai 1304d708f902SOr Gerlitz *match_level = MLX5_MATCH_NONE; 1305de0af0bfSRoi Dayan 1306e3a2b7edSAmir Vadai if (f->dissector->used_keys & 1307e3a2b7edSAmir Vadai ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) | 1308e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_BASIC) | 1309e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) | 1310095b6cfdSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_VLAN) | 1311699e96ddSJianbo Liu BIT(FLOW_DISSECTOR_KEY_CVLAN) | 1312e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) | 1313e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) | 1314bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_PORTS) | 1315bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) | 1316bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) | 1317bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) | 1318bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_PORTS) | 1319e77834ecSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) | 1320fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_TCP) | 1321bcef735cSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_IP) | 1322bcef735cSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_IP))) { 1323e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "Unsupported key"); 1324e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n", 1325e3a2b7edSAmir Vadai f->dissector->used_keys); 1326e3a2b7edSAmir Vadai return -EOPNOTSUPP; 1327e3a2b7edSAmir Vadai } 1328e3a2b7edSAmir Vadai 1329bbd00f7eSHadar Hen Zion if ((dissector_uses_key(f->dissector, 1330bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) || 1331bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_KEYID) || 1332bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_PORTS)) && 1333bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_CONTROL)) { 1334bbd00f7eSHadar Hen Zion struct flow_dissector_key_control *key = 1335bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 1336bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_CONTROL, 1337bbd00f7eSHadar Hen Zion f->key); 1338bbd00f7eSHadar Hen Zion switch (key->addr_type) { 1339bbd00f7eSHadar Hen Zion case FLOW_DISSECTOR_KEY_IPV4_ADDRS: 134019f44401SOr Gerlitz case FLOW_DISSECTOR_KEY_IPV6_ADDRS: 1341bbd00f7eSHadar Hen Zion if (parse_tunnel_attr(priv, spec, f)) 1342bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1343bbd00f7eSHadar Hen Zion break; 1344bbd00f7eSHadar Hen Zion default: 1345bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 1346bbd00f7eSHadar Hen Zion } 1347bbd00f7eSHadar Hen Zion 1348bbd00f7eSHadar Hen Zion /* In decap flow, header pointers should point to the inner 1349bbd00f7eSHadar Hen Zion * headers, outer header were already set by parse_tunnel_attr 1350bbd00f7eSHadar Hen Zion */ 1351bbd00f7eSHadar Hen Zion headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 1352bbd00f7eSHadar Hen Zion inner_headers); 1353bbd00f7eSHadar Hen Zion headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 1354bbd00f7eSHadar Hen Zion inner_headers); 1355bbd00f7eSHadar Hen Zion } 1356bbd00f7eSHadar Hen Zion 1357e3a2b7edSAmir Vadai if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ETH_ADDRS)) { 1358e3a2b7edSAmir Vadai struct flow_dissector_key_eth_addrs *key = 1359e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1360e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_ETH_ADDRS, 1361e3a2b7edSAmir Vadai f->key); 1362e3a2b7edSAmir Vadai struct flow_dissector_key_eth_addrs *mask = 1363e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1364e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_ETH_ADDRS, 1365e3a2b7edSAmir Vadai f->mask); 1366e3a2b7edSAmir Vadai 1367e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1368e3a2b7edSAmir Vadai dmac_47_16), 1369e3a2b7edSAmir Vadai mask->dst); 1370e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1371e3a2b7edSAmir Vadai dmac_47_16), 1372e3a2b7edSAmir Vadai key->dst); 1373e3a2b7edSAmir Vadai 1374e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1375e3a2b7edSAmir Vadai smac_47_16), 1376e3a2b7edSAmir Vadai mask->src); 1377e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1378e3a2b7edSAmir Vadai smac_47_16), 1379e3a2b7edSAmir Vadai key->src); 138054782900SOr Gerlitz 138154782900SOr Gerlitz if (!is_zero_ether_addr(mask->src) || !is_zero_ether_addr(mask->dst)) 1382d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1383e3a2b7edSAmir Vadai } 1384e3a2b7edSAmir Vadai 1385095b6cfdSOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_VLAN)) { 1386095b6cfdSOr Gerlitz struct flow_dissector_key_vlan *key = 1387095b6cfdSOr Gerlitz skb_flow_dissector_target(f->dissector, 1388095b6cfdSOr Gerlitz FLOW_DISSECTOR_KEY_VLAN, 1389095b6cfdSOr Gerlitz f->key); 1390095b6cfdSOr Gerlitz struct flow_dissector_key_vlan *mask = 1391095b6cfdSOr Gerlitz skb_flow_dissector_target(f->dissector, 1392095b6cfdSOr Gerlitz FLOW_DISSECTOR_KEY_VLAN, 1393095b6cfdSOr Gerlitz f->mask); 1394699e96ddSJianbo Liu if (mask->vlan_id || mask->vlan_priority || mask->vlan_tpid) { 1395699e96ddSJianbo Liu if (key->vlan_tpid == htons(ETH_P_8021AD)) { 1396699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1397699e96ddSJianbo Liu svlan_tag, 1); 1398699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1399699e96ddSJianbo Liu svlan_tag, 1); 1400699e96ddSJianbo Liu } else { 1401699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1402699e96ddSJianbo Liu cvlan_tag, 1); 1403699e96ddSJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1404699e96ddSJianbo Liu cvlan_tag, 1); 1405699e96ddSJianbo Liu } 1406095b6cfdSOr Gerlitz 1407095b6cfdSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid, mask->vlan_id); 1408095b6cfdSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid, key->vlan_id); 1409358d79a4SOr Gerlitz 1410358d79a4SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio, mask->vlan_priority); 1411358d79a4SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio, key->vlan_priority); 141254782900SOr Gerlitz 1413d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 1414095b6cfdSOr Gerlitz } 1415cee26487SJianbo Liu } else { 1416cee26487SJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, svlan_tag, 1); 1417cee26487SJianbo Liu MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1); 1418095b6cfdSOr Gerlitz } 1419095b6cfdSOr Gerlitz 1420699e96ddSJianbo Liu if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_CVLAN)) { 1421699e96ddSJianbo Liu struct flow_dissector_key_vlan *key = 1422699e96ddSJianbo Liu skb_flow_dissector_target(f->dissector, 1423699e96ddSJianbo Liu FLOW_DISSECTOR_KEY_CVLAN, 1424699e96ddSJianbo Liu f->key); 1425699e96ddSJianbo Liu struct flow_dissector_key_vlan *mask = 1426699e96ddSJianbo Liu skb_flow_dissector_target(f->dissector, 1427699e96ddSJianbo Liu FLOW_DISSECTOR_KEY_CVLAN, 1428699e96ddSJianbo Liu f->mask); 1429699e96ddSJianbo Liu if (mask->vlan_id || mask->vlan_priority || mask->vlan_tpid) { 1430699e96ddSJianbo Liu if (key->vlan_tpid == htons(ETH_P_8021AD)) { 1431699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1432699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1433699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1434699e96ddSJianbo Liu outer_second_svlan_tag, 1); 1435699e96ddSJianbo Liu } else { 1436699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, 1437699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1438699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, 1439699e96ddSJianbo Liu outer_second_cvlan_tag, 1); 1440699e96ddSJianbo Liu } 1441699e96ddSJianbo Liu 1442699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_vid, 1443699e96ddSJianbo Liu mask->vlan_id); 1444699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_vid, 1445699e96ddSJianbo Liu key->vlan_id); 1446699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_c, outer_second_prio, 1447699e96ddSJianbo Liu mask->vlan_priority); 1448699e96ddSJianbo Liu MLX5_SET(fte_match_set_misc, misc_v, outer_second_prio, 1449699e96ddSJianbo Liu key->vlan_priority); 1450699e96ddSJianbo Liu 1451699e96ddSJianbo Liu *match_level = MLX5_MATCH_L2; 1452699e96ddSJianbo Liu } 1453699e96ddSJianbo Liu } 1454699e96ddSJianbo Liu 145554782900SOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_BASIC)) { 145654782900SOr Gerlitz struct flow_dissector_key_basic *key = 145754782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 145854782900SOr Gerlitz FLOW_DISSECTOR_KEY_BASIC, 145954782900SOr Gerlitz f->key); 146054782900SOr Gerlitz struct flow_dissector_key_basic *mask = 146154782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 146254782900SOr Gerlitz FLOW_DISSECTOR_KEY_BASIC, 146354782900SOr Gerlitz f->mask); 146454782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype, 146554782900SOr Gerlitz ntohs(mask->n_proto)); 146654782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 146754782900SOr Gerlitz ntohs(key->n_proto)); 146854782900SOr Gerlitz 146954782900SOr Gerlitz if (mask->n_proto) 1470d708f902SOr Gerlitz *match_level = MLX5_MATCH_L2; 147154782900SOr Gerlitz } 147254782900SOr Gerlitz 147354782900SOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_CONTROL)) { 147454782900SOr Gerlitz struct flow_dissector_key_control *key = 147554782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 147654782900SOr Gerlitz FLOW_DISSECTOR_KEY_CONTROL, 147754782900SOr Gerlitz f->key); 147854782900SOr Gerlitz 147954782900SOr Gerlitz struct flow_dissector_key_control *mask = 148054782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 148154782900SOr Gerlitz FLOW_DISSECTOR_KEY_CONTROL, 148254782900SOr Gerlitz f->mask); 148354782900SOr Gerlitz addr_type = key->addr_type; 148454782900SOr Gerlitz 148554782900SOr Gerlitz /* the HW doesn't support frag first/later */ 148654782900SOr Gerlitz if (mask->flags & FLOW_DIS_FIRST_FRAG) 148754782900SOr Gerlitz return -EOPNOTSUPP; 148854782900SOr Gerlitz 148954782900SOr Gerlitz if (mask->flags & FLOW_DIS_IS_FRAGMENT) { 149054782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 149154782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 149254782900SOr Gerlitz key->flags & FLOW_DIS_IS_FRAGMENT); 149354782900SOr Gerlitz 149454782900SOr Gerlitz /* the HW doesn't need L3 inline to match on frag=no */ 149554782900SOr Gerlitz if (!(key->flags & FLOW_DIS_IS_FRAGMENT)) 1496d708f902SOr Gerlitz *match_level = MLX5_INLINE_MODE_L2; 149754782900SOr Gerlitz /* *** L2 attributes parsing up to here *** */ 149854782900SOr Gerlitz else 1499d708f902SOr Gerlitz *match_level = MLX5_INLINE_MODE_IP; 150054782900SOr Gerlitz } 150154782900SOr Gerlitz } 150254782900SOr Gerlitz 150354782900SOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_BASIC)) { 150454782900SOr Gerlitz struct flow_dissector_key_basic *key = 150554782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 150654782900SOr Gerlitz FLOW_DISSECTOR_KEY_BASIC, 150754782900SOr Gerlitz f->key); 150854782900SOr Gerlitz struct flow_dissector_key_basic *mask = 150954782900SOr Gerlitz skb_flow_dissector_target(f->dissector, 151054782900SOr Gerlitz FLOW_DISSECTOR_KEY_BASIC, 151154782900SOr Gerlitz f->mask); 151254782900SOr Gerlitz ip_proto = key->ip_proto; 151354782900SOr Gerlitz 151454782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol, 151554782900SOr Gerlitz mask->ip_proto); 151654782900SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, 151754782900SOr Gerlitz key->ip_proto); 151854782900SOr Gerlitz 151954782900SOr Gerlitz if (mask->ip_proto) 1520d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 152154782900SOr Gerlitz } 152254782900SOr Gerlitz 1523e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 1524e3a2b7edSAmir Vadai struct flow_dissector_key_ipv4_addrs *key = 1525e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1526e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV4_ADDRS, 1527e3a2b7edSAmir Vadai f->key); 1528e3a2b7edSAmir Vadai struct flow_dissector_key_ipv4_addrs *mask = 1529e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1530e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV4_ADDRS, 1531e3a2b7edSAmir Vadai f->mask); 1532e3a2b7edSAmir Vadai 1533e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1534e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 1535e3a2b7edSAmir Vadai &mask->src, sizeof(mask->src)); 1536e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1537e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 1538e3a2b7edSAmir Vadai &key->src, sizeof(key->src)); 1539e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1540e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 1541e3a2b7edSAmir Vadai &mask->dst, sizeof(mask->dst)); 1542e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1543e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 1544e3a2b7edSAmir Vadai &key->dst, sizeof(key->dst)); 1545de0af0bfSRoi Dayan 1546de0af0bfSRoi Dayan if (mask->src || mask->dst) 1547d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 1548e3a2b7edSAmir Vadai } 1549e3a2b7edSAmir Vadai 1550e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 1551e3a2b7edSAmir Vadai struct flow_dissector_key_ipv6_addrs *key = 1552e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1553e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV6_ADDRS, 1554e3a2b7edSAmir Vadai f->key); 1555e3a2b7edSAmir Vadai struct flow_dissector_key_ipv6_addrs *mask = 1556e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1557e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV6_ADDRS, 1558e3a2b7edSAmir Vadai f->mask); 1559e3a2b7edSAmir Vadai 1560e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1561e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 1562e3a2b7edSAmir Vadai &mask->src, sizeof(mask->src)); 1563e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1564e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 1565e3a2b7edSAmir Vadai &key->src, sizeof(key->src)); 1566e3a2b7edSAmir Vadai 1567e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 1568e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 1569e3a2b7edSAmir Vadai &mask->dst, sizeof(mask->dst)); 1570e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 1571e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 1572e3a2b7edSAmir Vadai &key->dst, sizeof(key->dst)); 1573de0af0bfSRoi Dayan 1574de0af0bfSRoi Dayan if (ipv6_addr_type(&mask->src) != IPV6_ADDR_ANY || 1575de0af0bfSRoi Dayan ipv6_addr_type(&mask->dst) != IPV6_ADDR_ANY) 1576d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 1577e3a2b7edSAmir Vadai } 1578e3a2b7edSAmir Vadai 15791f97a526SOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_IP)) { 15801f97a526SOr Gerlitz struct flow_dissector_key_ip *key = 15811f97a526SOr Gerlitz skb_flow_dissector_target(f->dissector, 15821f97a526SOr Gerlitz FLOW_DISSECTOR_KEY_IP, 15831f97a526SOr Gerlitz f->key); 15841f97a526SOr Gerlitz struct flow_dissector_key_ip *mask = 15851f97a526SOr Gerlitz skb_flow_dissector_target(f->dissector, 15861f97a526SOr Gerlitz FLOW_DISSECTOR_KEY_IP, 15871f97a526SOr Gerlitz f->mask); 15881f97a526SOr Gerlitz 15891f97a526SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, mask->tos & 0x3); 15901f97a526SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, key->tos & 0x3); 15911f97a526SOr Gerlitz 15921f97a526SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, mask->tos >> 2); 15931f97a526SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, key->tos >> 2); 15941f97a526SOr Gerlitz 1595a8ade55fSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ttl_hoplimit, mask->ttl); 1596a8ade55fSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ttl_hoplimit, key->ttl); 15971f97a526SOr Gerlitz 1598a8ade55fSOr Gerlitz if (mask->ttl && 1599a8ade55fSOr Gerlitz !MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, 1600e98bedf5SEli Britstein ft_field_support.outer_ipv4_ttl)) { 1601e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1602e98bedf5SEli Britstein "Matching on TTL is not supported"); 16031f97a526SOr Gerlitz return -EOPNOTSUPP; 1604e98bedf5SEli Britstein } 1605a8ade55fSOr Gerlitz 1606a8ade55fSOr Gerlitz if (mask->tos || mask->ttl) 1607d708f902SOr Gerlitz *match_level = MLX5_MATCH_L3; 16081f97a526SOr Gerlitz } 16091f97a526SOr Gerlitz 161054782900SOr Gerlitz /* *** L3 attributes parsing up to here *** */ 161154782900SOr Gerlitz 1612e3a2b7edSAmir Vadai if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_PORTS)) { 1613e3a2b7edSAmir Vadai struct flow_dissector_key_ports *key = 1614e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1615e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_PORTS, 1616e3a2b7edSAmir Vadai f->key); 1617e3a2b7edSAmir Vadai struct flow_dissector_key_ports *mask = 1618e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 1619e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_PORTS, 1620e3a2b7edSAmir Vadai f->mask); 1621e3a2b7edSAmir Vadai switch (ip_proto) { 1622e3a2b7edSAmir Vadai case IPPROTO_TCP: 1623e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1624e3a2b7edSAmir Vadai tcp_sport, ntohs(mask->src)); 1625e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1626e3a2b7edSAmir Vadai tcp_sport, ntohs(key->src)); 1627e3a2b7edSAmir Vadai 1628e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1629e3a2b7edSAmir Vadai tcp_dport, ntohs(mask->dst)); 1630e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1631e3a2b7edSAmir Vadai tcp_dport, ntohs(key->dst)); 1632e3a2b7edSAmir Vadai break; 1633e3a2b7edSAmir Vadai 1634e3a2b7edSAmir Vadai case IPPROTO_UDP: 1635e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1636e3a2b7edSAmir Vadai udp_sport, ntohs(mask->src)); 1637e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1638e3a2b7edSAmir Vadai udp_sport, ntohs(key->src)); 1639e3a2b7edSAmir Vadai 1640e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 1641e3a2b7edSAmir Vadai udp_dport, ntohs(mask->dst)); 1642e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 1643e3a2b7edSAmir Vadai udp_dport, ntohs(key->dst)); 1644e3a2b7edSAmir Vadai break; 1645e3a2b7edSAmir Vadai default: 1646e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1647e98bedf5SEli Britstein "Only UDP and TCP transports are supported for L4 matching"); 1648e3a2b7edSAmir Vadai netdev_err(priv->netdev, 1649e3a2b7edSAmir Vadai "Only UDP and TCP transport are supported\n"); 1650e3a2b7edSAmir Vadai return -EINVAL; 1651e3a2b7edSAmir Vadai } 1652de0af0bfSRoi Dayan 1653de0af0bfSRoi Dayan if (mask->src || mask->dst) 1654d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 1655e3a2b7edSAmir Vadai } 1656e3a2b7edSAmir Vadai 1657e77834ecSOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_TCP)) { 1658e77834ecSOr Gerlitz struct flow_dissector_key_tcp *key = 1659e77834ecSOr Gerlitz skb_flow_dissector_target(f->dissector, 1660e77834ecSOr Gerlitz FLOW_DISSECTOR_KEY_TCP, 1661e77834ecSOr Gerlitz f->key); 1662e77834ecSOr Gerlitz struct flow_dissector_key_tcp *mask = 1663e77834ecSOr Gerlitz skb_flow_dissector_target(f->dissector, 1664e77834ecSOr Gerlitz FLOW_DISSECTOR_KEY_TCP, 1665e77834ecSOr Gerlitz f->mask); 1666e77834ecSOr Gerlitz 1667e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags, 1668e77834ecSOr Gerlitz ntohs(mask->flags)); 1669e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags, 1670e77834ecSOr Gerlitz ntohs(key->flags)); 1671e77834ecSOr Gerlitz 1672e77834ecSOr Gerlitz if (mask->flags) 1673d708f902SOr Gerlitz *match_level = MLX5_MATCH_L4; 1674e77834ecSOr Gerlitz } 1675e77834ecSOr Gerlitz 1676e3a2b7edSAmir Vadai return 0; 1677e3a2b7edSAmir Vadai } 1678e3a2b7edSAmir Vadai 1679de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv, 168065ba8fb7SOr Gerlitz struct mlx5e_tc_flow *flow, 1681de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 1682de0af0bfSRoi Dayan struct tc_cls_flower_offload *f) 1683de0af0bfSRoi Dayan { 1684e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 1685de0af0bfSRoi Dayan struct mlx5_core_dev *dev = priv->mdev; 1686de0af0bfSRoi Dayan struct mlx5_eswitch *esw = dev->priv.eswitch; 16871d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 16881d447a39SSaeed Mahameed struct mlx5_eswitch_rep *rep; 1689d708f902SOr Gerlitz u8 match_level; 1690de0af0bfSRoi Dayan int err; 1691de0af0bfSRoi Dayan 1692d708f902SOr Gerlitz err = __parse_cls_flower(priv, spec, f, &match_level); 1693de0af0bfSRoi Dayan 16941d447a39SSaeed Mahameed if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) { 16951d447a39SSaeed Mahameed rep = rpriv->rep; 16961d447a39SSaeed Mahameed if (rep->vport != FDB_UPLINK_VPORT && 16971d447a39SSaeed Mahameed (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE && 1698d708f902SOr Gerlitz esw->offloads.inline_mode < match_level)) { 1699e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1700e98bedf5SEli Britstein "Flow is not offloaded due to min inline setting"); 1701de0af0bfSRoi Dayan netdev_warn(priv->netdev, 1702de0af0bfSRoi Dayan "Flow is not offloaded due to min inline setting, required %d actual %d\n", 1703d708f902SOr Gerlitz match_level, esw->offloads.inline_mode); 1704de0af0bfSRoi Dayan return -EOPNOTSUPP; 1705de0af0bfSRoi Dayan } 1706de0af0bfSRoi Dayan } 1707de0af0bfSRoi Dayan 170838aa51c1SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 170938aa51c1SOr Gerlitz flow->esw_attr->match_level = match_level; 171038aa51c1SOr Gerlitz else 171138aa51c1SOr Gerlitz flow->nic_attr->match_level = match_level; 171238aa51c1SOr Gerlitz 1713de0af0bfSRoi Dayan return err; 1714de0af0bfSRoi Dayan } 1715de0af0bfSRoi Dayan 1716d79b6df6SOr Gerlitz struct pedit_headers { 1717d79b6df6SOr Gerlitz struct ethhdr eth; 1718d79b6df6SOr Gerlitz struct iphdr ip4; 1719d79b6df6SOr Gerlitz struct ipv6hdr ip6; 1720d79b6df6SOr Gerlitz struct tcphdr tcp; 1721d79b6df6SOr Gerlitz struct udphdr udp; 1722d79b6df6SOr Gerlitz }; 1723d79b6df6SOr Gerlitz 1724d79b6df6SOr Gerlitz static int pedit_header_offsets[] = { 1725d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth), 1726d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4), 1727d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6), 1728d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp), 1729d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp), 1730d79b6df6SOr Gerlitz }; 1731d79b6df6SOr Gerlitz 1732d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype]) 1733d79b6df6SOr Gerlitz 1734d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset, 1735d79b6df6SOr Gerlitz struct pedit_headers *masks, 1736d79b6df6SOr Gerlitz struct pedit_headers *vals) 1737d79b6df6SOr Gerlitz { 1738d79b6df6SOr Gerlitz u32 *curr_pmask, *curr_pval; 1739d79b6df6SOr Gerlitz 1740d79b6df6SOr Gerlitz if (hdr_type >= __PEDIT_HDR_TYPE_MAX) 1741d79b6df6SOr Gerlitz goto out_err; 1742d79b6df6SOr Gerlitz 1743d79b6df6SOr Gerlitz curr_pmask = (u32 *)(pedit_header(masks, hdr_type) + offset); 1744d79b6df6SOr Gerlitz curr_pval = (u32 *)(pedit_header(vals, hdr_type) + offset); 1745d79b6df6SOr Gerlitz 1746d79b6df6SOr Gerlitz if (*curr_pmask & mask) /* disallow acting twice on the same location */ 1747d79b6df6SOr Gerlitz goto out_err; 1748d79b6df6SOr Gerlitz 1749d79b6df6SOr Gerlitz *curr_pmask |= mask; 1750d79b6df6SOr Gerlitz *curr_pval |= (val & mask); 1751d79b6df6SOr Gerlitz 1752d79b6df6SOr Gerlitz return 0; 1753d79b6df6SOr Gerlitz 1754d79b6df6SOr Gerlitz out_err: 1755d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1756d79b6df6SOr Gerlitz } 1757d79b6df6SOr Gerlitz 1758d79b6df6SOr Gerlitz struct mlx5_fields { 1759d79b6df6SOr Gerlitz u8 field; 1760d79b6df6SOr Gerlitz u8 size; 1761d79b6df6SOr Gerlitz u32 offset; 1762d79b6df6SOr Gerlitz }; 1763d79b6df6SOr Gerlitz 1764a8e4f0c4SOr Gerlitz #define OFFLOAD(fw_field, size, field, off) \ 1765a8e4f0c4SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_ ## fw_field, size, offsetof(struct pedit_headers, field) + (off)} 1766a8e4f0c4SOr Gerlitz 1767d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = { 1768a8e4f0c4SOr Gerlitz OFFLOAD(DMAC_47_16, 4, eth.h_dest[0], 0), 1769a8e4f0c4SOr Gerlitz OFFLOAD(DMAC_15_0, 2, eth.h_dest[4], 0), 1770a8e4f0c4SOr Gerlitz OFFLOAD(SMAC_47_16, 4, eth.h_source[0], 0), 1771a8e4f0c4SOr Gerlitz OFFLOAD(SMAC_15_0, 2, eth.h_source[4], 0), 1772a8e4f0c4SOr Gerlitz OFFLOAD(ETHERTYPE, 2, eth.h_proto, 0), 1773d79b6df6SOr Gerlitz 1774a8e4f0c4SOr Gerlitz OFFLOAD(IP_TTL, 1, ip4.ttl, 0), 1775a8e4f0c4SOr Gerlitz OFFLOAD(SIPV4, 4, ip4.saddr, 0), 1776a8e4f0c4SOr Gerlitz OFFLOAD(DIPV4, 4, ip4.daddr, 0), 1777d79b6df6SOr Gerlitz 1778a8e4f0c4SOr Gerlitz OFFLOAD(SIPV6_127_96, 4, ip6.saddr.s6_addr32[0], 0), 1779a8e4f0c4SOr Gerlitz OFFLOAD(SIPV6_95_64, 4, ip6.saddr.s6_addr32[1], 0), 1780a8e4f0c4SOr Gerlitz OFFLOAD(SIPV6_63_32, 4, ip6.saddr.s6_addr32[2], 0), 1781a8e4f0c4SOr Gerlitz OFFLOAD(SIPV6_31_0, 4, ip6.saddr.s6_addr32[3], 0), 1782a8e4f0c4SOr Gerlitz OFFLOAD(DIPV6_127_96, 4, ip6.daddr.s6_addr32[0], 0), 1783a8e4f0c4SOr Gerlitz OFFLOAD(DIPV6_95_64, 4, ip6.daddr.s6_addr32[1], 0), 1784a8e4f0c4SOr Gerlitz OFFLOAD(DIPV6_63_32, 4, ip6.daddr.s6_addr32[2], 0), 1785a8e4f0c4SOr Gerlitz OFFLOAD(DIPV6_31_0, 4, ip6.daddr.s6_addr32[3], 0), 17860c0316f5SOr Gerlitz OFFLOAD(IPV6_HOPLIMIT, 1, ip6.hop_limit, 0), 1787d79b6df6SOr Gerlitz 1788a8e4f0c4SOr Gerlitz OFFLOAD(TCP_SPORT, 2, tcp.source, 0), 1789a8e4f0c4SOr Gerlitz OFFLOAD(TCP_DPORT, 2, tcp.dest, 0), 1790a8e4f0c4SOr Gerlitz OFFLOAD(TCP_FLAGS, 1, tcp.ack_seq, 5), 1791d79b6df6SOr Gerlitz 1792a8e4f0c4SOr Gerlitz OFFLOAD(UDP_SPORT, 2, udp.source, 0), 1793a8e4f0c4SOr Gerlitz OFFLOAD(UDP_DPORT, 2, udp.dest, 0), 1794d79b6df6SOr Gerlitz }; 1795d79b6df6SOr Gerlitz 1796d79b6df6SOr Gerlitz /* On input attr->num_mod_hdr_actions tells how many HW actions can be parsed at 1797d79b6df6SOr Gerlitz * max from the SW pedit action. On success, it says how many HW actions were 1798d79b6df6SOr Gerlitz * actually parsed. 1799d79b6df6SOr Gerlitz */ 1800d79b6df6SOr Gerlitz static int offload_pedit_fields(struct pedit_headers *masks, 1801d79b6df6SOr Gerlitz struct pedit_headers *vals, 1802e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 1803e98bedf5SEli Britstein struct netlink_ext_ack *extack) 1804d79b6df6SOr Gerlitz { 1805d79b6df6SOr Gerlitz struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals; 18062b64bebaSOr Gerlitz int i, action_size, nactions, max_actions, first, last, next_z; 1807d79b6df6SOr Gerlitz void *s_masks_p, *a_masks_p, *vals_p; 1808d79b6df6SOr Gerlitz struct mlx5_fields *f; 1809d79b6df6SOr Gerlitz u8 cmd, field_bsize; 1810e3ca4e05SOr Gerlitz u32 s_mask, a_mask; 1811d79b6df6SOr Gerlitz unsigned long mask; 18122b64bebaSOr Gerlitz __be32 mask_be32; 18132b64bebaSOr Gerlitz __be16 mask_be16; 1814d79b6df6SOr Gerlitz void *action; 1815d79b6df6SOr Gerlitz 1816d79b6df6SOr Gerlitz set_masks = &masks[TCA_PEDIT_KEY_EX_CMD_SET]; 1817d79b6df6SOr Gerlitz add_masks = &masks[TCA_PEDIT_KEY_EX_CMD_ADD]; 1818d79b6df6SOr Gerlitz set_vals = &vals[TCA_PEDIT_KEY_EX_CMD_SET]; 1819d79b6df6SOr Gerlitz add_vals = &vals[TCA_PEDIT_KEY_EX_CMD_ADD]; 1820d79b6df6SOr Gerlitz 1821d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 1822d79b6df6SOr Gerlitz action = parse_attr->mod_hdr_actions; 1823d79b6df6SOr Gerlitz max_actions = parse_attr->num_mod_hdr_actions; 1824d79b6df6SOr Gerlitz nactions = 0; 1825d79b6df6SOr Gerlitz 1826d79b6df6SOr Gerlitz for (i = 0; i < ARRAY_SIZE(fields); i++) { 1827d79b6df6SOr Gerlitz f = &fields[i]; 1828d79b6df6SOr Gerlitz /* avoid seeing bits set from previous iterations */ 1829e3ca4e05SOr Gerlitz s_mask = 0; 1830e3ca4e05SOr Gerlitz a_mask = 0; 1831d79b6df6SOr Gerlitz 1832d79b6df6SOr Gerlitz s_masks_p = (void *)set_masks + f->offset; 1833d79b6df6SOr Gerlitz a_masks_p = (void *)add_masks + f->offset; 1834d79b6df6SOr Gerlitz 1835d79b6df6SOr Gerlitz memcpy(&s_mask, s_masks_p, f->size); 1836d79b6df6SOr Gerlitz memcpy(&a_mask, a_masks_p, f->size); 1837d79b6df6SOr Gerlitz 1838d79b6df6SOr Gerlitz if (!s_mask && !a_mask) /* nothing to offload here */ 1839d79b6df6SOr Gerlitz continue; 1840d79b6df6SOr Gerlitz 1841d79b6df6SOr Gerlitz if (s_mask && a_mask) { 1842e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1843e98bedf5SEli Britstein "can't set and add to the same HW field"); 1844d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field); 1845d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1846d79b6df6SOr Gerlitz } 1847d79b6df6SOr Gerlitz 1848d79b6df6SOr Gerlitz if (nactions == max_actions) { 1849e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1850e98bedf5SEli Britstein "too many pedit actions, can't offload"); 1851d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions); 1852d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1853d79b6df6SOr Gerlitz } 1854d79b6df6SOr Gerlitz 1855d79b6df6SOr Gerlitz if (s_mask) { 1856d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_SET; 1857d79b6df6SOr Gerlitz mask = s_mask; 1858d79b6df6SOr Gerlitz vals_p = (void *)set_vals + f->offset; 1859d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 1860d79b6df6SOr Gerlitz memset(s_masks_p, 0, f->size); 1861d79b6df6SOr Gerlitz } else { 1862d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_ADD; 1863d79b6df6SOr Gerlitz mask = a_mask; 1864d79b6df6SOr Gerlitz vals_p = (void *)add_vals + f->offset; 1865d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 1866d79b6df6SOr Gerlitz memset(a_masks_p, 0, f->size); 1867d79b6df6SOr Gerlitz } 1868d79b6df6SOr Gerlitz 1869d79b6df6SOr Gerlitz field_bsize = f->size * BITS_PER_BYTE; 1870e3ca4e05SOr Gerlitz 18712b64bebaSOr Gerlitz if (field_bsize == 32) { 18722b64bebaSOr Gerlitz mask_be32 = *(__be32 *)&mask; 18732b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le32(be32_to_cpu(mask_be32)); 18742b64bebaSOr Gerlitz } else if (field_bsize == 16) { 18752b64bebaSOr Gerlitz mask_be16 = *(__be16 *)&mask; 18762b64bebaSOr Gerlitz mask = (__force unsigned long)cpu_to_le16(be16_to_cpu(mask_be16)); 18772b64bebaSOr Gerlitz } 18782b64bebaSOr Gerlitz 1879d79b6df6SOr Gerlitz first = find_first_bit(&mask, field_bsize); 18802b64bebaSOr Gerlitz next_z = find_next_zero_bit(&mask, field_bsize, first); 1881d79b6df6SOr Gerlitz last = find_last_bit(&mask, field_bsize); 18822b64bebaSOr Gerlitz if (first < next_z && next_z < last) { 1883e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1884e98bedf5SEli Britstein "rewrite of few sub-fields isn't supported"); 18852b64bebaSOr Gerlitz printk(KERN_WARNING "mlx5: rewrite of few sub-fields (mask %lx) isn't offloaded\n", 1886d79b6df6SOr Gerlitz mask); 1887d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1888d79b6df6SOr Gerlitz } 1889d79b6df6SOr Gerlitz 1890d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, action_type, cmd); 1891d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, field, f->field); 1892d79b6df6SOr Gerlitz 1893d79b6df6SOr Gerlitz if (cmd == MLX5_ACTION_TYPE_SET) { 18942b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, offset, first); 1895d79b6df6SOr Gerlitz /* length is num of bits to be written, zero means length of 32 */ 18962b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, length, (last - first + 1)); 1897d79b6df6SOr Gerlitz } 1898d79b6df6SOr Gerlitz 1899d79b6df6SOr Gerlitz if (field_bsize == 32) 19002b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p) >> first); 1901d79b6df6SOr Gerlitz else if (field_bsize == 16) 19022b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p) >> first); 1903d79b6df6SOr Gerlitz else if (field_bsize == 8) 19042b64bebaSOr Gerlitz MLX5_SET(set_action_in, action, data, *(u8 *)vals_p >> first); 1905d79b6df6SOr Gerlitz 1906d79b6df6SOr Gerlitz action += action_size; 1907d79b6df6SOr Gerlitz nactions++; 1908d79b6df6SOr Gerlitz } 1909d79b6df6SOr Gerlitz 1910d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = nactions; 1911d79b6df6SOr Gerlitz return 0; 1912d79b6df6SOr Gerlitz } 1913d79b6df6SOr Gerlitz 1914d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv, 1915d79b6df6SOr Gerlitz const struct tc_action *a, int namespace, 1916d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 1917d79b6df6SOr Gerlitz { 1918d79b6df6SOr Gerlitz int nkeys, action_size, max_actions; 1919d79b6df6SOr Gerlitz 1920d79b6df6SOr Gerlitz nkeys = tcf_pedit_nkeys(a); 1921d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 1922d79b6df6SOr Gerlitz 1923d79b6df6SOr Gerlitz if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */ 1924d79b6df6SOr Gerlitz max_actions = MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, max_modify_header_actions); 1925d79b6df6SOr Gerlitz else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */ 1926d79b6df6SOr Gerlitz max_actions = MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, max_modify_header_actions); 1927d79b6df6SOr Gerlitz 1928d79b6df6SOr Gerlitz /* can get up to crazingly 16 HW actions in 32 bits pedit SW key */ 1929d79b6df6SOr Gerlitz max_actions = min(max_actions, nkeys * 16); 1930d79b6df6SOr Gerlitz 1931d79b6df6SOr Gerlitz parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL); 1932d79b6df6SOr Gerlitz if (!parse_attr->mod_hdr_actions) 1933d79b6df6SOr Gerlitz return -ENOMEM; 1934d79b6df6SOr Gerlitz 1935d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = max_actions; 1936d79b6df6SOr Gerlitz return 0; 1937d79b6df6SOr Gerlitz } 1938d79b6df6SOr Gerlitz 1939d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {}; 1940d79b6df6SOr Gerlitz 1941d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv, 1942d79b6df6SOr Gerlitz const struct tc_action *a, int namespace, 1943e98bedf5SEli Britstein struct mlx5e_tc_flow_parse_attr *parse_attr, 1944e98bedf5SEli Britstein struct netlink_ext_ack *extack) 1945d79b6df6SOr Gerlitz { 1946d79b6df6SOr Gerlitz struct pedit_headers masks[__PEDIT_CMD_MAX], vals[__PEDIT_CMD_MAX], *cmd_masks; 1947d79b6df6SOr Gerlitz int nkeys, i, err = -EOPNOTSUPP; 1948d79b6df6SOr Gerlitz u32 mask, val, offset; 1949d79b6df6SOr Gerlitz u8 cmd, htype; 1950d79b6df6SOr Gerlitz 1951d79b6df6SOr Gerlitz nkeys = tcf_pedit_nkeys(a); 1952d79b6df6SOr Gerlitz 1953d79b6df6SOr Gerlitz memset(masks, 0, sizeof(struct pedit_headers) * __PEDIT_CMD_MAX); 1954d79b6df6SOr Gerlitz memset(vals, 0, sizeof(struct pedit_headers) * __PEDIT_CMD_MAX); 1955d79b6df6SOr Gerlitz 1956d79b6df6SOr Gerlitz for (i = 0; i < nkeys; i++) { 1957d79b6df6SOr Gerlitz htype = tcf_pedit_htype(a, i); 1958d79b6df6SOr Gerlitz cmd = tcf_pedit_cmd(a, i); 1959d79b6df6SOr Gerlitz err = -EOPNOTSUPP; /* can't be all optimistic */ 1960d79b6df6SOr Gerlitz 1961d79b6df6SOr Gerlitz if (htype == TCA_PEDIT_KEY_EX_HDR_TYPE_NETWORK) { 1962e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1963e98bedf5SEli Britstein "legacy pedit isn't offloaded"); 1964d79b6df6SOr Gerlitz goto out_err; 1965d79b6df6SOr Gerlitz } 1966d79b6df6SOr Gerlitz 1967d79b6df6SOr Gerlitz if (cmd != TCA_PEDIT_KEY_EX_CMD_SET && cmd != TCA_PEDIT_KEY_EX_CMD_ADD) { 1968e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, "pedit cmd isn't offloaded"); 1969d79b6df6SOr Gerlitz goto out_err; 1970d79b6df6SOr Gerlitz } 1971d79b6df6SOr Gerlitz 1972d79b6df6SOr Gerlitz mask = tcf_pedit_mask(a, i); 1973d79b6df6SOr Gerlitz val = tcf_pedit_val(a, i); 1974d79b6df6SOr Gerlitz offset = tcf_pedit_offset(a, i); 1975d79b6df6SOr Gerlitz 1976d79b6df6SOr Gerlitz err = set_pedit_val(htype, ~mask, val, offset, &masks[cmd], &vals[cmd]); 1977d79b6df6SOr Gerlitz if (err) 1978d79b6df6SOr Gerlitz goto out_err; 1979d79b6df6SOr Gerlitz } 1980d79b6df6SOr Gerlitz 1981d79b6df6SOr Gerlitz err = alloc_mod_hdr_actions(priv, a, namespace, parse_attr); 1982d79b6df6SOr Gerlitz if (err) 1983d79b6df6SOr Gerlitz goto out_err; 1984d79b6df6SOr Gerlitz 1985e98bedf5SEli Britstein err = offload_pedit_fields(masks, vals, parse_attr, extack); 1986d79b6df6SOr Gerlitz if (err < 0) 1987d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 1988d79b6df6SOr Gerlitz 1989d79b6df6SOr Gerlitz for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) { 1990d79b6df6SOr Gerlitz cmd_masks = &masks[cmd]; 1991d79b6df6SOr Gerlitz if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) { 1992e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 1993e98bedf5SEli Britstein "attempt to offload an unsupported field"); 1994b3a433deSOr Gerlitz netdev_warn(priv->netdev, "attempt to offload an unsupported field (cmd %d)\n", cmd); 1995d79b6df6SOr Gerlitz print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS, 1996d79b6df6SOr Gerlitz 16, 1, cmd_masks, sizeof(zero_masks), true); 1997d79b6df6SOr Gerlitz err = -EOPNOTSUPP; 1998d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 1999d79b6df6SOr Gerlitz } 2000d79b6df6SOr Gerlitz } 2001d79b6df6SOr Gerlitz 2002d79b6df6SOr Gerlitz return 0; 2003d79b6df6SOr Gerlitz 2004d79b6df6SOr Gerlitz out_dealloc_parsed_actions: 2005d79b6df6SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 2006d79b6df6SOr Gerlitz out_err: 2007d79b6df6SOr Gerlitz return err; 2008d79b6df6SOr Gerlitz } 2009d79b6df6SOr Gerlitz 2010e98bedf5SEli Britstein static bool csum_offload_supported(struct mlx5e_priv *priv, 2011e98bedf5SEli Britstein u32 action, 2012e98bedf5SEli Britstein u32 update_flags, 2013e98bedf5SEli Britstein struct netlink_ext_ack *extack) 201426c02749SOr Gerlitz { 201526c02749SOr Gerlitz u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP | 201626c02749SOr Gerlitz TCA_CSUM_UPDATE_FLAG_UDP; 201726c02749SOr Gerlitz 201826c02749SOr Gerlitz /* The HW recalcs checksums only if re-writing headers */ 201926c02749SOr Gerlitz if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) { 2020e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2021e98bedf5SEli Britstein "TC csum action is only offloaded with pedit"); 202226c02749SOr Gerlitz netdev_warn(priv->netdev, 202326c02749SOr Gerlitz "TC csum action is only offloaded with pedit\n"); 202426c02749SOr Gerlitz return false; 202526c02749SOr Gerlitz } 202626c02749SOr Gerlitz 202726c02749SOr Gerlitz if (update_flags & ~prot_flags) { 2028e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2029e98bedf5SEli Britstein "can't offload TC csum action for some header/s"); 203026c02749SOr Gerlitz netdev_warn(priv->netdev, 203126c02749SOr Gerlitz "can't offload TC csum action for some header/s - flags %#x\n", 203226c02749SOr Gerlitz update_flags); 203326c02749SOr Gerlitz return false; 203426c02749SOr Gerlitz } 203526c02749SOr Gerlitz 203626c02749SOr Gerlitz return true; 203726c02749SOr Gerlitz } 203826c02749SOr Gerlitz 2039bdd66ac0SOr Gerlitz static bool modify_header_match_supported(struct mlx5_flow_spec *spec, 2040e98bedf5SEli Britstein struct tcf_exts *exts, 2041e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2042bdd66ac0SOr Gerlitz { 2043bdd66ac0SOr Gerlitz const struct tc_action *a; 2044bdd66ac0SOr Gerlitz bool modify_ip_header; 2045bdd66ac0SOr Gerlitz LIST_HEAD(actions); 2046bdd66ac0SOr Gerlitz u8 htype, ip_proto; 2047bdd66ac0SOr Gerlitz void *headers_v; 2048bdd66ac0SOr Gerlitz u16 ethertype; 2049bdd66ac0SOr Gerlitz int nkeys, i; 2050bdd66ac0SOr Gerlitz 2051bdd66ac0SOr Gerlitz headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, outer_headers); 2052bdd66ac0SOr Gerlitz ethertype = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ethertype); 2053bdd66ac0SOr Gerlitz 2054bdd66ac0SOr Gerlitz /* for non-IP we only re-write MACs, so we're okay */ 2055bdd66ac0SOr Gerlitz if (ethertype != ETH_P_IP && ethertype != ETH_P_IPV6) 2056bdd66ac0SOr Gerlitz goto out_ok; 2057bdd66ac0SOr Gerlitz 2058bdd66ac0SOr Gerlitz modify_ip_header = false; 2059244cd96aSCong Wang tcf_exts_for_each_action(i, a, exts) { 2060244cd96aSCong Wang int k; 2061244cd96aSCong Wang 2062bdd66ac0SOr Gerlitz if (!is_tcf_pedit(a)) 2063bdd66ac0SOr Gerlitz continue; 2064bdd66ac0SOr Gerlitz 2065bdd66ac0SOr Gerlitz nkeys = tcf_pedit_nkeys(a); 2066244cd96aSCong Wang for (k = 0; k < nkeys; k++) { 2067244cd96aSCong Wang htype = tcf_pedit_htype(a, k); 2068bdd66ac0SOr Gerlitz if (htype == TCA_PEDIT_KEY_EX_HDR_TYPE_IP4 || 2069bdd66ac0SOr Gerlitz htype == TCA_PEDIT_KEY_EX_HDR_TYPE_IP6) { 2070bdd66ac0SOr Gerlitz modify_ip_header = true; 2071bdd66ac0SOr Gerlitz break; 2072bdd66ac0SOr Gerlitz } 2073bdd66ac0SOr Gerlitz } 2074bdd66ac0SOr Gerlitz } 2075bdd66ac0SOr Gerlitz 2076bdd66ac0SOr Gerlitz ip_proto = MLX5_GET(fte_match_set_lyr_2_4, headers_v, ip_protocol); 20771ccef350SJianbo Liu if (modify_ip_header && ip_proto != IPPROTO_TCP && 20781ccef350SJianbo Liu ip_proto != IPPROTO_UDP && ip_proto != IPPROTO_ICMP) { 2079e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2080e98bedf5SEli Britstein "can't offload re-write of non TCP/UDP"); 2081bdd66ac0SOr Gerlitz pr_info("can't offload re-write of ip proto %d\n", ip_proto); 2082bdd66ac0SOr Gerlitz return false; 2083bdd66ac0SOr Gerlitz } 2084bdd66ac0SOr Gerlitz 2085bdd66ac0SOr Gerlitz out_ok: 2086bdd66ac0SOr Gerlitz return true; 2087bdd66ac0SOr Gerlitz } 2088bdd66ac0SOr Gerlitz 2089bdd66ac0SOr Gerlitz static bool actions_match_supported(struct mlx5e_priv *priv, 2090bdd66ac0SOr Gerlitz struct tcf_exts *exts, 2091bdd66ac0SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2092e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2093e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2094bdd66ac0SOr Gerlitz { 2095bdd66ac0SOr Gerlitz u32 actions; 2096bdd66ac0SOr Gerlitz 2097bdd66ac0SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 2098bdd66ac0SOr Gerlitz actions = flow->esw_attr->action; 2099bdd66ac0SOr Gerlitz else 2100bdd66ac0SOr Gerlitz actions = flow->nic_attr->action; 2101bdd66ac0SOr Gerlitz 21027e29392eSRoi Dayan if (flow->flags & MLX5E_TC_FLOW_EGRESS && 21037e29392eSRoi Dayan !(actions & MLX5_FLOW_CONTEXT_ACTION_DECAP)) 21047e29392eSRoi Dayan return false; 21057e29392eSRoi Dayan 2106bdd66ac0SOr Gerlitz if (actions & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 2107e98bedf5SEli Britstein return modify_header_match_supported(&parse_attr->spec, exts, 2108e98bedf5SEli Britstein extack); 2109bdd66ac0SOr Gerlitz 2110bdd66ac0SOr Gerlitz return true; 2111bdd66ac0SOr Gerlitz } 2112bdd66ac0SOr Gerlitz 21135c65c564SOr Gerlitz static bool same_hw_devs(struct mlx5e_priv *priv, struct mlx5e_priv *peer_priv) 21145c65c564SOr Gerlitz { 21155c65c564SOr Gerlitz struct mlx5_core_dev *fmdev, *pmdev; 2116816f6706SOr Gerlitz u64 fsystem_guid, psystem_guid; 21175c65c564SOr Gerlitz 21185c65c564SOr Gerlitz fmdev = priv->mdev; 21195c65c564SOr Gerlitz pmdev = peer_priv->mdev; 21205c65c564SOr Gerlitz 212159c9d35eSAlaa Hleihel fsystem_guid = mlx5_query_nic_system_image_guid(fmdev); 212259c9d35eSAlaa Hleihel psystem_guid = mlx5_query_nic_system_image_guid(pmdev); 21235c65c564SOr Gerlitz 2124816f6706SOr Gerlitz return (fsystem_guid == psystem_guid); 21255c65c564SOr Gerlitz } 21265c65c564SOr Gerlitz 21275c40348cSOr Gerlitz static int parse_tc_nic_actions(struct mlx5e_priv *priv, struct tcf_exts *exts, 2128aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2129e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2130e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2131e3a2b7edSAmir Vadai { 2132aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 2133e3a2b7edSAmir Vadai const struct tc_action *a; 213422dc13c8SWANG Cong LIST_HEAD(actions); 21351cab1cd7SOr Gerlitz u32 action = 0; 2136244cd96aSCong Wang int err, i; 2137e3a2b7edSAmir Vadai 21383bcc0cecSJiri Pirko if (!tcf_exts_has_actions(exts)) 2139e3a2b7edSAmir Vadai return -EINVAL; 2140e3a2b7edSAmir Vadai 21413bc4b7bfSOr Gerlitz attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG; 2142e3a2b7edSAmir Vadai 2143244cd96aSCong Wang tcf_exts_for_each_action(i, a, exts) { 2144e3a2b7edSAmir Vadai if (is_tcf_gact_shot(a)) { 21451cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP; 2146aad7e08dSAmir Vadai if (MLX5_CAP_FLOWTABLE(priv->mdev, 2147aad7e08dSAmir Vadai flow_table_properties_nic_receive.flow_counter)) 21481cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 2149e3a2b7edSAmir Vadai continue; 2150e3a2b7edSAmir Vadai } 2151e3a2b7edSAmir Vadai 21522f4fe4caSOr Gerlitz if (is_tcf_pedit(a)) { 21532f4fe4caSOr Gerlitz err = parse_tc_pedit_action(priv, a, MLX5_FLOW_NAMESPACE_KERNEL, 2154e98bedf5SEli Britstein parse_attr, extack); 21552f4fe4caSOr Gerlitz if (err) 21562f4fe4caSOr Gerlitz return err; 21572f4fe4caSOr Gerlitz 21581cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR | 21592f4fe4caSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 21602f4fe4caSOr Gerlitz continue; 21612f4fe4caSOr Gerlitz } 21622f4fe4caSOr Gerlitz 216326c02749SOr Gerlitz if (is_tcf_csum(a)) { 21641cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 2165e98bedf5SEli Britstein tcf_csum_update_flags(a), 2166e98bedf5SEli Britstein extack)) 216726c02749SOr Gerlitz continue; 216826c02749SOr Gerlitz 216926c02749SOr Gerlitz return -EOPNOTSUPP; 217026c02749SOr Gerlitz } 217126c02749SOr Gerlitz 21725c65c564SOr Gerlitz if (is_tcf_mirred_egress_redirect(a)) { 21735c65c564SOr Gerlitz struct net_device *peer_dev = tcf_mirred_dev(a); 21745c65c564SOr Gerlitz 21755c65c564SOr Gerlitz if (priv->netdev->netdev_ops == peer_dev->netdev_ops && 21765c65c564SOr Gerlitz same_hw_devs(priv, netdev_priv(peer_dev))) { 21775c65c564SOr Gerlitz parse_attr->mirred_ifindex = peer_dev->ifindex; 21785c65c564SOr Gerlitz flow->flags |= MLX5E_TC_FLOW_HAIRPIN; 21791cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 21805c65c564SOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 21815c65c564SOr Gerlitz } else { 2182e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2183e98bedf5SEli Britstein "device is not on same HW, can't offload"); 21845c65c564SOr Gerlitz netdev_warn(priv->netdev, "device %s not on same HW, can't offload\n", 21855c65c564SOr Gerlitz peer_dev->name); 21865c65c564SOr Gerlitz return -EINVAL; 21875c65c564SOr Gerlitz } 21885c65c564SOr Gerlitz continue; 21895c65c564SOr Gerlitz } 21905c65c564SOr Gerlitz 2191e3a2b7edSAmir Vadai if (is_tcf_skbedit_mark(a)) { 2192e3a2b7edSAmir Vadai u32 mark = tcf_skbedit_mark(a); 2193e3a2b7edSAmir Vadai 2194e3a2b7edSAmir Vadai if (mark & ~MLX5E_TC_FLOW_ID_MASK) { 2195e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2196e98bedf5SEli Britstein "Bad flow mark - only 16 bit is supported"); 2197e3a2b7edSAmir Vadai return -EINVAL; 2198e3a2b7edSAmir Vadai } 2199e3a2b7edSAmir Vadai 22003bc4b7bfSOr Gerlitz attr->flow_tag = mark; 22011cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 2202e3a2b7edSAmir Vadai continue; 2203e3a2b7edSAmir Vadai } 2204e3a2b7edSAmir Vadai 2205e3a2b7edSAmir Vadai return -EINVAL; 2206e3a2b7edSAmir Vadai } 2207e3a2b7edSAmir Vadai 22081cab1cd7SOr Gerlitz attr->action = action; 2209e98bedf5SEli Britstein if (!actions_match_supported(priv, exts, parse_attr, flow, extack)) 2210bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 2211bdd66ac0SOr Gerlitz 2212e3a2b7edSAmir Vadai return 0; 2213e3a2b7edSAmir Vadai } 2214e3a2b7edSAmir Vadai 221576f7444dSOr Gerlitz static inline int cmp_encap_info(struct ip_tunnel_key *a, 221676f7444dSOr Gerlitz struct ip_tunnel_key *b) 2217a54e20b4SHadar Hen Zion { 2218a54e20b4SHadar Hen Zion return memcmp(a, b, sizeof(*a)); 2219a54e20b4SHadar Hen Zion } 2220a54e20b4SHadar Hen Zion 222176f7444dSOr Gerlitz static inline int hash_encap_info(struct ip_tunnel_key *key) 2222a54e20b4SHadar Hen Zion { 222376f7444dSOr Gerlitz return jhash(key, sizeof(*key), 0); 2224a54e20b4SHadar Hen Zion } 2225a54e20b4SHadar Hen Zion 2226a54e20b4SHadar Hen Zion static int mlx5e_route_lookup_ipv4(struct mlx5e_priv *priv, 2227a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 2228a54e20b4SHadar Hen Zion struct net_device **out_dev, 2229a54e20b4SHadar Hen Zion struct flowi4 *fl4, 2230a54e20b4SHadar Hen Zion struct neighbour **out_n, 22316360cd62SOr Gerlitz u8 *out_ttl) 2232a54e20b4SHadar Hen Zion { 22333e621b19SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 22345ed99fb4SMark Bloch struct mlx5e_rep_priv *uplink_rpriv; 2235a54e20b4SHadar Hen Zion struct rtable *rt; 2236a54e20b4SHadar Hen Zion struct neighbour *n = NULL; 2237a54e20b4SHadar Hen Zion 2238a54e20b4SHadar Hen Zion #if IS_ENABLED(CONFIG_INET) 2239abeffce9SArnd Bergmann int ret; 2240abeffce9SArnd Bergmann 2241a54e20b4SHadar Hen Zion rt = ip_route_output_key(dev_net(mirred_dev), fl4); 2242abeffce9SArnd Bergmann ret = PTR_ERR_OR_ZERO(rt); 2243abeffce9SArnd Bergmann if (ret) 2244abeffce9SArnd Bergmann return ret; 2245a54e20b4SHadar Hen Zion #else 2246a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 2247a54e20b4SHadar Hen Zion #endif 2248a4b97ab4SMark Bloch uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 22493e621b19SHadar Hen Zion /* if the egress device isn't on the same HW e-switch, we use the uplink */ 22503e621b19SHadar Hen Zion if (!switchdev_port_same_parent_id(priv->netdev, rt->dst.dev)) 22515ed99fb4SMark Bloch *out_dev = uplink_rpriv->netdev; 22523e621b19SHadar Hen Zion else 22533e621b19SHadar Hen Zion *out_dev = rt->dst.dev; 2254a54e20b4SHadar Hen Zion 22556360cd62SOr Gerlitz if (!(*out_ttl)) 225675c33da8SOr Gerlitz *out_ttl = ip4_dst_hoplimit(&rt->dst); 2257a54e20b4SHadar Hen Zion n = dst_neigh_lookup(&rt->dst, &fl4->daddr); 2258a54e20b4SHadar Hen Zion ip_rt_put(rt); 2259a54e20b4SHadar Hen Zion if (!n) 2260a54e20b4SHadar Hen Zion return -ENOMEM; 2261a54e20b4SHadar Hen Zion 2262a54e20b4SHadar Hen Zion *out_n = n; 2263a54e20b4SHadar Hen Zion return 0; 2264a54e20b4SHadar Hen Zion } 2265a54e20b4SHadar Hen Zion 2266b1d90e6bSRabie Loulou static bool is_merged_eswitch_dev(struct mlx5e_priv *priv, 2267b1d90e6bSRabie Loulou struct net_device *peer_netdev) 2268b1d90e6bSRabie Loulou { 2269b1d90e6bSRabie Loulou struct mlx5e_priv *peer_priv; 2270b1d90e6bSRabie Loulou 2271b1d90e6bSRabie Loulou peer_priv = netdev_priv(peer_netdev); 2272b1d90e6bSRabie Loulou 2273b1d90e6bSRabie Loulou return (MLX5_CAP_ESW(priv->mdev, merged_eswitch) && 2274b1d90e6bSRabie Loulou (priv->netdev->netdev_ops == peer_netdev->netdev_ops) && 2275b1d90e6bSRabie Loulou same_hw_devs(priv, peer_priv) && 2276b1d90e6bSRabie Loulou MLX5_VPORT_MANAGER(peer_priv->mdev) && 2277b1d90e6bSRabie Loulou (peer_priv->mdev->priv.eswitch->mode == SRIOV_OFFLOADS)); 2278b1d90e6bSRabie Loulou } 2279b1d90e6bSRabie Loulou 2280ce99f6b9SOr Gerlitz static int mlx5e_route_lookup_ipv6(struct mlx5e_priv *priv, 2281ce99f6b9SOr Gerlitz struct net_device *mirred_dev, 2282ce99f6b9SOr Gerlitz struct net_device **out_dev, 2283ce99f6b9SOr Gerlitz struct flowi6 *fl6, 2284ce99f6b9SOr Gerlitz struct neighbour **out_n, 22856360cd62SOr Gerlitz u8 *out_ttl) 2286ce99f6b9SOr Gerlitz { 2287ce99f6b9SOr Gerlitz struct neighbour *n = NULL; 2288ce99f6b9SOr Gerlitz struct dst_entry *dst; 2289ce99f6b9SOr Gerlitz 2290ce99f6b9SOr Gerlitz #if IS_ENABLED(CONFIG_INET) && IS_ENABLED(CONFIG_IPV6) 229174bd5d56SArnd Bergmann struct mlx5e_rep_priv *uplink_rpriv; 2292ce99f6b9SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2293ce99f6b9SOr Gerlitz int ret; 2294ce99f6b9SOr Gerlitz 229508820528SPaul Blakey ret = ipv6_stub->ipv6_dst_lookup(dev_net(mirred_dev), NULL, &dst, 229608820528SPaul Blakey fl6); 229708820528SPaul Blakey if (ret < 0) 2298ce99f6b9SOr Gerlitz return ret; 2299ce99f6b9SOr Gerlitz 23006360cd62SOr Gerlitz if (!(*out_ttl)) 2301ce99f6b9SOr Gerlitz *out_ttl = ip6_dst_hoplimit(dst); 2302ce99f6b9SOr Gerlitz 2303a4b97ab4SMark Bloch uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 2304ce99f6b9SOr Gerlitz /* if the egress device isn't on the same HW e-switch, we use the uplink */ 2305ce99f6b9SOr Gerlitz if (!switchdev_port_same_parent_id(priv->netdev, dst->dev)) 23065ed99fb4SMark Bloch *out_dev = uplink_rpriv->netdev; 2307ce99f6b9SOr Gerlitz else 2308ce99f6b9SOr Gerlitz *out_dev = dst->dev; 2309ce99f6b9SOr Gerlitz #else 2310ce99f6b9SOr Gerlitz return -EOPNOTSUPP; 2311ce99f6b9SOr Gerlitz #endif 2312ce99f6b9SOr Gerlitz 2313ce99f6b9SOr Gerlitz n = dst_neigh_lookup(dst, &fl6->daddr); 2314ce99f6b9SOr Gerlitz dst_release(dst); 2315ce99f6b9SOr Gerlitz if (!n) 2316ce99f6b9SOr Gerlitz return -ENOMEM; 2317ce99f6b9SOr Gerlitz 2318ce99f6b9SOr Gerlitz *out_n = n; 2319ce99f6b9SOr Gerlitz return 0; 2320ce99f6b9SOr Gerlitz } 2321ce99f6b9SOr Gerlitz 232232f3671fSOr Gerlitz static void gen_vxlan_header_ipv4(struct net_device *out_dev, 232332f3671fSOr Gerlitz char buf[], int encap_size, 2324a54e20b4SHadar Hen Zion unsigned char h_dest[ETH_ALEN], 2325f35f800dSOr Gerlitz u8 tos, u8 ttl, 2326a54e20b4SHadar Hen Zion __be32 daddr, 2327a54e20b4SHadar Hen Zion __be32 saddr, 2328a54e20b4SHadar Hen Zion __be16 udp_dst_port, 2329a54e20b4SHadar Hen Zion __be32 vx_vni) 2330a54e20b4SHadar Hen Zion { 2331a54e20b4SHadar Hen Zion struct ethhdr *eth = (struct ethhdr *)buf; 2332a54e20b4SHadar Hen Zion struct iphdr *ip = (struct iphdr *)((char *)eth + sizeof(struct ethhdr)); 2333a54e20b4SHadar Hen Zion struct udphdr *udp = (struct udphdr *)((char *)ip + sizeof(struct iphdr)); 2334a54e20b4SHadar Hen Zion struct vxlanhdr *vxh = (struct vxlanhdr *)((char *)udp + sizeof(struct udphdr)); 2335a54e20b4SHadar Hen Zion 2336a54e20b4SHadar Hen Zion memset(buf, 0, encap_size); 2337a54e20b4SHadar Hen Zion 2338a54e20b4SHadar Hen Zion ether_addr_copy(eth->h_dest, h_dest); 2339a54e20b4SHadar Hen Zion ether_addr_copy(eth->h_source, out_dev->dev_addr); 2340a54e20b4SHadar Hen Zion eth->h_proto = htons(ETH_P_IP); 2341a54e20b4SHadar Hen Zion 2342a54e20b4SHadar Hen Zion ip->daddr = daddr; 2343a54e20b4SHadar Hen Zion ip->saddr = saddr; 2344a54e20b4SHadar Hen Zion 2345f35f800dSOr Gerlitz ip->tos = tos; 2346a54e20b4SHadar Hen Zion ip->ttl = ttl; 2347a54e20b4SHadar Hen Zion ip->protocol = IPPROTO_UDP; 2348a54e20b4SHadar Hen Zion ip->version = 0x4; 2349a54e20b4SHadar Hen Zion ip->ihl = 0x5; 2350a54e20b4SHadar Hen Zion 2351a54e20b4SHadar Hen Zion udp->dest = udp_dst_port; 2352a54e20b4SHadar Hen Zion vxh->vx_flags = VXLAN_HF_VNI; 2353a54e20b4SHadar Hen Zion vxh->vx_vni = vxlan_vni_field(vx_vni); 2354a54e20b4SHadar Hen Zion } 2355a54e20b4SHadar Hen Zion 2356225aabafSOr Gerlitz static void gen_vxlan_header_ipv6(struct net_device *out_dev, 2357225aabafSOr Gerlitz char buf[], int encap_size, 2358ce99f6b9SOr Gerlitz unsigned char h_dest[ETH_ALEN], 2359f35f800dSOr Gerlitz u8 tos, u8 ttl, 2360ce99f6b9SOr Gerlitz struct in6_addr *daddr, 2361ce99f6b9SOr Gerlitz struct in6_addr *saddr, 2362ce99f6b9SOr Gerlitz __be16 udp_dst_port, 2363ce99f6b9SOr Gerlitz __be32 vx_vni) 2364ce99f6b9SOr Gerlitz { 2365ce99f6b9SOr Gerlitz struct ethhdr *eth = (struct ethhdr *)buf; 2366ce99f6b9SOr Gerlitz struct ipv6hdr *ip6h = (struct ipv6hdr *)((char *)eth + sizeof(struct ethhdr)); 2367ce99f6b9SOr Gerlitz struct udphdr *udp = (struct udphdr *)((char *)ip6h + sizeof(struct ipv6hdr)); 2368ce99f6b9SOr Gerlitz struct vxlanhdr *vxh = (struct vxlanhdr *)((char *)udp + sizeof(struct udphdr)); 2369ce99f6b9SOr Gerlitz 2370ce99f6b9SOr Gerlitz memset(buf, 0, encap_size); 2371ce99f6b9SOr Gerlitz 2372ce99f6b9SOr Gerlitz ether_addr_copy(eth->h_dest, h_dest); 2373ce99f6b9SOr Gerlitz ether_addr_copy(eth->h_source, out_dev->dev_addr); 2374ce99f6b9SOr Gerlitz eth->h_proto = htons(ETH_P_IPV6); 2375ce99f6b9SOr Gerlitz 2376f35f800dSOr Gerlitz ip6_flow_hdr(ip6h, tos, 0); 2377ce99f6b9SOr Gerlitz /* the HW fills up ipv6 payload len */ 2378ce99f6b9SOr Gerlitz ip6h->nexthdr = IPPROTO_UDP; 2379ce99f6b9SOr Gerlitz ip6h->hop_limit = ttl; 2380ce99f6b9SOr Gerlitz ip6h->daddr = *daddr; 2381ce99f6b9SOr Gerlitz ip6h->saddr = *saddr; 2382ce99f6b9SOr Gerlitz 2383ce99f6b9SOr Gerlitz udp->dest = udp_dst_port; 2384ce99f6b9SOr Gerlitz vxh->vx_flags = VXLAN_HF_VNI; 2385ce99f6b9SOr Gerlitz vxh->vx_vni = vxlan_vni_field(vx_vni); 2386ce99f6b9SOr Gerlitz } 2387ce99f6b9SOr Gerlitz 2388a54e20b4SHadar Hen Zion static int mlx5e_create_encap_header_ipv4(struct mlx5e_priv *priv, 2389a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 23901a8552bdSHadar Hen Zion struct mlx5e_encap_entry *e) 2391a54e20b4SHadar Hen Zion { 2392a54e20b4SHadar Hen Zion int max_encap_size = MLX5_CAP_ESW(priv->mdev, max_encap_header_size); 239332f3671fSOr Gerlitz int ipv4_encap_size = ETH_HLEN + sizeof(struct iphdr) + VXLAN_HLEN; 239476f7444dSOr Gerlitz struct ip_tunnel_key *tun_key = &e->tun_info.key; 23951a8552bdSHadar Hen Zion struct net_device *out_dev; 2396a42485ebSOr Gerlitz struct neighbour *n = NULL; 2397a54e20b4SHadar Hen Zion struct flowi4 fl4 = {}; 2398f35f800dSOr Gerlitz u8 nud_state, tos, ttl; 2399a54e20b4SHadar Hen Zion char *encap_header; 24006360cd62SOr Gerlitz int err; 2401a54e20b4SHadar Hen Zion 240232f3671fSOr Gerlitz if (max_encap_size < ipv4_encap_size) { 240332f3671fSOr Gerlitz mlx5_core_warn(priv->mdev, "encap size %d too big, max supported is %d\n", 240432f3671fSOr Gerlitz ipv4_encap_size, max_encap_size); 240532f3671fSOr Gerlitz return -EOPNOTSUPP; 240632f3671fSOr Gerlitz } 240732f3671fSOr Gerlitz 240832f3671fSOr Gerlitz encap_header = kzalloc(ipv4_encap_size, GFP_KERNEL); 2409a54e20b4SHadar Hen Zion if (!encap_header) 2410a54e20b4SHadar Hen Zion return -ENOMEM; 2411a54e20b4SHadar Hen Zion 2412a54e20b4SHadar Hen Zion switch (e->tunnel_type) { 241360786f09SMark Bloch case MLX5_REFORMAT_TYPE_L2_TO_VXLAN: 2414a54e20b4SHadar Hen Zion fl4.flowi4_proto = IPPROTO_UDP; 241576f7444dSOr Gerlitz fl4.fl4_dport = tun_key->tp_dst; 2416a54e20b4SHadar Hen Zion break; 2417a54e20b4SHadar Hen Zion default: 2418a54e20b4SHadar Hen Zion err = -EOPNOTSUPP; 2419ace74321SPaul Blakey goto free_encap; 2420a54e20b4SHadar Hen Zion } 24216360cd62SOr Gerlitz 2422f35f800dSOr Gerlitz tos = tun_key->tos; 2423f35f800dSOr Gerlitz ttl = tun_key->ttl; 24246360cd62SOr Gerlitz 24259a941117SOr Gerlitz fl4.flowi4_tos = tun_key->tos; 242676f7444dSOr Gerlitz fl4.daddr = tun_key->u.ipv4.dst; 24279a941117SOr Gerlitz fl4.saddr = tun_key->u.ipv4.src; 2428a54e20b4SHadar Hen Zion 24291a8552bdSHadar Hen Zion err = mlx5e_route_lookup_ipv4(priv, mirred_dev, &out_dev, 24309a941117SOr Gerlitz &fl4, &n, &ttl); 2431a54e20b4SHadar Hen Zion if (err) 2432ace74321SPaul Blakey goto free_encap; 2433a54e20b4SHadar Hen Zion 2434232c0013SHadar Hen Zion /* used by mlx5e_detach_encap to lookup a neigh hash table 2435232c0013SHadar Hen Zion * entry in the neigh hash table when a user deletes a rule 2436232c0013SHadar Hen Zion */ 2437232c0013SHadar Hen Zion e->m_neigh.dev = n->dev; 2438f6dfb4c3SHadar Hen Zion e->m_neigh.family = n->ops->family; 2439232c0013SHadar Hen Zion memcpy(&e->m_neigh.dst_ip, n->primary_key, n->tbl->key_len); 2440232c0013SHadar Hen Zion e->out_dev = out_dev; 2441232c0013SHadar Hen Zion 2442232c0013SHadar Hen Zion /* It's importent to add the neigh to the hash table before checking 2443232c0013SHadar Hen Zion * the neigh validity state. So if we'll get a notification, in case the 2444232c0013SHadar Hen Zion * neigh changes it's validity state, we would find the relevant neigh 2445232c0013SHadar Hen Zion * in the hash. 2446232c0013SHadar Hen Zion */ 2447232c0013SHadar Hen Zion err = mlx5e_rep_encap_entry_attach(netdev_priv(out_dev), e); 2448232c0013SHadar Hen Zion if (err) 2449ace74321SPaul Blakey goto free_encap; 2450232c0013SHadar Hen Zion 2451033354d5SHadar Hen Zion read_lock_bh(&n->lock); 2452033354d5SHadar Hen Zion nud_state = n->nud_state; 2453033354d5SHadar Hen Zion ether_addr_copy(e->h_dest, n->ha); 2454033354d5SHadar Hen Zion read_unlock_bh(&n->lock); 2455033354d5SHadar Hen Zion 2456a54e20b4SHadar Hen Zion switch (e->tunnel_type) { 245760786f09SMark Bloch case MLX5_REFORMAT_TYPE_L2_TO_VXLAN: 24581a8552bdSHadar Hen Zion gen_vxlan_header_ipv4(out_dev, encap_header, 2459f35f800dSOr Gerlitz ipv4_encap_size, e->h_dest, tos, ttl, 24609a941117SOr Gerlitz fl4.daddr, 24619a941117SOr Gerlitz fl4.saddr, tun_key->tp_dst, 246276f7444dSOr Gerlitz tunnel_id_to_key32(tun_key->tun_id)); 2463a54e20b4SHadar Hen Zion break; 2464a54e20b4SHadar Hen Zion default: 2465a54e20b4SHadar Hen Zion err = -EOPNOTSUPP; 2466232c0013SHadar Hen Zion goto destroy_neigh_entry; 2467232c0013SHadar Hen Zion } 2468232c0013SHadar Hen Zion e->encap_size = ipv4_encap_size; 2469232c0013SHadar Hen Zion e->encap_header = encap_header; 2470232c0013SHadar Hen Zion 2471232c0013SHadar Hen Zion if (!(nud_state & NUD_VALID)) { 2472232c0013SHadar Hen Zion neigh_event_send(n, NULL); 247327902f08SWei Yongjun err = -EAGAIN; 247427902f08SWei Yongjun goto out; 2475a54e20b4SHadar Hen Zion } 2476a54e20b4SHadar Hen Zion 247760786f09SMark Bloch err = mlx5_packet_reformat_alloc(priv->mdev, e->tunnel_type, 247860786f09SMark Bloch ipv4_encap_size, encap_header, 247931ca3648SMark Bloch MLX5_FLOW_NAMESPACE_FDB, 248060786f09SMark Bloch &e->encap_id); 2481232c0013SHadar Hen Zion if (err) 2482232c0013SHadar Hen Zion goto destroy_neigh_entry; 2483232c0013SHadar Hen Zion 2484232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 2485f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(netdev_priv(out_dev)); 2486a42485ebSOr Gerlitz neigh_release(n); 2487232c0013SHadar Hen Zion return err; 2488232c0013SHadar Hen Zion 2489232c0013SHadar Hen Zion destroy_neigh_entry: 2490232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 2491ace74321SPaul Blakey free_encap: 2492a54e20b4SHadar Hen Zion kfree(encap_header); 2493ace74321SPaul Blakey out: 2494232c0013SHadar Hen Zion if (n) 2495232c0013SHadar Hen Zion neigh_release(n); 2496a54e20b4SHadar Hen Zion return err; 2497a54e20b4SHadar Hen Zion } 2498a54e20b4SHadar Hen Zion 2499ce99f6b9SOr Gerlitz static int mlx5e_create_encap_header_ipv6(struct mlx5e_priv *priv, 2500ce99f6b9SOr Gerlitz struct net_device *mirred_dev, 25011a8552bdSHadar Hen Zion struct mlx5e_encap_entry *e) 2502ce99f6b9SOr Gerlitz { 2503ce99f6b9SOr Gerlitz int max_encap_size = MLX5_CAP_ESW(priv->mdev, max_encap_header_size); 2504225aabafSOr Gerlitz int ipv6_encap_size = ETH_HLEN + sizeof(struct ipv6hdr) + VXLAN_HLEN; 2505ce99f6b9SOr Gerlitz struct ip_tunnel_key *tun_key = &e->tun_info.key; 25061a8552bdSHadar Hen Zion struct net_device *out_dev; 2507ce99f6b9SOr Gerlitz struct neighbour *n = NULL; 2508ce99f6b9SOr Gerlitz struct flowi6 fl6 = {}; 2509f35f800dSOr Gerlitz u8 nud_state, tos, ttl; 2510ce99f6b9SOr Gerlitz char *encap_header; 25116360cd62SOr Gerlitz int err; 2512ce99f6b9SOr Gerlitz 2513225aabafSOr Gerlitz if (max_encap_size < ipv6_encap_size) { 2514225aabafSOr Gerlitz mlx5_core_warn(priv->mdev, "encap size %d too big, max supported is %d\n", 2515225aabafSOr Gerlitz ipv6_encap_size, max_encap_size); 2516225aabafSOr Gerlitz return -EOPNOTSUPP; 2517225aabafSOr Gerlitz } 2518225aabafSOr Gerlitz 2519225aabafSOr Gerlitz encap_header = kzalloc(ipv6_encap_size, GFP_KERNEL); 2520ce99f6b9SOr Gerlitz if (!encap_header) 2521ce99f6b9SOr Gerlitz return -ENOMEM; 2522ce99f6b9SOr Gerlitz 2523ce99f6b9SOr Gerlitz switch (e->tunnel_type) { 252460786f09SMark Bloch case MLX5_REFORMAT_TYPE_L2_TO_VXLAN: 2525ce99f6b9SOr Gerlitz fl6.flowi6_proto = IPPROTO_UDP; 2526ce99f6b9SOr Gerlitz fl6.fl6_dport = tun_key->tp_dst; 2527ce99f6b9SOr Gerlitz break; 2528ce99f6b9SOr Gerlitz default: 2529ce99f6b9SOr Gerlitz err = -EOPNOTSUPP; 2530ace74321SPaul Blakey goto free_encap; 2531ce99f6b9SOr Gerlitz } 2532ce99f6b9SOr Gerlitz 2533f35f800dSOr Gerlitz tos = tun_key->tos; 2534f35f800dSOr Gerlitz ttl = tun_key->ttl; 25356360cd62SOr Gerlitz 2536ce99f6b9SOr Gerlitz fl6.flowlabel = ip6_make_flowinfo(RT_TOS(tun_key->tos), tun_key->label); 2537ce99f6b9SOr Gerlitz fl6.daddr = tun_key->u.ipv6.dst; 2538ce99f6b9SOr Gerlitz fl6.saddr = tun_key->u.ipv6.src; 2539ce99f6b9SOr Gerlitz 25401a8552bdSHadar Hen Zion err = mlx5e_route_lookup_ipv6(priv, mirred_dev, &out_dev, 2541ce99f6b9SOr Gerlitz &fl6, &n, &ttl); 2542ce99f6b9SOr Gerlitz if (err) 2543ace74321SPaul Blakey goto free_encap; 2544ce99f6b9SOr Gerlitz 2545232c0013SHadar Hen Zion /* used by mlx5e_detach_encap to lookup a neigh hash table 2546232c0013SHadar Hen Zion * entry in the neigh hash table when a user deletes a rule 2547232c0013SHadar Hen Zion */ 2548232c0013SHadar Hen Zion e->m_neigh.dev = n->dev; 2549f6dfb4c3SHadar Hen Zion e->m_neigh.family = n->ops->family; 2550232c0013SHadar Hen Zion memcpy(&e->m_neigh.dst_ip, n->primary_key, n->tbl->key_len); 2551232c0013SHadar Hen Zion e->out_dev = out_dev; 2552232c0013SHadar Hen Zion 2553232c0013SHadar Hen Zion /* It's importent to add the neigh to the hash table before checking 2554232c0013SHadar Hen Zion * the neigh validity state. So if we'll get a notification, in case the 2555232c0013SHadar Hen Zion * neigh changes it's validity state, we would find the relevant neigh 2556232c0013SHadar Hen Zion * in the hash. 2557232c0013SHadar Hen Zion */ 2558232c0013SHadar Hen Zion err = mlx5e_rep_encap_entry_attach(netdev_priv(out_dev), e); 2559232c0013SHadar Hen Zion if (err) 2560ace74321SPaul Blakey goto free_encap; 2561232c0013SHadar Hen Zion 2562033354d5SHadar Hen Zion read_lock_bh(&n->lock); 2563033354d5SHadar Hen Zion nud_state = n->nud_state; 2564033354d5SHadar Hen Zion ether_addr_copy(e->h_dest, n->ha); 2565033354d5SHadar Hen Zion read_unlock_bh(&n->lock); 2566033354d5SHadar Hen Zion 2567ce99f6b9SOr Gerlitz switch (e->tunnel_type) { 256860786f09SMark Bloch case MLX5_REFORMAT_TYPE_L2_TO_VXLAN: 25691a8552bdSHadar Hen Zion gen_vxlan_header_ipv6(out_dev, encap_header, 2570f35f800dSOr Gerlitz ipv6_encap_size, e->h_dest, tos, ttl, 2571ce99f6b9SOr Gerlitz &fl6.daddr, 2572ce99f6b9SOr Gerlitz &fl6.saddr, tun_key->tp_dst, 2573ce99f6b9SOr Gerlitz tunnel_id_to_key32(tun_key->tun_id)); 2574ce99f6b9SOr Gerlitz break; 2575ce99f6b9SOr Gerlitz default: 2576ce99f6b9SOr Gerlitz err = -EOPNOTSUPP; 2577232c0013SHadar Hen Zion goto destroy_neigh_entry; 2578232c0013SHadar Hen Zion } 2579232c0013SHadar Hen Zion 2580232c0013SHadar Hen Zion e->encap_size = ipv6_encap_size; 2581232c0013SHadar Hen Zion e->encap_header = encap_header; 2582232c0013SHadar Hen Zion 2583232c0013SHadar Hen Zion if (!(nud_state & NUD_VALID)) { 2584232c0013SHadar Hen Zion neigh_event_send(n, NULL); 258527902f08SWei Yongjun err = -EAGAIN; 258627902f08SWei Yongjun goto out; 2587ce99f6b9SOr Gerlitz } 2588ce99f6b9SOr Gerlitz 258960786f09SMark Bloch err = mlx5_packet_reformat_alloc(priv->mdev, e->tunnel_type, 259060786f09SMark Bloch ipv6_encap_size, encap_header, 259131ca3648SMark Bloch MLX5_FLOW_NAMESPACE_FDB, 259260786f09SMark Bloch &e->encap_id); 2593232c0013SHadar Hen Zion if (err) 2594232c0013SHadar Hen Zion goto destroy_neigh_entry; 2595232c0013SHadar Hen Zion 2596232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 2597f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(netdev_priv(out_dev)); 2598ce99f6b9SOr Gerlitz neigh_release(n); 2599232c0013SHadar Hen Zion return err; 2600232c0013SHadar Hen Zion 2601232c0013SHadar Hen Zion destroy_neigh_entry: 2602232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 2603ace74321SPaul Blakey free_encap: 2604ce99f6b9SOr Gerlitz kfree(encap_header); 2605ace74321SPaul Blakey out: 2606232c0013SHadar Hen Zion if (n) 2607232c0013SHadar Hen Zion neigh_release(n); 2608ce99f6b9SOr Gerlitz return err; 2609ce99f6b9SOr Gerlitz } 2610ce99f6b9SOr Gerlitz 2611a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv, 2612a54e20b4SHadar Hen Zion struct ip_tunnel_info *tun_info, 2613a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 261445247bf2SOr Gerlitz struct net_device **encap_dev, 2615e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2616e98bedf5SEli Britstein struct netlink_ext_ack *extack) 261703a9d11eSOr Gerlitz { 2618a54e20b4SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2619a54e20b4SHadar Hen Zion unsigned short family = ip_tunnel_info_af(tun_info); 262045247bf2SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 2621a54e20b4SHadar Hen Zion struct ip_tunnel_key *key = &tun_info->key; 2622c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 262345247bf2SOr Gerlitz int tunnel_type, err = 0; 2624a54e20b4SHadar Hen Zion uintptr_t hash_key; 2625a54e20b4SHadar Hen Zion bool found = false; 2626a54e20b4SHadar Hen Zion 26272fcd82e9SOr Gerlitz /* udp dst port must be set */ 2628a54e20b4SHadar Hen Zion if (!memchr_inv(&key->tp_dst, 0, sizeof(key->tp_dst))) 26292fcd82e9SOr Gerlitz goto vxlan_encap_offload_err; 2630a54e20b4SHadar Hen Zion 2631cd377663SOr Gerlitz /* setting udp src port isn't supported */ 26322fcd82e9SOr Gerlitz if (memchr_inv(&key->tp_src, 0, sizeof(key->tp_src))) { 26332fcd82e9SOr Gerlitz vxlan_encap_offload_err: 2634e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2635e98bedf5SEli Britstein "must set udp dst port and not set udp src port"); 26362fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 26372fcd82e9SOr Gerlitz "must set udp dst port and not set udp src port\n"); 2638cd377663SOr Gerlitz return -EOPNOTSUPP; 26392fcd82e9SOr Gerlitz } 2640cd377663SOr Gerlitz 2641a3e67366SSaeed Mahameed if (mlx5_vxlan_lookup_port(priv->mdev->vxlan, be16_to_cpu(key->tp_dst)) && 2642a54e20b4SHadar Hen Zion MLX5_CAP_ESW(priv->mdev, vxlan_encap_decap)) { 264360786f09SMark Bloch tunnel_type = MLX5_REFORMAT_TYPE_L2_TO_VXLAN; 2644a54e20b4SHadar Hen Zion } else { 2645e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2646e98bedf5SEli Britstein "port isn't an offloaded vxlan udp dport"); 26472fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 26482fcd82e9SOr Gerlitz "%d isn't an offloaded vxlan udp dport\n", be16_to_cpu(key->tp_dst)); 2649a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 2650a54e20b4SHadar Hen Zion } 2651a54e20b4SHadar Hen Zion 265276f7444dSOr Gerlitz hash_key = hash_encap_info(key); 2653a54e20b4SHadar Hen Zion 2654a54e20b4SHadar Hen Zion hash_for_each_possible_rcu(esw->offloads.encap_tbl, e, 2655a54e20b4SHadar Hen Zion encap_hlist, hash_key) { 265676f7444dSOr Gerlitz if (!cmp_encap_info(&e->tun_info.key, key)) { 2657a54e20b4SHadar Hen Zion found = true; 2658a54e20b4SHadar Hen Zion break; 2659a54e20b4SHadar Hen Zion } 2660a54e20b4SHadar Hen Zion } 2661a54e20b4SHadar Hen Zion 2662b2812089SVlad Buslov /* must verify if encap is valid or not */ 266345247bf2SOr Gerlitz if (found) 266445247bf2SOr Gerlitz goto attach_flow; 2665a54e20b4SHadar Hen Zion 2666a54e20b4SHadar Hen Zion e = kzalloc(sizeof(*e), GFP_KERNEL); 2667a54e20b4SHadar Hen Zion if (!e) 2668a54e20b4SHadar Hen Zion return -ENOMEM; 2669a54e20b4SHadar Hen Zion 267076f7444dSOr Gerlitz e->tun_info = *tun_info; 2671a54e20b4SHadar Hen Zion e->tunnel_type = tunnel_type; 2672a54e20b4SHadar Hen Zion INIT_LIST_HEAD(&e->flows); 2673a54e20b4SHadar Hen Zion 2674ce99f6b9SOr Gerlitz if (family == AF_INET) 26751a8552bdSHadar Hen Zion err = mlx5e_create_encap_header_ipv4(priv, mirred_dev, e); 2676ce99f6b9SOr Gerlitz else if (family == AF_INET6) 26771a8552bdSHadar Hen Zion err = mlx5e_create_encap_header_ipv6(priv, mirred_dev, e); 2678ce99f6b9SOr Gerlitz 2679232c0013SHadar Hen Zion if (err && err != -EAGAIN) 2680a54e20b4SHadar Hen Zion goto out_err; 2681a54e20b4SHadar Hen Zion 2682a54e20b4SHadar Hen Zion hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key); 2683a54e20b4SHadar Hen Zion 268445247bf2SOr Gerlitz attach_flow: 268545247bf2SOr Gerlitz list_add(&flow->encap, &e->flows); 268645247bf2SOr Gerlitz *encap_dev = e->out_dev; 2687232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 268845247bf2SOr Gerlitz attr->encap_id = e->encap_id; 2689b2812089SVlad Buslov else 2690b2812089SVlad Buslov err = -EAGAIN; 269145247bf2SOr Gerlitz 2692232c0013SHadar Hen Zion return err; 2693a54e20b4SHadar Hen Zion 2694a54e20b4SHadar Hen Zion out_err: 2695a54e20b4SHadar Hen Zion kfree(e); 2696a54e20b4SHadar Hen Zion return err; 2697a54e20b4SHadar Hen Zion } 2698a54e20b4SHadar Hen Zion 26991482bd3dSJianbo Liu static int parse_tc_vlan_action(struct mlx5e_priv *priv, 27001482bd3dSJianbo Liu const struct tc_action *a, 27011482bd3dSJianbo Liu struct mlx5_esw_flow_attr *attr, 27021482bd3dSJianbo Liu u32 *action) 27031482bd3dSJianbo Liu { 2704cc495188SJianbo Liu u8 vlan_idx = attr->total_vlan; 2705cc495188SJianbo Liu 2706cc495188SJianbo Liu if (vlan_idx >= MLX5_FS_VLAN_DEPTH) 27071482bd3dSJianbo Liu return -EOPNOTSUPP; 2708cc495188SJianbo Liu 2709cc495188SJianbo Liu if (tcf_vlan_action(a) == TCA_VLAN_ACT_POP) { 2710cc495188SJianbo Liu if (vlan_idx) { 2711cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 2712cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 2713cc495188SJianbo Liu return -EOPNOTSUPP; 2714cc495188SJianbo Liu 2715cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP_2; 2716cc495188SJianbo Liu } else { 2717cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 2718cc495188SJianbo Liu } 2719cc495188SJianbo Liu } else if (tcf_vlan_action(a) == TCA_VLAN_ACT_PUSH) { 2720cc495188SJianbo Liu attr->vlan_vid[vlan_idx] = tcf_vlan_push_vid(a); 2721cc495188SJianbo Liu attr->vlan_prio[vlan_idx] = tcf_vlan_push_prio(a); 2722cc495188SJianbo Liu attr->vlan_proto[vlan_idx] = tcf_vlan_push_proto(a); 2723cc495188SJianbo Liu if (!attr->vlan_proto[vlan_idx]) 2724cc495188SJianbo Liu attr->vlan_proto[vlan_idx] = htons(ETH_P_8021Q); 2725cc495188SJianbo Liu 2726cc495188SJianbo Liu if (vlan_idx) { 2727cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 2728cc495188SJianbo Liu MLX5_FS_VLAN_DEPTH)) 2729cc495188SJianbo Liu return -EOPNOTSUPP; 2730cc495188SJianbo Liu 2731cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH_2; 2732cc495188SJianbo Liu } else { 2733cc495188SJianbo Liu if (!mlx5_eswitch_vlan_actions_supported(priv->mdev, 1) && 2734cc495188SJianbo Liu (tcf_vlan_push_proto(a) != htons(ETH_P_8021Q) || 2735cc495188SJianbo Liu tcf_vlan_push_prio(a))) 2736cc495188SJianbo Liu return -EOPNOTSUPP; 2737cc495188SJianbo Liu 2738cc495188SJianbo Liu *action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH; 27391482bd3dSJianbo Liu } 27401482bd3dSJianbo Liu } else { /* action is TCA_VLAN_ACT_MODIFY */ 27411482bd3dSJianbo Liu return -EOPNOTSUPP; 27421482bd3dSJianbo Liu } 27431482bd3dSJianbo Liu 2744cc495188SJianbo Liu attr->total_vlan = vlan_idx + 1; 2745cc495188SJianbo Liu 27461482bd3dSJianbo Liu return 0; 27471482bd3dSJianbo Liu } 27481482bd3dSJianbo Liu 2749a54e20b4SHadar Hen Zion static int parse_tc_fdb_actions(struct mlx5e_priv *priv, struct tcf_exts *exts, 2750d7e75a32SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 2751e98bedf5SEli Britstein struct mlx5e_tc_flow *flow, 2752e98bedf5SEli Britstein struct netlink_ext_ack *extack) 2753a54e20b4SHadar Hen Zion { 2754ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 27551d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 2756a54e20b4SHadar Hen Zion struct ip_tunnel_info *info = NULL; 275703a9d11eSOr Gerlitz const struct tc_action *a; 275822dc13c8SWANG Cong LIST_HEAD(actions); 2759a54e20b4SHadar Hen Zion bool encap = false; 27601cab1cd7SOr Gerlitz u32 action = 0; 2761244cd96aSCong Wang int err, i; 276203a9d11eSOr Gerlitz 27633bcc0cecSJiri Pirko if (!tcf_exts_has_actions(exts)) 276403a9d11eSOr Gerlitz return -EINVAL; 276503a9d11eSOr Gerlitz 27661d447a39SSaeed Mahameed attr->in_rep = rpriv->rep; 276710ff5359SShahar Klein attr->in_mdev = priv->mdev; 276803a9d11eSOr Gerlitz 2769244cd96aSCong Wang tcf_exts_for_each_action(i, a, exts) { 277003a9d11eSOr Gerlitz if (is_tcf_gact_shot(a)) { 27711cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DROP | 277203a9d11eSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 277303a9d11eSOr Gerlitz continue; 277403a9d11eSOr Gerlitz } 277503a9d11eSOr Gerlitz 2776d7e75a32SOr Gerlitz if (is_tcf_pedit(a)) { 2777d7e75a32SOr Gerlitz err = parse_tc_pedit_action(priv, a, MLX5_FLOW_NAMESPACE_FDB, 2778e98bedf5SEli Britstein parse_attr, extack); 2779d7e75a32SOr Gerlitz if (err) 2780d7e75a32SOr Gerlitz return err; 2781d7e75a32SOr Gerlitz 27821cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 2783592d3651SChris Mi attr->mirror_count = attr->out_count; 2784d7e75a32SOr Gerlitz continue; 2785d7e75a32SOr Gerlitz } 2786d7e75a32SOr Gerlitz 278726c02749SOr Gerlitz if (is_tcf_csum(a)) { 27881cab1cd7SOr Gerlitz if (csum_offload_supported(priv, action, 2789e98bedf5SEli Britstein tcf_csum_update_flags(a), 2790e98bedf5SEli Britstein extack)) 279126c02749SOr Gerlitz continue; 279226c02749SOr Gerlitz 279326c02749SOr Gerlitz return -EOPNOTSUPP; 279426c02749SOr Gerlitz } 279526c02749SOr Gerlitz 2796592d3651SChris Mi if (is_tcf_mirred_egress_redirect(a) || is_tcf_mirred_egress_mirror(a)) { 279703a9d11eSOr Gerlitz struct mlx5e_priv *out_priv; 2798592d3651SChris Mi struct net_device *out_dev; 279903a9d11eSOr Gerlitz 28009f8a739eSCong Wang out_dev = tcf_mirred_dev(a); 280103a9d11eSOr Gerlitz 2802592d3651SChris Mi if (attr->out_count >= MLX5_MAX_FLOW_FWD_VPORTS) { 2803e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2804e98bedf5SEli Britstein "can't support more output ports, can't offload forwarding"); 2805592d3651SChris Mi pr_err("can't support more than %d output ports, can't offload forwarding\n", 2806592d3651SChris Mi attr->out_count); 2807592d3651SChris Mi return -EOPNOTSUPP; 2808592d3651SChris Mi } 2809592d3651SChris Mi 2810a54e20b4SHadar Hen Zion if (switchdev_port_same_parent_id(priv->netdev, 2811b1d90e6bSRabie Loulou out_dev) || 2812b1d90e6bSRabie Loulou is_merged_eswitch_dev(priv, out_dev)) { 28131cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 2814e37a79e5SMark Bloch MLX5_FLOW_CONTEXT_ACTION_COUNT; 281503a9d11eSOr Gerlitz out_priv = netdev_priv(out_dev); 28161d447a39SSaeed Mahameed rpriv = out_priv->ppriv; 2817592d3651SChris Mi attr->out_rep[attr->out_count] = rpriv->rep; 2818592d3651SChris Mi attr->out_mdev[attr->out_count++] = out_priv->mdev; 2819a54e20b4SHadar Hen Zion } else if (encap) { 28209f8a739eSCong Wang parse_attr->mirred_ifindex = out_dev->ifindex; 28213c37745eSOr Gerlitz parse_attr->tun_info = *info; 28223c37745eSOr Gerlitz attr->parse_attr = parse_attr; 282360786f09SMark Bloch action |= MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT | 2824a54e20b4SHadar Hen Zion MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 2825a54e20b4SHadar Hen Zion MLX5_FLOW_CONTEXT_ACTION_COUNT; 28263c37745eSOr Gerlitz /* attr->out_rep is resolved when we handle encap */ 2827a54e20b4SHadar Hen Zion } else { 2828e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2829e98bedf5SEli Britstein "devices are not on same switch HW, can't offload forwarding"); 2830a54e20b4SHadar Hen Zion pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 2831a54e20b4SHadar Hen Zion priv->netdev->name, out_dev->name); 2832a54e20b4SHadar Hen Zion return -EINVAL; 2833a54e20b4SHadar Hen Zion } 2834a54e20b4SHadar Hen Zion continue; 2835a54e20b4SHadar Hen Zion } 2836a54e20b4SHadar Hen Zion 2837a54e20b4SHadar Hen Zion if (is_tcf_tunnel_set(a)) { 2838a54e20b4SHadar Hen Zion info = tcf_tunnel_info(a); 2839a54e20b4SHadar Hen Zion if (info) 2840a54e20b4SHadar Hen Zion encap = true; 2841a54e20b4SHadar Hen Zion else 2842a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 2843592d3651SChris Mi attr->mirror_count = attr->out_count; 284403a9d11eSOr Gerlitz continue; 284503a9d11eSOr Gerlitz } 284603a9d11eSOr Gerlitz 28478b32580dSOr Gerlitz if (is_tcf_vlan(a)) { 28481482bd3dSJianbo Liu err = parse_tc_vlan_action(priv, a, attr, &action); 28491482bd3dSJianbo Liu 28501482bd3dSJianbo Liu if (err) 28511482bd3dSJianbo Liu return err; 28521482bd3dSJianbo Liu 2853592d3651SChris Mi attr->mirror_count = attr->out_count; 28548b32580dSOr Gerlitz continue; 28558b32580dSOr Gerlitz } 28568b32580dSOr Gerlitz 2857bbd00f7eSHadar Hen Zion if (is_tcf_tunnel_release(a)) { 28581cab1cd7SOr Gerlitz action |= MLX5_FLOW_CONTEXT_ACTION_DECAP; 2859bbd00f7eSHadar Hen Zion continue; 2860bbd00f7eSHadar Hen Zion } 2861bbd00f7eSHadar Hen Zion 286203a9d11eSOr Gerlitz return -EINVAL; 286303a9d11eSOr Gerlitz } 2864bdd66ac0SOr Gerlitz 28651cab1cd7SOr Gerlitz attr->action = action; 2866e98bedf5SEli Britstein if (!actions_match_supported(priv, exts, parse_attr, flow, extack)) 2867bdd66ac0SOr Gerlitz return -EOPNOTSUPP; 2868bdd66ac0SOr Gerlitz 2869592d3651SChris Mi if (attr->out_count > 1 && !mlx5_esw_has_fwd_fdb(priv->mdev)) { 2870e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2871e98bedf5SEli Britstein "current firmware doesn't support split rule for port mirroring"); 2872592d3651SChris Mi netdev_warn_once(priv->netdev, "current firmware doesn't support split rule for port mirroring\n"); 2873592d3651SChris Mi return -EOPNOTSUPP; 2874592d3651SChris Mi } 2875592d3651SChris Mi 287631c8eba5SOr Gerlitz return 0; 287703a9d11eSOr Gerlitz } 287803a9d11eSOr Gerlitz 287960bd4af8SOr Gerlitz static void get_flags(int flags, u8 *flow_flags) 288060bd4af8SOr Gerlitz { 288160bd4af8SOr Gerlitz u8 __flow_flags = 0; 288260bd4af8SOr Gerlitz 288360bd4af8SOr Gerlitz if (flags & MLX5E_TC_INGRESS) 288460bd4af8SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_INGRESS; 288560bd4af8SOr Gerlitz if (flags & MLX5E_TC_EGRESS) 288660bd4af8SOr Gerlitz __flow_flags |= MLX5E_TC_FLOW_EGRESS; 288760bd4af8SOr Gerlitz 288860bd4af8SOr Gerlitz *flow_flags = __flow_flags; 288960bd4af8SOr Gerlitz } 289060bd4af8SOr Gerlitz 289105866c82SOr Gerlitz static const struct rhashtable_params tc_ht_params = { 289205866c82SOr Gerlitz .head_offset = offsetof(struct mlx5e_tc_flow, node), 289305866c82SOr Gerlitz .key_offset = offsetof(struct mlx5e_tc_flow, cookie), 289405866c82SOr Gerlitz .key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie), 289505866c82SOr Gerlitz .automatic_shrinking = true, 289605866c82SOr Gerlitz }; 289705866c82SOr Gerlitz 289805866c82SOr Gerlitz static struct rhashtable *get_tc_ht(struct mlx5e_priv *priv) 289905866c82SOr Gerlitz { 2900655dc3d2SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 2901655dc3d2SOr Gerlitz struct mlx5e_rep_priv *uplink_rpriv; 2902655dc3d2SOr Gerlitz 2903655dc3d2SOr Gerlitz if (MLX5_VPORT_MANAGER(priv->mdev) && esw->mode == SRIOV_OFFLOADS) { 2904655dc3d2SOr Gerlitz uplink_rpriv = mlx5_eswitch_get_uplink_priv(esw, REP_ETH); 2905655dc3d2SOr Gerlitz return &uplink_rpriv->tc_ht; 2906655dc3d2SOr Gerlitz } else 290705866c82SOr Gerlitz return &priv->fs.tc.ht; 290805866c82SOr Gerlitz } 290905866c82SOr Gerlitz 29105fd9fc4eSJiri Pirko int mlx5e_configure_flower(struct mlx5e_priv *priv, 291160bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 2912e3a2b7edSAmir Vadai { 2913e98bedf5SEli Britstein struct netlink_ext_ack *extack = f->common.extack; 2914adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 291517091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr; 291605866c82SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv); 29173bc4b7bfSOr Gerlitz struct mlx5e_tc_flow *flow; 29183bc4b7bfSOr Gerlitz int attr_size, err = 0; 291965ba8fb7SOr Gerlitz u8 flow_flags = 0; 2920e3a2b7edSAmir Vadai 292160bd4af8SOr Gerlitz get_flags(flags, &flow_flags); 292260bd4af8SOr Gerlitz 29238f8ae895SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 29248f8ae895SOr Gerlitz if (flow) { 2925e98bedf5SEli Britstein NL_SET_ERR_MSG_MOD(extack, 2926e98bedf5SEli Britstein "flow cookie already exists, ignoring"); 29278f8ae895SOr Gerlitz netdev_warn_once(priv->netdev, "flow cookie %lx already exists, ignoring\n", f->cookie); 29288f8ae895SOr Gerlitz return 0; 29298f8ae895SOr Gerlitz } 29308f8ae895SOr Gerlitz 293165ba8fb7SOr Gerlitz if (esw && esw->mode == SRIOV_OFFLOADS) { 293260bd4af8SOr Gerlitz flow_flags |= MLX5E_TC_FLOW_ESWITCH; 293365ba8fb7SOr Gerlitz attr_size = sizeof(struct mlx5_esw_flow_attr); 29343bc4b7bfSOr Gerlitz } else { 293560bd4af8SOr Gerlitz flow_flags |= MLX5E_TC_FLOW_NIC; 29363bc4b7bfSOr Gerlitz attr_size = sizeof(struct mlx5_nic_flow_attr); 293765ba8fb7SOr Gerlitz } 2938776b12b6SOr Gerlitz 293965ba8fb7SOr Gerlitz flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL); 29401b9a07eeSLeon Romanovsky parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL); 294117091853SOr Gerlitz if (!parse_attr || !flow) { 2942e3a2b7edSAmir Vadai err = -ENOMEM; 2943e3a2b7edSAmir Vadai goto err_free; 2944e3a2b7edSAmir Vadai } 2945e3a2b7edSAmir Vadai 2946e3a2b7edSAmir Vadai flow->cookie = f->cookie; 294765ba8fb7SOr Gerlitz flow->flags = flow_flags; 2948655dc3d2SOr Gerlitz flow->priv = priv; 2949e3a2b7edSAmir Vadai 295017091853SOr Gerlitz err = parse_cls_flower(priv, flow, &parse_attr->spec, f); 2951e3a2b7edSAmir Vadai if (err < 0) 2952e3a2b7edSAmir Vadai goto err_free; 2953e3a2b7edSAmir Vadai 295465ba8fb7SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 2955e98bedf5SEli Britstein err = parse_tc_fdb_actions(priv, f->exts, parse_attr, flow, 2956e98bedf5SEli Britstein extack); 2957adb4c123SOr Gerlitz if (err < 0) 29583c37745eSOr Gerlitz goto err_free; 2959c83954abSRabie Loulou err = mlx5e_tc_add_fdb_flow(priv, parse_attr, flow, extack); 2960adb4c123SOr Gerlitz } else { 2961e98bedf5SEli Britstein err = parse_tc_nic_actions(priv, f->exts, parse_attr, flow, 2962e98bedf5SEli Britstein extack); 2963e3a2b7edSAmir Vadai if (err < 0) 2964e3a2b7edSAmir Vadai goto err_free; 2965c83954abSRabie Loulou err = mlx5e_tc_add_nic_flow(priv, parse_attr, flow, extack); 2966adb4c123SOr Gerlitz } 2967adb4c123SOr Gerlitz 2968c83954abSRabie Loulou if (err && err != -EAGAIN) 2969aa0cbbaeSOr Gerlitz goto err_free; 29705c40348cSOr Gerlitz 29713c37745eSOr Gerlitz if (err != -EAGAIN) 29720b67a38fSHadar Hen Zion flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 29733c37745eSOr Gerlitz 2974af1607c3SJianbo Liu if (!(flow->flags & MLX5E_TC_FLOW_ESWITCH) || 297560786f09SMark Bloch !(flow->esw_attr->action & 297660786f09SMark Bloch MLX5_FLOW_CONTEXT_ACTION_PACKET_REFORMAT)) 2977232c0013SHadar Hen Zion kvfree(parse_attr); 2978e3a2b7edSAmir Vadai 297905866c82SOr Gerlitz err = rhashtable_insert_fast(tc_ht, &flow->node, tc_ht_params); 2980af1607c3SJianbo Liu if (err) { 29815e86397aSOr Gerlitz mlx5e_tc_del_flow(priv, flow); 2982af1607c3SJianbo Liu kfree(flow); 2983af1607c3SJianbo Liu } 2984af1607c3SJianbo Liu 2985af1607c3SJianbo Liu return err; 2986e3a2b7edSAmir Vadai 2987e3a2b7edSAmir Vadai err_free: 298817091853SOr Gerlitz kvfree(parse_attr); 2989232c0013SHadar Hen Zion kfree(flow); 2990e3a2b7edSAmir Vadai return err; 2991e3a2b7edSAmir Vadai } 2992e3a2b7edSAmir Vadai 29938f8ae895SOr Gerlitz #define DIRECTION_MASK (MLX5E_TC_INGRESS | MLX5E_TC_EGRESS) 29948f8ae895SOr Gerlitz #define FLOW_DIRECTION_MASK (MLX5E_TC_FLOW_INGRESS | MLX5E_TC_FLOW_EGRESS) 29958f8ae895SOr Gerlitz 29968f8ae895SOr Gerlitz static bool same_flow_direction(struct mlx5e_tc_flow *flow, int flags) 29978f8ae895SOr Gerlitz { 29988f8ae895SOr Gerlitz if ((flow->flags & FLOW_DIRECTION_MASK) == (flags & DIRECTION_MASK)) 29998f8ae895SOr Gerlitz return true; 30008f8ae895SOr Gerlitz 30018f8ae895SOr Gerlitz return false; 30028f8ae895SOr Gerlitz } 30038f8ae895SOr Gerlitz 3004e3a2b7edSAmir Vadai int mlx5e_delete_flower(struct mlx5e_priv *priv, 300560bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 3006e3a2b7edSAmir Vadai { 300705866c82SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv); 3008e3a2b7edSAmir Vadai struct mlx5e_tc_flow *flow; 3009e3a2b7edSAmir Vadai 301005866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 30118f8ae895SOr Gerlitz if (!flow || !same_flow_direction(flow, flags)) 3012e3a2b7edSAmir Vadai return -EINVAL; 3013e3a2b7edSAmir Vadai 301405866c82SOr Gerlitz rhashtable_remove_fast(tc_ht, &flow->node, tc_ht_params); 3015e3a2b7edSAmir Vadai 3016961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 3017e3a2b7edSAmir Vadai 3018e3a2b7edSAmir Vadai kfree(flow); 3019e3a2b7edSAmir Vadai 3020e3a2b7edSAmir Vadai return 0; 3021e3a2b7edSAmir Vadai } 3022e3a2b7edSAmir Vadai 3023aad7e08dSAmir Vadai int mlx5e_stats_flower(struct mlx5e_priv *priv, 302460bd4af8SOr Gerlitz struct tc_cls_flower_offload *f, int flags) 3025aad7e08dSAmir Vadai { 302605866c82SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv); 3027aad7e08dSAmir Vadai struct mlx5e_tc_flow *flow; 3028aad7e08dSAmir Vadai struct mlx5_fc *counter; 3029aad7e08dSAmir Vadai u64 bytes; 3030aad7e08dSAmir Vadai u64 packets; 3031aad7e08dSAmir Vadai u64 lastuse; 3032aad7e08dSAmir Vadai 303305866c82SOr Gerlitz flow = rhashtable_lookup_fast(tc_ht, &f->cookie, tc_ht_params); 30348f8ae895SOr Gerlitz if (!flow || !same_flow_direction(flow, flags)) 3035aad7e08dSAmir Vadai return -EINVAL; 3036aad7e08dSAmir Vadai 30370b67a38fSHadar Hen Zion if (!(flow->flags & MLX5E_TC_FLOW_OFFLOADED)) 30380b67a38fSHadar Hen Zion return 0; 30390b67a38fSHadar Hen Zion 3040b8aee822SMark Bloch counter = mlx5e_tc_get_counter(flow); 3041aad7e08dSAmir Vadai if (!counter) 3042aad7e08dSAmir Vadai return 0; 3043aad7e08dSAmir Vadai 3044aad7e08dSAmir Vadai mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 3045aad7e08dSAmir Vadai 3046d897a638SJakub Kicinski tcf_exts_stats_update(f->exts, bytes, packets, lastuse); 3047fed06ee8SOr Gerlitz 3048aad7e08dSAmir Vadai return 0; 3049aad7e08dSAmir Vadai } 3050aad7e08dSAmir Vadai 30514d8fcf21SAlaa Hleihel static void mlx5e_tc_hairpin_update_dead_peer(struct mlx5e_priv *priv, 30524d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv) 30534d8fcf21SAlaa Hleihel { 30544d8fcf21SAlaa Hleihel struct mlx5_core_dev *peer_mdev = peer_priv->mdev; 30554d8fcf21SAlaa Hleihel struct mlx5e_hairpin_entry *hpe; 30564d8fcf21SAlaa Hleihel u16 peer_vhca_id; 30574d8fcf21SAlaa Hleihel int bkt; 30584d8fcf21SAlaa Hleihel 30594d8fcf21SAlaa Hleihel if (!same_hw_devs(priv, peer_priv)) 30604d8fcf21SAlaa Hleihel return; 30614d8fcf21SAlaa Hleihel 30624d8fcf21SAlaa Hleihel peer_vhca_id = MLX5_CAP_GEN(peer_mdev, vhca_id); 30634d8fcf21SAlaa Hleihel 30644d8fcf21SAlaa Hleihel hash_for_each(priv->fs.tc.hairpin_tbl, bkt, hpe, hairpin_hlist) { 30654d8fcf21SAlaa Hleihel if (hpe->peer_vhca_id == peer_vhca_id) 30664d8fcf21SAlaa Hleihel hpe->hp->pair->peer_gone = true; 30674d8fcf21SAlaa Hleihel } 30684d8fcf21SAlaa Hleihel } 30694d8fcf21SAlaa Hleihel 30704d8fcf21SAlaa Hleihel static int mlx5e_tc_netdev_event(struct notifier_block *this, 30714d8fcf21SAlaa Hleihel unsigned long event, void *ptr) 30724d8fcf21SAlaa Hleihel { 30734d8fcf21SAlaa Hleihel struct net_device *ndev = netdev_notifier_info_to_dev(ptr); 30744d8fcf21SAlaa Hleihel struct mlx5e_flow_steering *fs; 30754d8fcf21SAlaa Hleihel struct mlx5e_priv *peer_priv; 30764d8fcf21SAlaa Hleihel struct mlx5e_tc_table *tc; 30774d8fcf21SAlaa Hleihel struct mlx5e_priv *priv; 30784d8fcf21SAlaa Hleihel 30794d8fcf21SAlaa Hleihel if (ndev->netdev_ops != &mlx5e_netdev_ops || 30804d8fcf21SAlaa Hleihel event != NETDEV_UNREGISTER || 30814d8fcf21SAlaa Hleihel ndev->reg_state == NETREG_REGISTERED) 30824d8fcf21SAlaa Hleihel return NOTIFY_DONE; 30834d8fcf21SAlaa Hleihel 30844d8fcf21SAlaa Hleihel tc = container_of(this, struct mlx5e_tc_table, netdevice_nb); 30854d8fcf21SAlaa Hleihel fs = container_of(tc, struct mlx5e_flow_steering, tc); 30864d8fcf21SAlaa Hleihel priv = container_of(fs, struct mlx5e_priv, fs); 30874d8fcf21SAlaa Hleihel peer_priv = netdev_priv(ndev); 30884d8fcf21SAlaa Hleihel if (priv == peer_priv || 30894d8fcf21SAlaa Hleihel !(priv->netdev->features & NETIF_F_HW_TC)) 30904d8fcf21SAlaa Hleihel return NOTIFY_DONE; 30914d8fcf21SAlaa Hleihel 30924d8fcf21SAlaa Hleihel mlx5e_tc_hairpin_update_dead_peer(priv, peer_priv); 30934d8fcf21SAlaa Hleihel 30944d8fcf21SAlaa Hleihel return NOTIFY_DONE; 30954d8fcf21SAlaa Hleihel } 30964d8fcf21SAlaa Hleihel 3097655dc3d2SOr Gerlitz int mlx5e_tc_nic_init(struct mlx5e_priv *priv) 3098e8f887acSAmir Vadai { 3099acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 31004d8fcf21SAlaa Hleihel int err; 3101e8f887acSAmir Vadai 310211c9c548SOr Gerlitz hash_init(tc->mod_hdr_tbl); 31035c65c564SOr Gerlitz hash_init(tc->hairpin_tbl); 310411c9c548SOr Gerlitz 31054d8fcf21SAlaa Hleihel err = rhashtable_init(&tc->ht, &tc_ht_params); 31064d8fcf21SAlaa Hleihel if (err) 31074d8fcf21SAlaa Hleihel return err; 31084d8fcf21SAlaa Hleihel 31094d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = mlx5e_tc_netdev_event; 31104d8fcf21SAlaa Hleihel if (register_netdevice_notifier(&tc->netdevice_nb)) { 31114d8fcf21SAlaa Hleihel tc->netdevice_nb.notifier_call = NULL; 31124d8fcf21SAlaa Hleihel mlx5_core_warn(priv->mdev, "Failed to register netdev notifier\n"); 31134d8fcf21SAlaa Hleihel } 31144d8fcf21SAlaa Hleihel 31154d8fcf21SAlaa Hleihel return err; 3116e8f887acSAmir Vadai } 3117e8f887acSAmir Vadai 3118e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg) 3119e8f887acSAmir Vadai { 3120e8f887acSAmir Vadai struct mlx5e_tc_flow *flow = ptr; 3121655dc3d2SOr Gerlitz struct mlx5e_priv *priv = flow->priv; 3122e8f887acSAmir Vadai 3123961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 3124e8f887acSAmir Vadai kfree(flow); 3125e8f887acSAmir Vadai } 3126e8f887acSAmir Vadai 3127655dc3d2SOr Gerlitz void mlx5e_tc_nic_cleanup(struct mlx5e_priv *priv) 3128e8f887acSAmir Vadai { 3129acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 3130e8f887acSAmir Vadai 31314d8fcf21SAlaa Hleihel if (tc->netdevice_nb.notifier_call) 31324d8fcf21SAlaa Hleihel unregister_netdevice_notifier(&tc->netdevice_nb); 31334d8fcf21SAlaa Hleihel 3134655dc3d2SOr Gerlitz rhashtable_free_and_destroy(&tc->ht, _mlx5e_tc_del_flow, NULL); 3135e8f887acSAmir Vadai 3136acff797cSMaor Gottlieb if (!IS_ERR_OR_NULL(tc->t)) { 3137acff797cSMaor Gottlieb mlx5_destroy_flow_table(tc->t); 3138acff797cSMaor Gottlieb tc->t = NULL; 3139e8f887acSAmir Vadai } 3140e8f887acSAmir Vadai } 3141655dc3d2SOr Gerlitz 3142655dc3d2SOr Gerlitz int mlx5e_tc_esw_init(struct rhashtable *tc_ht) 3143655dc3d2SOr Gerlitz { 3144655dc3d2SOr Gerlitz return rhashtable_init(tc_ht, &tc_ht_params); 3145655dc3d2SOr Gerlitz } 3146655dc3d2SOr Gerlitz 3147655dc3d2SOr Gerlitz void mlx5e_tc_esw_cleanup(struct rhashtable *tc_ht) 3148655dc3d2SOr Gerlitz { 3149655dc3d2SOr Gerlitz rhashtable_free_and_destroy(tc_ht, _mlx5e_tc_del_flow, NULL); 3150655dc3d2SOr Gerlitz } 315101252a27SOr Gerlitz 315201252a27SOr Gerlitz int mlx5e_tc_num_filters(struct mlx5e_priv *priv) 315301252a27SOr Gerlitz { 315401252a27SOr Gerlitz struct rhashtable *tc_ht = get_tc_ht(priv); 315501252a27SOr Gerlitz 315601252a27SOr Gerlitz return atomic_read(&tc_ht->nelems); 315701252a27SOr Gerlitz } 3158