1/*
2 * Copyright (c) 2015, Mellanox Technologies. All rights reserved.
3 *
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
9 *
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
12 * conditions are met:
13 *
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
16 * disclaimer.
17 *
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and/or other materials
21 * provided with the distribution.
22 *
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30 * SOFTWARE.
31 */
32
33#include <linux/debugfs.h>
34#include <linux/list.h>
35#include <linux/ip.h>
36#include <linux/ipv6.h>
37#include <linux/tcp.h>
38#include <linux/mlx5/fs.h>
39#include <linux/mlx5/mpfs.h>
40#include "en_tc.h"
41#include "lib/mpfs.h"
42#include "en/ptp.h"
43#include "en/fs_ethtool.h"
44
45struct mlx5e_flow_steering {
46 struct work_struct set_rx_mode_work;
47 bool state_destroy;
48 bool vlan_strip_disable;
49 struct mlx5_core_dev *mdev;
50 struct net_device *netdev;
51 struct mlx5_flow_namespace *ns;
52 struct mlx5_flow_namespace *egress_ns;
53#ifdef CONFIG_MLX5_EN_RXNFC
54 struct mlx5e_ethtool_steering *ethtool;
55#endif
56 struct mlx5e_tc_table *tc;
57 struct mlx5e_promisc_table promisc;
58 struct mlx5e_vlan_table *vlan;
59 struct mlx5e_l2_table l2;
60 struct mlx5_ttc_table *ttc;
61 struct mlx5_ttc_table *inner_ttc;
62#ifdef CONFIG_MLX5_EN_ARFS
63 struct mlx5e_arfs_tables *arfs;
64#endif
65#ifdef CONFIG_MLX5_EN_TLS
66 struct mlx5e_accel_fs_tcp *accel_tcp;
67#endif
68 struct mlx5e_fs_udp *udp;
69 struct mlx5e_fs_any *any;
70 struct mlx5e_ptp_fs *ptp_fs;
71 struct dentry *dfs_root;
72};
73
74static int mlx5e_add_l2_flow_rule(struct mlx5e_flow_steering *fs,
75 struct mlx5e_l2_rule *ai, int type);
76static void mlx5e_del_l2_flow_rule(struct mlx5e_flow_steering *fs,
77 struct mlx5e_l2_rule *ai);
78
79enum {
80 MLX5E_FULLMATCH = 0,
81 MLX5E_ALLMULTI = 1,
82};
83
84enum {
85 MLX5E_UC = 0,
86 MLX5E_MC_IPV4 = 1,
87 MLX5E_MC_IPV6 = 2,
88 MLX5E_MC_OTHER = 3,
89};
90
91enum {
92 MLX5E_ACTION_NONE = 0,
93 MLX5E_ACTION_ADD = 1,
94 MLX5E_ACTION_DEL = 2,
95};
96
97struct mlx5e_l2_hash_node {
98 struct hlist_node hlist;
99 u8 action;
100 struct mlx5e_l2_rule ai;
101 bool mpfs;
102};
103
104static inline int mlx5e_hash_l2(const u8 *addr)
105{
106 return addr[5];
107}
108
109struct dentry *mlx5e_fs_get_debugfs_root(struct mlx5e_flow_steering *fs)
110{
111 return fs->dfs_root;
112}
113
114static void mlx5e_add_l2_to_hash(struct hlist_head *hash, const u8 *addr)
115{
116 struct mlx5e_l2_hash_node *hn;
117 int ix = mlx5e_hash_l2(addr);
118 int found = 0;
119
120 hlist_for_each_entry(hn, &hash[ix], hlist)
121 if (ether_addr_equal_64bits(addr1: hn->ai.addr, addr2: addr)) {
122 found = 1;
123 break;
124 }
125
126 if (found) {
127 hn->action = MLX5E_ACTION_NONE;
128 return;
129 }
130
131 hn = kzalloc(size: sizeof(*hn), GFP_ATOMIC);
132 if (!hn)
133 return;
134
135 ether_addr_copy(dst: hn->ai.addr, src: addr);
136 hn->action = MLX5E_ACTION_ADD;
137
138 hlist_add_head(n: &hn->hlist, h: &hash[ix]);
139}
140
141static void mlx5e_del_l2_from_hash(struct mlx5e_l2_hash_node *hn)
142{
143 hlist_del(n: &hn->hlist);
144 kfree(objp: hn);
145}
146
147struct mlx5e_vlan_table {
148 struct mlx5e_flow_table ft;
149 DECLARE_BITMAP(active_cvlans, VLAN_N_VID);
150 DECLARE_BITMAP(active_svlans, VLAN_N_VID);
151 struct mlx5_flow_handle *active_cvlans_rule[VLAN_N_VID];
152 struct mlx5_flow_handle *active_svlans_rule[VLAN_N_VID];
153 struct mlx5_flow_handle *untagged_rule;
154 struct mlx5_flow_handle *any_cvlan_rule;
155 struct mlx5_flow_handle *any_svlan_rule;
156 struct mlx5_flow_handle *trap_rule;
157 bool cvlan_filter_disabled;
158};
159
160unsigned long *mlx5e_vlan_get_active_svlans(struct mlx5e_vlan_table *vlan)
161{
162 return vlan->active_svlans;
163}
164
165struct mlx5_flow_table *mlx5e_vlan_get_flowtable(struct mlx5e_vlan_table *vlan)
166{
167 return vlan->ft.t;
168}
169
170static int mlx5e_vport_context_update_vlans(struct mlx5e_flow_steering *fs)
171{
172 int max_list_size;
173 int list_size;
174 u16 *vlans;
175 int vlan;
176 int err;
177 int i;
178
179 list_size = 0;
180 for_each_set_bit(vlan, fs->vlan->active_cvlans, VLAN_N_VID)
181 list_size++;
182
183 max_list_size = 1 << MLX5_CAP_GEN(fs->mdev, log_max_vlan_list);
184
185 if (list_size > max_list_size) {
186 fs_warn(fs, "netdev vlans list size (%d) > (%d) max vport list size, some vlans will be dropped\n",
187 list_size, max_list_size);
188 list_size = max_list_size;
189 }
190
191 vlans = kvcalloc(n: list_size, size: sizeof(*vlans), GFP_KERNEL);
192 if (!vlans)
193 return -ENOMEM;
194
195 i = 0;
196 for_each_set_bit(vlan, fs->vlan->active_cvlans, VLAN_N_VID) {
197 if (i >= list_size)
198 break;
199 vlans[i++] = vlan;
200 }
201
202 err = mlx5_modify_nic_vport_vlans(dev: fs->mdev, vlans, list_size);
203 if (err)
204 fs_err(fs, "Failed to modify vport vlans list err(%d)\n",
205 err);
206
207 kvfree(addr: vlans);
208 return err;
209}
210
211enum mlx5e_vlan_rule_type {
212 MLX5E_VLAN_RULE_TYPE_UNTAGGED,
213 MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID,
214 MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID,
215 MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID,
216 MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID,
217};
218
219static int __mlx5e_add_vlan_rule(struct mlx5e_flow_steering *fs,
220 enum mlx5e_vlan_rule_type rule_type,
221 u16 vid, struct mlx5_flow_spec *spec)
222{
223 struct mlx5_flow_table *ft = fs->vlan->ft.t;
224 struct mlx5_flow_destination dest = {};
225 struct mlx5_flow_handle **rule_p;
226 MLX5_DECLARE_FLOW_ACT(flow_act);
227 int err = 0;
228
229 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
230 dest.ft = fs->l2.ft.t;
231
232 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
233
234 switch (rule_type) {
235 case MLX5E_VLAN_RULE_TYPE_UNTAGGED:
236 /* cvlan_tag enabled in match criteria and
237 * disabled in match value means both S & C tags
238 * don't exist (untagged of both)
239 */
240 rule_p = &fs->vlan->untagged_rule;
241 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
242 outer_headers.cvlan_tag);
243 break;
244 case MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID:
245 rule_p = &fs->vlan->any_cvlan_rule;
246 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
247 outer_headers.cvlan_tag);
248 MLX5_SET(fte_match_param, spec->match_value, outer_headers.cvlan_tag, 1);
249 break;
250 case MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID:
251 rule_p = &fs->vlan->any_svlan_rule;
252 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
253 outer_headers.svlan_tag);
254 MLX5_SET(fte_match_param, spec->match_value, outer_headers.svlan_tag, 1);
255 break;
256 case MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID:
257 rule_p = &fs->vlan->active_svlans_rule[vid];
258 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
259 outer_headers.svlan_tag);
260 MLX5_SET(fte_match_param, spec->match_value, outer_headers.svlan_tag, 1);
261 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
262 outer_headers.first_vid);
263 MLX5_SET(fte_match_param, spec->match_value, outer_headers.first_vid,
264 vid);
265 break;
266 default: /* MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID */
267 rule_p = &fs->vlan->active_cvlans_rule[vid];
268 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
269 outer_headers.cvlan_tag);
270 MLX5_SET(fte_match_param, spec->match_value, outer_headers.cvlan_tag, 1);
271 MLX5_SET_TO_ONES(fte_match_param, spec->match_criteria,
272 outer_headers.first_vid);
273 MLX5_SET(fte_match_param, spec->match_value, outer_headers.first_vid,
274 vid);
275 break;
276 }
277
278 if (WARN_ONCE(*rule_p, "VLAN rule already exists type %d", rule_type))
279 return 0;
280
281 *rule_p = mlx5_add_flow_rules(ft, spec, flow_act: &flow_act, dest: &dest, num_dest: 1);
282
283 if (IS_ERR(ptr: *rule_p)) {
284 err = PTR_ERR(ptr: *rule_p);
285 *rule_p = NULL;
286 fs_err(fs, "add rule failed\n");
287 }
288
289 return err;
290}
291
292static int mlx5e_add_vlan_rule(struct mlx5e_flow_steering *fs,
293 enum mlx5e_vlan_rule_type rule_type, u16 vid)
294{
295 struct mlx5_flow_spec *spec;
296 int err = 0;
297
298 spec = kvzalloc(size: sizeof(*spec), GFP_KERNEL);
299 if (!spec)
300 return -ENOMEM;
301
302 if (rule_type == MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID)
303 mlx5e_vport_context_update_vlans(fs);
304
305 err = __mlx5e_add_vlan_rule(fs, rule_type, vid, spec);
306
307 kvfree(addr: spec);
308
309 return err;
310}
311
312static void mlx5e_fs_del_vlan_rule(struct mlx5e_flow_steering *fs,
313 enum mlx5e_vlan_rule_type rule_type, u16 vid)
314{
315 switch (rule_type) {
316 case MLX5E_VLAN_RULE_TYPE_UNTAGGED:
317 if (fs->vlan->untagged_rule) {
318 mlx5_del_flow_rules(fr: fs->vlan->untagged_rule);
319 fs->vlan->untagged_rule = NULL;
320 }
321 break;
322 case MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID:
323 if (fs->vlan->any_cvlan_rule) {
324 mlx5_del_flow_rules(fr: fs->vlan->any_cvlan_rule);
325 fs->vlan->any_cvlan_rule = NULL;
326 }
327 break;
328 case MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID:
329 if (fs->vlan->any_svlan_rule) {
330 mlx5_del_flow_rules(fr: fs->vlan->any_svlan_rule);
331 fs->vlan->any_svlan_rule = NULL;
332 }
333 break;
334 case MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID:
335 if (fs->vlan->active_svlans_rule[vid]) {
336 mlx5_del_flow_rules(fr: fs->vlan->active_svlans_rule[vid]);
337 fs->vlan->active_svlans_rule[vid] = NULL;
338 }
339 break;
340 case MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID:
341 if (fs->vlan->active_cvlans_rule[vid]) {
342 mlx5_del_flow_rules(fr: fs->vlan->active_cvlans_rule[vid]);
343 fs->vlan->active_cvlans_rule[vid] = NULL;
344 }
345 mlx5e_vport_context_update_vlans(fs);
346 break;
347 }
348}
349
350static void mlx5e_fs_del_any_vid_rules(struct mlx5e_flow_steering *fs)
351{
352 mlx5e_fs_del_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID, vid: 0);
353 mlx5e_fs_del_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID, vid: 0);
354}
355
356static int mlx5e_fs_add_any_vid_rules(struct mlx5e_flow_steering *fs)
357{
358 int err;
359
360 err = mlx5e_add_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID, vid: 0);
361 if (err)
362 return err;
363
364 return mlx5e_add_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_ANY_STAG_VID, vid: 0);
365}
366
367static struct mlx5_flow_handle *
368mlx5e_add_trap_rule(struct mlx5_flow_table *ft, int trap_id, int tir_num)
369{
370 struct mlx5_flow_destination dest = {};
371 MLX5_DECLARE_FLOW_ACT(flow_act);
372 struct mlx5_flow_handle *rule;
373 struct mlx5_flow_spec *spec;
374
375 spec = kvzalloc(size: sizeof(*spec), GFP_KERNEL);
376 if (!spec)
377 return ERR_PTR(error: -ENOMEM);
378 spec->flow_context.flags |= FLOW_CONTEXT_HAS_TAG;
379 spec->flow_context.flow_tag = trap_id;
380 dest.type = MLX5_FLOW_DESTINATION_TYPE_TIR;
381 dest.tir_num = tir_num;
382
383 rule = mlx5_add_flow_rules(ft, spec, flow_act: &flow_act, dest: &dest, num_dest: 1);
384 kvfree(addr: spec);
385 return rule;
386}
387
388int mlx5e_add_vlan_trap(struct mlx5e_flow_steering *fs, int trap_id, int tir_num)
389{
390 struct mlx5_flow_table *ft = fs->vlan->ft.t;
391 struct mlx5_flow_handle *rule;
392 int err;
393
394 rule = mlx5e_add_trap_rule(ft, trap_id, tir_num);
395 if (IS_ERR(ptr: rule)) {
396 err = PTR_ERR(ptr: rule);
397 fs->vlan->trap_rule = NULL;
398 fs_err(fs, "add VLAN trap rule failed, err %d\n", err);
399 return err;
400 }
401 fs->vlan->trap_rule = rule;
402 return 0;
403}
404
405void mlx5e_remove_vlan_trap(struct mlx5e_flow_steering *fs)
406{
407 if (fs->vlan->trap_rule) {
408 mlx5_del_flow_rules(fr: fs->vlan->trap_rule);
409 fs->vlan->trap_rule = NULL;
410 }
411}
412
413int mlx5e_add_mac_trap(struct mlx5e_flow_steering *fs, int trap_id, int tir_num)
414{
415 struct mlx5_flow_table *ft = fs->l2.ft.t;
416 struct mlx5_flow_handle *rule;
417 int err;
418
419 rule = mlx5e_add_trap_rule(ft, trap_id, tir_num);
420 if (IS_ERR(ptr: rule)) {
421 err = PTR_ERR(ptr: rule);
422 fs->l2.trap_rule = NULL;
423 fs_err(fs, "add MAC trap rule failed, err %d\n", err);
424 return err;
425 }
426 fs->l2.trap_rule = rule;
427 return 0;
428}
429
430void mlx5e_remove_mac_trap(struct mlx5e_flow_steering *fs)
431{
432 if (fs->l2.trap_rule) {
433 mlx5_del_flow_rules(fr: fs->l2.trap_rule);
434 fs->l2.trap_rule = NULL;
435 }
436}
437
438void mlx5e_enable_cvlan_filter(struct mlx5e_flow_steering *fs, bool promisc)
439{
440 if (!fs->vlan->cvlan_filter_disabled)
441 return;
442
443 fs->vlan->cvlan_filter_disabled = false;
444 if (promisc)
445 return;
446 mlx5e_fs_del_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID, vid: 0);
447}
448
449void mlx5e_disable_cvlan_filter(struct mlx5e_flow_steering *fs, bool promisc)
450{
451 if (!fs->vlan || fs->vlan->cvlan_filter_disabled)
452 return;
453
454 fs->vlan->cvlan_filter_disabled = true;
455 if (promisc)
456 return;
457 mlx5e_add_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_ANY_CTAG_VID, vid: 0);
458}
459
460static int mlx5e_vlan_rx_add_cvid(struct mlx5e_flow_steering *fs, u16 vid)
461{
462 int err;
463
464 set_bit(nr: vid, addr: fs->vlan->active_cvlans);
465
466 err = mlx5e_add_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID, vid);
467 if (err)
468 clear_bit(nr: vid, addr: fs->vlan->active_cvlans);
469
470 return err;
471}
472
473static int mlx5e_vlan_rx_add_svid(struct mlx5e_flow_steering *fs,
474 struct net_device *netdev, u16 vid)
475{
476 int err;
477
478 set_bit(nr: vid, addr: fs->vlan->active_svlans);
479
480 err = mlx5e_add_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID, vid);
481 if (err) {
482 clear_bit(nr: vid, addr: fs->vlan->active_svlans);
483 return err;
484 }
485
486 /* Need to fix some features.. */
487 netdev_update_features(dev: netdev);
488 return err;
489}
490
491int mlx5e_fs_vlan_rx_add_vid(struct mlx5e_flow_steering *fs,
492 struct net_device *netdev,
493 __be16 proto, u16 vid)
494{
495
496 if (!fs->vlan) {
497 fs_err(fs, "Vlan doesn't exist\n");
498 return -EINVAL;
499 }
500
501 if (be16_to_cpu(proto) == ETH_P_8021Q)
502 return mlx5e_vlan_rx_add_cvid(fs, vid);
503 else if (be16_to_cpu(proto) == ETH_P_8021AD)
504 return mlx5e_vlan_rx_add_svid(fs, netdev, vid);
505
506 return -EOPNOTSUPP;
507}
508
509int mlx5e_fs_vlan_rx_kill_vid(struct mlx5e_flow_steering *fs,
510 struct net_device *netdev,
511 __be16 proto, u16 vid)
512{
513 if (!fs->vlan) {
514 fs_err(fs, "Vlan doesn't exist\n");
515 return -EINVAL;
516 }
517
518 if (be16_to_cpu(proto) == ETH_P_8021Q) {
519 clear_bit(nr: vid, addr: fs->vlan->active_cvlans);
520 mlx5e_fs_del_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID, vid);
521 } else if (be16_to_cpu(proto) == ETH_P_8021AD) {
522 clear_bit(nr: vid, addr: fs->vlan->active_svlans);
523 mlx5e_fs_del_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID, vid);
524 netdev_update_features(dev: netdev);
525 }
526
527 return 0;
528}
529
530static void mlx5e_fs_add_vlan_rules(struct mlx5e_flow_steering *fs)
531{
532 int i;
533
534 mlx5e_add_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_UNTAGGED, vid: 0);
535
536 for_each_set_bit(i, fs->vlan->active_cvlans, VLAN_N_VID) {
537 mlx5e_add_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID, vid: i);
538 }
539
540 for_each_set_bit(i, fs->vlan->active_svlans, VLAN_N_VID)
541 mlx5e_add_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID, vid: i);
542
543 if (fs->vlan->cvlan_filter_disabled)
544 mlx5e_fs_add_any_vid_rules(fs);
545}
546
547static void mlx5e_del_vlan_rules(struct mlx5e_flow_steering *fs)
548{
549 int i;
550
551 mlx5e_fs_del_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_UNTAGGED, vid: 0);
552
553 for_each_set_bit(i, fs->vlan->active_cvlans, VLAN_N_VID) {
554 mlx5e_fs_del_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_MATCH_CTAG_VID, vid: i);
555 }
556
557 for_each_set_bit(i, fs->vlan->active_svlans, VLAN_N_VID)
558 mlx5e_fs_del_vlan_rule(fs, rule_type: MLX5E_VLAN_RULE_TYPE_MATCH_STAG_VID, vid: i);
559
560 WARN_ON_ONCE(fs->state_destroy);
561
562 mlx5e_remove_vlan_trap(fs);
563
564 /* must be called after DESTROY bit is set and
565 * set_rx_mode is called and flushed
566 */
567 if (fs->vlan->cvlan_filter_disabled)
568 mlx5e_fs_del_any_vid_rules(fs);
569}
570
571#define mlx5e_for_each_hash_node(hn, tmp, hash, i) \
572 for (i = 0; i < MLX5E_L2_ADDR_HASH_SIZE; i++) \
573 hlist_for_each_entry_safe(hn, tmp, &hash[i], hlist)
574
575static void mlx5e_execute_l2_action(struct mlx5e_flow_steering *fs,
576 struct mlx5e_l2_hash_node *hn)
577{
578 u8 action = hn->action;
579 u8 mac_addr[ETH_ALEN];
580 int l2_err = 0;
581
582 ether_addr_copy(dst: mac_addr, src: hn->ai.addr);
583
584 switch (action) {
585 case MLX5E_ACTION_ADD:
586 mlx5e_add_l2_flow_rule(fs, ai: &hn->ai, type: MLX5E_FULLMATCH);
587 if (!is_multicast_ether_addr(addr: mac_addr)) {
588 l2_err = mlx5_mpfs_add_mac(dev: fs->mdev, mac: mac_addr);
589 hn->mpfs = !l2_err;
590 }
591 hn->action = MLX5E_ACTION_NONE;
592 break;
593
594 case MLX5E_ACTION_DEL:
595 if (!is_multicast_ether_addr(addr: mac_addr) && hn->mpfs)
596 l2_err = mlx5_mpfs_del_mac(dev: fs->mdev, mac: mac_addr);
597 mlx5e_del_l2_flow_rule(fs, ai: &hn->ai);
598 mlx5e_del_l2_from_hash(hn);
599 break;
600 }
601
602 if (l2_err)
603 fs_warn(fs, "MPFS, failed to %s mac %pM, err(%d)\n",
604 action == MLX5E_ACTION_ADD ? "add" : "del",
605 mac_addr, l2_err);
606}
607
608static void mlx5e_sync_netdev_addr(struct mlx5e_flow_steering *fs,
609 struct net_device *netdev)
610{
611 struct netdev_hw_addr *ha;
612
613 netif_addr_lock_bh(dev: netdev);
614
615 mlx5e_add_l2_to_hash(hash: fs->l2.netdev_uc, addr: netdev->dev_addr);
616 netdev_for_each_uc_addr(ha, netdev)
617 mlx5e_add_l2_to_hash(hash: fs->l2.netdev_uc, addr: ha->addr);
618
619 netdev_for_each_mc_addr(ha, netdev)
620 mlx5e_add_l2_to_hash(hash: fs->l2.netdev_mc, addr: ha->addr);
621
622 netif_addr_unlock_bh(dev: netdev);
623}
624
625static void mlx5e_fill_addr_array(struct mlx5e_flow_steering *fs, int list_type,
626 struct net_device *ndev,
627 u8 addr_array[][ETH_ALEN], int size)
628{
629 bool is_uc = (list_type == MLX5_NVPRT_LIST_TYPE_UC);
630 struct mlx5e_l2_hash_node *hn;
631 struct hlist_head *addr_list;
632 struct hlist_node *tmp;
633 int i = 0;
634 int hi;
635
636 addr_list = is_uc ? fs->l2.netdev_uc : fs->l2.netdev_mc;
637
638 if (is_uc) /* Make sure our own address is pushed first */
639 ether_addr_copy(dst: addr_array[i++], src: ndev->dev_addr);
640 else if (fs->l2.broadcast_enabled)
641 ether_addr_copy(dst: addr_array[i++], src: ndev->broadcast);
642
643 mlx5e_for_each_hash_node(hn, tmp, addr_list, hi) {
644 if (ether_addr_equal(addr1: ndev->dev_addr, addr2: hn->ai.addr))
645 continue;
646 if (i >= size)
647 break;
648 ether_addr_copy(dst: addr_array[i++], src: hn->ai.addr);
649 }
650}
651
652static void mlx5e_vport_context_update_addr_list(struct mlx5e_flow_steering *fs,
653 struct net_device *netdev,
654 int list_type)
655{
656 bool is_uc = (list_type == MLX5_NVPRT_LIST_TYPE_UC);
657 struct mlx5e_l2_hash_node *hn;
658 u8 (*addr_array)[ETH_ALEN] = NULL;
659 struct hlist_head *addr_list;
660 struct hlist_node *tmp;
661 int max_size;
662 int size;
663 int err;
664 int hi;
665
666 size = is_uc ? 0 : (fs->l2.broadcast_enabled ? 1 : 0);
667 max_size = is_uc ?
668 1 << MLX5_CAP_GEN(fs->mdev, log_max_current_uc_list) :
669 1 << MLX5_CAP_GEN(fs->mdev, log_max_current_mc_list);
670
671 addr_list = is_uc ? fs->l2.netdev_uc : fs->l2.netdev_mc;
672 mlx5e_for_each_hash_node(hn, tmp, addr_list, hi)
673 size++;
674
675 if (size > max_size) {
676 fs_warn(fs, "mdev %s list size (%d) > (%d) max vport list size, some addresses will be dropped\n",
677 is_uc ? "UC" : "MC", size, max_size);
678 size = max_size;
679 }
680
681 if (size) {
682 addr_array = kcalloc(n: size, ETH_ALEN, GFP_KERNEL);
683 if (!addr_array) {
684 err = -ENOMEM;
685 goto out;
686 }
687 mlx5e_fill_addr_array(fs, list_type, ndev: netdev, addr_array, size);
688 }
689
690 err = mlx5_modify_nic_vport_mac_list(dev: fs->mdev, list_type, addr_list: addr_array, list_size: size);
691out:
692 if (err)
693 fs_err(fs, "Failed to modify vport %s list err(%d)\n",
694 is_uc ? "UC" : "MC", err);
695 kfree(objp: addr_array);
696}
697
698static void mlx5e_vport_context_update(struct mlx5e_flow_steering *fs,
699 struct net_device *netdev)
700{
701 struct mlx5e_l2_table *ea = &fs->l2;
702
703 mlx5e_vport_context_update_addr_list(fs, netdev, list_type: MLX5_NVPRT_LIST_TYPE_UC);
704 mlx5e_vport_context_update_addr_list(fs, netdev, list_type: MLX5_NVPRT_LIST_TYPE_MC);
705 mlx5_modify_nic_vport_promisc(mdev: fs->mdev, promisc_uc: 0,
706 promisc_mc: ea->allmulti_enabled,
707 promisc_all: ea->promisc_enabled);
708}
709
710static void mlx5e_apply_netdev_addr(struct mlx5e_flow_steering *fs)
711{
712 struct mlx5e_l2_hash_node *hn;
713 struct hlist_node *tmp;
714 int i;
715
716 mlx5e_for_each_hash_node(hn, tmp, fs->l2.netdev_uc, i)
717 mlx5e_execute_l2_action(fs, hn);
718
719 mlx5e_for_each_hash_node(hn, tmp, fs->l2.netdev_mc, i)
720 mlx5e_execute_l2_action(fs, hn);
721}
722
723static void mlx5e_handle_netdev_addr(struct mlx5e_flow_steering *fs,
724 struct net_device *netdev)
725{
726 struct mlx5e_l2_hash_node *hn;
727 struct hlist_node *tmp;
728 int i;
729
730 mlx5e_for_each_hash_node(hn, tmp, fs->l2.netdev_uc, i)
731 hn->action = MLX5E_ACTION_DEL;
732 mlx5e_for_each_hash_node(hn, tmp, fs->l2.netdev_mc, i)
733 hn->action = MLX5E_ACTION_DEL;
734
735 if (fs->state_destroy)
736 mlx5e_sync_netdev_addr(fs, netdev);
737
738 mlx5e_apply_netdev_addr(fs);
739}
740
741#define MLX5E_PROMISC_GROUP0_SIZE BIT(0)
742#define MLX5E_PROMISC_TABLE_SIZE MLX5E_PROMISC_GROUP0_SIZE
743
744static int mlx5e_add_promisc_rule(struct mlx5e_flow_steering *fs)
745{
746 struct mlx5_flow_table *ft = fs->promisc.ft.t;
747 struct mlx5_flow_destination dest = {};
748 struct mlx5_flow_handle **rule_p;
749 MLX5_DECLARE_FLOW_ACT(flow_act);
750 struct mlx5_flow_spec *spec;
751 int err = 0;
752
753 spec = kvzalloc(size: sizeof(*spec), GFP_KERNEL);
754 if (!spec)
755 return -ENOMEM;
756 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
757 dest.ft = mlx5_get_ttc_flow_table(ttc: fs->ttc);
758
759 rule_p = &fs->promisc.rule;
760 *rule_p = mlx5_add_flow_rules(ft, spec, flow_act: &flow_act, dest: &dest, num_dest: 1);
761 if (IS_ERR(ptr: *rule_p)) {
762 err = PTR_ERR(ptr: *rule_p);
763 *rule_p = NULL;
764 fs_err(fs, "add promiscuous rule failed\n");
765 }
766 kvfree(addr: spec);
767 return err;
768}
769
770static int mlx5e_create_promisc_table(struct mlx5e_flow_steering *fs)
771{
772 struct mlx5e_flow_table *ft = &fs->promisc.ft;
773 struct mlx5_flow_table_attr ft_attr = {};
774 int err;
775
776 ft_attr.max_fte = MLX5E_PROMISC_TABLE_SIZE;
777 ft_attr.autogroup.max_num_groups = 1;
778 ft_attr.level = MLX5E_PROMISC_FT_LEVEL;
779 ft_attr.prio = MLX5E_NIC_PRIO;
780
781 ft->t = mlx5_create_auto_grouped_flow_table(ns: fs->ns, ft_attr: &ft_attr);
782 if (IS_ERR(ptr: ft->t)) {
783 err = PTR_ERR(ptr: ft->t);
784 ft->t = NULL;
785 fs_err(fs, "fail to create promisc table err=%d\n", err);
786 return err;
787 }
788
789 err = mlx5e_add_promisc_rule(fs);
790 if (err)
791 goto err_destroy_promisc_table;
792
793 return 0;
794
795err_destroy_promisc_table:
796 mlx5_destroy_flow_table(ft: ft->t);
797 ft->t = NULL;
798
799 return err;
800}
801
802static void mlx5e_del_promisc_rule(struct mlx5e_flow_steering *fs)
803{
804 if (WARN(!fs->promisc.rule, "Trying to remove non-existing promiscuous rule"))
805 return;
806 mlx5_del_flow_rules(fr: fs->promisc.rule);
807 fs->promisc.rule = NULL;
808}
809
810static void mlx5e_destroy_promisc_table(struct mlx5e_flow_steering *fs)
811{
812 if (!fs->promisc.ft.t)
813 return;
814 mlx5e_del_promisc_rule(fs);
815 mlx5_destroy_flow_table(ft: fs->promisc.ft.t);
816 fs->promisc.ft.t = NULL;
817}
818
819void mlx5e_fs_set_rx_mode_work(struct mlx5e_flow_steering *fs,
820 struct net_device *netdev)
821{
822 struct mlx5e_l2_table *ea = &fs->l2;
823
824 bool rx_mode_enable = fs->state_destroy;
825 bool promisc_enabled = rx_mode_enable && (netdev->flags & IFF_PROMISC);
826 bool allmulti_enabled = rx_mode_enable && (netdev->flags & IFF_ALLMULTI);
827 bool broadcast_enabled = rx_mode_enable;
828
829 bool enable_promisc = !ea->promisc_enabled && promisc_enabled;
830 bool disable_promisc = ea->promisc_enabled && !promisc_enabled;
831 bool enable_allmulti = !ea->allmulti_enabled && allmulti_enabled;
832 bool disable_allmulti = ea->allmulti_enabled && !allmulti_enabled;
833 bool enable_broadcast = !ea->broadcast_enabled && broadcast_enabled;
834 bool disable_broadcast = ea->broadcast_enabled && !broadcast_enabled;
835 int err;
836
837 if (enable_promisc) {
838 err = mlx5e_create_promisc_table(fs);
839 if (err)
840 enable_promisc = false;
841 if (!fs->vlan_strip_disable && !err)
842 fs_warn_once(fs,
843 "S-tagged traffic will be dropped while C-tag vlan stripping is enabled\n");
844 }
845 if (enable_allmulti)
846 mlx5e_add_l2_flow_rule(fs, ai: &ea->allmulti, type: MLX5E_ALLMULTI);
847 if (enable_broadcast)
848 mlx5e_add_l2_flow_rule(fs, ai: &ea->broadcast, type: MLX5E_FULLMATCH);
849
850 mlx5e_handle_netdev_addr(fs, netdev);
851
852 if (disable_broadcast)
853 mlx5e_del_l2_flow_rule(fs, ai: &ea->broadcast);
854 if (disable_allmulti)
855 mlx5e_del_l2_flow_rule(fs, ai: &ea->allmulti);
856 if (disable_promisc)
857 mlx5e_destroy_promisc_table(fs);
858
859 ea->promisc_enabled = promisc_enabled;
860 ea->allmulti_enabled = allmulti_enabled;
861 ea->broadcast_enabled = broadcast_enabled;
862
863 mlx5e_vport_context_update(fs, netdev);
864}
865
866static void mlx5e_destroy_groups(struct mlx5e_flow_table *ft)
867{
868 int i;
869
870 for (i = ft->num_groups - 1; i >= 0; i--) {
871 if (!IS_ERR_OR_NULL(ptr: ft->g[i]))
872 mlx5_destroy_flow_group(fg: ft->g[i]);
873 ft->g[i] = NULL;
874 }
875 ft->num_groups = 0;
876}
877
878void mlx5e_fs_init_l2_addr(struct mlx5e_flow_steering *fs, struct net_device *netdev)
879{
880 ether_addr_copy(dst: fs->l2.broadcast.addr, src: netdev->broadcast);
881}
882
883void mlx5e_destroy_flow_table(struct mlx5e_flow_table *ft)
884{
885 mlx5e_destroy_groups(ft);
886 kfree(objp: ft->g);
887 mlx5_destroy_flow_table(ft: ft->t);
888 ft->t = NULL;
889}
890
891static void mlx5e_set_inner_ttc_params(struct mlx5e_flow_steering *fs,
892 struct mlx5e_rx_res *rx_res,
893 struct ttc_params *ttc_params)
894{
895 struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
896 int tt;
897
898 memset(ttc_params, 0, sizeof(*ttc_params));
899 ttc_params->ns = mlx5_get_flow_namespace(dev: fs->mdev,
900 type: MLX5_FLOW_NAMESPACE_KERNEL);
901 ft_attr->level = MLX5E_INNER_TTC_FT_LEVEL;
902 ft_attr->prio = MLX5E_NIC_PRIO;
903
904 for (tt = 0; tt < MLX5_NUM_TT; tt++) {
905 ttc_params->dests[tt].type = MLX5_FLOW_DESTINATION_TYPE_TIR;
906 ttc_params->dests[tt].tir_num =
907 tt == MLX5_TT_ANY ?
908 mlx5e_rx_res_get_tirn_direct(res: rx_res, ix: 0) :
909 mlx5e_rx_res_get_tirn_rss_inner(res: rx_res,
910 tt);
911 }
912}
913
914void mlx5e_set_ttc_params(struct mlx5e_flow_steering *fs,
915 struct mlx5e_rx_res *rx_res,
916 struct ttc_params *ttc_params, bool tunnel)
917
918{
919 struct mlx5_flow_table_attr *ft_attr = &ttc_params->ft_attr;
920 int tt;
921
922 memset(ttc_params, 0, sizeof(*ttc_params));
923 ttc_params->ns = mlx5_get_flow_namespace(dev: fs->mdev,
924 type: MLX5_FLOW_NAMESPACE_KERNEL);
925 ft_attr->level = MLX5E_TTC_FT_LEVEL;
926 ft_attr->prio = MLX5E_NIC_PRIO;
927
928 for (tt = 0; tt < MLX5_NUM_TT; tt++) {
929 ttc_params->dests[tt].type = MLX5_FLOW_DESTINATION_TYPE_TIR;
930 ttc_params->dests[tt].tir_num =
931 tt == MLX5_TT_ANY ?
932 mlx5e_rx_res_get_tirn_direct(res: rx_res, ix: 0) :
933 mlx5e_rx_res_get_tirn_rss(res: rx_res, tt);
934 }
935
936 ttc_params->inner_ttc = tunnel;
937 if (!tunnel || !mlx5_tunnel_inner_ft_supported(mdev: fs->mdev))
938 return;
939
940 for (tt = 0; tt < MLX5_NUM_TUNNEL_TT; tt++) {
941 ttc_params->tunnel_dests[tt].type =
942 MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
943 ttc_params->tunnel_dests[tt].ft =
944 mlx5_get_ttc_flow_table(ttc: fs->inner_ttc);
945 }
946}
947
948static void mlx5e_del_l2_flow_rule(struct mlx5e_flow_steering *fs,
949 struct mlx5e_l2_rule *ai)
950{
951 if (!IS_ERR_OR_NULL(ptr: ai->rule)) {
952 mlx5_del_flow_rules(fr: ai->rule);
953 ai->rule = NULL;
954 }
955}
956
957static int mlx5e_add_l2_flow_rule(struct mlx5e_flow_steering *fs,
958 struct mlx5e_l2_rule *ai, int type)
959{
960 struct mlx5_flow_table *ft = fs->l2.ft.t;
961 struct mlx5_flow_destination dest = {};
962 MLX5_DECLARE_FLOW_ACT(flow_act);
963 struct mlx5_flow_spec *spec;
964 int err = 0;
965 u8 *mc_dmac;
966 u8 *mv_dmac;
967
968 spec = kvzalloc(size: sizeof(*spec), GFP_KERNEL);
969 if (!spec)
970 return -ENOMEM;
971
972 mc_dmac = MLX5_ADDR_OF(fte_match_param, spec->match_criteria,
973 outer_headers.dmac_47_16);
974 mv_dmac = MLX5_ADDR_OF(fte_match_param, spec->match_value,
975 outer_headers.dmac_47_16);
976
977 dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
978 dest.ft = mlx5_get_ttc_flow_table(ttc: fs->ttc);
979
980 switch (type) {
981 case MLX5E_FULLMATCH:
982 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
983 eth_broadcast_addr(addr: mc_dmac);
984 ether_addr_copy(dst: mv_dmac, src: ai->addr);
985 break;
986
987 case MLX5E_ALLMULTI:
988 spec->match_criteria_enable = MLX5_MATCH_OUTER_HEADERS;
989 mc_dmac[0] = 0x01;
990 mv_dmac[0] = 0x01;
991 break;
992 }
993
994 ai->rule = mlx5_add_flow_rules(ft, spec, flow_act: &flow_act, dest: &dest, num_dest: 1);
995 if (IS_ERR(ptr: ai->rule)) {
996 fs_err(fs, "add l2 rule(mac:%pM) failed\n", mv_dmac);
997 err = PTR_ERR(ptr: ai->rule);
998 ai->rule = NULL;
999 }
1000
1001 kvfree(addr: spec);
1002
1003 return err;
1004}
1005
1006#define MLX5E_NUM_L2_GROUPS 3
1007#define MLX5E_L2_GROUP1_SIZE BIT(15)
1008#define MLX5E_L2_GROUP2_SIZE BIT(0)
1009#define MLX5E_L2_GROUP_TRAP_SIZE BIT(0) /* must be last */
1010#define MLX5E_L2_TABLE_SIZE (MLX5E_L2_GROUP1_SIZE +\
1011 MLX5E_L2_GROUP2_SIZE +\
1012 MLX5E_L2_GROUP_TRAP_SIZE)
1013static int mlx5e_create_l2_table_groups(struct mlx5e_l2_table *l2_table)
1014{
1015 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1016 struct mlx5e_flow_table *ft = &l2_table->ft;
1017 int ix = 0;
1018 u8 *mc_dmac;
1019 u32 *in;
1020 int err;
1021 u8 *mc;
1022
1023 ft->g = kcalloc(MLX5E_NUM_L2_GROUPS, size: sizeof(*ft->g), GFP_KERNEL);
1024 if (!ft->g)
1025 return -ENOMEM;
1026 in = kvzalloc(size: inlen, GFP_KERNEL);
1027 if (!in) {
1028 kfree(objp: ft->g);
1029 return -ENOMEM;
1030 }
1031
1032 mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
1033 mc_dmac = MLX5_ADDR_OF(fte_match_param, mc,
1034 outer_headers.dmac_47_16);
1035 /* Flow Group for full match */
1036 eth_broadcast_addr(addr: mc_dmac);
1037 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1038 MLX5_SET_CFG(in, start_flow_index, ix);
1039 ix += MLX5E_L2_GROUP1_SIZE;
1040 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1041 ft->g[ft->num_groups] = mlx5_create_flow_group(ft: ft->t, in);
1042 if (IS_ERR(ptr: ft->g[ft->num_groups]))
1043 goto err_destroy_groups;
1044 ft->num_groups++;
1045
1046 /* Flow Group for allmulti */
1047 eth_zero_addr(addr: mc_dmac);
1048 mc_dmac[0] = 0x01;
1049 MLX5_SET_CFG(in, start_flow_index, ix);
1050 ix += MLX5E_L2_GROUP2_SIZE;
1051 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1052 ft->g[ft->num_groups] = mlx5_create_flow_group(ft: ft->t, in);
1053 if (IS_ERR(ptr: ft->g[ft->num_groups]))
1054 goto err_destroy_groups;
1055 ft->num_groups++;
1056
1057 /* Flow Group for l2 traps */
1058 memset(in, 0, inlen);
1059 MLX5_SET_CFG(in, start_flow_index, ix);
1060 ix += MLX5E_L2_GROUP_TRAP_SIZE;
1061 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1062 ft->g[ft->num_groups] = mlx5_create_flow_group(ft: ft->t, in);
1063 if (IS_ERR(ptr: ft->g[ft->num_groups]))
1064 goto err_destroy_groups;
1065 ft->num_groups++;
1066
1067 kvfree(addr: in);
1068 return 0;
1069
1070err_destroy_groups:
1071 err = PTR_ERR(ptr: ft->g[ft->num_groups]);
1072 ft->g[ft->num_groups] = NULL;
1073 mlx5e_destroy_groups(ft);
1074 kvfree(addr: in);
1075 kfree(objp: ft->g);
1076
1077 return err;
1078}
1079
1080static void mlx5e_destroy_l2_table(struct mlx5e_flow_steering *fs)
1081{
1082 mlx5e_destroy_flow_table(ft: &fs->l2.ft);
1083}
1084
1085static int mlx5e_create_l2_table(struct mlx5e_flow_steering *fs)
1086{
1087 struct mlx5e_l2_table *l2_table = &fs->l2;
1088 struct mlx5e_flow_table *ft = &l2_table->ft;
1089 struct mlx5_flow_table_attr ft_attr = {};
1090 int err;
1091
1092 ft->num_groups = 0;
1093
1094 ft_attr.max_fte = MLX5E_L2_TABLE_SIZE;
1095 ft_attr.level = MLX5E_L2_FT_LEVEL;
1096 ft_attr.prio = MLX5E_NIC_PRIO;
1097
1098 ft->t = mlx5_create_flow_table(ns: fs->ns, ft_attr: &ft_attr);
1099 if (IS_ERR(ptr: ft->t)) {
1100 err = PTR_ERR(ptr: ft->t);
1101 ft->t = NULL;
1102 return err;
1103 }
1104
1105 err = mlx5e_create_l2_table_groups(l2_table);
1106 if (err)
1107 goto err_destroy_flow_table;
1108
1109 return 0;
1110
1111err_destroy_flow_table:
1112 mlx5_destroy_flow_table(ft: ft->t);
1113 ft->t = NULL;
1114
1115 return err;
1116}
1117
1118#define MLX5E_NUM_VLAN_GROUPS 5
1119#define MLX5E_VLAN_GROUP0_SIZE BIT(12)
1120#define MLX5E_VLAN_GROUP1_SIZE BIT(12)
1121#define MLX5E_VLAN_GROUP2_SIZE BIT(1)
1122#define MLX5E_VLAN_GROUP3_SIZE BIT(0)
1123#define MLX5E_VLAN_GROUP_TRAP_SIZE BIT(0) /* must be last */
1124#define MLX5E_VLAN_TABLE_SIZE (MLX5E_VLAN_GROUP0_SIZE +\
1125 MLX5E_VLAN_GROUP1_SIZE +\
1126 MLX5E_VLAN_GROUP2_SIZE +\
1127 MLX5E_VLAN_GROUP3_SIZE +\
1128 MLX5E_VLAN_GROUP_TRAP_SIZE)
1129
1130static int __mlx5e_create_vlan_table_groups(struct mlx5e_flow_table *ft, u32 *in,
1131 int inlen)
1132{
1133 int err;
1134 int ix = 0;
1135 u8 *mc = MLX5_ADDR_OF(create_flow_group_in, in, match_criteria);
1136
1137 memset(in, 0, inlen);
1138 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1139 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.cvlan_tag);
1140 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.first_vid);
1141 MLX5_SET_CFG(in, start_flow_index, ix);
1142 ix += MLX5E_VLAN_GROUP0_SIZE;
1143 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1144 ft->g[ft->num_groups] = mlx5_create_flow_group(ft: ft->t, in);
1145 if (IS_ERR(ptr: ft->g[ft->num_groups]))
1146 goto err_destroy_groups;
1147 ft->num_groups++;
1148
1149 memset(in, 0, inlen);
1150 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1151 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.svlan_tag);
1152 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.first_vid);
1153 MLX5_SET_CFG(in, start_flow_index, ix);
1154 ix += MLX5E_VLAN_GROUP1_SIZE;
1155 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1156 ft->g[ft->num_groups] = mlx5_create_flow_group(ft: ft->t, in);
1157 if (IS_ERR(ptr: ft->g[ft->num_groups]))
1158 goto err_destroy_groups;
1159 ft->num_groups++;
1160
1161 memset(in, 0, inlen);
1162 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1163 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.cvlan_tag);
1164 MLX5_SET_CFG(in, start_flow_index, ix);
1165 ix += MLX5E_VLAN_GROUP2_SIZE;
1166 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1167 ft->g[ft->num_groups] = mlx5_create_flow_group(ft: ft->t, in);
1168 if (IS_ERR(ptr: ft->g[ft->num_groups]))
1169 goto err_destroy_groups;
1170 ft->num_groups++;
1171
1172 memset(in, 0, inlen);
1173 MLX5_SET_CFG(in, match_criteria_enable, MLX5_MATCH_OUTER_HEADERS);
1174 MLX5_SET_TO_ONES(fte_match_param, mc, outer_headers.svlan_tag);
1175 MLX5_SET_CFG(in, start_flow_index, ix);
1176 ix += MLX5E_VLAN_GROUP3_SIZE;
1177 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1178 ft->g[ft->num_groups] = mlx5_create_flow_group(ft: ft->t, in);
1179 if (IS_ERR(ptr: ft->g[ft->num_groups]))
1180 goto err_destroy_groups;
1181 ft->num_groups++;
1182
1183 memset(in, 0, inlen);
1184 MLX5_SET_CFG(in, start_flow_index, ix);
1185 ix += MLX5E_VLAN_GROUP_TRAP_SIZE;
1186 MLX5_SET_CFG(in, end_flow_index, ix - 1);
1187 ft->g[ft->num_groups] = mlx5_create_flow_group(ft: ft->t, in);
1188 if (IS_ERR(ptr: ft->g[ft->num_groups]))
1189 goto err_destroy_groups;
1190 ft->num_groups++;
1191
1192 return 0;
1193
1194err_destroy_groups:
1195 err = PTR_ERR(ptr: ft->g[ft->num_groups]);
1196 ft->g[ft->num_groups] = NULL;
1197 mlx5e_destroy_groups(ft);
1198
1199 return err;
1200}
1201
1202static int mlx5e_create_vlan_table_groups(struct mlx5e_flow_table *ft)
1203{
1204 u32 *in;
1205 int inlen = MLX5_ST_SZ_BYTES(create_flow_group_in);
1206 int err;
1207
1208 in = kvzalloc(size: inlen, GFP_KERNEL);
1209 if (!in)
1210 return -ENOMEM;
1211
1212 err = __mlx5e_create_vlan_table_groups(ft, in, inlen);
1213
1214 kvfree(addr: in);
1215 return err;
1216}
1217
1218static int mlx5e_fs_create_vlan_table(struct mlx5e_flow_steering *fs)
1219{
1220 struct mlx5_flow_table_attr ft_attr = {};
1221 struct mlx5e_flow_table *ft;
1222 int err;
1223
1224 ft = &fs->vlan->ft;
1225 ft->num_groups = 0;
1226
1227 ft_attr.max_fte = MLX5E_VLAN_TABLE_SIZE;
1228 ft_attr.level = MLX5E_VLAN_FT_LEVEL;
1229 ft_attr.prio = MLX5E_NIC_PRIO;
1230
1231 ft->t = mlx5_create_flow_table(ns: fs->ns, ft_attr: &ft_attr);
1232 if (IS_ERR(ptr: ft->t))
1233 return PTR_ERR(ptr: ft->t);
1234
1235 ft->g = kcalloc(MLX5E_NUM_VLAN_GROUPS, size: sizeof(*ft->g), GFP_KERNEL);
1236 if (!ft->g) {
1237 err = -ENOMEM;
1238 goto err_destroy_vlan_table;
1239 }
1240
1241 err = mlx5e_create_vlan_table_groups(ft);
1242 if (err)
1243 goto err_free_g;
1244
1245 mlx5e_fs_add_vlan_rules(fs);
1246
1247 return 0;
1248
1249err_free_g:
1250 kfree(objp: ft->g);
1251err_destroy_vlan_table:
1252 mlx5_destroy_flow_table(ft: ft->t);
1253
1254 return err;
1255}
1256
1257static void mlx5e_destroy_vlan_table(struct mlx5e_flow_steering *fs)
1258{
1259 mlx5e_del_vlan_rules(fs);
1260 mlx5e_destroy_flow_table(ft: &fs->vlan->ft);
1261}
1262
1263static void mlx5e_destroy_inner_ttc_table(struct mlx5e_flow_steering *fs)
1264{
1265 if (!mlx5_tunnel_inner_ft_supported(mdev: fs->mdev))
1266 return;
1267 mlx5_destroy_ttc_table(ttc: fs->inner_ttc);
1268}
1269
1270void mlx5e_destroy_ttc_table(struct mlx5e_flow_steering *fs)
1271{
1272 mlx5_destroy_ttc_table(ttc: fs->ttc);
1273}
1274
1275static int mlx5e_create_inner_ttc_table(struct mlx5e_flow_steering *fs,
1276 struct mlx5e_rx_res *rx_res)
1277{
1278 struct ttc_params ttc_params = {};
1279
1280 if (!mlx5_tunnel_inner_ft_supported(mdev: fs->mdev))
1281 return 0;
1282
1283 mlx5e_set_inner_ttc_params(fs, rx_res, ttc_params: &ttc_params);
1284 fs->inner_ttc = mlx5_create_inner_ttc_table(dev: fs->mdev,
1285 params: &ttc_params);
1286 return PTR_ERR_OR_ZERO(ptr: fs->inner_ttc);
1287}
1288
1289int mlx5e_create_ttc_table(struct mlx5e_flow_steering *fs,
1290 struct mlx5e_rx_res *rx_res)
1291{
1292 struct ttc_params ttc_params = {};
1293
1294 mlx5e_set_ttc_params(fs, rx_res, ttc_params: &ttc_params, tunnel: true);
1295 fs->ttc = mlx5_create_ttc_table(dev: fs->mdev, params: &ttc_params);
1296 return PTR_ERR_OR_ZERO(ptr: fs->ttc);
1297}
1298
1299int mlx5e_create_flow_steering(struct mlx5e_flow_steering *fs,
1300 struct mlx5e_rx_res *rx_res,
1301 const struct mlx5e_profile *profile,
1302 struct net_device *netdev)
1303{
1304 struct mlx5_flow_namespace *ns = mlx5_get_flow_namespace(dev: fs->mdev,
1305 type: MLX5_FLOW_NAMESPACE_KERNEL);
1306 int err;
1307
1308 if (!ns)
1309 return -EOPNOTSUPP;
1310
1311 mlx5e_fs_set_ns(fs, ns, egress: false);
1312 err = mlx5e_arfs_create_tables(fs, rx_res,
1313 ntuple: !!(netdev->hw_features & NETIF_F_NTUPLE));
1314 if (err) {
1315 fs_err(fs, "Failed to create arfs tables, err=%d\n", err);
1316 netdev->hw_features &= ~NETIF_F_NTUPLE;
1317 }
1318
1319 err = mlx5e_create_inner_ttc_table(fs, rx_res);
1320 if (err) {
1321 fs_err(fs, "Failed to create inner ttc table, err=%d\n", err);
1322 goto err_destroy_arfs_tables;
1323 }
1324
1325 err = mlx5e_create_ttc_table(fs, rx_res);
1326 if (err) {
1327 fs_err(fs, "Failed to create ttc table, err=%d\n", err);
1328 goto err_destroy_inner_ttc_table;
1329 }
1330
1331 err = mlx5e_create_l2_table(fs);
1332 if (err) {
1333 fs_err(fs, "Failed to create l2 table, err=%d\n", err);
1334 goto err_destroy_ttc_table;
1335 }
1336
1337 err = mlx5e_fs_create_vlan_table(fs);
1338 if (err) {
1339 fs_err(fs, "Failed to create vlan table, err=%d\n", err);
1340 goto err_destroy_l2_table;
1341 }
1342
1343 err = mlx5e_ptp_alloc_rx_fs(fs, profile);
1344 if (err)
1345 goto err_destory_vlan_table;
1346
1347 mlx5e_ethtool_init_steering(fs);
1348
1349 return 0;
1350
1351err_destory_vlan_table:
1352 mlx5e_destroy_vlan_table(fs);
1353err_destroy_l2_table:
1354 mlx5e_destroy_l2_table(fs);
1355err_destroy_ttc_table:
1356 mlx5e_destroy_ttc_table(fs);
1357err_destroy_inner_ttc_table:
1358 mlx5e_destroy_inner_ttc_table(fs);
1359err_destroy_arfs_tables:
1360 mlx5e_arfs_destroy_tables(fs, ntuple: !!(netdev->hw_features & NETIF_F_NTUPLE));
1361
1362 return err;
1363}
1364
1365void mlx5e_destroy_flow_steering(struct mlx5e_flow_steering *fs, bool ntuple,
1366 const struct mlx5e_profile *profile)
1367{
1368 mlx5e_ptp_free_rx_fs(fs, profile);
1369 mlx5e_destroy_vlan_table(fs);
1370 mlx5e_destroy_l2_table(fs);
1371 mlx5e_destroy_ttc_table(fs);
1372 mlx5e_destroy_inner_ttc_table(fs);
1373 mlx5e_arfs_destroy_tables(fs, ntuple);
1374 mlx5e_ethtool_cleanup_steering(fs);
1375}
1376
1377static int mlx5e_fs_vlan_alloc(struct mlx5e_flow_steering *fs)
1378{
1379 fs->vlan = kvzalloc(size: sizeof(*fs->vlan), GFP_KERNEL);
1380 if (!fs->vlan)
1381 return -ENOMEM;
1382 return 0;
1383}
1384
1385static void mlx5e_fs_vlan_free(struct mlx5e_flow_steering *fs)
1386{
1387 kvfree(addr: fs->vlan);
1388}
1389
1390struct mlx5e_vlan_table *mlx5e_fs_get_vlan(struct mlx5e_flow_steering *fs)
1391{
1392 return fs->vlan;
1393}
1394
1395static int mlx5e_fs_tc_alloc(struct mlx5e_flow_steering *fs)
1396{
1397 fs->tc = mlx5e_tc_table_alloc();
1398 if (IS_ERR(ptr: fs->tc))
1399 return -ENOMEM;
1400 return 0;
1401}
1402
1403static void mlx5e_fs_tc_free(struct mlx5e_flow_steering *fs)
1404{
1405 mlx5e_tc_table_free(tc: fs->tc);
1406}
1407
1408struct mlx5e_tc_table *mlx5e_fs_get_tc(struct mlx5e_flow_steering *fs)
1409{
1410 return fs->tc;
1411}
1412
1413#ifdef CONFIG_MLX5_EN_RXNFC
1414static int mlx5e_fs_ethtool_alloc(struct mlx5e_flow_steering *fs)
1415{
1416 return mlx5e_ethtool_alloc(ethtool: &fs->ethtool);
1417}
1418
1419static void mlx5e_fs_ethtool_free(struct mlx5e_flow_steering *fs)
1420{
1421 mlx5e_ethtool_free(ethtool: fs->ethtool);
1422}
1423
1424struct mlx5e_ethtool_steering *mlx5e_fs_get_ethtool(struct mlx5e_flow_steering *fs)
1425{
1426 return fs->ethtool;
1427}
1428#else
1429static int mlx5e_fs_ethtool_alloc(struct mlx5e_flow_steering *fs)
1430{ return 0; }
1431static void mlx5e_fs_ethtool_free(struct mlx5e_flow_steering *fs) { }
1432#endif
1433
1434static void mlx5e_fs_debugfs_init(struct mlx5e_flow_steering *fs,
1435 struct dentry *dfs_root)
1436{
1437 if (IS_ERR_OR_NULL(ptr: dfs_root))
1438 return;
1439
1440 fs->dfs_root = debugfs_create_dir(name: "fs", parent: dfs_root);
1441}
1442
1443struct mlx5e_flow_steering *mlx5e_fs_init(const struct mlx5e_profile *profile,
1444 struct mlx5_core_dev *mdev,
1445 bool state_destroy,
1446 struct dentry *dfs_root)
1447{
1448 struct mlx5e_flow_steering *fs;
1449 int err;
1450
1451 fs = kvzalloc(size: sizeof(*fs), GFP_KERNEL);
1452 if (!fs)
1453 goto err;
1454
1455 fs->mdev = mdev;
1456 fs->state_destroy = state_destroy;
1457 if (mlx5e_profile_feature_cap(profile, FS_VLAN)) {
1458 err = mlx5e_fs_vlan_alloc(fs);
1459 if (err)
1460 goto err_free_fs;
1461 }
1462
1463 if (mlx5e_profile_feature_cap(profile, FS_TC)) {
1464 err = mlx5e_fs_tc_alloc(fs);
1465 if (err)
1466 goto err_free_vlan;
1467 }
1468
1469 err = mlx5e_fs_ethtool_alloc(fs);
1470 if (err)
1471 goto err_free_tc;
1472
1473 mlx5e_fs_debugfs_init(fs, dfs_root);
1474
1475 return fs;
1476err_free_tc:
1477 mlx5e_fs_tc_free(fs);
1478err_free_vlan:
1479 mlx5e_fs_vlan_free(fs);
1480err_free_fs:
1481 kvfree(addr: fs);
1482err:
1483 return NULL;
1484}
1485
1486void mlx5e_fs_cleanup(struct mlx5e_flow_steering *fs)
1487{
1488 if (!fs)
1489 return;
1490 debugfs_remove_recursive(dentry: fs->dfs_root);
1491 mlx5e_fs_ethtool_free(fs);
1492 mlx5e_fs_tc_free(fs);
1493 mlx5e_fs_vlan_free(fs);
1494 kvfree(addr: fs);
1495}
1496
1497struct mlx5e_l2_table *mlx5e_fs_get_l2(struct mlx5e_flow_steering *fs)
1498{
1499 return &fs->l2;
1500}
1501
1502struct mlx5_flow_namespace *mlx5e_fs_get_ns(struct mlx5e_flow_steering *fs, bool egress)
1503{
1504 return egress ? fs->egress_ns : fs->ns;
1505}
1506
1507void mlx5e_fs_set_ns(struct mlx5e_flow_steering *fs, struct mlx5_flow_namespace *ns, bool egress)
1508{
1509 if (!egress)
1510 fs->ns = ns;
1511 else
1512 fs->egress_ns = ns;
1513}
1514
1515struct mlx5_ttc_table *mlx5e_fs_get_ttc(struct mlx5e_flow_steering *fs, bool inner)
1516{
1517 return inner ? fs->inner_ttc : fs->ttc;
1518}
1519
1520void mlx5e_fs_set_ttc(struct mlx5e_flow_steering *fs, struct mlx5_ttc_table *ttc, bool inner)
1521{
1522 if (!inner)
1523 fs->ttc = ttc;
1524 else
1525 fs->inner_ttc = ttc;
1526}
1527
1528#ifdef CONFIG_MLX5_EN_ARFS
1529struct mlx5e_arfs_tables *mlx5e_fs_get_arfs(struct mlx5e_flow_steering *fs)
1530{
1531 return fs->arfs;
1532}
1533
1534void mlx5e_fs_set_arfs(struct mlx5e_flow_steering *fs, struct mlx5e_arfs_tables *arfs)
1535{
1536 fs->arfs = arfs;
1537}
1538#endif
1539
1540struct mlx5e_ptp_fs *mlx5e_fs_get_ptp(struct mlx5e_flow_steering *fs)
1541{
1542 return fs->ptp_fs;
1543}
1544
1545void mlx5e_fs_set_ptp(struct mlx5e_flow_steering *fs, struct mlx5e_ptp_fs *ptp_fs)
1546{
1547 fs->ptp_fs = ptp_fs;
1548}
1549
1550struct mlx5e_fs_any *mlx5e_fs_get_any(struct mlx5e_flow_steering *fs)
1551{
1552 return fs->any;
1553}
1554
1555void mlx5e_fs_set_any(struct mlx5e_flow_steering *fs, struct mlx5e_fs_any *any)
1556{
1557 fs->any = any;
1558}
1559
1560#ifdef CONFIG_MLX5_EN_TLS
1561struct mlx5e_accel_fs_tcp *mlx5e_fs_get_accel_tcp(struct mlx5e_flow_steering *fs)
1562{
1563 return fs->accel_tcp;
1564}
1565
1566void mlx5e_fs_set_accel_tcp(struct mlx5e_flow_steering *fs, struct mlx5e_accel_fs_tcp *accel_tcp)
1567{
1568 fs->accel_tcp = accel_tcp;
1569}
1570#endif
1571
1572void mlx5e_fs_set_state_destroy(struct mlx5e_flow_steering *fs, bool state_destroy)
1573{
1574 fs->state_destroy = state_destroy;
1575}
1576
1577void mlx5e_fs_set_vlan_strip_disable(struct mlx5e_flow_steering *fs,
1578 bool vlan_strip_disable)
1579{
1580 fs->vlan_strip_disable = vlan_strip_disable;
1581}
1582
1583struct mlx5e_fs_udp *mlx5e_fs_get_udp(struct mlx5e_flow_steering *fs)
1584{
1585 return fs->udp;
1586}
1587
1588void mlx5e_fs_set_udp(struct mlx5e_flow_steering *fs, struct mlx5e_fs_udp *udp)
1589{
1590 fs->udp = udp;
1591}
1592
1593struct mlx5_core_dev *mlx5e_fs_get_mdev(struct mlx5e_flow_steering *fs)
1594{
1595 return fs->mdev;
1596}
1597

source code of linux/drivers/net/ethernet/mellanox/mlx5/core/en_fs.c