1e8f887acSAmir Vadai /* 2e8f887acSAmir Vadai * Copyright (c) 2016, Mellanox Technologies. All rights reserved. 3e8f887acSAmir Vadai * 4e8f887acSAmir Vadai * This software is available to you under a choice of one of two 5e8f887acSAmir Vadai * licenses. You may choose to be licensed under the terms of the GNU 6e8f887acSAmir Vadai * General Public License (GPL) Version 2, available from the file 7e8f887acSAmir Vadai * COPYING in the main directory of this source tree, or the 8e8f887acSAmir Vadai * OpenIB.org BSD license below: 9e8f887acSAmir Vadai * 10e8f887acSAmir Vadai * Redistribution and use in source and binary forms, with or 11e8f887acSAmir Vadai * without modification, are permitted provided that the following 12e8f887acSAmir Vadai * conditions are met: 13e8f887acSAmir Vadai * 14e8f887acSAmir Vadai * - Redistributions of source code must retain the above 15e8f887acSAmir Vadai * copyright notice, this list of conditions and the following 16e8f887acSAmir Vadai * disclaimer. 17e8f887acSAmir Vadai * 18e8f887acSAmir Vadai * - Redistributions in binary form must reproduce the above 19e8f887acSAmir Vadai * copyright notice, this list of conditions and the following 20e8f887acSAmir Vadai * disclaimer in the documentation and/or other materials 21e8f887acSAmir Vadai * provided with the distribution. 22e8f887acSAmir Vadai * 23e8f887acSAmir Vadai * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 24e8f887acSAmir Vadai * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 25e8f887acSAmir Vadai * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 26e8f887acSAmir Vadai * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 27e8f887acSAmir Vadai * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 28e8f887acSAmir Vadai * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 29e8f887acSAmir Vadai * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 30e8f887acSAmir Vadai * SOFTWARE. 31e8f887acSAmir Vadai */ 32e8f887acSAmir Vadai 33e3a2b7edSAmir Vadai #include <net/flow_dissector.h> 343f7d0eb4SOr Gerlitz #include <net/sch_generic.h> 35e3a2b7edSAmir Vadai #include <net/pkt_cls.h> 36e3a2b7edSAmir Vadai #include <net/tc_act/tc_gact.h> 3712185a9fSAmir Vadai #include <net/tc_act/tc_skbedit.h> 38e8f887acSAmir Vadai #include <linux/mlx5/fs.h> 39e8f887acSAmir Vadai #include <linux/mlx5/device.h> 40e8f887acSAmir Vadai #include <linux/rhashtable.h> 4103a9d11eSOr Gerlitz #include <net/switchdev.h> 4203a9d11eSOr Gerlitz #include <net/tc_act/tc_mirred.h> 43776b12b6SOr Gerlitz #include <net/tc_act/tc_vlan.h> 44bbd00f7eSHadar Hen Zion #include <net/tc_act/tc_tunnel_key.h> 45d79b6df6SOr Gerlitz #include <net/tc_act/tc_pedit.h> 4626c02749SOr Gerlitz #include <net/tc_act/tc_csum.h> 47a54e20b4SHadar Hen Zion #include <net/vxlan.h> 48f6dfb4c3SHadar Hen Zion #include <net/arp.h> 49e8f887acSAmir Vadai #include "en.h" 501d447a39SSaeed Mahameed #include "en_rep.h" 51232c0013SHadar Hen Zion #include "en_tc.h" 5203a9d11eSOr Gerlitz #include "eswitch.h" 53bbd00f7eSHadar Hen Zion #include "vxlan.h" 54e8f887acSAmir Vadai 553bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr { 563bc4b7bfSOr Gerlitz u32 action; 573bc4b7bfSOr Gerlitz u32 flow_tag; 582f4fe4caSOr Gerlitz u32 mod_hdr_id; 593bc4b7bfSOr Gerlitz }; 603bc4b7bfSOr Gerlitz 6165ba8fb7SOr Gerlitz enum { 6265ba8fb7SOr Gerlitz MLX5E_TC_FLOW_ESWITCH = BIT(0), 633bc4b7bfSOr Gerlitz MLX5E_TC_FLOW_NIC = BIT(1), 640b67a38fSHadar Hen Zion MLX5E_TC_FLOW_OFFLOADED = BIT(2), 6565ba8fb7SOr Gerlitz }; 6665ba8fb7SOr Gerlitz 67e8f887acSAmir Vadai struct mlx5e_tc_flow { 68e8f887acSAmir Vadai struct rhash_head node; 69e8f887acSAmir Vadai u64 cookie; 7065ba8fb7SOr Gerlitz u8 flags; 7174491de9SMark Bloch struct mlx5_flow_handle *rule; 72a54e20b4SHadar Hen Zion struct list_head encap; /* flows sharing the same encap */ 733bc4b7bfSOr Gerlitz union { 74ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr esw_attr[0]; 753bc4b7bfSOr Gerlitz struct mlx5_nic_flow_attr nic_attr[0]; 763bc4b7bfSOr Gerlitz }; 77e8f887acSAmir Vadai }; 78e8f887acSAmir Vadai 7917091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr { 8017091853SOr Gerlitz struct mlx5_flow_spec spec; 81d79b6df6SOr Gerlitz int num_mod_hdr_actions; 82d79b6df6SOr Gerlitz void *mod_hdr_actions; 8317091853SOr Gerlitz }; 8417091853SOr Gerlitz 85a54e20b4SHadar Hen Zion enum { 86a54e20b4SHadar Hen Zion MLX5_HEADER_TYPE_VXLAN = 0x0, 87a54e20b4SHadar Hen Zion MLX5_HEADER_TYPE_NVGRE = 0x1, 88a54e20b4SHadar Hen Zion }; 89a54e20b4SHadar Hen Zion 90acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_ENTRIES 1024 91acff797cSMaor Gottlieb #define MLX5E_TC_TABLE_NUM_GROUPS 4 92e8f887acSAmir Vadai 9374491de9SMark Bloch static struct mlx5_flow_handle * 9474491de9SMark Bloch mlx5e_tc_add_nic_flow(struct mlx5e_priv *priv, 9517091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 96aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow) 97e8f887acSAmir Vadai { 98aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 99aad7e08dSAmir Vadai struct mlx5_core_dev *dev = priv->mdev; 100aa0cbbaeSOr Gerlitz struct mlx5_flow_destination dest = {}; 10166958ed9SHadar Hen Zion struct mlx5_flow_act flow_act = { 1023bc4b7bfSOr Gerlitz .action = attr->action, 1033bc4b7bfSOr Gerlitz .flow_tag = attr->flow_tag, 10466958ed9SHadar Hen Zion .encap_id = 0, 10566958ed9SHadar Hen Zion }; 106aad7e08dSAmir Vadai struct mlx5_fc *counter = NULL; 10774491de9SMark Bloch struct mlx5_flow_handle *rule; 108e8f887acSAmir Vadai bool table_created = false; 1092f4fe4caSOr Gerlitz int err; 110e8f887acSAmir Vadai 1113bc4b7bfSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_FWD_DEST) { 112aad7e08dSAmir Vadai dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE; 113aad7e08dSAmir Vadai dest.ft = priv->fs.vlan.ft.t; 1143bc4b7bfSOr Gerlitz } else if (attr->action & MLX5_FLOW_CONTEXT_ACTION_COUNT) { 115aad7e08dSAmir Vadai counter = mlx5_fc_create(dev, true); 116aad7e08dSAmir Vadai if (IS_ERR(counter)) 117aad7e08dSAmir Vadai return ERR_CAST(counter); 118aad7e08dSAmir Vadai 119aad7e08dSAmir Vadai dest.type = MLX5_FLOW_DESTINATION_TYPE_COUNTER; 120aad7e08dSAmir Vadai dest.counter = counter; 121aad7e08dSAmir Vadai } 122aad7e08dSAmir Vadai 1232f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 1242f4fe4caSOr Gerlitz err = mlx5_modify_header_alloc(dev, MLX5_FLOW_NAMESPACE_KERNEL, 1252f4fe4caSOr Gerlitz parse_attr->num_mod_hdr_actions, 1262f4fe4caSOr Gerlitz parse_attr->mod_hdr_actions, 1272f4fe4caSOr Gerlitz &attr->mod_hdr_id); 128d7e75a32SOr Gerlitz flow_act.modify_id = attr->mod_hdr_id; 1292f4fe4caSOr Gerlitz kfree(parse_attr->mod_hdr_actions); 1302f4fe4caSOr Gerlitz if (err) { 1312f4fe4caSOr Gerlitz rule = ERR_PTR(err); 1322f4fe4caSOr Gerlitz goto err_create_mod_hdr_id; 1332f4fe4caSOr Gerlitz } 1342f4fe4caSOr Gerlitz } 1352f4fe4caSOr Gerlitz 136acff797cSMaor Gottlieb if (IS_ERR_OR_NULL(priv->fs.tc.t)) { 137acff797cSMaor Gottlieb priv->fs.tc.t = 138acff797cSMaor Gottlieb mlx5_create_auto_grouped_flow_table(priv->fs.ns, 139acff797cSMaor Gottlieb MLX5E_TC_PRIO, 140acff797cSMaor Gottlieb MLX5E_TC_TABLE_NUM_ENTRIES, 141acff797cSMaor Gottlieb MLX5E_TC_TABLE_NUM_GROUPS, 142c9f1b073SHadar Hen Zion 0, 0); 143acff797cSMaor Gottlieb if (IS_ERR(priv->fs.tc.t)) { 144e8f887acSAmir Vadai netdev_err(priv->netdev, 145e8f887acSAmir Vadai "Failed to create tc offload table\n"); 146aad7e08dSAmir Vadai rule = ERR_CAST(priv->fs.tc.t); 147aad7e08dSAmir Vadai goto err_create_ft; 148e8f887acSAmir Vadai } 149e8f887acSAmir Vadai 150e8f887acSAmir Vadai table_created = true; 151e8f887acSAmir Vadai } 152e8f887acSAmir Vadai 15317091853SOr Gerlitz parse_attr->spec.match_criteria_enable = MLX5_MATCH_OUTER_HEADERS; 15417091853SOr Gerlitz rule = mlx5_add_flow_rules(priv->fs.tc.t, &parse_attr->spec, 15517091853SOr Gerlitz &flow_act, &dest, 1); 156e8f887acSAmir Vadai 157aad7e08dSAmir Vadai if (IS_ERR(rule)) 158aad7e08dSAmir Vadai goto err_add_rule; 159aad7e08dSAmir Vadai 160aad7e08dSAmir Vadai return rule; 161aad7e08dSAmir Vadai 162aad7e08dSAmir Vadai err_add_rule: 163aad7e08dSAmir Vadai if (table_created) { 164acff797cSMaor Gottlieb mlx5_destroy_flow_table(priv->fs.tc.t); 165acff797cSMaor Gottlieb priv->fs.tc.t = NULL; 166e8f887acSAmir Vadai } 167aad7e08dSAmir Vadai err_create_ft: 1682f4fe4caSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 1692f4fe4caSOr Gerlitz mlx5_modify_header_dealloc(priv->mdev, 1702f4fe4caSOr Gerlitz attr->mod_hdr_id); 1712f4fe4caSOr Gerlitz err_create_mod_hdr_id: 172aad7e08dSAmir Vadai mlx5_fc_destroy(dev, counter); 173e8f887acSAmir Vadai 174e8f887acSAmir Vadai return rule; 175e8f887acSAmir Vadai } 176e8f887acSAmir Vadai 177d85cdccbSOr Gerlitz static void mlx5e_tc_del_nic_flow(struct mlx5e_priv *priv, 178d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 179d85cdccbSOr Gerlitz { 180513f8f7fSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 181d85cdccbSOr Gerlitz struct mlx5_fc *counter = NULL; 182d85cdccbSOr Gerlitz 183d85cdccbSOr Gerlitz counter = mlx5_flow_rule_counter(flow->rule); 184d85cdccbSOr Gerlitz mlx5_del_flow_rules(flow->rule); 185d85cdccbSOr Gerlitz mlx5_fc_destroy(priv->mdev, counter); 186d85cdccbSOr Gerlitz 187d85cdccbSOr Gerlitz if (!mlx5e_tc_num_filters(priv) && (priv->fs.tc.t)) { 188d85cdccbSOr Gerlitz mlx5_destroy_flow_table(priv->fs.tc.t); 189d85cdccbSOr Gerlitz priv->fs.tc.t = NULL; 190d85cdccbSOr Gerlitz } 1912f4fe4caSOr Gerlitz 192513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 1932f4fe4caSOr Gerlitz mlx5_modify_header_dealloc(priv->mdev, 194513f8f7fSOr Gerlitz attr->mod_hdr_id); 195d85cdccbSOr Gerlitz } 196d85cdccbSOr Gerlitz 197aa0cbbaeSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 198aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow); 199aa0cbbaeSOr Gerlitz 20074491de9SMark Bloch static struct mlx5_flow_handle * 20174491de9SMark Bloch mlx5e_tc_add_fdb_flow(struct mlx5e_priv *priv, 20217091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 203aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow) 204adb4c123SOr Gerlitz { 205adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 206aa0cbbaeSOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 207aa0cbbaeSOr Gerlitz struct mlx5_flow_handle *rule; 2088b32580dSOr Gerlitz int err; 2098b32580dSOr Gerlitz 2108b32580dSOr Gerlitz err = mlx5_eswitch_add_vlan_action(esw, attr); 211aa0cbbaeSOr Gerlitz if (err) { 212aa0cbbaeSOr Gerlitz rule = ERR_PTR(err); 213aa0cbbaeSOr Gerlitz goto err_add_vlan; 214adb4c123SOr Gerlitz } 215adb4c123SOr Gerlitz 216d7e75a32SOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) { 217d7e75a32SOr Gerlitz err = mlx5_modify_header_alloc(priv->mdev, MLX5_FLOW_NAMESPACE_FDB, 218d7e75a32SOr Gerlitz parse_attr->num_mod_hdr_actions, 219d7e75a32SOr Gerlitz parse_attr->mod_hdr_actions, 220d7e75a32SOr Gerlitz &attr->mod_hdr_id); 221d7e75a32SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 222d7e75a32SOr Gerlitz if (err) { 223d7e75a32SOr Gerlitz rule = ERR_PTR(err); 224d7e75a32SOr Gerlitz goto err_mod_hdr; 225d7e75a32SOr Gerlitz } 226d7e75a32SOr Gerlitz } 227d7e75a32SOr Gerlitz 228aa0cbbaeSOr Gerlitz rule = mlx5_eswitch_add_offloaded_rule(esw, &parse_attr->spec, attr); 229aa0cbbaeSOr Gerlitz if (IS_ERR(rule)) 230aa0cbbaeSOr Gerlitz goto err_add_rule; 231aa0cbbaeSOr Gerlitz 232aa0cbbaeSOr Gerlitz return rule; 233aa0cbbaeSOr Gerlitz 234aa0cbbaeSOr Gerlitz err_add_rule: 235513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 236d7e75a32SOr Gerlitz mlx5_modify_header_dealloc(priv->mdev, 237d7e75a32SOr Gerlitz attr->mod_hdr_id); 238d7e75a32SOr Gerlitz err_mod_hdr: 239aa0cbbaeSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 240aa0cbbaeSOr Gerlitz err_add_vlan: 241aa0cbbaeSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_ENCAP) 242aa0cbbaeSOr Gerlitz mlx5e_detach_encap(priv, flow); 243aa0cbbaeSOr Gerlitz return rule; 244aa0cbbaeSOr Gerlitz } 245d85cdccbSOr Gerlitz 246d85cdccbSOr Gerlitz static void mlx5e_tc_del_fdb_flow(struct mlx5e_priv *priv, 247d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 248d85cdccbSOr Gerlitz { 249d85cdccbSOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 250d7e75a32SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 251d85cdccbSOr Gerlitz 252232c0013SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 253232c0013SHadar Hen Zion flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED; 254513f8f7fSOr Gerlitz mlx5_eswitch_del_offloaded_rule(esw, flow->rule, attr); 255232c0013SHadar Hen Zion } 256d85cdccbSOr Gerlitz 257513f8f7fSOr Gerlitz mlx5_eswitch_del_vlan_action(esw, attr); 258d85cdccbSOr Gerlitz 259513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_ENCAP) { 260d85cdccbSOr Gerlitz mlx5e_detach_encap(priv, flow); 261513f8f7fSOr Gerlitz kvfree(attr->parse_attr); 262232c0013SHadar Hen Zion } 263d7e75a32SOr Gerlitz 264513f8f7fSOr Gerlitz if (attr->action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR) 265d7e75a32SOr Gerlitz mlx5_modify_header_dealloc(priv->mdev, 266d7e75a32SOr Gerlitz attr->mod_hdr_id); 267d85cdccbSOr Gerlitz } 268d85cdccbSOr Gerlitz 269232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_add(struct mlx5e_priv *priv, 270232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 271232c0013SHadar Hen Zion { 272232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 273232c0013SHadar Hen Zion int err; 274232c0013SHadar Hen Zion 275232c0013SHadar Hen Zion err = mlx5_encap_alloc(priv->mdev, e->tunnel_type, 276232c0013SHadar Hen Zion e->encap_size, e->encap_header, 277232c0013SHadar Hen Zion &e->encap_id); 278232c0013SHadar Hen Zion if (err) { 279232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to offload cached encapsulation header, %d\n", 280232c0013SHadar Hen Zion err); 281232c0013SHadar Hen Zion return; 282232c0013SHadar Hen Zion } 283232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 284f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(priv); 285232c0013SHadar Hen Zion 286232c0013SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 287232c0013SHadar Hen Zion flow->esw_attr->encap_id = e->encap_id; 288232c0013SHadar Hen Zion flow->rule = mlx5e_tc_add_fdb_flow(priv, 289232c0013SHadar Hen Zion flow->esw_attr->parse_attr, 290232c0013SHadar Hen Zion flow); 291232c0013SHadar Hen Zion if (IS_ERR(flow->rule)) { 292232c0013SHadar Hen Zion err = PTR_ERR(flow->rule); 293232c0013SHadar Hen Zion mlx5_core_warn(priv->mdev, "Failed to update cached encapsulation flow, %d\n", 294232c0013SHadar Hen Zion err); 295232c0013SHadar Hen Zion continue; 296232c0013SHadar Hen Zion } 297232c0013SHadar Hen Zion flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 298232c0013SHadar Hen Zion } 299232c0013SHadar Hen Zion } 300232c0013SHadar Hen Zion 301232c0013SHadar Hen Zion void mlx5e_tc_encap_flows_del(struct mlx5e_priv *priv, 302232c0013SHadar Hen Zion struct mlx5e_encap_entry *e) 303232c0013SHadar Hen Zion { 304232c0013SHadar Hen Zion struct mlx5e_tc_flow *flow; 305232c0013SHadar Hen Zion struct mlx5_fc *counter; 306232c0013SHadar Hen Zion 307232c0013SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 308232c0013SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 309232c0013SHadar Hen Zion flow->flags &= ~MLX5E_TC_FLOW_OFFLOADED; 310232c0013SHadar Hen Zion counter = mlx5_flow_rule_counter(flow->rule); 311232c0013SHadar Hen Zion mlx5_del_flow_rules(flow->rule); 312232c0013SHadar Hen Zion mlx5_fc_destroy(priv->mdev, counter); 313232c0013SHadar Hen Zion } 314232c0013SHadar Hen Zion } 315232c0013SHadar Hen Zion 316232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) { 317232c0013SHadar Hen Zion e->flags &= ~MLX5_ENCAP_ENTRY_VALID; 318232c0013SHadar Hen Zion mlx5_encap_dealloc(priv->mdev, e->encap_id); 319232c0013SHadar Hen Zion } 320232c0013SHadar Hen Zion } 321232c0013SHadar Hen Zion 322f6dfb4c3SHadar Hen Zion void mlx5e_tc_update_neigh_used_value(struct mlx5e_neigh_hash_entry *nhe) 323f6dfb4c3SHadar Hen Zion { 324f6dfb4c3SHadar Hen Zion struct mlx5e_neigh *m_neigh = &nhe->m_neigh; 325f6dfb4c3SHadar Hen Zion u64 bytes, packets, lastuse = 0; 326f6dfb4c3SHadar Hen Zion struct mlx5e_tc_flow *flow; 327f6dfb4c3SHadar Hen Zion struct mlx5e_encap_entry *e; 328f6dfb4c3SHadar Hen Zion struct mlx5_fc *counter; 329f6dfb4c3SHadar Hen Zion struct neigh_table *tbl; 330f6dfb4c3SHadar Hen Zion bool neigh_used = false; 331f6dfb4c3SHadar Hen Zion struct neighbour *n; 332f6dfb4c3SHadar Hen Zion 333f6dfb4c3SHadar Hen Zion if (m_neigh->family == AF_INET) 334f6dfb4c3SHadar Hen Zion tbl = &arp_tbl; 335f6dfb4c3SHadar Hen Zion #if IS_ENABLED(CONFIG_IPV6) 336f6dfb4c3SHadar Hen Zion else if (m_neigh->family == AF_INET6) 337f6dfb4c3SHadar Hen Zion tbl = ipv6_stub->nd_tbl; 338f6dfb4c3SHadar Hen Zion #endif 339f6dfb4c3SHadar Hen Zion else 340f6dfb4c3SHadar Hen Zion return; 341f6dfb4c3SHadar Hen Zion 342f6dfb4c3SHadar Hen Zion list_for_each_entry(e, &nhe->encap_list, encap_list) { 343f6dfb4c3SHadar Hen Zion if (!(e->flags & MLX5_ENCAP_ENTRY_VALID)) 344f6dfb4c3SHadar Hen Zion continue; 345f6dfb4c3SHadar Hen Zion list_for_each_entry(flow, &e->flows, encap) { 346f6dfb4c3SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_OFFLOADED) { 347f6dfb4c3SHadar Hen Zion counter = mlx5_flow_rule_counter(flow->rule); 348f6dfb4c3SHadar Hen Zion mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 349f6dfb4c3SHadar Hen Zion if (time_after((unsigned long)lastuse, nhe->reported_lastuse)) { 350f6dfb4c3SHadar Hen Zion neigh_used = true; 351f6dfb4c3SHadar Hen Zion break; 352f6dfb4c3SHadar Hen Zion } 353f6dfb4c3SHadar Hen Zion } 354f6dfb4c3SHadar Hen Zion } 355f6dfb4c3SHadar Hen Zion } 356f6dfb4c3SHadar Hen Zion 357f6dfb4c3SHadar Hen Zion if (neigh_used) { 358f6dfb4c3SHadar Hen Zion nhe->reported_lastuse = jiffies; 359f6dfb4c3SHadar Hen Zion 360f6dfb4c3SHadar Hen Zion /* find the relevant neigh according to the cached device and 361f6dfb4c3SHadar Hen Zion * dst ip pair 362f6dfb4c3SHadar Hen Zion */ 363f6dfb4c3SHadar Hen Zion n = neigh_lookup(tbl, &m_neigh->dst_ip, m_neigh->dev); 364f6dfb4c3SHadar Hen Zion if (!n) { 365f6dfb4c3SHadar Hen Zion WARN(1, "The neighbour already freed\n"); 366f6dfb4c3SHadar Hen Zion return; 367f6dfb4c3SHadar Hen Zion } 368f6dfb4c3SHadar Hen Zion 369f6dfb4c3SHadar Hen Zion neigh_event_send(n, NULL); 370f6dfb4c3SHadar Hen Zion neigh_release(n); 371f6dfb4c3SHadar Hen Zion } 372f6dfb4c3SHadar Hen Zion } 373f6dfb4c3SHadar Hen Zion 374d85cdccbSOr Gerlitz static void mlx5e_detach_encap(struct mlx5e_priv *priv, 375d85cdccbSOr Gerlitz struct mlx5e_tc_flow *flow) 376d85cdccbSOr Gerlitz { 3775067b602SRoi Dayan struct list_head *next = flow->encap.next; 3785067b602SRoi Dayan 3795067b602SRoi Dayan list_del(&flow->encap); 3805067b602SRoi Dayan if (list_empty(next)) { 381c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 3825067b602SRoi Dayan 383c1ae1152SOr Gerlitz e = list_entry(next, struct mlx5e_encap_entry, flows); 384232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 385232c0013SHadar Hen Zion 386232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 3875067b602SRoi Dayan mlx5_encap_dealloc(priv->mdev, e->encap_id); 388232c0013SHadar Hen Zion 389cdc5a7f3SOr Gerlitz hash_del_rcu(&e->encap_hlist); 390232c0013SHadar Hen Zion kfree(e->encap_header); 3915067b602SRoi Dayan kfree(e); 3925067b602SRoi Dayan } 3935067b602SRoi Dayan } 3945067b602SRoi Dayan 395e8f887acSAmir Vadai static void mlx5e_tc_del_flow(struct mlx5e_priv *priv, 396961e8979SRoi Dayan struct mlx5e_tc_flow *flow) 397e8f887acSAmir Vadai { 398d85cdccbSOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) 399d85cdccbSOr Gerlitz mlx5e_tc_del_fdb_flow(priv, flow); 400d85cdccbSOr Gerlitz else 401d85cdccbSOr Gerlitz mlx5e_tc_del_nic_flow(priv, flow); 402e8f887acSAmir Vadai } 403e8f887acSAmir Vadai 404bbd00f7eSHadar Hen Zion static void parse_vxlan_attr(struct mlx5_flow_spec *spec, 405bbd00f7eSHadar Hen Zion struct tc_cls_flower_offload *f) 406bbd00f7eSHadar Hen Zion { 407bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 408bbd00f7eSHadar Hen Zion outer_headers); 409bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 410bbd00f7eSHadar Hen Zion outer_headers); 411bbd00f7eSHadar Hen Zion void *misc_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 412bbd00f7eSHadar Hen Zion misc_parameters); 413bbd00f7eSHadar Hen Zion void *misc_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 414bbd00f7eSHadar Hen Zion misc_parameters); 415bbd00f7eSHadar Hen Zion 416bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ip_protocol); 417bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, IPPROTO_UDP); 418bbd00f7eSHadar Hen Zion 419bbd00f7eSHadar Hen Zion if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_KEYID)) { 420bbd00f7eSHadar Hen Zion struct flow_dissector_key_keyid *key = 421bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 422bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_KEYID, 423bbd00f7eSHadar Hen Zion f->key); 424bbd00f7eSHadar Hen Zion struct flow_dissector_key_keyid *mask = 425bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 426bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_KEYID, 427bbd00f7eSHadar Hen Zion f->mask); 428bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_misc, misc_c, vxlan_vni, 429bbd00f7eSHadar Hen Zion be32_to_cpu(mask->keyid)); 430bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_misc, misc_v, vxlan_vni, 431bbd00f7eSHadar Hen Zion be32_to_cpu(key->keyid)); 432bbd00f7eSHadar Hen Zion } 433bbd00f7eSHadar Hen Zion } 434bbd00f7eSHadar Hen Zion 435bbd00f7eSHadar Hen Zion static int parse_tunnel_attr(struct mlx5e_priv *priv, 436bbd00f7eSHadar Hen Zion struct mlx5_flow_spec *spec, 437bbd00f7eSHadar Hen Zion struct tc_cls_flower_offload *f) 438bbd00f7eSHadar Hen Zion { 439bbd00f7eSHadar Hen Zion void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 440bbd00f7eSHadar Hen Zion outer_headers); 441bbd00f7eSHadar Hen Zion void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 442bbd00f7eSHadar Hen Zion outer_headers); 443bbd00f7eSHadar Hen Zion 4442e72eb43SOr Gerlitz struct flow_dissector_key_control *enc_control = 4452e72eb43SOr Gerlitz skb_flow_dissector_target(f->dissector, 4462e72eb43SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_CONTROL, 4472e72eb43SOr Gerlitz f->key); 4482e72eb43SOr Gerlitz 449bbd00f7eSHadar Hen Zion if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_PORTS)) { 450bbd00f7eSHadar Hen Zion struct flow_dissector_key_ports *key = 451bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 452bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_PORTS, 453bbd00f7eSHadar Hen Zion f->key); 454bbd00f7eSHadar Hen Zion struct flow_dissector_key_ports *mask = 455bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 456bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_PORTS, 457bbd00f7eSHadar Hen Zion f->mask); 4581ad9a00aSPaul Blakey struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 4591ad9a00aSPaul Blakey struct net_device *up_dev = mlx5_eswitch_get_uplink_netdev(esw); 4601ad9a00aSPaul Blakey struct mlx5e_priv *up_priv = netdev_priv(up_dev); 461bbd00f7eSHadar Hen Zion 462bbd00f7eSHadar Hen Zion /* Full udp dst port must be given */ 463bbd00f7eSHadar Hen Zion if (memchr_inv(&mask->dst, 0xff, sizeof(mask->dst))) 4642fcd82e9SOr Gerlitz goto vxlan_match_offload_err; 465bbd00f7eSHadar Hen Zion 4661ad9a00aSPaul Blakey if (mlx5e_vxlan_lookup_port(up_priv, be16_to_cpu(key->dst)) && 467bbd00f7eSHadar Hen Zion MLX5_CAP_ESW(priv->mdev, vxlan_encap_decap)) 468bbd00f7eSHadar Hen Zion parse_vxlan_attr(spec, f); 4692fcd82e9SOr Gerlitz else { 4702fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 4712fcd82e9SOr Gerlitz "%d isn't an offloaded vxlan udp dport\n", be16_to_cpu(key->dst)); 472bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 4732fcd82e9SOr Gerlitz } 474bbd00f7eSHadar Hen Zion 475bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 476bbd00f7eSHadar Hen Zion udp_dport, ntohs(mask->dst)); 477bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 478bbd00f7eSHadar Hen Zion udp_dport, ntohs(key->dst)); 479bbd00f7eSHadar Hen Zion 480cd377663SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, 481cd377663SOr Gerlitz udp_sport, ntohs(mask->src)); 482cd377663SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, 483cd377663SOr Gerlitz udp_sport, ntohs(key->src)); 484bbd00f7eSHadar Hen Zion } else { /* udp dst port must be given */ 4852fcd82e9SOr Gerlitz vxlan_match_offload_err: 4862fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 4872fcd82e9SOr Gerlitz "IP tunnel decap offload supported only for vxlan, must set UDP dport\n"); 488bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 489bbd00f7eSHadar Hen Zion } 490bbd00f7eSHadar Hen Zion 4912e72eb43SOr Gerlitz if (enc_control->addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 492bbd00f7eSHadar Hen Zion struct flow_dissector_key_ipv4_addrs *key = 493bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 494bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS, 495bbd00f7eSHadar Hen Zion f->key); 496bbd00f7eSHadar Hen Zion struct flow_dissector_key_ipv4_addrs *mask = 497bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 498bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS, 499bbd00f7eSHadar Hen Zion f->mask); 500bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 501bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 502bbd00f7eSHadar Hen Zion ntohl(mask->src)); 503bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 504bbd00f7eSHadar Hen Zion src_ipv4_src_ipv6.ipv4_layout.ipv4, 505bbd00f7eSHadar Hen Zion ntohl(key->src)); 506bbd00f7eSHadar Hen Zion 507bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, 508bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 509bbd00f7eSHadar Hen Zion ntohl(mask->dst)); 510bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, 511bbd00f7eSHadar Hen Zion dst_ipv4_dst_ipv6.ipv4_layout.ipv4, 512bbd00f7eSHadar Hen Zion ntohl(key->dst)); 513bbd00f7eSHadar Hen Zion 514bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 515bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IP); 51619f44401SOr Gerlitz } else if (enc_control->addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 51719f44401SOr Gerlitz struct flow_dissector_key_ipv6_addrs *key = 51819f44401SOr Gerlitz skb_flow_dissector_target(f->dissector, 51919f44401SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS, 52019f44401SOr Gerlitz f->key); 52119f44401SOr Gerlitz struct flow_dissector_key_ipv6_addrs *mask = 52219f44401SOr Gerlitz skb_flow_dissector_target(f->dissector, 52319f44401SOr Gerlitz FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS, 52419f44401SOr Gerlitz f->mask); 52519f44401SOr Gerlitz 52619f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 52719f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 52819f44401SOr Gerlitz &mask->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 52919f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 53019f44401SOr Gerlitz src_ipv4_src_ipv6.ipv6_layout.ipv6), 53119f44401SOr Gerlitz &key->src, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 53219f44401SOr Gerlitz 53319f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 53419f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 53519f44401SOr Gerlitz &mask->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 53619f44401SOr Gerlitz memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 53719f44401SOr Gerlitz dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 53819f44401SOr Gerlitz &key->dst, MLX5_FLD_SZ_BYTES(ipv6_layout, ipv6)); 53919f44401SOr Gerlitz 54019f44401SOr Gerlitz MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, ethertype); 54119f44401SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, ETH_P_IPV6); 5422e72eb43SOr Gerlitz } 543bbd00f7eSHadar Hen Zion 544bbd00f7eSHadar Hen Zion /* Enforce DMAC when offloading incoming tunneled flows. 545bbd00f7eSHadar Hen Zion * Flow counters require a match on the DMAC. 546bbd00f7eSHadar Hen Zion */ 547bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_47_16); 548bbd00f7eSHadar Hen Zion MLX5_SET_TO_ONES(fte_match_set_lyr_2_4, headers_c, dmac_15_0); 549bbd00f7eSHadar Hen Zion ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 550bbd00f7eSHadar Hen Zion dmac_47_16), priv->netdev->dev_addr); 551bbd00f7eSHadar Hen Zion 552bbd00f7eSHadar Hen Zion /* let software handle IP fragments */ 553bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 554bbd00f7eSHadar Hen Zion MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 0); 555bbd00f7eSHadar Hen Zion 556bbd00f7eSHadar Hen Zion return 0; 557bbd00f7eSHadar Hen Zion } 558bbd00f7eSHadar Hen Zion 559de0af0bfSRoi Dayan static int __parse_cls_flower(struct mlx5e_priv *priv, 560de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 561de0af0bfSRoi Dayan struct tc_cls_flower_offload *f, 562de0af0bfSRoi Dayan u8 *min_inline) 563e3a2b7edSAmir Vadai { 564c5bb1730SMaor Gottlieb void *headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 565c5bb1730SMaor Gottlieb outer_headers); 566c5bb1730SMaor Gottlieb void *headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 567c5bb1730SMaor Gottlieb outer_headers); 568e3a2b7edSAmir Vadai u16 addr_type = 0; 569e3a2b7edSAmir Vadai u8 ip_proto = 0; 570e3a2b7edSAmir Vadai 571de0af0bfSRoi Dayan *min_inline = MLX5_INLINE_MODE_L2; 572de0af0bfSRoi Dayan 573e3a2b7edSAmir Vadai if (f->dissector->used_keys & 574e3a2b7edSAmir Vadai ~(BIT(FLOW_DISSECTOR_KEY_CONTROL) | 575e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_BASIC) | 576e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) | 577095b6cfdSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_VLAN) | 578e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) | 579e3a2b7edSAmir Vadai BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) | 580bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_PORTS) | 581bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_KEYID) | 582bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) | 583bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS) | 584bbd00f7eSHadar Hen Zion BIT(FLOW_DISSECTOR_KEY_ENC_PORTS) | 585e77834ecSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_ENC_CONTROL) | 586fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_TCP) | 587fd7da28bSOr Gerlitz BIT(FLOW_DISSECTOR_KEY_IP))) { 588e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Unsupported key used: 0x%x\n", 589e3a2b7edSAmir Vadai f->dissector->used_keys); 590e3a2b7edSAmir Vadai return -EOPNOTSUPP; 591e3a2b7edSAmir Vadai } 592e3a2b7edSAmir Vadai 593bbd00f7eSHadar Hen Zion if ((dissector_uses_key(f->dissector, 594bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS) || 595bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_KEYID) || 596bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_PORTS)) && 597bbd00f7eSHadar Hen Zion dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ENC_CONTROL)) { 598bbd00f7eSHadar Hen Zion struct flow_dissector_key_control *key = 599bbd00f7eSHadar Hen Zion skb_flow_dissector_target(f->dissector, 600bbd00f7eSHadar Hen Zion FLOW_DISSECTOR_KEY_ENC_CONTROL, 601bbd00f7eSHadar Hen Zion f->key); 602bbd00f7eSHadar Hen Zion switch (key->addr_type) { 603bbd00f7eSHadar Hen Zion case FLOW_DISSECTOR_KEY_IPV4_ADDRS: 60419f44401SOr Gerlitz case FLOW_DISSECTOR_KEY_IPV6_ADDRS: 605bbd00f7eSHadar Hen Zion if (parse_tunnel_attr(priv, spec, f)) 606bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 607bbd00f7eSHadar Hen Zion break; 608bbd00f7eSHadar Hen Zion default: 609bbd00f7eSHadar Hen Zion return -EOPNOTSUPP; 610bbd00f7eSHadar Hen Zion } 611bbd00f7eSHadar Hen Zion 612bbd00f7eSHadar Hen Zion /* In decap flow, header pointers should point to the inner 613bbd00f7eSHadar Hen Zion * headers, outer header were already set by parse_tunnel_attr 614bbd00f7eSHadar Hen Zion */ 615bbd00f7eSHadar Hen Zion headers_c = MLX5_ADDR_OF(fte_match_param, spec->match_criteria, 616bbd00f7eSHadar Hen Zion inner_headers); 617bbd00f7eSHadar Hen Zion headers_v = MLX5_ADDR_OF(fte_match_param, spec->match_value, 618bbd00f7eSHadar Hen Zion inner_headers); 619bbd00f7eSHadar Hen Zion } 620bbd00f7eSHadar Hen Zion 621e3a2b7edSAmir Vadai if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_CONTROL)) { 622e3a2b7edSAmir Vadai struct flow_dissector_key_control *key = 623e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 6241dbd0d37SHadar Hen Zion FLOW_DISSECTOR_KEY_CONTROL, 625e3a2b7edSAmir Vadai f->key); 6263f7d0eb4SOr Gerlitz 6273f7d0eb4SOr Gerlitz struct flow_dissector_key_control *mask = 6283f7d0eb4SOr Gerlitz skb_flow_dissector_target(f->dissector, 6293f7d0eb4SOr Gerlitz FLOW_DISSECTOR_KEY_CONTROL, 6303f7d0eb4SOr Gerlitz f->mask); 631e3a2b7edSAmir Vadai addr_type = key->addr_type; 6323f7d0eb4SOr Gerlitz 6333f7d0eb4SOr Gerlitz if (mask->flags & FLOW_DIS_IS_FRAGMENT) { 6343f7d0eb4SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, frag, 1); 6353f7d0eb4SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, frag, 6363f7d0eb4SOr Gerlitz key->flags & FLOW_DIS_IS_FRAGMENT); 6370827444dSOr Gerlitz 6380827444dSOr Gerlitz /* the HW doesn't need L3 inline to match on frag=no */ 6390827444dSOr Gerlitz if (key->flags & FLOW_DIS_IS_FRAGMENT) 6400827444dSOr Gerlitz *min_inline = MLX5_INLINE_MODE_IP; 6413f7d0eb4SOr Gerlitz } 642e3a2b7edSAmir Vadai } 643e3a2b7edSAmir Vadai 644e3a2b7edSAmir Vadai if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_BASIC)) { 645e3a2b7edSAmir Vadai struct flow_dissector_key_basic *key = 646e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 647e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_BASIC, 648e3a2b7edSAmir Vadai f->key); 649e3a2b7edSAmir Vadai struct flow_dissector_key_basic *mask = 650e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 651e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_BASIC, 652e3a2b7edSAmir Vadai f->mask); 653e3a2b7edSAmir Vadai ip_proto = key->ip_proto; 654e3a2b7edSAmir Vadai 655e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, ethertype, 656e3a2b7edSAmir Vadai ntohs(mask->n_proto)); 657e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, ethertype, 658e3a2b7edSAmir Vadai ntohs(key->n_proto)); 659e3a2b7edSAmir Vadai 660e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol, 661e3a2b7edSAmir Vadai mask->ip_proto); 662e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol, 663e3a2b7edSAmir Vadai key->ip_proto); 664de0af0bfSRoi Dayan 665de0af0bfSRoi Dayan if (mask->ip_proto) 666de0af0bfSRoi Dayan *min_inline = MLX5_INLINE_MODE_IP; 667e3a2b7edSAmir Vadai } 668e3a2b7edSAmir Vadai 669e3a2b7edSAmir Vadai if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_ETH_ADDRS)) { 670e3a2b7edSAmir Vadai struct flow_dissector_key_eth_addrs *key = 671e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 672e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_ETH_ADDRS, 673e3a2b7edSAmir Vadai f->key); 674e3a2b7edSAmir Vadai struct flow_dissector_key_eth_addrs *mask = 675e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 676e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_ETH_ADDRS, 677e3a2b7edSAmir Vadai f->mask); 678e3a2b7edSAmir Vadai 679e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 680e3a2b7edSAmir Vadai dmac_47_16), 681e3a2b7edSAmir Vadai mask->dst); 682e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 683e3a2b7edSAmir Vadai dmac_47_16), 684e3a2b7edSAmir Vadai key->dst); 685e3a2b7edSAmir Vadai 686e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 687e3a2b7edSAmir Vadai smac_47_16), 688e3a2b7edSAmir Vadai mask->src); 689e3a2b7edSAmir Vadai ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 690e3a2b7edSAmir Vadai smac_47_16), 691e3a2b7edSAmir Vadai key->src); 692e3a2b7edSAmir Vadai } 693e3a2b7edSAmir Vadai 694095b6cfdSOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_VLAN)) { 695095b6cfdSOr Gerlitz struct flow_dissector_key_vlan *key = 696095b6cfdSOr Gerlitz skb_flow_dissector_target(f->dissector, 697095b6cfdSOr Gerlitz FLOW_DISSECTOR_KEY_VLAN, 698095b6cfdSOr Gerlitz f->key); 699095b6cfdSOr Gerlitz struct flow_dissector_key_vlan *mask = 700095b6cfdSOr Gerlitz skb_flow_dissector_target(f->dissector, 701095b6cfdSOr Gerlitz FLOW_DISSECTOR_KEY_VLAN, 702095b6cfdSOr Gerlitz f->mask); 703358d79a4SOr Gerlitz if (mask->vlan_id || mask->vlan_priority) { 70410543365SMohamad Haj Yahia MLX5_SET(fte_match_set_lyr_2_4, headers_c, cvlan_tag, 1); 70510543365SMohamad Haj Yahia MLX5_SET(fte_match_set_lyr_2_4, headers_v, cvlan_tag, 1); 706095b6cfdSOr Gerlitz 707095b6cfdSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_vid, mask->vlan_id); 708095b6cfdSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_vid, key->vlan_id); 709358d79a4SOr Gerlitz 710358d79a4SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, first_prio, mask->vlan_priority); 711358d79a4SOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, first_prio, key->vlan_priority); 712095b6cfdSOr Gerlitz } 713095b6cfdSOr Gerlitz } 714095b6cfdSOr Gerlitz 715e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) { 716e3a2b7edSAmir Vadai struct flow_dissector_key_ipv4_addrs *key = 717e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 718e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV4_ADDRS, 719e3a2b7edSAmir Vadai f->key); 720e3a2b7edSAmir Vadai struct flow_dissector_key_ipv4_addrs *mask = 721e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 722e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV4_ADDRS, 723e3a2b7edSAmir Vadai f->mask); 724e3a2b7edSAmir Vadai 725e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 726e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 727e3a2b7edSAmir Vadai &mask->src, sizeof(mask->src)); 728e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 729e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv4_layout.ipv4), 730e3a2b7edSAmir Vadai &key->src, sizeof(key->src)); 731e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 732e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 733e3a2b7edSAmir Vadai &mask->dst, sizeof(mask->dst)); 734e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 735e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv4_layout.ipv4), 736e3a2b7edSAmir Vadai &key->dst, sizeof(key->dst)); 737de0af0bfSRoi Dayan 738de0af0bfSRoi Dayan if (mask->src || mask->dst) 739de0af0bfSRoi Dayan *min_inline = MLX5_INLINE_MODE_IP; 740e3a2b7edSAmir Vadai } 741e3a2b7edSAmir Vadai 742e3a2b7edSAmir Vadai if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) { 743e3a2b7edSAmir Vadai struct flow_dissector_key_ipv6_addrs *key = 744e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 745e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV6_ADDRS, 746e3a2b7edSAmir Vadai f->key); 747e3a2b7edSAmir Vadai struct flow_dissector_key_ipv6_addrs *mask = 748e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 749e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_IPV6_ADDRS, 750e3a2b7edSAmir Vadai f->mask); 751e3a2b7edSAmir Vadai 752e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 753e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 754e3a2b7edSAmir Vadai &mask->src, sizeof(mask->src)); 755e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 756e3a2b7edSAmir Vadai src_ipv4_src_ipv6.ipv6_layout.ipv6), 757e3a2b7edSAmir Vadai &key->src, sizeof(key->src)); 758e3a2b7edSAmir Vadai 759e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c, 760e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 761e3a2b7edSAmir Vadai &mask->dst, sizeof(mask->dst)); 762e3a2b7edSAmir Vadai memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v, 763e3a2b7edSAmir Vadai dst_ipv4_dst_ipv6.ipv6_layout.ipv6), 764e3a2b7edSAmir Vadai &key->dst, sizeof(key->dst)); 765de0af0bfSRoi Dayan 766de0af0bfSRoi Dayan if (ipv6_addr_type(&mask->src) != IPV6_ADDR_ANY || 767de0af0bfSRoi Dayan ipv6_addr_type(&mask->dst) != IPV6_ADDR_ANY) 768de0af0bfSRoi Dayan *min_inline = MLX5_INLINE_MODE_IP; 769e3a2b7edSAmir Vadai } 770e3a2b7edSAmir Vadai 771e3a2b7edSAmir Vadai if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_PORTS)) { 772e3a2b7edSAmir Vadai struct flow_dissector_key_ports *key = 773e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 774e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_PORTS, 775e3a2b7edSAmir Vadai f->key); 776e3a2b7edSAmir Vadai struct flow_dissector_key_ports *mask = 777e3a2b7edSAmir Vadai skb_flow_dissector_target(f->dissector, 778e3a2b7edSAmir Vadai FLOW_DISSECTOR_KEY_PORTS, 779e3a2b7edSAmir Vadai f->mask); 780e3a2b7edSAmir Vadai switch (ip_proto) { 781e3a2b7edSAmir Vadai case IPPROTO_TCP: 782e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 783e3a2b7edSAmir Vadai tcp_sport, ntohs(mask->src)); 784e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 785e3a2b7edSAmir Vadai tcp_sport, ntohs(key->src)); 786e3a2b7edSAmir Vadai 787e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 788e3a2b7edSAmir Vadai tcp_dport, ntohs(mask->dst)); 789e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 790e3a2b7edSAmir Vadai tcp_dport, ntohs(key->dst)); 791e3a2b7edSAmir Vadai break; 792e3a2b7edSAmir Vadai 793e3a2b7edSAmir Vadai case IPPROTO_UDP: 794e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 795e3a2b7edSAmir Vadai udp_sport, ntohs(mask->src)); 796e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 797e3a2b7edSAmir Vadai udp_sport, ntohs(key->src)); 798e3a2b7edSAmir Vadai 799e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_c, 800e3a2b7edSAmir Vadai udp_dport, ntohs(mask->dst)); 801e3a2b7edSAmir Vadai MLX5_SET(fte_match_set_lyr_2_4, headers_v, 802e3a2b7edSAmir Vadai udp_dport, ntohs(key->dst)); 803e3a2b7edSAmir Vadai break; 804e3a2b7edSAmir Vadai default: 805e3a2b7edSAmir Vadai netdev_err(priv->netdev, 806e3a2b7edSAmir Vadai "Only UDP and TCP transport are supported\n"); 807e3a2b7edSAmir Vadai return -EINVAL; 808e3a2b7edSAmir Vadai } 809de0af0bfSRoi Dayan 810de0af0bfSRoi Dayan if (mask->src || mask->dst) 811de0af0bfSRoi Dayan *min_inline = MLX5_INLINE_MODE_TCP_UDP; 812e3a2b7edSAmir Vadai } 813e3a2b7edSAmir Vadai 814fd7da28bSOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_IP)) { 815fd7da28bSOr Gerlitz struct flow_dissector_key_ip *key = 816fd7da28bSOr Gerlitz skb_flow_dissector_target(f->dissector, 817fd7da28bSOr Gerlitz FLOW_DISSECTOR_KEY_IP, 818fd7da28bSOr Gerlitz f->key); 819fd7da28bSOr Gerlitz struct flow_dissector_key_ip *mask = 820fd7da28bSOr Gerlitz skb_flow_dissector_target(f->dissector, 821fd7da28bSOr Gerlitz FLOW_DISSECTOR_KEY_IP, 822fd7da28bSOr Gerlitz f->mask); 823fd7da28bSOr Gerlitz 824fd7da28bSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_ecn, mask->tos & 0x3); 825fd7da28bSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_ecn, key->tos & 0x3); 826fd7da28bSOr Gerlitz 827fd7da28bSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_dscp, mask->tos >> 2); 828fd7da28bSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_dscp, key->tos >> 2); 829fd7da28bSOr Gerlitz 830fd7da28bSOr Gerlitz if (mask->tos) 831fd7da28bSOr Gerlitz *min_inline = MLX5_INLINE_MODE_IP; 832fd7da28bSOr Gerlitz 833fd7da28bSOr Gerlitz if (mask->ttl) /* currently not supported */ 834fd7da28bSOr Gerlitz return -EOPNOTSUPP; 835fd7da28bSOr Gerlitz } 836fd7da28bSOr Gerlitz 837e77834ecSOr Gerlitz if (dissector_uses_key(f->dissector, FLOW_DISSECTOR_KEY_TCP)) { 838e77834ecSOr Gerlitz struct flow_dissector_key_tcp *key = 839e77834ecSOr Gerlitz skb_flow_dissector_target(f->dissector, 840e77834ecSOr Gerlitz FLOW_DISSECTOR_KEY_TCP, 841e77834ecSOr Gerlitz f->key); 842e77834ecSOr Gerlitz struct flow_dissector_key_tcp *mask = 843e77834ecSOr Gerlitz skb_flow_dissector_target(f->dissector, 844e77834ecSOr Gerlitz FLOW_DISSECTOR_KEY_TCP, 845e77834ecSOr Gerlitz f->mask); 846e77834ecSOr Gerlitz 847e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_flags, 848e77834ecSOr Gerlitz ntohs(mask->flags)); 849e77834ecSOr Gerlitz MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_flags, 850e77834ecSOr Gerlitz ntohs(key->flags)); 851e77834ecSOr Gerlitz 852e77834ecSOr Gerlitz if (mask->flags) 853e77834ecSOr Gerlitz *min_inline = MLX5_INLINE_MODE_TCP_UDP; 854e77834ecSOr Gerlitz } 855e77834ecSOr Gerlitz 856e3a2b7edSAmir Vadai return 0; 857e3a2b7edSAmir Vadai } 858e3a2b7edSAmir Vadai 859de0af0bfSRoi Dayan static int parse_cls_flower(struct mlx5e_priv *priv, 86065ba8fb7SOr Gerlitz struct mlx5e_tc_flow *flow, 861de0af0bfSRoi Dayan struct mlx5_flow_spec *spec, 862de0af0bfSRoi Dayan struct tc_cls_flower_offload *f) 863de0af0bfSRoi Dayan { 864de0af0bfSRoi Dayan struct mlx5_core_dev *dev = priv->mdev; 865de0af0bfSRoi Dayan struct mlx5_eswitch *esw = dev->priv.eswitch; 8661d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 8671d447a39SSaeed Mahameed struct mlx5_eswitch_rep *rep; 868de0af0bfSRoi Dayan u8 min_inline; 869de0af0bfSRoi Dayan int err; 870de0af0bfSRoi Dayan 871de0af0bfSRoi Dayan err = __parse_cls_flower(priv, spec, f, &min_inline); 872de0af0bfSRoi Dayan 8731d447a39SSaeed Mahameed if (!err && (flow->flags & MLX5E_TC_FLOW_ESWITCH)) { 8741d447a39SSaeed Mahameed rep = rpriv->rep; 8751d447a39SSaeed Mahameed if (rep->vport != FDB_UPLINK_VPORT && 8761d447a39SSaeed Mahameed (esw->offloads.inline_mode != MLX5_INLINE_MODE_NONE && 8771d447a39SSaeed Mahameed esw->offloads.inline_mode < min_inline)) { 878de0af0bfSRoi Dayan netdev_warn(priv->netdev, 879de0af0bfSRoi Dayan "Flow is not offloaded due to min inline setting, required %d actual %d\n", 880de0af0bfSRoi Dayan min_inline, esw->offloads.inline_mode); 881de0af0bfSRoi Dayan return -EOPNOTSUPP; 882de0af0bfSRoi Dayan } 883de0af0bfSRoi Dayan } 884de0af0bfSRoi Dayan 885de0af0bfSRoi Dayan return err; 886de0af0bfSRoi Dayan } 887de0af0bfSRoi Dayan 888d79b6df6SOr Gerlitz struct pedit_headers { 889d79b6df6SOr Gerlitz struct ethhdr eth; 890d79b6df6SOr Gerlitz struct iphdr ip4; 891d79b6df6SOr Gerlitz struct ipv6hdr ip6; 892d79b6df6SOr Gerlitz struct tcphdr tcp; 893d79b6df6SOr Gerlitz struct udphdr udp; 894d79b6df6SOr Gerlitz }; 895d79b6df6SOr Gerlitz 896d79b6df6SOr Gerlitz static int pedit_header_offsets[] = { 897d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_ETH] = offsetof(struct pedit_headers, eth), 898d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_IP4] = offsetof(struct pedit_headers, ip4), 899d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_IP6] = offsetof(struct pedit_headers, ip6), 900d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_TCP] = offsetof(struct pedit_headers, tcp), 901d79b6df6SOr Gerlitz [TCA_PEDIT_KEY_EX_HDR_TYPE_UDP] = offsetof(struct pedit_headers, udp), 902d79b6df6SOr Gerlitz }; 903d79b6df6SOr Gerlitz 904d79b6df6SOr Gerlitz #define pedit_header(_ph, _htype) ((void *)(_ph) + pedit_header_offsets[_htype]) 905d79b6df6SOr Gerlitz 906d79b6df6SOr Gerlitz static int set_pedit_val(u8 hdr_type, u32 mask, u32 val, u32 offset, 907d79b6df6SOr Gerlitz struct pedit_headers *masks, 908d79b6df6SOr Gerlitz struct pedit_headers *vals) 909d79b6df6SOr Gerlitz { 910d79b6df6SOr Gerlitz u32 *curr_pmask, *curr_pval; 911d79b6df6SOr Gerlitz 912d79b6df6SOr Gerlitz if (hdr_type >= __PEDIT_HDR_TYPE_MAX) 913d79b6df6SOr Gerlitz goto out_err; 914d79b6df6SOr Gerlitz 915d79b6df6SOr Gerlitz curr_pmask = (u32 *)(pedit_header(masks, hdr_type) + offset); 916d79b6df6SOr Gerlitz curr_pval = (u32 *)(pedit_header(vals, hdr_type) + offset); 917d79b6df6SOr Gerlitz 918d79b6df6SOr Gerlitz if (*curr_pmask & mask) /* disallow acting twice on the same location */ 919d79b6df6SOr Gerlitz goto out_err; 920d79b6df6SOr Gerlitz 921d79b6df6SOr Gerlitz *curr_pmask |= mask; 922d79b6df6SOr Gerlitz *curr_pval |= (val & mask); 923d79b6df6SOr Gerlitz 924d79b6df6SOr Gerlitz return 0; 925d79b6df6SOr Gerlitz 926d79b6df6SOr Gerlitz out_err: 927d79b6df6SOr Gerlitz return -EOPNOTSUPP; 928d79b6df6SOr Gerlitz } 929d79b6df6SOr Gerlitz 930d79b6df6SOr Gerlitz struct mlx5_fields { 931d79b6df6SOr Gerlitz u8 field; 932d79b6df6SOr Gerlitz u8 size; 933d79b6df6SOr Gerlitz u32 offset; 934d79b6df6SOr Gerlitz }; 935d79b6df6SOr Gerlitz 936d79b6df6SOr Gerlitz static struct mlx5_fields fields[] = { 937d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_DMAC_47_16, 4, offsetof(struct pedit_headers, eth.h_dest[0])}, 938d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_DMAC_15_0, 2, offsetof(struct pedit_headers, eth.h_dest[4])}, 939d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_SMAC_47_16, 4, offsetof(struct pedit_headers, eth.h_source[0])}, 940d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_SMAC_15_0, 2, offsetof(struct pedit_headers, eth.h_source[4])}, 941d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_ETHERTYPE, 2, offsetof(struct pedit_headers, eth.h_proto)}, 942d79b6df6SOr Gerlitz 943d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_IP_DSCP, 1, offsetof(struct pedit_headers, ip4.tos)}, 944d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_IP_TTL, 1, offsetof(struct pedit_headers, ip4.ttl)}, 945d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_SIPV4, 4, offsetof(struct pedit_headers, ip4.saddr)}, 946d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_DIPV4, 4, offsetof(struct pedit_headers, ip4.daddr)}, 947d79b6df6SOr Gerlitz 948d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_SIPV6_127_96, 4, offsetof(struct pedit_headers, ip6.saddr.s6_addr32[0])}, 949d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_SIPV6_95_64, 4, offsetof(struct pedit_headers, ip6.saddr.s6_addr32[1])}, 950d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_SIPV6_63_32, 4, offsetof(struct pedit_headers, ip6.saddr.s6_addr32[2])}, 951d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_SIPV6_31_0, 4, offsetof(struct pedit_headers, ip6.saddr.s6_addr32[3])}, 952d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_DIPV6_127_96, 4, offsetof(struct pedit_headers, ip6.daddr.s6_addr32[0])}, 953d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_DIPV6_95_64, 4, offsetof(struct pedit_headers, ip6.daddr.s6_addr32[1])}, 954d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_DIPV6_63_32, 4, offsetof(struct pedit_headers, ip6.daddr.s6_addr32[2])}, 955d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_DIPV6_31_0, 4, offsetof(struct pedit_headers, ip6.daddr.s6_addr32[3])}, 956d79b6df6SOr Gerlitz 957d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_TCP_SPORT, 2, offsetof(struct pedit_headers, tcp.source)}, 958d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_TCP_DPORT, 2, offsetof(struct pedit_headers, tcp.dest)}, 959d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_TCP_FLAGS, 1, offsetof(struct pedit_headers, tcp.ack_seq) + 5}, 960d79b6df6SOr Gerlitz 961d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_UDP_SPORT, 2, offsetof(struct pedit_headers, udp.source)}, 962d79b6df6SOr Gerlitz {MLX5_ACTION_IN_FIELD_OUT_UDP_DPORT, 2, offsetof(struct pedit_headers, udp.dest)}, 963d79b6df6SOr Gerlitz }; 964d79b6df6SOr Gerlitz 965d79b6df6SOr Gerlitz /* On input attr->num_mod_hdr_actions tells how many HW actions can be parsed at 966d79b6df6SOr Gerlitz * max from the SW pedit action. On success, it says how many HW actions were 967d79b6df6SOr Gerlitz * actually parsed. 968d79b6df6SOr Gerlitz */ 969d79b6df6SOr Gerlitz static int offload_pedit_fields(struct pedit_headers *masks, 970d79b6df6SOr Gerlitz struct pedit_headers *vals, 971d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 972d79b6df6SOr Gerlitz { 973d79b6df6SOr Gerlitz struct pedit_headers *set_masks, *add_masks, *set_vals, *add_vals; 974d824bf3fSOr Gerlitz int i, action_size, nactions, max_actions, first, last, first_z; 975d79b6df6SOr Gerlitz void *s_masks_p, *a_masks_p, *vals_p; 976d79b6df6SOr Gerlitz struct mlx5_fields *f; 977d79b6df6SOr Gerlitz u8 cmd, field_bsize; 978e3ca4e05SOr Gerlitz u32 s_mask, a_mask; 979d79b6df6SOr Gerlitz unsigned long mask; 980d79b6df6SOr Gerlitz void *action; 981d79b6df6SOr Gerlitz 982d79b6df6SOr Gerlitz set_masks = &masks[TCA_PEDIT_KEY_EX_CMD_SET]; 983d79b6df6SOr Gerlitz add_masks = &masks[TCA_PEDIT_KEY_EX_CMD_ADD]; 984d79b6df6SOr Gerlitz set_vals = &vals[TCA_PEDIT_KEY_EX_CMD_SET]; 985d79b6df6SOr Gerlitz add_vals = &vals[TCA_PEDIT_KEY_EX_CMD_ADD]; 986d79b6df6SOr Gerlitz 987d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 988d79b6df6SOr Gerlitz action = parse_attr->mod_hdr_actions; 989d79b6df6SOr Gerlitz max_actions = parse_attr->num_mod_hdr_actions; 990d79b6df6SOr Gerlitz nactions = 0; 991d79b6df6SOr Gerlitz 992d79b6df6SOr Gerlitz for (i = 0; i < ARRAY_SIZE(fields); i++) { 993d79b6df6SOr Gerlitz f = &fields[i]; 994d79b6df6SOr Gerlitz /* avoid seeing bits set from previous iterations */ 995e3ca4e05SOr Gerlitz s_mask = 0; 996e3ca4e05SOr Gerlitz a_mask = 0; 997d79b6df6SOr Gerlitz 998d79b6df6SOr Gerlitz s_masks_p = (void *)set_masks + f->offset; 999d79b6df6SOr Gerlitz a_masks_p = (void *)add_masks + f->offset; 1000d79b6df6SOr Gerlitz 1001d79b6df6SOr Gerlitz memcpy(&s_mask, s_masks_p, f->size); 1002d79b6df6SOr Gerlitz memcpy(&a_mask, a_masks_p, f->size); 1003d79b6df6SOr Gerlitz 1004d79b6df6SOr Gerlitz if (!s_mask && !a_mask) /* nothing to offload here */ 1005d79b6df6SOr Gerlitz continue; 1006d79b6df6SOr Gerlitz 1007d79b6df6SOr Gerlitz if (s_mask && a_mask) { 1008d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: can't set and add to the same HW field (%x)\n", f->field); 1009d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1010d79b6df6SOr Gerlitz } 1011d79b6df6SOr Gerlitz 1012d79b6df6SOr Gerlitz if (nactions == max_actions) { 1013d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: parsed %d pedit actions, can't do more\n", nactions); 1014d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1015d79b6df6SOr Gerlitz } 1016d79b6df6SOr Gerlitz 1017d79b6df6SOr Gerlitz if (s_mask) { 1018d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_SET; 1019d79b6df6SOr Gerlitz mask = s_mask; 1020d79b6df6SOr Gerlitz vals_p = (void *)set_vals + f->offset; 1021d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 1022d79b6df6SOr Gerlitz memset(s_masks_p, 0, f->size); 1023d79b6df6SOr Gerlitz } else { 1024d79b6df6SOr Gerlitz cmd = MLX5_ACTION_TYPE_ADD; 1025d79b6df6SOr Gerlitz mask = a_mask; 1026d79b6df6SOr Gerlitz vals_p = (void *)add_vals + f->offset; 1027d79b6df6SOr Gerlitz /* clear to denote we consumed this field */ 1028d79b6df6SOr Gerlitz memset(a_masks_p, 0, f->size); 1029d79b6df6SOr Gerlitz } 1030d79b6df6SOr Gerlitz 1031d79b6df6SOr Gerlitz field_bsize = f->size * BITS_PER_BYTE; 1032e3ca4e05SOr Gerlitz 1033d824bf3fSOr Gerlitz first_z = find_first_zero_bit(&mask, field_bsize); 1034d79b6df6SOr Gerlitz first = find_first_bit(&mask, field_bsize); 1035d79b6df6SOr Gerlitz last = find_last_bit(&mask, field_bsize); 1036d824bf3fSOr Gerlitz if (first > 0 || last != (field_bsize - 1) || first_z < last) { 1037d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: partial rewrite (mask %lx) is currently not offloaded\n", 1038d79b6df6SOr Gerlitz mask); 1039d79b6df6SOr Gerlitz return -EOPNOTSUPP; 1040d79b6df6SOr Gerlitz } 1041d79b6df6SOr Gerlitz 1042d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, action_type, cmd); 1043d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, field, f->field); 1044d79b6df6SOr Gerlitz 1045d79b6df6SOr Gerlitz if (cmd == MLX5_ACTION_TYPE_SET) { 1046d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, offset, 0); 1047d79b6df6SOr Gerlitz /* length is num of bits to be written, zero means length of 32 */ 1048d79b6df6SOr Gerlitz MLX5_SET(set_action_in, action, length, field_bsize); 1049d79b6df6SOr Gerlitz } 1050d79b6df6SOr Gerlitz 1051d79b6df6SOr Gerlitz if (field_bsize == 32) 1052e3ca4e05SOr Gerlitz MLX5_SET(set_action_in, action, data, ntohl(*(__be32 *)vals_p)); 1053d79b6df6SOr Gerlitz else if (field_bsize == 16) 1054e3ca4e05SOr Gerlitz MLX5_SET(set_action_in, action, data, ntohs(*(__be16 *)vals_p)); 1055d79b6df6SOr Gerlitz else if (field_bsize == 8) 1056e3ca4e05SOr Gerlitz MLX5_SET(set_action_in, action, data, *(u8 *)vals_p); 1057d79b6df6SOr Gerlitz 1058d79b6df6SOr Gerlitz action += action_size; 1059d79b6df6SOr Gerlitz nactions++; 1060d79b6df6SOr Gerlitz } 1061d79b6df6SOr Gerlitz 1062d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = nactions; 1063d79b6df6SOr Gerlitz return 0; 1064d79b6df6SOr Gerlitz } 1065d79b6df6SOr Gerlitz 1066d79b6df6SOr Gerlitz static int alloc_mod_hdr_actions(struct mlx5e_priv *priv, 1067d79b6df6SOr Gerlitz const struct tc_action *a, int namespace, 1068d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 1069d79b6df6SOr Gerlitz { 1070d79b6df6SOr Gerlitz int nkeys, action_size, max_actions; 1071d79b6df6SOr Gerlitz 1072d79b6df6SOr Gerlitz nkeys = tcf_pedit_nkeys(a); 1073d79b6df6SOr Gerlitz action_size = MLX5_UN_SZ_BYTES(set_action_in_add_action_in_auto); 1074d79b6df6SOr Gerlitz 1075d79b6df6SOr Gerlitz if (namespace == MLX5_FLOW_NAMESPACE_FDB) /* FDB offloading */ 1076d79b6df6SOr Gerlitz max_actions = MLX5_CAP_ESW_FLOWTABLE_FDB(priv->mdev, max_modify_header_actions); 1077d79b6df6SOr Gerlitz else /* namespace is MLX5_FLOW_NAMESPACE_KERNEL - NIC offloading */ 1078d79b6df6SOr Gerlitz max_actions = MLX5_CAP_FLOWTABLE_NIC_RX(priv->mdev, max_modify_header_actions); 1079d79b6df6SOr Gerlitz 1080d79b6df6SOr Gerlitz /* can get up to crazingly 16 HW actions in 32 bits pedit SW key */ 1081d79b6df6SOr Gerlitz max_actions = min(max_actions, nkeys * 16); 1082d79b6df6SOr Gerlitz 1083d79b6df6SOr Gerlitz parse_attr->mod_hdr_actions = kcalloc(max_actions, action_size, GFP_KERNEL); 1084d79b6df6SOr Gerlitz if (!parse_attr->mod_hdr_actions) 1085d79b6df6SOr Gerlitz return -ENOMEM; 1086d79b6df6SOr Gerlitz 1087d79b6df6SOr Gerlitz parse_attr->num_mod_hdr_actions = max_actions; 1088d79b6df6SOr Gerlitz return 0; 1089d79b6df6SOr Gerlitz } 1090d79b6df6SOr Gerlitz 1091d79b6df6SOr Gerlitz static const struct pedit_headers zero_masks = {}; 1092d79b6df6SOr Gerlitz 1093d79b6df6SOr Gerlitz static int parse_tc_pedit_action(struct mlx5e_priv *priv, 1094d79b6df6SOr Gerlitz const struct tc_action *a, int namespace, 1095d79b6df6SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr) 1096d79b6df6SOr Gerlitz { 1097d79b6df6SOr Gerlitz struct pedit_headers masks[__PEDIT_CMD_MAX], vals[__PEDIT_CMD_MAX], *cmd_masks; 1098d79b6df6SOr Gerlitz int nkeys, i, err = -EOPNOTSUPP; 1099d79b6df6SOr Gerlitz u32 mask, val, offset; 1100d79b6df6SOr Gerlitz u8 cmd, htype; 1101d79b6df6SOr Gerlitz 1102d79b6df6SOr Gerlitz nkeys = tcf_pedit_nkeys(a); 1103d79b6df6SOr Gerlitz 1104d79b6df6SOr Gerlitz memset(masks, 0, sizeof(struct pedit_headers) * __PEDIT_CMD_MAX); 1105d79b6df6SOr Gerlitz memset(vals, 0, sizeof(struct pedit_headers) * __PEDIT_CMD_MAX); 1106d79b6df6SOr Gerlitz 1107d79b6df6SOr Gerlitz for (i = 0; i < nkeys; i++) { 1108d79b6df6SOr Gerlitz htype = tcf_pedit_htype(a, i); 1109d79b6df6SOr Gerlitz cmd = tcf_pedit_cmd(a, i); 1110d79b6df6SOr Gerlitz err = -EOPNOTSUPP; /* can't be all optimistic */ 1111d79b6df6SOr Gerlitz 1112d79b6df6SOr Gerlitz if (htype == TCA_PEDIT_KEY_EX_HDR_TYPE_NETWORK) { 1113d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: legacy pedit isn't offloaded\n"); 1114d79b6df6SOr Gerlitz goto out_err; 1115d79b6df6SOr Gerlitz } 1116d79b6df6SOr Gerlitz 1117d79b6df6SOr Gerlitz if (cmd != TCA_PEDIT_KEY_EX_CMD_SET && cmd != TCA_PEDIT_KEY_EX_CMD_ADD) { 1118d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: pedit cmd %d isn't offloaded\n", cmd); 1119d79b6df6SOr Gerlitz goto out_err; 1120d79b6df6SOr Gerlitz } 1121d79b6df6SOr Gerlitz 1122d79b6df6SOr Gerlitz mask = tcf_pedit_mask(a, i); 1123d79b6df6SOr Gerlitz val = tcf_pedit_val(a, i); 1124d79b6df6SOr Gerlitz offset = tcf_pedit_offset(a, i); 1125d79b6df6SOr Gerlitz 1126d79b6df6SOr Gerlitz err = set_pedit_val(htype, ~mask, val, offset, &masks[cmd], &vals[cmd]); 1127d79b6df6SOr Gerlitz if (err) 1128d79b6df6SOr Gerlitz goto out_err; 1129d79b6df6SOr Gerlitz } 1130d79b6df6SOr Gerlitz 1131d79b6df6SOr Gerlitz err = alloc_mod_hdr_actions(priv, a, namespace, parse_attr); 1132d79b6df6SOr Gerlitz if (err) 1133d79b6df6SOr Gerlitz goto out_err; 1134d79b6df6SOr Gerlitz 1135d79b6df6SOr Gerlitz err = offload_pedit_fields(masks, vals, parse_attr); 1136d79b6df6SOr Gerlitz if (err < 0) 1137d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 1138d79b6df6SOr Gerlitz 1139d79b6df6SOr Gerlitz for (cmd = 0; cmd < __PEDIT_CMD_MAX; cmd++) { 1140d79b6df6SOr Gerlitz cmd_masks = &masks[cmd]; 1141d79b6df6SOr Gerlitz if (memcmp(cmd_masks, &zero_masks, sizeof(zero_masks))) { 1142d79b6df6SOr Gerlitz printk(KERN_WARNING "mlx5: attempt to offload an unsupported field (cmd %d)\n", 1143d79b6df6SOr Gerlitz cmd); 1144d79b6df6SOr Gerlitz print_hex_dump(KERN_WARNING, "mask: ", DUMP_PREFIX_ADDRESS, 1145d79b6df6SOr Gerlitz 16, 1, cmd_masks, sizeof(zero_masks), true); 1146d79b6df6SOr Gerlitz err = -EOPNOTSUPP; 1147d79b6df6SOr Gerlitz goto out_dealloc_parsed_actions; 1148d79b6df6SOr Gerlitz } 1149d79b6df6SOr Gerlitz } 1150d79b6df6SOr Gerlitz 1151d79b6df6SOr Gerlitz return 0; 1152d79b6df6SOr Gerlitz 1153d79b6df6SOr Gerlitz out_dealloc_parsed_actions: 1154d79b6df6SOr Gerlitz kfree(parse_attr->mod_hdr_actions); 1155d79b6df6SOr Gerlitz out_err: 1156d79b6df6SOr Gerlitz return err; 1157d79b6df6SOr Gerlitz } 1158d79b6df6SOr Gerlitz 115926c02749SOr Gerlitz static bool csum_offload_supported(struct mlx5e_priv *priv, u32 action, u32 update_flags) 116026c02749SOr Gerlitz { 116126c02749SOr Gerlitz u32 prot_flags = TCA_CSUM_UPDATE_FLAG_IPV4HDR | TCA_CSUM_UPDATE_FLAG_TCP | 116226c02749SOr Gerlitz TCA_CSUM_UPDATE_FLAG_UDP; 116326c02749SOr Gerlitz 116426c02749SOr Gerlitz /* The HW recalcs checksums only if re-writing headers */ 116526c02749SOr Gerlitz if (!(action & MLX5_FLOW_CONTEXT_ACTION_MOD_HDR)) { 116626c02749SOr Gerlitz netdev_warn(priv->netdev, 116726c02749SOr Gerlitz "TC csum action is only offloaded with pedit\n"); 116826c02749SOr Gerlitz return false; 116926c02749SOr Gerlitz } 117026c02749SOr Gerlitz 117126c02749SOr Gerlitz if (update_flags & ~prot_flags) { 117226c02749SOr Gerlitz netdev_warn(priv->netdev, 117326c02749SOr Gerlitz "can't offload TC csum action for some header/s - flags %#x\n", 117426c02749SOr Gerlitz update_flags); 117526c02749SOr Gerlitz return false; 117626c02749SOr Gerlitz } 117726c02749SOr Gerlitz 117826c02749SOr Gerlitz return true; 117926c02749SOr Gerlitz } 118026c02749SOr Gerlitz 11815c40348cSOr Gerlitz static int parse_tc_nic_actions(struct mlx5e_priv *priv, struct tcf_exts *exts, 1182aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 1183aa0cbbaeSOr Gerlitz struct mlx5e_tc_flow *flow) 1184e3a2b7edSAmir Vadai { 1185aa0cbbaeSOr Gerlitz struct mlx5_nic_flow_attr *attr = flow->nic_attr; 1186e3a2b7edSAmir Vadai const struct tc_action *a; 118722dc13c8SWANG Cong LIST_HEAD(actions); 11882f4fe4caSOr Gerlitz int err; 1189e3a2b7edSAmir Vadai 1190e3a2b7edSAmir Vadai if (tc_no_actions(exts)) 1191e3a2b7edSAmir Vadai return -EINVAL; 1192e3a2b7edSAmir Vadai 11933bc4b7bfSOr Gerlitz attr->flow_tag = MLX5_FS_DEFAULT_FLOW_TAG; 11943bc4b7bfSOr Gerlitz attr->action = 0; 1195e3a2b7edSAmir Vadai 119622dc13c8SWANG Cong tcf_exts_to_list(exts, &actions); 119722dc13c8SWANG Cong list_for_each_entry(a, &actions, list) { 1198e3a2b7edSAmir Vadai if (is_tcf_gact_shot(a)) { 11993bc4b7bfSOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_DROP; 1200aad7e08dSAmir Vadai if (MLX5_CAP_FLOWTABLE(priv->mdev, 1201aad7e08dSAmir Vadai flow_table_properties_nic_receive.flow_counter)) 12023bc4b7bfSOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_COUNT; 1203e3a2b7edSAmir Vadai continue; 1204e3a2b7edSAmir Vadai } 1205e3a2b7edSAmir Vadai 12062f4fe4caSOr Gerlitz if (is_tcf_pedit(a)) { 12072f4fe4caSOr Gerlitz err = parse_tc_pedit_action(priv, a, MLX5_FLOW_NAMESPACE_KERNEL, 12082f4fe4caSOr Gerlitz parse_attr); 12092f4fe4caSOr Gerlitz if (err) 12102f4fe4caSOr Gerlitz return err; 12112f4fe4caSOr Gerlitz 12122f4fe4caSOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR | 12132f4fe4caSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 12142f4fe4caSOr Gerlitz continue; 12152f4fe4caSOr Gerlitz } 12162f4fe4caSOr Gerlitz 121726c02749SOr Gerlitz if (is_tcf_csum(a)) { 121826c02749SOr Gerlitz if (csum_offload_supported(priv, attr->action, 121926c02749SOr Gerlitz tcf_csum_update_flags(a))) 122026c02749SOr Gerlitz continue; 122126c02749SOr Gerlitz 122226c02749SOr Gerlitz return -EOPNOTSUPP; 122326c02749SOr Gerlitz } 122426c02749SOr Gerlitz 1225e3a2b7edSAmir Vadai if (is_tcf_skbedit_mark(a)) { 1226e3a2b7edSAmir Vadai u32 mark = tcf_skbedit_mark(a); 1227e3a2b7edSAmir Vadai 1228e3a2b7edSAmir Vadai if (mark & ~MLX5E_TC_FLOW_ID_MASK) { 1229e3a2b7edSAmir Vadai netdev_warn(priv->netdev, "Bad flow mark - only 16 bit is supported: 0x%x\n", 1230e3a2b7edSAmir Vadai mark); 1231e3a2b7edSAmir Vadai return -EINVAL; 1232e3a2b7edSAmir Vadai } 1233e3a2b7edSAmir Vadai 12343bc4b7bfSOr Gerlitz attr->flow_tag = mark; 12353bc4b7bfSOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST; 1236e3a2b7edSAmir Vadai continue; 1237e3a2b7edSAmir Vadai } 1238e3a2b7edSAmir Vadai 1239e3a2b7edSAmir Vadai return -EINVAL; 1240e3a2b7edSAmir Vadai } 1241e3a2b7edSAmir Vadai 1242e3a2b7edSAmir Vadai return 0; 1243e3a2b7edSAmir Vadai } 1244e3a2b7edSAmir Vadai 124576f7444dSOr Gerlitz static inline int cmp_encap_info(struct ip_tunnel_key *a, 124676f7444dSOr Gerlitz struct ip_tunnel_key *b) 1247a54e20b4SHadar Hen Zion { 1248a54e20b4SHadar Hen Zion return memcmp(a, b, sizeof(*a)); 1249a54e20b4SHadar Hen Zion } 1250a54e20b4SHadar Hen Zion 125176f7444dSOr Gerlitz static inline int hash_encap_info(struct ip_tunnel_key *key) 1252a54e20b4SHadar Hen Zion { 125376f7444dSOr Gerlitz return jhash(key, sizeof(*key), 0); 1254a54e20b4SHadar Hen Zion } 1255a54e20b4SHadar Hen Zion 1256a54e20b4SHadar Hen Zion static int mlx5e_route_lookup_ipv4(struct mlx5e_priv *priv, 1257a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 1258a54e20b4SHadar Hen Zion struct net_device **out_dev, 1259a54e20b4SHadar Hen Zion struct flowi4 *fl4, 1260a54e20b4SHadar Hen Zion struct neighbour **out_n, 1261a54e20b4SHadar Hen Zion int *out_ttl) 1262a54e20b4SHadar Hen Zion { 12633e621b19SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 1264a54e20b4SHadar Hen Zion struct rtable *rt; 1265a54e20b4SHadar Hen Zion struct neighbour *n = NULL; 1266a54e20b4SHadar Hen Zion 1267a54e20b4SHadar Hen Zion #if IS_ENABLED(CONFIG_INET) 1268abeffce9SArnd Bergmann int ret; 1269abeffce9SArnd Bergmann 1270a54e20b4SHadar Hen Zion rt = ip_route_output_key(dev_net(mirred_dev), fl4); 1271abeffce9SArnd Bergmann ret = PTR_ERR_OR_ZERO(rt); 1272abeffce9SArnd Bergmann if (ret) 1273abeffce9SArnd Bergmann return ret; 1274a54e20b4SHadar Hen Zion #else 1275a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 1276a54e20b4SHadar Hen Zion #endif 12773e621b19SHadar Hen Zion /* if the egress device isn't on the same HW e-switch, we use the uplink */ 12783e621b19SHadar Hen Zion if (!switchdev_port_same_parent_id(priv->netdev, rt->dst.dev)) 12793e621b19SHadar Hen Zion *out_dev = mlx5_eswitch_get_uplink_netdev(esw); 12803e621b19SHadar Hen Zion else 12813e621b19SHadar Hen Zion *out_dev = rt->dst.dev; 1282a54e20b4SHadar Hen Zion 128375c33da8SOr Gerlitz *out_ttl = ip4_dst_hoplimit(&rt->dst); 1284a54e20b4SHadar Hen Zion n = dst_neigh_lookup(&rt->dst, &fl4->daddr); 1285a54e20b4SHadar Hen Zion ip_rt_put(rt); 1286a54e20b4SHadar Hen Zion if (!n) 1287a54e20b4SHadar Hen Zion return -ENOMEM; 1288a54e20b4SHadar Hen Zion 1289a54e20b4SHadar Hen Zion *out_n = n; 1290a54e20b4SHadar Hen Zion return 0; 1291a54e20b4SHadar Hen Zion } 1292a54e20b4SHadar Hen Zion 1293ce99f6b9SOr Gerlitz static int mlx5e_route_lookup_ipv6(struct mlx5e_priv *priv, 1294ce99f6b9SOr Gerlitz struct net_device *mirred_dev, 1295ce99f6b9SOr Gerlitz struct net_device **out_dev, 1296ce99f6b9SOr Gerlitz struct flowi6 *fl6, 1297ce99f6b9SOr Gerlitz struct neighbour **out_n, 1298ce99f6b9SOr Gerlitz int *out_ttl) 1299ce99f6b9SOr Gerlitz { 1300ce99f6b9SOr Gerlitz struct neighbour *n = NULL; 1301ce99f6b9SOr Gerlitz struct dst_entry *dst; 1302ce99f6b9SOr Gerlitz 1303ce99f6b9SOr Gerlitz #if IS_ENABLED(CONFIG_INET) && IS_ENABLED(CONFIG_IPV6) 1304ce99f6b9SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 1305ce99f6b9SOr Gerlitz int ret; 1306ce99f6b9SOr Gerlitz 1307ce99f6b9SOr Gerlitz dst = ip6_route_output(dev_net(mirred_dev), NULL, fl6); 1308ce99f6b9SOr Gerlitz ret = dst->error; 1309321fa4ffSArnd Bergmann if (ret) { 1310ce99f6b9SOr Gerlitz dst_release(dst); 1311ce99f6b9SOr Gerlitz return ret; 1312ce99f6b9SOr Gerlitz } 1313ce99f6b9SOr Gerlitz 1314ce99f6b9SOr Gerlitz *out_ttl = ip6_dst_hoplimit(dst); 1315ce99f6b9SOr Gerlitz 1316ce99f6b9SOr Gerlitz /* if the egress device isn't on the same HW e-switch, we use the uplink */ 1317ce99f6b9SOr Gerlitz if (!switchdev_port_same_parent_id(priv->netdev, dst->dev)) 1318ce99f6b9SOr Gerlitz *out_dev = mlx5_eswitch_get_uplink_netdev(esw); 1319ce99f6b9SOr Gerlitz else 1320ce99f6b9SOr Gerlitz *out_dev = dst->dev; 1321ce99f6b9SOr Gerlitz #else 1322ce99f6b9SOr Gerlitz return -EOPNOTSUPP; 1323ce99f6b9SOr Gerlitz #endif 1324ce99f6b9SOr Gerlitz 1325ce99f6b9SOr Gerlitz n = dst_neigh_lookup(dst, &fl6->daddr); 1326ce99f6b9SOr Gerlitz dst_release(dst); 1327ce99f6b9SOr Gerlitz if (!n) 1328ce99f6b9SOr Gerlitz return -ENOMEM; 1329ce99f6b9SOr Gerlitz 1330ce99f6b9SOr Gerlitz *out_n = n; 1331ce99f6b9SOr Gerlitz return 0; 1332ce99f6b9SOr Gerlitz } 1333ce99f6b9SOr Gerlitz 133432f3671fSOr Gerlitz static void gen_vxlan_header_ipv4(struct net_device *out_dev, 133532f3671fSOr Gerlitz char buf[], int encap_size, 1336a54e20b4SHadar Hen Zion unsigned char h_dest[ETH_ALEN], 1337a54e20b4SHadar Hen Zion int ttl, 1338a54e20b4SHadar Hen Zion __be32 daddr, 1339a54e20b4SHadar Hen Zion __be32 saddr, 1340a54e20b4SHadar Hen Zion __be16 udp_dst_port, 1341a54e20b4SHadar Hen Zion __be32 vx_vni) 1342a54e20b4SHadar Hen Zion { 1343a54e20b4SHadar Hen Zion struct ethhdr *eth = (struct ethhdr *)buf; 1344a54e20b4SHadar Hen Zion struct iphdr *ip = (struct iphdr *)((char *)eth + sizeof(struct ethhdr)); 1345a54e20b4SHadar Hen Zion struct udphdr *udp = (struct udphdr *)((char *)ip + sizeof(struct iphdr)); 1346a54e20b4SHadar Hen Zion struct vxlanhdr *vxh = (struct vxlanhdr *)((char *)udp + sizeof(struct udphdr)); 1347a54e20b4SHadar Hen Zion 1348a54e20b4SHadar Hen Zion memset(buf, 0, encap_size); 1349a54e20b4SHadar Hen Zion 1350a54e20b4SHadar Hen Zion ether_addr_copy(eth->h_dest, h_dest); 1351a54e20b4SHadar Hen Zion ether_addr_copy(eth->h_source, out_dev->dev_addr); 1352a54e20b4SHadar Hen Zion eth->h_proto = htons(ETH_P_IP); 1353a54e20b4SHadar Hen Zion 1354a54e20b4SHadar Hen Zion ip->daddr = daddr; 1355a54e20b4SHadar Hen Zion ip->saddr = saddr; 1356a54e20b4SHadar Hen Zion 1357a54e20b4SHadar Hen Zion ip->ttl = ttl; 1358a54e20b4SHadar Hen Zion ip->protocol = IPPROTO_UDP; 1359a54e20b4SHadar Hen Zion ip->version = 0x4; 1360a54e20b4SHadar Hen Zion ip->ihl = 0x5; 1361a54e20b4SHadar Hen Zion 1362a54e20b4SHadar Hen Zion udp->dest = udp_dst_port; 1363a54e20b4SHadar Hen Zion vxh->vx_flags = VXLAN_HF_VNI; 1364a54e20b4SHadar Hen Zion vxh->vx_vni = vxlan_vni_field(vx_vni); 1365a54e20b4SHadar Hen Zion } 1366a54e20b4SHadar Hen Zion 1367225aabafSOr Gerlitz static void gen_vxlan_header_ipv6(struct net_device *out_dev, 1368225aabafSOr Gerlitz char buf[], int encap_size, 1369ce99f6b9SOr Gerlitz unsigned char h_dest[ETH_ALEN], 1370ce99f6b9SOr Gerlitz int ttl, 1371ce99f6b9SOr Gerlitz struct in6_addr *daddr, 1372ce99f6b9SOr Gerlitz struct in6_addr *saddr, 1373ce99f6b9SOr Gerlitz __be16 udp_dst_port, 1374ce99f6b9SOr Gerlitz __be32 vx_vni) 1375ce99f6b9SOr Gerlitz { 1376ce99f6b9SOr Gerlitz struct ethhdr *eth = (struct ethhdr *)buf; 1377ce99f6b9SOr Gerlitz struct ipv6hdr *ip6h = (struct ipv6hdr *)((char *)eth + sizeof(struct ethhdr)); 1378ce99f6b9SOr Gerlitz struct udphdr *udp = (struct udphdr *)((char *)ip6h + sizeof(struct ipv6hdr)); 1379ce99f6b9SOr Gerlitz struct vxlanhdr *vxh = (struct vxlanhdr *)((char *)udp + sizeof(struct udphdr)); 1380ce99f6b9SOr Gerlitz 1381ce99f6b9SOr Gerlitz memset(buf, 0, encap_size); 1382ce99f6b9SOr Gerlitz 1383ce99f6b9SOr Gerlitz ether_addr_copy(eth->h_dest, h_dest); 1384ce99f6b9SOr Gerlitz ether_addr_copy(eth->h_source, out_dev->dev_addr); 1385ce99f6b9SOr Gerlitz eth->h_proto = htons(ETH_P_IPV6); 1386ce99f6b9SOr Gerlitz 1387ce99f6b9SOr Gerlitz ip6_flow_hdr(ip6h, 0, 0); 1388ce99f6b9SOr Gerlitz /* the HW fills up ipv6 payload len */ 1389ce99f6b9SOr Gerlitz ip6h->nexthdr = IPPROTO_UDP; 1390ce99f6b9SOr Gerlitz ip6h->hop_limit = ttl; 1391ce99f6b9SOr Gerlitz ip6h->daddr = *daddr; 1392ce99f6b9SOr Gerlitz ip6h->saddr = *saddr; 1393ce99f6b9SOr Gerlitz 1394ce99f6b9SOr Gerlitz udp->dest = udp_dst_port; 1395ce99f6b9SOr Gerlitz vxh->vx_flags = VXLAN_HF_VNI; 1396ce99f6b9SOr Gerlitz vxh->vx_vni = vxlan_vni_field(vx_vni); 1397ce99f6b9SOr Gerlitz } 1398ce99f6b9SOr Gerlitz 1399a54e20b4SHadar Hen Zion static int mlx5e_create_encap_header_ipv4(struct mlx5e_priv *priv, 1400a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 14011a8552bdSHadar Hen Zion struct mlx5e_encap_entry *e) 1402a54e20b4SHadar Hen Zion { 1403a54e20b4SHadar Hen Zion int max_encap_size = MLX5_CAP_ESW(priv->mdev, max_encap_header_size); 140432f3671fSOr Gerlitz int ipv4_encap_size = ETH_HLEN + sizeof(struct iphdr) + VXLAN_HLEN; 140576f7444dSOr Gerlitz struct ip_tunnel_key *tun_key = &e->tun_info.key; 14061a8552bdSHadar Hen Zion struct net_device *out_dev; 1407a42485ebSOr Gerlitz struct neighbour *n = NULL; 1408a54e20b4SHadar Hen Zion struct flowi4 fl4 = {}; 1409a54e20b4SHadar Hen Zion char *encap_header; 141032f3671fSOr Gerlitz int ttl, err; 1411033354d5SHadar Hen Zion u8 nud_state; 1412a54e20b4SHadar Hen Zion 141332f3671fSOr Gerlitz if (max_encap_size < ipv4_encap_size) { 141432f3671fSOr Gerlitz mlx5_core_warn(priv->mdev, "encap size %d too big, max supported is %d\n", 141532f3671fSOr Gerlitz ipv4_encap_size, max_encap_size); 141632f3671fSOr Gerlitz return -EOPNOTSUPP; 141732f3671fSOr Gerlitz } 141832f3671fSOr Gerlitz 141932f3671fSOr Gerlitz encap_header = kzalloc(ipv4_encap_size, GFP_KERNEL); 1420a54e20b4SHadar Hen Zion if (!encap_header) 1421a54e20b4SHadar Hen Zion return -ENOMEM; 1422a54e20b4SHadar Hen Zion 1423a54e20b4SHadar Hen Zion switch (e->tunnel_type) { 1424a54e20b4SHadar Hen Zion case MLX5_HEADER_TYPE_VXLAN: 1425a54e20b4SHadar Hen Zion fl4.flowi4_proto = IPPROTO_UDP; 142676f7444dSOr Gerlitz fl4.fl4_dport = tun_key->tp_dst; 1427a54e20b4SHadar Hen Zion break; 1428a54e20b4SHadar Hen Zion default: 1429a54e20b4SHadar Hen Zion err = -EOPNOTSUPP; 1430a54e20b4SHadar Hen Zion goto out; 1431a54e20b4SHadar Hen Zion } 14329a941117SOr Gerlitz fl4.flowi4_tos = tun_key->tos; 143376f7444dSOr Gerlitz fl4.daddr = tun_key->u.ipv4.dst; 14349a941117SOr Gerlitz fl4.saddr = tun_key->u.ipv4.src; 1435a54e20b4SHadar Hen Zion 14361a8552bdSHadar Hen Zion err = mlx5e_route_lookup_ipv4(priv, mirred_dev, &out_dev, 14379a941117SOr Gerlitz &fl4, &n, &ttl); 1438a54e20b4SHadar Hen Zion if (err) 1439a54e20b4SHadar Hen Zion goto out; 1440a54e20b4SHadar Hen Zion 1441232c0013SHadar Hen Zion /* used by mlx5e_detach_encap to lookup a neigh hash table 1442232c0013SHadar Hen Zion * entry in the neigh hash table when a user deletes a rule 1443232c0013SHadar Hen Zion */ 1444232c0013SHadar Hen Zion e->m_neigh.dev = n->dev; 1445f6dfb4c3SHadar Hen Zion e->m_neigh.family = n->ops->family; 1446232c0013SHadar Hen Zion memcpy(&e->m_neigh.dst_ip, n->primary_key, n->tbl->key_len); 1447232c0013SHadar Hen Zion e->out_dev = out_dev; 1448232c0013SHadar Hen Zion 1449232c0013SHadar Hen Zion /* It's importent to add the neigh to the hash table before checking 1450232c0013SHadar Hen Zion * the neigh validity state. So if we'll get a notification, in case the 1451232c0013SHadar Hen Zion * neigh changes it's validity state, we would find the relevant neigh 1452232c0013SHadar Hen Zion * in the hash. 1453232c0013SHadar Hen Zion */ 1454232c0013SHadar Hen Zion err = mlx5e_rep_encap_entry_attach(netdev_priv(out_dev), e); 1455232c0013SHadar Hen Zion if (err) 1456232c0013SHadar Hen Zion goto out; 1457232c0013SHadar Hen Zion 1458033354d5SHadar Hen Zion read_lock_bh(&n->lock); 1459033354d5SHadar Hen Zion nud_state = n->nud_state; 1460033354d5SHadar Hen Zion ether_addr_copy(e->h_dest, n->ha); 1461033354d5SHadar Hen Zion read_unlock_bh(&n->lock); 1462033354d5SHadar Hen Zion 1463a54e20b4SHadar Hen Zion switch (e->tunnel_type) { 1464a54e20b4SHadar Hen Zion case MLX5_HEADER_TYPE_VXLAN: 14651a8552bdSHadar Hen Zion gen_vxlan_header_ipv4(out_dev, encap_header, 146632f3671fSOr Gerlitz ipv4_encap_size, e->h_dest, ttl, 14679a941117SOr Gerlitz fl4.daddr, 14689a941117SOr Gerlitz fl4.saddr, tun_key->tp_dst, 146976f7444dSOr Gerlitz tunnel_id_to_key32(tun_key->tun_id)); 1470a54e20b4SHadar Hen Zion break; 1471a54e20b4SHadar Hen Zion default: 1472a54e20b4SHadar Hen Zion err = -EOPNOTSUPP; 1473232c0013SHadar Hen Zion goto destroy_neigh_entry; 1474232c0013SHadar Hen Zion } 1475232c0013SHadar Hen Zion e->encap_size = ipv4_encap_size; 1476232c0013SHadar Hen Zion e->encap_header = encap_header; 1477232c0013SHadar Hen Zion 1478232c0013SHadar Hen Zion if (!(nud_state & NUD_VALID)) { 1479232c0013SHadar Hen Zion neigh_event_send(n, NULL); 148027902f08SWei Yongjun err = -EAGAIN; 148127902f08SWei Yongjun goto out; 1482a54e20b4SHadar Hen Zion } 1483a54e20b4SHadar Hen Zion 1484a54e20b4SHadar Hen Zion err = mlx5_encap_alloc(priv->mdev, e->tunnel_type, 148532f3671fSOr Gerlitz ipv4_encap_size, encap_header, &e->encap_id); 1486232c0013SHadar Hen Zion if (err) 1487232c0013SHadar Hen Zion goto destroy_neigh_entry; 1488232c0013SHadar Hen Zion 1489232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 1490f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(netdev_priv(out_dev)); 1491a42485ebSOr Gerlitz neigh_release(n); 1492232c0013SHadar Hen Zion return err; 1493232c0013SHadar Hen Zion 1494232c0013SHadar Hen Zion destroy_neigh_entry: 1495232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 1496232c0013SHadar Hen Zion out: 1497a54e20b4SHadar Hen Zion kfree(encap_header); 1498232c0013SHadar Hen Zion if (n) 1499232c0013SHadar Hen Zion neigh_release(n); 1500a54e20b4SHadar Hen Zion return err; 1501a54e20b4SHadar Hen Zion } 1502a54e20b4SHadar Hen Zion 1503ce99f6b9SOr Gerlitz static int mlx5e_create_encap_header_ipv6(struct mlx5e_priv *priv, 1504ce99f6b9SOr Gerlitz struct net_device *mirred_dev, 15051a8552bdSHadar Hen Zion struct mlx5e_encap_entry *e) 1506ce99f6b9SOr Gerlitz { 1507ce99f6b9SOr Gerlitz int max_encap_size = MLX5_CAP_ESW(priv->mdev, max_encap_header_size); 1508225aabafSOr Gerlitz int ipv6_encap_size = ETH_HLEN + sizeof(struct ipv6hdr) + VXLAN_HLEN; 1509ce99f6b9SOr Gerlitz struct ip_tunnel_key *tun_key = &e->tun_info.key; 15101a8552bdSHadar Hen Zion struct net_device *out_dev; 1511ce99f6b9SOr Gerlitz struct neighbour *n = NULL; 1512ce99f6b9SOr Gerlitz struct flowi6 fl6 = {}; 1513ce99f6b9SOr Gerlitz char *encap_header; 1514225aabafSOr Gerlitz int err, ttl = 0; 1515033354d5SHadar Hen Zion u8 nud_state; 1516ce99f6b9SOr Gerlitz 1517225aabafSOr Gerlitz if (max_encap_size < ipv6_encap_size) { 1518225aabafSOr Gerlitz mlx5_core_warn(priv->mdev, "encap size %d too big, max supported is %d\n", 1519225aabafSOr Gerlitz ipv6_encap_size, max_encap_size); 1520225aabafSOr Gerlitz return -EOPNOTSUPP; 1521225aabafSOr Gerlitz } 1522225aabafSOr Gerlitz 1523225aabafSOr Gerlitz encap_header = kzalloc(ipv6_encap_size, GFP_KERNEL); 1524ce99f6b9SOr Gerlitz if (!encap_header) 1525ce99f6b9SOr Gerlitz return -ENOMEM; 1526ce99f6b9SOr Gerlitz 1527ce99f6b9SOr Gerlitz switch (e->tunnel_type) { 1528ce99f6b9SOr Gerlitz case MLX5_HEADER_TYPE_VXLAN: 1529ce99f6b9SOr Gerlitz fl6.flowi6_proto = IPPROTO_UDP; 1530ce99f6b9SOr Gerlitz fl6.fl6_dport = tun_key->tp_dst; 1531ce99f6b9SOr Gerlitz break; 1532ce99f6b9SOr Gerlitz default: 1533ce99f6b9SOr Gerlitz err = -EOPNOTSUPP; 1534ce99f6b9SOr Gerlitz goto out; 1535ce99f6b9SOr Gerlitz } 1536ce99f6b9SOr Gerlitz 1537ce99f6b9SOr Gerlitz fl6.flowlabel = ip6_make_flowinfo(RT_TOS(tun_key->tos), tun_key->label); 1538ce99f6b9SOr Gerlitz fl6.daddr = tun_key->u.ipv6.dst; 1539ce99f6b9SOr Gerlitz fl6.saddr = tun_key->u.ipv6.src; 1540ce99f6b9SOr Gerlitz 15411a8552bdSHadar Hen Zion err = mlx5e_route_lookup_ipv6(priv, mirred_dev, &out_dev, 1542ce99f6b9SOr Gerlitz &fl6, &n, &ttl); 1543ce99f6b9SOr Gerlitz if (err) 1544ce99f6b9SOr Gerlitz goto out; 1545ce99f6b9SOr Gerlitz 1546232c0013SHadar Hen Zion /* used by mlx5e_detach_encap to lookup a neigh hash table 1547232c0013SHadar Hen Zion * entry in the neigh hash table when a user deletes a rule 1548232c0013SHadar Hen Zion */ 1549232c0013SHadar Hen Zion e->m_neigh.dev = n->dev; 1550f6dfb4c3SHadar Hen Zion e->m_neigh.family = n->ops->family; 1551232c0013SHadar Hen Zion memcpy(&e->m_neigh.dst_ip, n->primary_key, n->tbl->key_len); 1552232c0013SHadar Hen Zion e->out_dev = out_dev; 1553232c0013SHadar Hen Zion 1554232c0013SHadar Hen Zion /* It's importent to add the neigh to the hash table before checking 1555232c0013SHadar Hen Zion * the neigh validity state. So if we'll get a notification, in case the 1556232c0013SHadar Hen Zion * neigh changes it's validity state, we would find the relevant neigh 1557232c0013SHadar Hen Zion * in the hash. 1558232c0013SHadar Hen Zion */ 1559232c0013SHadar Hen Zion err = mlx5e_rep_encap_entry_attach(netdev_priv(out_dev), e); 1560232c0013SHadar Hen Zion if (err) 1561232c0013SHadar Hen Zion goto out; 1562232c0013SHadar Hen Zion 1563033354d5SHadar Hen Zion read_lock_bh(&n->lock); 1564033354d5SHadar Hen Zion nud_state = n->nud_state; 1565033354d5SHadar Hen Zion ether_addr_copy(e->h_dest, n->ha); 1566033354d5SHadar Hen Zion read_unlock_bh(&n->lock); 1567033354d5SHadar Hen Zion 1568ce99f6b9SOr Gerlitz switch (e->tunnel_type) { 1569ce99f6b9SOr Gerlitz case MLX5_HEADER_TYPE_VXLAN: 15701a8552bdSHadar Hen Zion gen_vxlan_header_ipv6(out_dev, encap_header, 1571225aabafSOr Gerlitz ipv6_encap_size, e->h_dest, ttl, 1572ce99f6b9SOr Gerlitz &fl6.daddr, 1573ce99f6b9SOr Gerlitz &fl6.saddr, tun_key->tp_dst, 1574ce99f6b9SOr Gerlitz tunnel_id_to_key32(tun_key->tun_id)); 1575ce99f6b9SOr Gerlitz break; 1576ce99f6b9SOr Gerlitz default: 1577ce99f6b9SOr Gerlitz err = -EOPNOTSUPP; 1578232c0013SHadar Hen Zion goto destroy_neigh_entry; 1579232c0013SHadar Hen Zion } 1580232c0013SHadar Hen Zion 1581232c0013SHadar Hen Zion e->encap_size = ipv6_encap_size; 1582232c0013SHadar Hen Zion e->encap_header = encap_header; 1583232c0013SHadar Hen Zion 1584232c0013SHadar Hen Zion if (!(nud_state & NUD_VALID)) { 1585232c0013SHadar Hen Zion neigh_event_send(n, NULL); 158627902f08SWei Yongjun err = -EAGAIN; 158727902f08SWei Yongjun goto out; 1588ce99f6b9SOr Gerlitz } 1589ce99f6b9SOr Gerlitz 1590ce99f6b9SOr Gerlitz err = mlx5_encap_alloc(priv->mdev, e->tunnel_type, 1591225aabafSOr Gerlitz ipv6_encap_size, encap_header, &e->encap_id); 1592232c0013SHadar Hen Zion if (err) 1593232c0013SHadar Hen Zion goto destroy_neigh_entry; 1594232c0013SHadar Hen Zion 1595232c0013SHadar Hen Zion e->flags |= MLX5_ENCAP_ENTRY_VALID; 1596f6dfb4c3SHadar Hen Zion mlx5e_rep_queue_neigh_stats_work(netdev_priv(out_dev)); 1597ce99f6b9SOr Gerlitz neigh_release(n); 1598232c0013SHadar Hen Zion return err; 1599232c0013SHadar Hen Zion 1600232c0013SHadar Hen Zion destroy_neigh_entry: 1601232c0013SHadar Hen Zion mlx5e_rep_encap_entry_detach(netdev_priv(e->out_dev), e); 1602232c0013SHadar Hen Zion out: 1603ce99f6b9SOr Gerlitz kfree(encap_header); 1604232c0013SHadar Hen Zion if (n) 1605232c0013SHadar Hen Zion neigh_release(n); 1606ce99f6b9SOr Gerlitz return err; 1607ce99f6b9SOr Gerlitz } 1608ce99f6b9SOr Gerlitz 1609a54e20b4SHadar Hen Zion static int mlx5e_attach_encap(struct mlx5e_priv *priv, 1610a54e20b4SHadar Hen Zion struct ip_tunnel_info *tun_info, 1611a54e20b4SHadar Hen Zion struct net_device *mirred_dev, 161245247bf2SOr Gerlitz struct net_device **encap_dev, 161345247bf2SOr Gerlitz struct mlx5e_tc_flow *flow) 161403a9d11eSOr Gerlitz { 1615a54e20b4SHadar Hen Zion struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 16161ad9a00aSPaul Blakey struct net_device *up_dev = mlx5_eswitch_get_uplink_netdev(esw); 1617a54e20b4SHadar Hen Zion unsigned short family = ip_tunnel_info_af(tun_info); 161845247bf2SOr Gerlitz struct mlx5e_priv *up_priv = netdev_priv(up_dev); 161945247bf2SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 1620a54e20b4SHadar Hen Zion struct ip_tunnel_key *key = &tun_info->key; 1621c1ae1152SOr Gerlitz struct mlx5e_encap_entry *e; 162245247bf2SOr Gerlitz int tunnel_type, err = 0; 1623a54e20b4SHadar Hen Zion uintptr_t hash_key; 1624a54e20b4SHadar Hen Zion bool found = false; 1625a54e20b4SHadar Hen Zion 16262fcd82e9SOr Gerlitz /* udp dst port must be set */ 1627a54e20b4SHadar Hen Zion if (!memchr_inv(&key->tp_dst, 0, sizeof(key->tp_dst))) 16282fcd82e9SOr Gerlitz goto vxlan_encap_offload_err; 1629a54e20b4SHadar Hen Zion 1630cd377663SOr Gerlitz /* setting udp src port isn't supported */ 16312fcd82e9SOr Gerlitz if (memchr_inv(&key->tp_src, 0, sizeof(key->tp_src))) { 16322fcd82e9SOr Gerlitz vxlan_encap_offload_err: 16332fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 16342fcd82e9SOr Gerlitz "must set udp dst port and not set udp src port\n"); 1635cd377663SOr Gerlitz return -EOPNOTSUPP; 16362fcd82e9SOr Gerlitz } 1637cd377663SOr Gerlitz 16381ad9a00aSPaul Blakey if (mlx5e_vxlan_lookup_port(up_priv, be16_to_cpu(key->tp_dst)) && 1639a54e20b4SHadar Hen Zion MLX5_CAP_ESW(priv->mdev, vxlan_encap_decap)) { 1640a54e20b4SHadar Hen Zion tunnel_type = MLX5_HEADER_TYPE_VXLAN; 1641a54e20b4SHadar Hen Zion } else { 16422fcd82e9SOr Gerlitz netdev_warn(priv->netdev, 16432fcd82e9SOr Gerlitz "%d isn't an offloaded vxlan udp dport\n", be16_to_cpu(key->tp_dst)); 1644a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 1645a54e20b4SHadar Hen Zion } 1646a54e20b4SHadar Hen Zion 164776f7444dSOr Gerlitz hash_key = hash_encap_info(key); 1648a54e20b4SHadar Hen Zion 1649a54e20b4SHadar Hen Zion hash_for_each_possible_rcu(esw->offloads.encap_tbl, e, 1650a54e20b4SHadar Hen Zion encap_hlist, hash_key) { 165176f7444dSOr Gerlitz if (!cmp_encap_info(&e->tun_info.key, key)) { 1652a54e20b4SHadar Hen Zion found = true; 1653a54e20b4SHadar Hen Zion break; 1654a54e20b4SHadar Hen Zion } 1655a54e20b4SHadar Hen Zion } 1656a54e20b4SHadar Hen Zion 165745247bf2SOr Gerlitz if (found) 165845247bf2SOr Gerlitz goto attach_flow; 1659a54e20b4SHadar Hen Zion 1660a54e20b4SHadar Hen Zion e = kzalloc(sizeof(*e), GFP_KERNEL); 1661a54e20b4SHadar Hen Zion if (!e) 1662a54e20b4SHadar Hen Zion return -ENOMEM; 1663a54e20b4SHadar Hen Zion 166476f7444dSOr Gerlitz e->tun_info = *tun_info; 1665a54e20b4SHadar Hen Zion e->tunnel_type = tunnel_type; 1666a54e20b4SHadar Hen Zion INIT_LIST_HEAD(&e->flows); 1667a54e20b4SHadar Hen Zion 1668ce99f6b9SOr Gerlitz if (family == AF_INET) 16691a8552bdSHadar Hen Zion err = mlx5e_create_encap_header_ipv4(priv, mirred_dev, e); 1670ce99f6b9SOr Gerlitz else if (family == AF_INET6) 16711a8552bdSHadar Hen Zion err = mlx5e_create_encap_header_ipv6(priv, mirred_dev, e); 1672ce99f6b9SOr Gerlitz 1673232c0013SHadar Hen Zion if (err && err != -EAGAIN) 1674a54e20b4SHadar Hen Zion goto out_err; 1675a54e20b4SHadar Hen Zion 1676a54e20b4SHadar Hen Zion hash_add_rcu(esw->offloads.encap_tbl, &e->encap_hlist, hash_key); 1677a54e20b4SHadar Hen Zion 167845247bf2SOr Gerlitz attach_flow: 167945247bf2SOr Gerlitz list_add(&flow->encap, &e->flows); 168045247bf2SOr Gerlitz *encap_dev = e->out_dev; 1681232c0013SHadar Hen Zion if (e->flags & MLX5_ENCAP_ENTRY_VALID) 168245247bf2SOr Gerlitz attr->encap_id = e->encap_id; 168345247bf2SOr Gerlitz 1684232c0013SHadar Hen Zion return err; 1685a54e20b4SHadar Hen Zion 1686a54e20b4SHadar Hen Zion out_err: 1687a54e20b4SHadar Hen Zion kfree(e); 1688a54e20b4SHadar Hen Zion return err; 1689a54e20b4SHadar Hen Zion } 1690a54e20b4SHadar Hen Zion 1691a54e20b4SHadar Hen Zion static int parse_tc_fdb_actions(struct mlx5e_priv *priv, struct tcf_exts *exts, 1692d7e75a32SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr, 1693a54e20b4SHadar Hen Zion struct mlx5e_tc_flow *flow) 1694a54e20b4SHadar Hen Zion { 1695ecf5bb79SOr Gerlitz struct mlx5_esw_flow_attr *attr = flow->esw_attr; 16961d447a39SSaeed Mahameed struct mlx5e_rep_priv *rpriv = priv->ppriv; 1697a54e20b4SHadar Hen Zion struct ip_tunnel_info *info = NULL; 169803a9d11eSOr Gerlitz const struct tc_action *a; 169922dc13c8SWANG Cong LIST_HEAD(actions); 1700a54e20b4SHadar Hen Zion bool encap = false; 1701232c0013SHadar Hen Zion int err = 0; 170203a9d11eSOr Gerlitz 170303a9d11eSOr Gerlitz if (tc_no_actions(exts)) 170403a9d11eSOr Gerlitz return -EINVAL; 170503a9d11eSOr Gerlitz 1706776b12b6SOr Gerlitz memset(attr, 0, sizeof(*attr)); 17071d447a39SSaeed Mahameed attr->in_rep = rpriv->rep; 170803a9d11eSOr Gerlitz 170922dc13c8SWANG Cong tcf_exts_to_list(exts, &actions); 171022dc13c8SWANG Cong list_for_each_entry(a, &actions, list) { 171103a9d11eSOr Gerlitz if (is_tcf_gact_shot(a)) { 17128b32580dSOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_DROP | 171303a9d11eSOr Gerlitz MLX5_FLOW_CONTEXT_ACTION_COUNT; 171403a9d11eSOr Gerlitz continue; 171503a9d11eSOr Gerlitz } 171603a9d11eSOr Gerlitz 1717d7e75a32SOr Gerlitz if (is_tcf_pedit(a)) { 1718d7e75a32SOr Gerlitz err = parse_tc_pedit_action(priv, a, MLX5_FLOW_NAMESPACE_FDB, 1719d7e75a32SOr Gerlitz parse_attr); 1720d7e75a32SOr Gerlitz if (err) 1721d7e75a32SOr Gerlitz return err; 1722d7e75a32SOr Gerlitz 1723d7e75a32SOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_MOD_HDR; 1724d7e75a32SOr Gerlitz continue; 1725d7e75a32SOr Gerlitz } 1726d7e75a32SOr Gerlitz 172726c02749SOr Gerlitz if (is_tcf_csum(a)) { 172826c02749SOr Gerlitz if (csum_offload_supported(priv, attr->action, 172926c02749SOr Gerlitz tcf_csum_update_flags(a))) 173026c02749SOr Gerlitz continue; 173126c02749SOr Gerlitz 173226c02749SOr Gerlitz return -EOPNOTSUPP; 173326c02749SOr Gerlitz } 173426c02749SOr Gerlitz 17355724b8b5SShmulik Ladkani if (is_tcf_mirred_egress_redirect(a)) { 173603a9d11eSOr Gerlitz int ifindex = tcf_mirred_ifindex(a); 173745247bf2SOr Gerlitz struct net_device *out_dev, *encap_dev = NULL; 173803a9d11eSOr Gerlitz struct mlx5e_priv *out_priv; 173903a9d11eSOr Gerlitz 174003a9d11eSOr Gerlitz out_dev = __dev_get_by_index(dev_net(priv->netdev), ifindex); 174103a9d11eSOr Gerlitz 1742a54e20b4SHadar Hen Zion if (switchdev_port_same_parent_id(priv->netdev, 1743a54e20b4SHadar Hen Zion out_dev)) { 1744e37a79e5SMark Bloch attr->action |= MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 1745e37a79e5SMark Bloch MLX5_FLOW_CONTEXT_ACTION_COUNT; 174603a9d11eSOr Gerlitz out_priv = netdev_priv(out_dev); 17471d447a39SSaeed Mahameed rpriv = out_priv->ppriv; 17481d447a39SSaeed Mahameed attr->out_rep = rpriv->rep; 1749a54e20b4SHadar Hen Zion } else if (encap) { 1750a54e20b4SHadar Hen Zion err = mlx5e_attach_encap(priv, info, 175145247bf2SOr Gerlitz out_dev, &encap_dev, flow); 1752232c0013SHadar Hen Zion if (err && err != -EAGAIN) 1753a54e20b4SHadar Hen Zion return err; 1754a54e20b4SHadar Hen Zion attr->action |= MLX5_FLOW_CONTEXT_ACTION_ENCAP | 1755a54e20b4SHadar Hen Zion MLX5_FLOW_CONTEXT_ACTION_FWD_DEST | 1756a54e20b4SHadar Hen Zion MLX5_FLOW_CONTEXT_ACTION_COUNT; 175745247bf2SOr Gerlitz out_priv = netdev_priv(encap_dev); 17581d447a39SSaeed Mahameed rpriv = out_priv->ppriv; 17591d447a39SSaeed Mahameed attr->out_rep = rpriv->rep; 1760232c0013SHadar Hen Zion attr->parse_attr = parse_attr; 1761a54e20b4SHadar Hen Zion } else { 1762a54e20b4SHadar Hen Zion pr_err("devices %s %s not on same switch HW, can't offload forwarding\n", 1763a54e20b4SHadar Hen Zion priv->netdev->name, out_dev->name); 1764a54e20b4SHadar Hen Zion return -EINVAL; 1765a54e20b4SHadar Hen Zion } 1766a54e20b4SHadar Hen Zion continue; 1767a54e20b4SHadar Hen Zion } 1768a54e20b4SHadar Hen Zion 1769a54e20b4SHadar Hen Zion if (is_tcf_tunnel_set(a)) { 1770a54e20b4SHadar Hen Zion info = tcf_tunnel_info(a); 1771a54e20b4SHadar Hen Zion if (info) 1772a54e20b4SHadar Hen Zion encap = true; 1773a54e20b4SHadar Hen Zion else 1774a54e20b4SHadar Hen Zion return -EOPNOTSUPP; 177503a9d11eSOr Gerlitz continue; 177603a9d11eSOr Gerlitz } 177703a9d11eSOr Gerlitz 17788b32580dSOr Gerlitz if (is_tcf_vlan(a)) { 177909c91ddfSOr Gerlitz if (tcf_vlan_action(a) == TCA_VLAN_ACT_POP) { 17808b32580dSOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_POP; 178109c91ddfSOr Gerlitz } else if (tcf_vlan_action(a) == TCA_VLAN_ACT_PUSH) { 17828b32580dSOr Gerlitz if (tcf_vlan_push_proto(a) != htons(ETH_P_8021Q)) 17838b32580dSOr Gerlitz return -EOPNOTSUPP; 17848b32580dSOr Gerlitz 17858b32580dSOr Gerlitz attr->action |= MLX5_FLOW_CONTEXT_ACTION_VLAN_PUSH; 17868b32580dSOr Gerlitz attr->vlan = tcf_vlan_push_vid(a); 178709c91ddfSOr Gerlitz } else { /* action is TCA_VLAN_ACT_MODIFY */ 178809c91ddfSOr Gerlitz return -EOPNOTSUPP; 17898b32580dSOr Gerlitz } 17908b32580dSOr Gerlitz continue; 17918b32580dSOr Gerlitz } 17928b32580dSOr Gerlitz 1793bbd00f7eSHadar Hen Zion if (is_tcf_tunnel_release(a)) { 1794bbd00f7eSHadar Hen Zion attr->action |= MLX5_FLOW_CONTEXT_ACTION_DECAP; 1795bbd00f7eSHadar Hen Zion continue; 1796bbd00f7eSHadar Hen Zion } 1797bbd00f7eSHadar Hen Zion 179803a9d11eSOr Gerlitz return -EINVAL; 179903a9d11eSOr Gerlitz } 1800232c0013SHadar Hen Zion return err; 180103a9d11eSOr Gerlitz } 180203a9d11eSOr Gerlitz 1803e3a2b7edSAmir Vadai int mlx5e_configure_flower(struct mlx5e_priv *priv, __be16 protocol, 1804e3a2b7edSAmir Vadai struct tc_cls_flower_offload *f) 1805e3a2b7edSAmir Vadai { 1806adb4c123SOr Gerlitz struct mlx5_eswitch *esw = priv->mdev->priv.eswitch; 180717091853SOr Gerlitz struct mlx5e_tc_flow_parse_attr *parse_attr; 18083bc4b7bfSOr Gerlitz struct mlx5e_tc_table *tc = &priv->fs.tc; 18093bc4b7bfSOr Gerlitz struct mlx5e_tc_flow *flow; 18103bc4b7bfSOr Gerlitz int attr_size, err = 0; 181165ba8fb7SOr Gerlitz u8 flow_flags = 0; 1812e3a2b7edSAmir Vadai 181365ba8fb7SOr Gerlitz if (esw && esw->mode == SRIOV_OFFLOADS) { 181465ba8fb7SOr Gerlitz flow_flags = MLX5E_TC_FLOW_ESWITCH; 181565ba8fb7SOr Gerlitz attr_size = sizeof(struct mlx5_esw_flow_attr); 18163bc4b7bfSOr Gerlitz } else { 18173bc4b7bfSOr Gerlitz flow_flags = MLX5E_TC_FLOW_NIC; 18183bc4b7bfSOr Gerlitz attr_size = sizeof(struct mlx5_nic_flow_attr); 181965ba8fb7SOr Gerlitz } 1820776b12b6SOr Gerlitz 182165ba8fb7SOr Gerlitz flow = kzalloc(sizeof(*flow) + attr_size, GFP_KERNEL); 18221b9a07eeSLeon Romanovsky parse_attr = kvzalloc(sizeof(*parse_attr), GFP_KERNEL); 182317091853SOr Gerlitz if (!parse_attr || !flow) { 1824e3a2b7edSAmir Vadai err = -ENOMEM; 1825e3a2b7edSAmir Vadai goto err_free; 1826e3a2b7edSAmir Vadai } 1827e3a2b7edSAmir Vadai 1828e3a2b7edSAmir Vadai flow->cookie = f->cookie; 182965ba8fb7SOr Gerlitz flow->flags = flow_flags; 1830e3a2b7edSAmir Vadai 183117091853SOr Gerlitz err = parse_cls_flower(priv, flow, &parse_attr->spec, f); 1832e3a2b7edSAmir Vadai if (err < 0) 1833e3a2b7edSAmir Vadai goto err_free; 1834e3a2b7edSAmir Vadai 183565ba8fb7SOr Gerlitz if (flow->flags & MLX5E_TC_FLOW_ESWITCH) { 1836d7e75a32SOr Gerlitz err = parse_tc_fdb_actions(priv, f->exts, parse_attr, flow); 1837adb4c123SOr Gerlitz if (err < 0) 1838232c0013SHadar Hen Zion goto err_handle_encap_flow; 1839aa0cbbaeSOr Gerlitz flow->rule = mlx5e_tc_add_fdb_flow(priv, parse_attr, flow); 1840adb4c123SOr Gerlitz } else { 1841aa0cbbaeSOr Gerlitz err = parse_tc_nic_actions(priv, f->exts, parse_attr, flow); 1842e3a2b7edSAmir Vadai if (err < 0) 1843e3a2b7edSAmir Vadai goto err_free; 1844aa0cbbaeSOr Gerlitz flow->rule = mlx5e_tc_add_nic_flow(priv, parse_attr, flow); 1845adb4c123SOr Gerlitz } 1846adb4c123SOr Gerlitz 18475c40348cSOr Gerlitz if (IS_ERR(flow->rule)) { 18485c40348cSOr Gerlitz err = PTR_ERR(flow->rule); 1849aa0cbbaeSOr Gerlitz goto err_free; 18505c40348cSOr Gerlitz } 18515c40348cSOr Gerlitz 18520b67a38fSHadar Hen Zion flow->flags |= MLX5E_TC_FLOW_OFFLOADED; 1853e3a2b7edSAmir Vadai err = rhashtable_insert_fast(&tc->ht, &flow->node, 1854e3a2b7edSAmir Vadai tc->ht_params); 1855e3a2b7edSAmir Vadai if (err) 18565c40348cSOr Gerlitz goto err_del_rule; 1857e3a2b7edSAmir Vadai 1858232c0013SHadar Hen Zion if (flow->flags & MLX5E_TC_FLOW_ESWITCH && 1859232c0013SHadar Hen Zion !(flow->esw_attr->action & MLX5_FLOW_CONTEXT_ACTION_ENCAP)) 1860232c0013SHadar Hen Zion kvfree(parse_attr); 1861232c0013SHadar Hen Zion return err; 1862e3a2b7edSAmir Vadai 18635c40348cSOr Gerlitz err_del_rule: 18645e86397aSOr Gerlitz mlx5e_tc_del_flow(priv, flow); 1865e3a2b7edSAmir Vadai 1866232c0013SHadar Hen Zion err_handle_encap_flow: 1867232c0013SHadar Hen Zion if (err == -EAGAIN) { 1868232c0013SHadar Hen Zion err = rhashtable_insert_fast(&tc->ht, &flow->node, 1869232c0013SHadar Hen Zion tc->ht_params); 1870232c0013SHadar Hen Zion if (err) 1871232c0013SHadar Hen Zion mlx5e_tc_del_flow(priv, flow); 1872232c0013SHadar Hen Zion else 1873232c0013SHadar Hen Zion return 0; 1874232c0013SHadar Hen Zion } 1875232c0013SHadar Hen Zion 1876e3a2b7edSAmir Vadai err_free: 187717091853SOr Gerlitz kvfree(parse_attr); 1878232c0013SHadar Hen Zion kfree(flow); 1879e3a2b7edSAmir Vadai return err; 1880e3a2b7edSAmir Vadai } 1881e3a2b7edSAmir Vadai 1882e3a2b7edSAmir Vadai int mlx5e_delete_flower(struct mlx5e_priv *priv, 1883e3a2b7edSAmir Vadai struct tc_cls_flower_offload *f) 1884e3a2b7edSAmir Vadai { 1885e3a2b7edSAmir Vadai struct mlx5e_tc_flow *flow; 1886acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 1887e3a2b7edSAmir Vadai 1888e3a2b7edSAmir Vadai flow = rhashtable_lookup_fast(&tc->ht, &f->cookie, 1889e3a2b7edSAmir Vadai tc->ht_params); 1890e3a2b7edSAmir Vadai if (!flow) 1891e3a2b7edSAmir Vadai return -EINVAL; 1892e3a2b7edSAmir Vadai 1893e3a2b7edSAmir Vadai rhashtable_remove_fast(&tc->ht, &flow->node, tc->ht_params); 1894e3a2b7edSAmir Vadai 1895961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 1896e3a2b7edSAmir Vadai 1897e3a2b7edSAmir Vadai kfree(flow); 1898e3a2b7edSAmir Vadai 1899e3a2b7edSAmir Vadai return 0; 1900e3a2b7edSAmir Vadai } 1901e3a2b7edSAmir Vadai 1902aad7e08dSAmir Vadai int mlx5e_stats_flower(struct mlx5e_priv *priv, 1903aad7e08dSAmir Vadai struct tc_cls_flower_offload *f) 1904aad7e08dSAmir Vadai { 1905aad7e08dSAmir Vadai struct mlx5e_tc_table *tc = &priv->fs.tc; 1906aad7e08dSAmir Vadai struct mlx5e_tc_flow *flow; 1907aad7e08dSAmir Vadai struct mlx5_fc *counter; 1908aad7e08dSAmir Vadai u64 bytes; 1909aad7e08dSAmir Vadai u64 packets; 1910aad7e08dSAmir Vadai u64 lastuse; 1911aad7e08dSAmir Vadai 1912aad7e08dSAmir Vadai flow = rhashtable_lookup_fast(&tc->ht, &f->cookie, 1913aad7e08dSAmir Vadai tc->ht_params); 1914aad7e08dSAmir Vadai if (!flow) 1915aad7e08dSAmir Vadai return -EINVAL; 1916aad7e08dSAmir Vadai 19170b67a38fSHadar Hen Zion if (!(flow->flags & MLX5E_TC_FLOW_OFFLOADED)) 19180b67a38fSHadar Hen Zion return 0; 19190b67a38fSHadar Hen Zion 1920aad7e08dSAmir Vadai counter = mlx5_flow_rule_counter(flow->rule); 1921aad7e08dSAmir Vadai if (!counter) 1922aad7e08dSAmir Vadai return 0; 1923aad7e08dSAmir Vadai 1924aad7e08dSAmir Vadai mlx5_fc_query_cached(counter, &bytes, &packets, &lastuse); 1925aad7e08dSAmir Vadai 1926d897a638SJakub Kicinski tcf_exts_stats_update(f->exts, bytes, packets, lastuse); 1927fed06ee8SOr Gerlitz 1928aad7e08dSAmir Vadai return 0; 1929aad7e08dSAmir Vadai } 1930aad7e08dSAmir Vadai 1931e8f887acSAmir Vadai static const struct rhashtable_params mlx5e_tc_flow_ht_params = { 1932e8f887acSAmir Vadai .head_offset = offsetof(struct mlx5e_tc_flow, node), 1933e8f887acSAmir Vadai .key_offset = offsetof(struct mlx5e_tc_flow, cookie), 1934e8f887acSAmir Vadai .key_len = sizeof(((struct mlx5e_tc_flow *)0)->cookie), 1935e8f887acSAmir Vadai .automatic_shrinking = true, 1936e8f887acSAmir Vadai }; 1937e8f887acSAmir Vadai 1938e8f887acSAmir Vadai int mlx5e_tc_init(struct mlx5e_priv *priv) 1939e8f887acSAmir Vadai { 1940acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 1941e8f887acSAmir Vadai 1942e8f887acSAmir Vadai tc->ht_params = mlx5e_tc_flow_ht_params; 1943e8f887acSAmir Vadai return rhashtable_init(&tc->ht, &tc->ht_params); 1944e8f887acSAmir Vadai } 1945e8f887acSAmir Vadai 1946e8f887acSAmir Vadai static void _mlx5e_tc_del_flow(void *ptr, void *arg) 1947e8f887acSAmir Vadai { 1948e8f887acSAmir Vadai struct mlx5e_tc_flow *flow = ptr; 1949e8f887acSAmir Vadai struct mlx5e_priv *priv = arg; 1950e8f887acSAmir Vadai 1951961e8979SRoi Dayan mlx5e_tc_del_flow(priv, flow); 1952e8f887acSAmir Vadai kfree(flow); 1953e8f887acSAmir Vadai } 1954e8f887acSAmir Vadai 1955e8f887acSAmir Vadai void mlx5e_tc_cleanup(struct mlx5e_priv *priv) 1956e8f887acSAmir Vadai { 1957acff797cSMaor Gottlieb struct mlx5e_tc_table *tc = &priv->fs.tc; 1958e8f887acSAmir Vadai 1959e8f887acSAmir Vadai rhashtable_free_and_destroy(&tc->ht, _mlx5e_tc_del_flow, priv); 1960e8f887acSAmir Vadai 1961acff797cSMaor Gottlieb if (!IS_ERR_OR_NULL(tc->t)) { 1962acff797cSMaor Gottlieb mlx5_destroy_flow_table(tc->t); 1963acff797cSMaor Gottlieb tc->t = NULL; 1964e8f887acSAmir Vadai } 1965e8f887acSAmir Vadai } 1966