xref: /OK3568_Linux_fs/kernel/drivers/net/ethernet/mellanox/mlxsw/spectrum_flower.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
2*4882a593Smuzhiyun /* Copyright (c) 2017-2018 Mellanox Technologies. All rights reserved */
3*4882a593Smuzhiyun 
4*4882a593Smuzhiyun #include <linux/kernel.h>
5*4882a593Smuzhiyun #include <linux/errno.h>
6*4882a593Smuzhiyun #include <linux/netdevice.h>
7*4882a593Smuzhiyun #include <linux/log2.h>
8*4882a593Smuzhiyun #include <net/net_namespace.h>
9*4882a593Smuzhiyun #include <net/flow_dissector.h>
10*4882a593Smuzhiyun #include <net/pkt_cls.h>
11*4882a593Smuzhiyun #include <net/tc_act/tc_gact.h>
12*4882a593Smuzhiyun #include <net/tc_act/tc_mirred.h>
13*4882a593Smuzhiyun #include <net/tc_act/tc_vlan.h>
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #include "spectrum.h"
16*4882a593Smuzhiyun #include "core_acl_flex_keys.h"
17*4882a593Smuzhiyun 
mlxsw_sp_flower_parse_actions(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_flow_block * block,struct mlxsw_sp_acl_rule_info * rulei,struct flow_action * flow_action,struct netlink_ext_ack * extack)18*4882a593Smuzhiyun static int mlxsw_sp_flower_parse_actions(struct mlxsw_sp *mlxsw_sp,
19*4882a593Smuzhiyun 					 struct mlxsw_sp_flow_block *block,
20*4882a593Smuzhiyun 					 struct mlxsw_sp_acl_rule_info *rulei,
21*4882a593Smuzhiyun 					 struct flow_action *flow_action,
22*4882a593Smuzhiyun 					 struct netlink_ext_ack *extack)
23*4882a593Smuzhiyun {
24*4882a593Smuzhiyun 	const struct flow_action_entry *act;
25*4882a593Smuzhiyun 	int mirror_act_count = 0;
26*4882a593Smuzhiyun 	int police_act_count = 0;
27*4882a593Smuzhiyun 	int err, i;
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun 	if (!flow_action_has_entries(flow_action))
30*4882a593Smuzhiyun 		return 0;
31*4882a593Smuzhiyun 	if (!flow_action_mixed_hw_stats_check(flow_action, extack))
32*4882a593Smuzhiyun 		return -EOPNOTSUPP;
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun 	act = flow_action_first_entry_get(flow_action);
35*4882a593Smuzhiyun 	if (act->hw_stats & FLOW_ACTION_HW_STATS_DISABLED) {
36*4882a593Smuzhiyun 		/* Nothing to do */
37*4882a593Smuzhiyun 	} else if (act->hw_stats & FLOW_ACTION_HW_STATS_IMMEDIATE) {
38*4882a593Smuzhiyun 		/* Count action is inserted first */
39*4882a593Smuzhiyun 		err = mlxsw_sp_acl_rulei_act_count(mlxsw_sp, rulei, extack);
40*4882a593Smuzhiyun 		if (err)
41*4882a593Smuzhiyun 			return err;
42*4882a593Smuzhiyun 	} else {
43*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(extack, "Unsupported action HW stats type");
44*4882a593Smuzhiyun 		return -EOPNOTSUPP;
45*4882a593Smuzhiyun 	}
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun 	flow_action_for_each(i, act, flow_action) {
48*4882a593Smuzhiyun 		switch (act->id) {
49*4882a593Smuzhiyun 		case FLOW_ACTION_ACCEPT:
50*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_terminate(rulei);
51*4882a593Smuzhiyun 			if (err) {
52*4882a593Smuzhiyun 				NL_SET_ERR_MSG_MOD(extack, "Cannot append terminate action");
53*4882a593Smuzhiyun 				return err;
54*4882a593Smuzhiyun 			}
55*4882a593Smuzhiyun 			break;
56*4882a593Smuzhiyun 		case FLOW_ACTION_DROP: {
57*4882a593Smuzhiyun 			bool ingress;
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun 			if (mlxsw_sp_flow_block_is_mixed_bound(block)) {
60*4882a593Smuzhiyun 				NL_SET_ERR_MSG_MOD(extack, "Drop action is not supported when block is bound to ingress and egress");
61*4882a593Smuzhiyun 				return -EOPNOTSUPP;
62*4882a593Smuzhiyun 			}
63*4882a593Smuzhiyun 			ingress = mlxsw_sp_flow_block_is_ingress_bound(block);
64*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_drop(rulei, ingress,
65*4882a593Smuzhiyun 							  act->cookie, extack);
66*4882a593Smuzhiyun 			if (err) {
67*4882a593Smuzhiyun 				NL_SET_ERR_MSG_MOD(extack, "Cannot append drop action");
68*4882a593Smuzhiyun 				return err;
69*4882a593Smuzhiyun 			}
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun 			/* Forbid block with this rulei to be bound
72*4882a593Smuzhiyun 			 * to ingress/egress in future. Ingress rule is
73*4882a593Smuzhiyun 			 * a blocker for egress and vice versa.
74*4882a593Smuzhiyun 			 */
75*4882a593Smuzhiyun 			if (ingress)
76*4882a593Smuzhiyun 				rulei->egress_bind_blocker = 1;
77*4882a593Smuzhiyun 			else
78*4882a593Smuzhiyun 				rulei->ingress_bind_blocker = 1;
79*4882a593Smuzhiyun 			}
80*4882a593Smuzhiyun 			break;
81*4882a593Smuzhiyun 		case FLOW_ACTION_TRAP:
82*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_trap(rulei);
83*4882a593Smuzhiyun 			if (err) {
84*4882a593Smuzhiyun 				NL_SET_ERR_MSG_MOD(extack, "Cannot append trap action");
85*4882a593Smuzhiyun 				return err;
86*4882a593Smuzhiyun 			}
87*4882a593Smuzhiyun 			break;
88*4882a593Smuzhiyun 		case FLOW_ACTION_GOTO: {
89*4882a593Smuzhiyun 			u32 chain_index = act->chain_index;
90*4882a593Smuzhiyun 			struct mlxsw_sp_acl_ruleset *ruleset;
91*4882a593Smuzhiyun 			u16 group_id;
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun 			ruleset = mlxsw_sp_acl_ruleset_lookup(mlxsw_sp, block,
94*4882a593Smuzhiyun 							      chain_index,
95*4882a593Smuzhiyun 							      MLXSW_SP_ACL_PROFILE_FLOWER);
96*4882a593Smuzhiyun 			if (IS_ERR(ruleset))
97*4882a593Smuzhiyun 				return PTR_ERR(ruleset);
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun 			group_id = mlxsw_sp_acl_ruleset_group_id(ruleset);
100*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_jump(rulei, group_id);
101*4882a593Smuzhiyun 			if (err) {
102*4882a593Smuzhiyun 				NL_SET_ERR_MSG_MOD(extack, "Cannot append jump action");
103*4882a593Smuzhiyun 				return err;
104*4882a593Smuzhiyun 			}
105*4882a593Smuzhiyun 			}
106*4882a593Smuzhiyun 			break;
107*4882a593Smuzhiyun 		case FLOW_ACTION_REDIRECT: {
108*4882a593Smuzhiyun 			struct net_device *out_dev;
109*4882a593Smuzhiyun 			struct mlxsw_sp_fid *fid;
110*4882a593Smuzhiyun 			u16 fid_index;
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun 			if (mlxsw_sp_flow_block_is_egress_bound(block)) {
113*4882a593Smuzhiyun 				NL_SET_ERR_MSG_MOD(extack, "Redirect action is not supported on egress");
114*4882a593Smuzhiyun 				return -EOPNOTSUPP;
115*4882a593Smuzhiyun 			}
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun 			/* Forbid block with this rulei to be bound
118*4882a593Smuzhiyun 			 * to egress in future.
119*4882a593Smuzhiyun 			 */
120*4882a593Smuzhiyun 			rulei->egress_bind_blocker = 1;
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 			fid = mlxsw_sp_acl_dummy_fid(mlxsw_sp);
123*4882a593Smuzhiyun 			fid_index = mlxsw_sp_fid_index(fid);
124*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_fid_set(mlxsw_sp, rulei,
125*4882a593Smuzhiyun 							     fid_index, extack);
126*4882a593Smuzhiyun 			if (err)
127*4882a593Smuzhiyun 				return err;
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun 			out_dev = act->dev;
130*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_fwd(mlxsw_sp, rulei,
131*4882a593Smuzhiyun 							 out_dev, extack);
132*4882a593Smuzhiyun 			if (err)
133*4882a593Smuzhiyun 				return err;
134*4882a593Smuzhiyun 			}
135*4882a593Smuzhiyun 			break;
136*4882a593Smuzhiyun 		case FLOW_ACTION_MIRRED: {
137*4882a593Smuzhiyun 			struct net_device *out_dev = act->dev;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 			if (mirror_act_count++) {
140*4882a593Smuzhiyun 				NL_SET_ERR_MSG_MOD(extack, "Multiple mirror actions per rule are not supported");
141*4882a593Smuzhiyun 				return -EOPNOTSUPP;
142*4882a593Smuzhiyun 			}
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_mirror(mlxsw_sp, rulei,
145*4882a593Smuzhiyun 							    block, out_dev,
146*4882a593Smuzhiyun 							    extack);
147*4882a593Smuzhiyun 			if (err)
148*4882a593Smuzhiyun 				return err;
149*4882a593Smuzhiyun 			}
150*4882a593Smuzhiyun 			break;
151*4882a593Smuzhiyun 		case FLOW_ACTION_VLAN_MANGLE: {
152*4882a593Smuzhiyun 			u16 proto = be16_to_cpu(act->vlan.proto);
153*4882a593Smuzhiyun 			u8 prio = act->vlan.prio;
154*4882a593Smuzhiyun 			u16 vid = act->vlan.vid;
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_vlan(mlxsw_sp, rulei,
157*4882a593Smuzhiyun 							  act->id, vid,
158*4882a593Smuzhiyun 							  proto, prio, extack);
159*4882a593Smuzhiyun 			if (err)
160*4882a593Smuzhiyun 				return err;
161*4882a593Smuzhiyun 			break;
162*4882a593Smuzhiyun 			}
163*4882a593Smuzhiyun 		case FLOW_ACTION_PRIORITY:
164*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_priority(mlxsw_sp, rulei,
165*4882a593Smuzhiyun 							      act->priority,
166*4882a593Smuzhiyun 							      extack);
167*4882a593Smuzhiyun 			if (err)
168*4882a593Smuzhiyun 				return err;
169*4882a593Smuzhiyun 			break;
170*4882a593Smuzhiyun 		case FLOW_ACTION_MANGLE: {
171*4882a593Smuzhiyun 			enum flow_action_mangle_base htype = act->mangle.htype;
172*4882a593Smuzhiyun 			__be32 be_mask = (__force __be32) act->mangle.mask;
173*4882a593Smuzhiyun 			__be32 be_val = (__force __be32) act->mangle.val;
174*4882a593Smuzhiyun 			u32 offset = act->mangle.offset;
175*4882a593Smuzhiyun 			u32 mask = be32_to_cpu(be_mask);
176*4882a593Smuzhiyun 			u32 val = be32_to_cpu(be_val);
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_mangle(mlxsw_sp, rulei,
179*4882a593Smuzhiyun 							    htype, offset,
180*4882a593Smuzhiyun 							    mask, val, extack);
181*4882a593Smuzhiyun 			if (err)
182*4882a593Smuzhiyun 				return err;
183*4882a593Smuzhiyun 			break;
184*4882a593Smuzhiyun 			}
185*4882a593Smuzhiyun 		case FLOW_ACTION_POLICE: {
186*4882a593Smuzhiyun 			u32 burst;
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun 			if (police_act_count++) {
189*4882a593Smuzhiyun 				NL_SET_ERR_MSG_MOD(extack, "Multiple police actions per rule are not supported");
190*4882a593Smuzhiyun 				return -EOPNOTSUPP;
191*4882a593Smuzhiyun 			}
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 			/* The kernel might adjust the requested burst size so
194*4882a593Smuzhiyun 			 * that it is not exactly a power of two. Re-adjust it
195*4882a593Smuzhiyun 			 * here since the hardware only supports burst sizes
196*4882a593Smuzhiyun 			 * that are a power of two.
197*4882a593Smuzhiyun 			 */
198*4882a593Smuzhiyun 			burst = roundup_pow_of_two(act->police.burst);
199*4882a593Smuzhiyun 			err = mlxsw_sp_acl_rulei_act_police(mlxsw_sp, rulei,
200*4882a593Smuzhiyun 							    act->police.index,
201*4882a593Smuzhiyun 							    act->police.rate_bytes_ps,
202*4882a593Smuzhiyun 							    burst, extack);
203*4882a593Smuzhiyun 			if (err)
204*4882a593Smuzhiyun 				return err;
205*4882a593Smuzhiyun 			break;
206*4882a593Smuzhiyun 			}
207*4882a593Smuzhiyun 		default:
208*4882a593Smuzhiyun 			NL_SET_ERR_MSG_MOD(extack, "Unsupported action");
209*4882a593Smuzhiyun 			dev_err(mlxsw_sp->bus_info->dev, "Unsupported action\n");
210*4882a593Smuzhiyun 			return -EOPNOTSUPP;
211*4882a593Smuzhiyun 		}
212*4882a593Smuzhiyun 	}
213*4882a593Smuzhiyun 	return 0;
214*4882a593Smuzhiyun }
215*4882a593Smuzhiyun 
mlxsw_sp_flower_parse_meta(struct mlxsw_sp_acl_rule_info * rulei,struct flow_cls_offload * f,struct mlxsw_sp_flow_block * block)216*4882a593Smuzhiyun static int mlxsw_sp_flower_parse_meta(struct mlxsw_sp_acl_rule_info *rulei,
217*4882a593Smuzhiyun 				      struct flow_cls_offload *f,
218*4882a593Smuzhiyun 				      struct mlxsw_sp_flow_block *block)
219*4882a593Smuzhiyun {
220*4882a593Smuzhiyun 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
221*4882a593Smuzhiyun 	struct mlxsw_sp_port *mlxsw_sp_port;
222*4882a593Smuzhiyun 	struct net_device *ingress_dev;
223*4882a593Smuzhiyun 	struct flow_match_meta match;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	if (!flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_META))
226*4882a593Smuzhiyun 		return 0;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	flow_rule_match_meta(rule, &match);
229*4882a593Smuzhiyun 	if (match.mask->ingress_ifindex != 0xFFFFFFFF) {
230*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "Unsupported ingress ifindex mask");
231*4882a593Smuzhiyun 		return -EINVAL;
232*4882a593Smuzhiyun 	}
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	ingress_dev = __dev_get_by_index(block->net,
235*4882a593Smuzhiyun 					 match.key->ingress_ifindex);
236*4882a593Smuzhiyun 	if (!ingress_dev) {
237*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "Can't find specified ingress port to match on");
238*4882a593Smuzhiyun 		return -EINVAL;
239*4882a593Smuzhiyun 	}
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 	if (!mlxsw_sp_port_dev_check(ingress_dev)) {
242*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "Can't match on non-mlxsw ingress port");
243*4882a593Smuzhiyun 		return -EINVAL;
244*4882a593Smuzhiyun 	}
245*4882a593Smuzhiyun 
246*4882a593Smuzhiyun 	mlxsw_sp_port = netdev_priv(ingress_dev);
247*4882a593Smuzhiyun 	if (mlxsw_sp_port->mlxsw_sp != block->mlxsw_sp) {
248*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "Can't match on a port from different device");
249*4882a593Smuzhiyun 		return -EINVAL;
250*4882a593Smuzhiyun 	}
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_u32(rulei,
253*4882a593Smuzhiyun 				       MLXSW_AFK_ELEMENT_SRC_SYS_PORT,
254*4882a593Smuzhiyun 				       mlxsw_sp_port->local_port,
255*4882a593Smuzhiyun 				       0xFFFFFFFF);
256*4882a593Smuzhiyun 	return 0;
257*4882a593Smuzhiyun }
258*4882a593Smuzhiyun 
mlxsw_sp_flower_parse_ipv4(struct mlxsw_sp_acl_rule_info * rulei,struct flow_cls_offload * f)259*4882a593Smuzhiyun static void mlxsw_sp_flower_parse_ipv4(struct mlxsw_sp_acl_rule_info *rulei,
260*4882a593Smuzhiyun 				       struct flow_cls_offload *f)
261*4882a593Smuzhiyun {
262*4882a593Smuzhiyun 	struct flow_match_ipv4_addrs match;
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	flow_rule_match_ipv4_addrs(f->rule, &match);
265*4882a593Smuzhiyun 
266*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_SRC_IP_0_31,
267*4882a593Smuzhiyun 				       (char *) &match.key->src,
268*4882a593Smuzhiyun 				       (char *) &match.mask->src, 4);
269*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_DST_IP_0_31,
270*4882a593Smuzhiyun 				       (char *) &match.key->dst,
271*4882a593Smuzhiyun 				       (char *) &match.mask->dst, 4);
272*4882a593Smuzhiyun }
273*4882a593Smuzhiyun 
mlxsw_sp_flower_parse_ipv6(struct mlxsw_sp_acl_rule_info * rulei,struct flow_cls_offload * f)274*4882a593Smuzhiyun static void mlxsw_sp_flower_parse_ipv6(struct mlxsw_sp_acl_rule_info *rulei,
275*4882a593Smuzhiyun 				       struct flow_cls_offload *f)
276*4882a593Smuzhiyun {
277*4882a593Smuzhiyun 	struct flow_match_ipv6_addrs match;
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun 	flow_rule_match_ipv6_addrs(f->rule, &match);
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_SRC_IP_96_127,
282*4882a593Smuzhiyun 				       &match.key->src.s6_addr[0x0],
283*4882a593Smuzhiyun 				       &match.mask->src.s6_addr[0x0], 4);
284*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_SRC_IP_64_95,
285*4882a593Smuzhiyun 				       &match.key->src.s6_addr[0x4],
286*4882a593Smuzhiyun 				       &match.mask->src.s6_addr[0x4], 4);
287*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_SRC_IP_32_63,
288*4882a593Smuzhiyun 				       &match.key->src.s6_addr[0x8],
289*4882a593Smuzhiyun 				       &match.mask->src.s6_addr[0x8], 4);
290*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_SRC_IP_0_31,
291*4882a593Smuzhiyun 				       &match.key->src.s6_addr[0xC],
292*4882a593Smuzhiyun 				       &match.mask->src.s6_addr[0xC], 4);
293*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_DST_IP_96_127,
294*4882a593Smuzhiyun 				       &match.key->dst.s6_addr[0x0],
295*4882a593Smuzhiyun 				       &match.mask->dst.s6_addr[0x0], 4);
296*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_DST_IP_64_95,
297*4882a593Smuzhiyun 				       &match.key->dst.s6_addr[0x4],
298*4882a593Smuzhiyun 				       &match.mask->dst.s6_addr[0x4], 4);
299*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_DST_IP_32_63,
300*4882a593Smuzhiyun 				       &match.key->dst.s6_addr[0x8],
301*4882a593Smuzhiyun 				       &match.mask->dst.s6_addr[0x8], 4);
302*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_buf(rulei, MLXSW_AFK_ELEMENT_DST_IP_0_31,
303*4882a593Smuzhiyun 				       &match.key->dst.s6_addr[0xC],
304*4882a593Smuzhiyun 				       &match.mask->dst.s6_addr[0xC], 4);
305*4882a593Smuzhiyun }
306*4882a593Smuzhiyun 
mlxsw_sp_flower_parse_ports(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_acl_rule_info * rulei,struct flow_cls_offload * f,u8 ip_proto)307*4882a593Smuzhiyun static int mlxsw_sp_flower_parse_ports(struct mlxsw_sp *mlxsw_sp,
308*4882a593Smuzhiyun 				       struct mlxsw_sp_acl_rule_info *rulei,
309*4882a593Smuzhiyun 				       struct flow_cls_offload *f,
310*4882a593Smuzhiyun 				       u8 ip_proto)
311*4882a593Smuzhiyun {
312*4882a593Smuzhiyun 	const struct flow_rule *rule = flow_cls_offload_flow_rule(f);
313*4882a593Smuzhiyun 	struct flow_match_ports match;
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	if (!flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS))
316*4882a593Smuzhiyun 		return 0;
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	if (ip_proto != IPPROTO_TCP && ip_proto != IPPROTO_UDP) {
319*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "Only UDP and TCP keys are supported");
320*4882a593Smuzhiyun 		dev_err(mlxsw_sp->bus_info->dev, "Only UDP and TCP keys are supported\n");
321*4882a593Smuzhiyun 		return -EINVAL;
322*4882a593Smuzhiyun 	}
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	flow_rule_match_ports(rule, &match);
325*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_u32(rulei, MLXSW_AFK_ELEMENT_DST_L4_PORT,
326*4882a593Smuzhiyun 				       ntohs(match.key->dst),
327*4882a593Smuzhiyun 				       ntohs(match.mask->dst));
328*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_u32(rulei, MLXSW_AFK_ELEMENT_SRC_L4_PORT,
329*4882a593Smuzhiyun 				       ntohs(match.key->src),
330*4882a593Smuzhiyun 				       ntohs(match.mask->src));
331*4882a593Smuzhiyun 	return 0;
332*4882a593Smuzhiyun }
333*4882a593Smuzhiyun 
mlxsw_sp_flower_parse_tcp(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_acl_rule_info * rulei,struct flow_cls_offload * f,u8 ip_proto)334*4882a593Smuzhiyun static int mlxsw_sp_flower_parse_tcp(struct mlxsw_sp *mlxsw_sp,
335*4882a593Smuzhiyun 				     struct mlxsw_sp_acl_rule_info *rulei,
336*4882a593Smuzhiyun 				     struct flow_cls_offload *f,
337*4882a593Smuzhiyun 				     u8 ip_proto)
338*4882a593Smuzhiyun {
339*4882a593Smuzhiyun 	const struct flow_rule *rule = flow_cls_offload_flow_rule(f);
340*4882a593Smuzhiyun 	struct flow_match_tcp match;
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	if (!flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP))
343*4882a593Smuzhiyun 		return 0;
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 	if (ip_proto != IPPROTO_TCP) {
346*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "TCP keys supported only for TCP");
347*4882a593Smuzhiyun 		dev_err(mlxsw_sp->bus_info->dev, "TCP keys supported only for TCP\n");
348*4882a593Smuzhiyun 		return -EINVAL;
349*4882a593Smuzhiyun 	}
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 	flow_rule_match_tcp(rule, &match);
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 	if (match.mask->flags & htons(0x0E00)) {
354*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "TCP flags match not supported on reserved bits");
355*4882a593Smuzhiyun 		dev_err(mlxsw_sp->bus_info->dev, "TCP flags match not supported on reserved bits\n");
356*4882a593Smuzhiyun 		return -EINVAL;
357*4882a593Smuzhiyun 	}
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_u32(rulei, MLXSW_AFK_ELEMENT_TCP_FLAGS,
360*4882a593Smuzhiyun 				       ntohs(match.key->flags),
361*4882a593Smuzhiyun 				       ntohs(match.mask->flags));
362*4882a593Smuzhiyun 	return 0;
363*4882a593Smuzhiyun }
364*4882a593Smuzhiyun 
mlxsw_sp_flower_parse_ip(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_acl_rule_info * rulei,struct flow_cls_offload * f,u16 n_proto)365*4882a593Smuzhiyun static int mlxsw_sp_flower_parse_ip(struct mlxsw_sp *mlxsw_sp,
366*4882a593Smuzhiyun 				    struct mlxsw_sp_acl_rule_info *rulei,
367*4882a593Smuzhiyun 				    struct flow_cls_offload *f,
368*4882a593Smuzhiyun 				    u16 n_proto)
369*4882a593Smuzhiyun {
370*4882a593Smuzhiyun 	const struct flow_rule *rule = flow_cls_offload_flow_rule(f);
371*4882a593Smuzhiyun 	struct flow_match_ip match;
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun 	if (!flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP))
374*4882a593Smuzhiyun 		return 0;
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun 	if (n_proto != ETH_P_IP && n_proto != ETH_P_IPV6) {
377*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "IP keys supported only for IPv4/6");
378*4882a593Smuzhiyun 		dev_err(mlxsw_sp->bus_info->dev, "IP keys supported only for IPv4/6\n");
379*4882a593Smuzhiyun 		return -EINVAL;
380*4882a593Smuzhiyun 	}
381*4882a593Smuzhiyun 
382*4882a593Smuzhiyun 	flow_rule_match_ip(rule, &match);
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_u32(rulei, MLXSW_AFK_ELEMENT_IP_TTL_,
385*4882a593Smuzhiyun 				       match.key->ttl, match.mask->ttl);
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_u32(rulei, MLXSW_AFK_ELEMENT_IP_ECN,
388*4882a593Smuzhiyun 				       match.key->tos & 0x3,
389*4882a593Smuzhiyun 				       match.mask->tos & 0x3);
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_keymask_u32(rulei, MLXSW_AFK_ELEMENT_IP_DSCP,
392*4882a593Smuzhiyun 				       match.key->tos >> 2,
393*4882a593Smuzhiyun 				       match.mask->tos >> 2);
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun 	return 0;
396*4882a593Smuzhiyun }
397*4882a593Smuzhiyun 
mlxsw_sp_flower_parse(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_flow_block * block,struct mlxsw_sp_acl_rule_info * rulei,struct flow_cls_offload * f)398*4882a593Smuzhiyun static int mlxsw_sp_flower_parse(struct mlxsw_sp *mlxsw_sp,
399*4882a593Smuzhiyun 				 struct mlxsw_sp_flow_block *block,
400*4882a593Smuzhiyun 				 struct mlxsw_sp_acl_rule_info *rulei,
401*4882a593Smuzhiyun 				 struct flow_cls_offload *f)
402*4882a593Smuzhiyun {
403*4882a593Smuzhiyun 	struct flow_rule *rule = flow_cls_offload_flow_rule(f);
404*4882a593Smuzhiyun 	struct flow_dissector *dissector = rule->match.dissector;
405*4882a593Smuzhiyun 	u16 n_proto_mask = 0;
406*4882a593Smuzhiyun 	u16 n_proto_key = 0;
407*4882a593Smuzhiyun 	u16 addr_type = 0;
408*4882a593Smuzhiyun 	u8 ip_proto = 0;
409*4882a593Smuzhiyun 	int err;
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	if (dissector->used_keys &
412*4882a593Smuzhiyun 	    ~(BIT(FLOW_DISSECTOR_KEY_META) |
413*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_CONTROL) |
414*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_BASIC) |
415*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS) |
416*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS) |
417*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS) |
418*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_PORTS) |
419*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_TCP) |
420*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_IP) |
421*4882a593Smuzhiyun 	      BIT(FLOW_DISSECTOR_KEY_VLAN))) {
422*4882a593Smuzhiyun 		dev_err(mlxsw_sp->bus_info->dev, "Unsupported key\n");
423*4882a593Smuzhiyun 		NL_SET_ERR_MSG_MOD(f->common.extack, "Unsupported key");
424*4882a593Smuzhiyun 		return -EOPNOTSUPP;
425*4882a593Smuzhiyun 	}
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	mlxsw_sp_acl_rulei_priority(rulei, f->common.prio);
428*4882a593Smuzhiyun 
429*4882a593Smuzhiyun 	err = mlxsw_sp_flower_parse_meta(rulei, f, block);
430*4882a593Smuzhiyun 	if (err)
431*4882a593Smuzhiyun 		return err;
432*4882a593Smuzhiyun 
433*4882a593Smuzhiyun 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) {
434*4882a593Smuzhiyun 		struct flow_match_control match;
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 		flow_rule_match_control(rule, &match);
437*4882a593Smuzhiyun 		addr_type = match.key->addr_type;
438*4882a593Smuzhiyun 	}
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) {
441*4882a593Smuzhiyun 		struct flow_match_basic match;
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun 		flow_rule_match_basic(rule, &match);
444*4882a593Smuzhiyun 		n_proto_key = ntohs(match.key->n_proto);
445*4882a593Smuzhiyun 		n_proto_mask = ntohs(match.mask->n_proto);
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun 		if (n_proto_key == ETH_P_ALL) {
448*4882a593Smuzhiyun 			n_proto_key = 0;
449*4882a593Smuzhiyun 			n_proto_mask = 0;
450*4882a593Smuzhiyun 		}
451*4882a593Smuzhiyun 		mlxsw_sp_acl_rulei_keymask_u32(rulei,
452*4882a593Smuzhiyun 					       MLXSW_AFK_ELEMENT_ETHERTYPE,
453*4882a593Smuzhiyun 					       n_proto_key, n_proto_mask);
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 		ip_proto = match.key->ip_proto;
456*4882a593Smuzhiyun 		mlxsw_sp_acl_rulei_keymask_u32(rulei,
457*4882a593Smuzhiyun 					       MLXSW_AFK_ELEMENT_IP_PROTO,
458*4882a593Smuzhiyun 					       match.key->ip_proto,
459*4882a593Smuzhiyun 					       match.mask->ip_proto);
460*4882a593Smuzhiyun 	}
461*4882a593Smuzhiyun 
462*4882a593Smuzhiyun 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) {
463*4882a593Smuzhiyun 		struct flow_match_eth_addrs match;
464*4882a593Smuzhiyun 
465*4882a593Smuzhiyun 		flow_rule_match_eth_addrs(rule, &match);
466*4882a593Smuzhiyun 		mlxsw_sp_acl_rulei_keymask_buf(rulei,
467*4882a593Smuzhiyun 					       MLXSW_AFK_ELEMENT_DMAC_32_47,
468*4882a593Smuzhiyun 					       match.key->dst,
469*4882a593Smuzhiyun 					       match.mask->dst, 2);
470*4882a593Smuzhiyun 		mlxsw_sp_acl_rulei_keymask_buf(rulei,
471*4882a593Smuzhiyun 					       MLXSW_AFK_ELEMENT_DMAC_0_31,
472*4882a593Smuzhiyun 					       match.key->dst + 2,
473*4882a593Smuzhiyun 					       match.mask->dst + 2, 4);
474*4882a593Smuzhiyun 		mlxsw_sp_acl_rulei_keymask_buf(rulei,
475*4882a593Smuzhiyun 					       MLXSW_AFK_ELEMENT_SMAC_32_47,
476*4882a593Smuzhiyun 					       match.key->src,
477*4882a593Smuzhiyun 					       match.mask->src, 2);
478*4882a593Smuzhiyun 		mlxsw_sp_acl_rulei_keymask_buf(rulei,
479*4882a593Smuzhiyun 					       MLXSW_AFK_ELEMENT_SMAC_0_31,
480*4882a593Smuzhiyun 					       match.key->src + 2,
481*4882a593Smuzhiyun 					       match.mask->src + 2, 4);
482*4882a593Smuzhiyun 	}
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun 	if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN)) {
485*4882a593Smuzhiyun 		struct flow_match_vlan match;
486*4882a593Smuzhiyun 
487*4882a593Smuzhiyun 		flow_rule_match_vlan(rule, &match);
488*4882a593Smuzhiyun 		if (mlxsw_sp_flow_block_is_egress_bound(block)) {
489*4882a593Smuzhiyun 			NL_SET_ERR_MSG_MOD(f->common.extack, "vlan_id key is not supported on egress");
490*4882a593Smuzhiyun 			return -EOPNOTSUPP;
491*4882a593Smuzhiyun 		}
492*4882a593Smuzhiyun 
493*4882a593Smuzhiyun 		/* Forbid block with this rulei to be bound
494*4882a593Smuzhiyun 		 * to egress in future.
495*4882a593Smuzhiyun 		 */
496*4882a593Smuzhiyun 		rulei->egress_bind_blocker = 1;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 		if (match.mask->vlan_id != 0)
499*4882a593Smuzhiyun 			mlxsw_sp_acl_rulei_keymask_u32(rulei,
500*4882a593Smuzhiyun 						       MLXSW_AFK_ELEMENT_VID,
501*4882a593Smuzhiyun 						       match.key->vlan_id,
502*4882a593Smuzhiyun 						       match.mask->vlan_id);
503*4882a593Smuzhiyun 		if (match.mask->vlan_priority != 0)
504*4882a593Smuzhiyun 			mlxsw_sp_acl_rulei_keymask_u32(rulei,
505*4882a593Smuzhiyun 						       MLXSW_AFK_ELEMENT_PCP,
506*4882a593Smuzhiyun 						       match.key->vlan_priority,
507*4882a593Smuzhiyun 						       match.mask->vlan_priority);
508*4882a593Smuzhiyun 	}
509*4882a593Smuzhiyun 
510*4882a593Smuzhiyun 	if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS)
511*4882a593Smuzhiyun 		mlxsw_sp_flower_parse_ipv4(rulei, f);
512*4882a593Smuzhiyun 
513*4882a593Smuzhiyun 	if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS)
514*4882a593Smuzhiyun 		mlxsw_sp_flower_parse_ipv6(rulei, f);
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 	err = mlxsw_sp_flower_parse_ports(mlxsw_sp, rulei, f, ip_proto);
517*4882a593Smuzhiyun 	if (err)
518*4882a593Smuzhiyun 		return err;
519*4882a593Smuzhiyun 	err = mlxsw_sp_flower_parse_tcp(mlxsw_sp, rulei, f, ip_proto);
520*4882a593Smuzhiyun 	if (err)
521*4882a593Smuzhiyun 		return err;
522*4882a593Smuzhiyun 
523*4882a593Smuzhiyun 	err = mlxsw_sp_flower_parse_ip(mlxsw_sp, rulei, f, n_proto_key & n_proto_mask);
524*4882a593Smuzhiyun 	if (err)
525*4882a593Smuzhiyun 		return err;
526*4882a593Smuzhiyun 
527*4882a593Smuzhiyun 	return mlxsw_sp_flower_parse_actions(mlxsw_sp, block, rulei,
528*4882a593Smuzhiyun 					     &f->rule->action,
529*4882a593Smuzhiyun 					     f->common.extack);
530*4882a593Smuzhiyun }
531*4882a593Smuzhiyun 
mlxsw_sp_flower_mall_prio_check(struct mlxsw_sp_flow_block * block,struct flow_cls_offload * f)532*4882a593Smuzhiyun static int mlxsw_sp_flower_mall_prio_check(struct mlxsw_sp_flow_block *block,
533*4882a593Smuzhiyun 					   struct flow_cls_offload *f)
534*4882a593Smuzhiyun {
535*4882a593Smuzhiyun 	bool ingress = mlxsw_sp_flow_block_is_ingress_bound(block);
536*4882a593Smuzhiyun 	unsigned int mall_min_prio;
537*4882a593Smuzhiyun 	unsigned int mall_max_prio;
538*4882a593Smuzhiyun 	int err;
539*4882a593Smuzhiyun 
540*4882a593Smuzhiyun 	err = mlxsw_sp_mall_prio_get(block, f->common.chain_index,
541*4882a593Smuzhiyun 				     &mall_min_prio, &mall_max_prio);
542*4882a593Smuzhiyun 	if (err) {
543*4882a593Smuzhiyun 		if (err == -ENOENT)
544*4882a593Smuzhiyun 			/* No matchall filters installed on this chain. */
545*4882a593Smuzhiyun 			return 0;
546*4882a593Smuzhiyun 		NL_SET_ERR_MSG(f->common.extack, "Failed to get matchall priorities");
547*4882a593Smuzhiyun 		return err;
548*4882a593Smuzhiyun 	}
549*4882a593Smuzhiyun 	if (ingress && f->common.prio <= mall_min_prio) {
550*4882a593Smuzhiyun 		NL_SET_ERR_MSG(f->common.extack, "Failed to add in front of existing matchall rules");
551*4882a593Smuzhiyun 		return -EOPNOTSUPP;
552*4882a593Smuzhiyun 	}
553*4882a593Smuzhiyun 	if (!ingress && f->common.prio >= mall_max_prio) {
554*4882a593Smuzhiyun 		NL_SET_ERR_MSG(f->common.extack, "Failed to add behind of existing matchall rules");
555*4882a593Smuzhiyun 		return -EOPNOTSUPP;
556*4882a593Smuzhiyun 	}
557*4882a593Smuzhiyun 	return 0;
558*4882a593Smuzhiyun }
559*4882a593Smuzhiyun 
mlxsw_sp_flower_replace(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_flow_block * block,struct flow_cls_offload * f)560*4882a593Smuzhiyun int mlxsw_sp_flower_replace(struct mlxsw_sp *mlxsw_sp,
561*4882a593Smuzhiyun 			    struct mlxsw_sp_flow_block *block,
562*4882a593Smuzhiyun 			    struct flow_cls_offload *f)
563*4882a593Smuzhiyun {
564*4882a593Smuzhiyun 	struct mlxsw_sp_acl_rule_info *rulei;
565*4882a593Smuzhiyun 	struct mlxsw_sp_acl_ruleset *ruleset;
566*4882a593Smuzhiyun 	struct mlxsw_sp_acl_rule *rule;
567*4882a593Smuzhiyun 	int err;
568*4882a593Smuzhiyun 
569*4882a593Smuzhiyun 	err = mlxsw_sp_flower_mall_prio_check(block, f);
570*4882a593Smuzhiyun 	if (err)
571*4882a593Smuzhiyun 		return err;
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun 	ruleset = mlxsw_sp_acl_ruleset_get(mlxsw_sp, block,
574*4882a593Smuzhiyun 					   f->common.chain_index,
575*4882a593Smuzhiyun 					   MLXSW_SP_ACL_PROFILE_FLOWER, NULL);
576*4882a593Smuzhiyun 	if (IS_ERR(ruleset))
577*4882a593Smuzhiyun 		return PTR_ERR(ruleset);
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	rule = mlxsw_sp_acl_rule_create(mlxsw_sp, ruleset, f->cookie, NULL,
580*4882a593Smuzhiyun 					f->common.extack);
581*4882a593Smuzhiyun 	if (IS_ERR(rule)) {
582*4882a593Smuzhiyun 		err = PTR_ERR(rule);
583*4882a593Smuzhiyun 		goto err_rule_create;
584*4882a593Smuzhiyun 	}
585*4882a593Smuzhiyun 
586*4882a593Smuzhiyun 	rulei = mlxsw_sp_acl_rule_rulei(rule);
587*4882a593Smuzhiyun 	err = mlxsw_sp_flower_parse(mlxsw_sp, block, rulei, f);
588*4882a593Smuzhiyun 	if (err)
589*4882a593Smuzhiyun 		goto err_flower_parse;
590*4882a593Smuzhiyun 
591*4882a593Smuzhiyun 	err = mlxsw_sp_acl_rulei_commit(rulei);
592*4882a593Smuzhiyun 	if (err)
593*4882a593Smuzhiyun 		goto err_rulei_commit;
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 	err = mlxsw_sp_acl_rule_add(mlxsw_sp, rule);
596*4882a593Smuzhiyun 	if (err)
597*4882a593Smuzhiyun 		goto err_rule_add;
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun 	mlxsw_sp_acl_ruleset_put(mlxsw_sp, ruleset);
600*4882a593Smuzhiyun 	return 0;
601*4882a593Smuzhiyun 
602*4882a593Smuzhiyun err_rule_add:
603*4882a593Smuzhiyun err_rulei_commit:
604*4882a593Smuzhiyun err_flower_parse:
605*4882a593Smuzhiyun 	mlxsw_sp_acl_rule_destroy(mlxsw_sp, rule);
606*4882a593Smuzhiyun err_rule_create:
607*4882a593Smuzhiyun 	mlxsw_sp_acl_ruleset_put(mlxsw_sp, ruleset);
608*4882a593Smuzhiyun 	return err;
609*4882a593Smuzhiyun }
610*4882a593Smuzhiyun 
mlxsw_sp_flower_destroy(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_flow_block * block,struct flow_cls_offload * f)611*4882a593Smuzhiyun void mlxsw_sp_flower_destroy(struct mlxsw_sp *mlxsw_sp,
612*4882a593Smuzhiyun 			     struct mlxsw_sp_flow_block *block,
613*4882a593Smuzhiyun 			     struct flow_cls_offload *f)
614*4882a593Smuzhiyun {
615*4882a593Smuzhiyun 	struct mlxsw_sp_acl_ruleset *ruleset;
616*4882a593Smuzhiyun 	struct mlxsw_sp_acl_rule *rule;
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	ruleset = mlxsw_sp_acl_ruleset_get(mlxsw_sp, block,
619*4882a593Smuzhiyun 					   f->common.chain_index,
620*4882a593Smuzhiyun 					   MLXSW_SP_ACL_PROFILE_FLOWER, NULL);
621*4882a593Smuzhiyun 	if (IS_ERR(ruleset))
622*4882a593Smuzhiyun 		return;
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 	rule = mlxsw_sp_acl_rule_lookup(mlxsw_sp, ruleset, f->cookie);
625*4882a593Smuzhiyun 	if (rule) {
626*4882a593Smuzhiyun 		mlxsw_sp_acl_rule_del(mlxsw_sp, rule);
627*4882a593Smuzhiyun 		mlxsw_sp_acl_rule_destroy(mlxsw_sp, rule);
628*4882a593Smuzhiyun 	}
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun 	mlxsw_sp_acl_ruleset_put(mlxsw_sp, ruleset);
631*4882a593Smuzhiyun }
632*4882a593Smuzhiyun 
mlxsw_sp_flower_stats(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_flow_block * block,struct flow_cls_offload * f)633*4882a593Smuzhiyun int mlxsw_sp_flower_stats(struct mlxsw_sp *mlxsw_sp,
634*4882a593Smuzhiyun 			  struct mlxsw_sp_flow_block *block,
635*4882a593Smuzhiyun 			  struct flow_cls_offload *f)
636*4882a593Smuzhiyun {
637*4882a593Smuzhiyun 	enum flow_action_hw_stats used_hw_stats = FLOW_ACTION_HW_STATS_DISABLED;
638*4882a593Smuzhiyun 	struct mlxsw_sp_acl_ruleset *ruleset;
639*4882a593Smuzhiyun 	struct mlxsw_sp_acl_rule *rule;
640*4882a593Smuzhiyun 	u64 packets;
641*4882a593Smuzhiyun 	u64 lastuse;
642*4882a593Smuzhiyun 	u64 bytes;
643*4882a593Smuzhiyun 	u64 drops;
644*4882a593Smuzhiyun 	int err;
645*4882a593Smuzhiyun 
646*4882a593Smuzhiyun 	ruleset = mlxsw_sp_acl_ruleset_get(mlxsw_sp, block,
647*4882a593Smuzhiyun 					   f->common.chain_index,
648*4882a593Smuzhiyun 					   MLXSW_SP_ACL_PROFILE_FLOWER, NULL);
649*4882a593Smuzhiyun 	if (WARN_ON(IS_ERR(ruleset)))
650*4882a593Smuzhiyun 		return -EINVAL;
651*4882a593Smuzhiyun 
652*4882a593Smuzhiyun 	rule = mlxsw_sp_acl_rule_lookup(mlxsw_sp, ruleset, f->cookie);
653*4882a593Smuzhiyun 	if (!rule)
654*4882a593Smuzhiyun 		return -EINVAL;
655*4882a593Smuzhiyun 
656*4882a593Smuzhiyun 	err = mlxsw_sp_acl_rule_get_stats(mlxsw_sp, rule, &packets, &bytes,
657*4882a593Smuzhiyun 					  &drops, &lastuse, &used_hw_stats);
658*4882a593Smuzhiyun 	if (err)
659*4882a593Smuzhiyun 		goto err_rule_get_stats;
660*4882a593Smuzhiyun 
661*4882a593Smuzhiyun 	flow_stats_update(&f->stats, bytes, packets, drops, lastuse,
662*4882a593Smuzhiyun 			  used_hw_stats);
663*4882a593Smuzhiyun 
664*4882a593Smuzhiyun 	mlxsw_sp_acl_ruleset_put(mlxsw_sp, ruleset);
665*4882a593Smuzhiyun 	return 0;
666*4882a593Smuzhiyun 
667*4882a593Smuzhiyun err_rule_get_stats:
668*4882a593Smuzhiyun 	mlxsw_sp_acl_ruleset_put(mlxsw_sp, ruleset);
669*4882a593Smuzhiyun 	return err;
670*4882a593Smuzhiyun }
671*4882a593Smuzhiyun 
mlxsw_sp_flower_tmplt_create(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_flow_block * block,struct flow_cls_offload * f)672*4882a593Smuzhiyun int mlxsw_sp_flower_tmplt_create(struct mlxsw_sp *mlxsw_sp,
673*4882a593Smuzhiyun 				 struct mlxsw_sp_flow_block *block,
674*4882a593Smuzhiyun 				 struct flow_cls_offload *f)
675*4882a593Smuzhiyun {
676*4882a593Smuzhiyun 	struct mlxsw_sp_acl_ruleset *ruleset;
677*4882a593Smuzhiyun 	struct mlxsw_sp_acl_rule_info rulei;
678*4882a593Smuzhiyun 	int err;
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun 	memset(&rulei, 0, sizeof(rulei));
681*4882a593Smuzhiyun 	err = mlxsw_sp_flower_parse(mlxsw_sp, block, &rulei, f);
682*4882a593Smuzhiyun 	if (err)
683*4882a593Smuzhiyun 		return err;
684*4882a593Smuzhiyun 	ruleset = mlxsw_sp_acl_ruleset_get(mlxsw_sp, block,
685*4882a593Smuzhiyun 					   f->common.chain_index,
686*4882a593Smuzhiyun 					   MLXSW_SP_ACL_PROFILE_FLOWER,
687*4882a593Smuzhiyun 					   &rulei.values.elusage);
688*4882a593Smuzhiyun 
689*4882a593Smuzhiyun 	/* keep the reference to the ruleset */
690*4882a593Smuzhiyun 	return PTR_ERR_OR_ZERO(ruleset);
691*4882a593Smuzhiyun }
692*4882a593Smuzhiyun 
mlxsw_sp_flower_tmplt_destroy(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_flow_block * block,struct flow_cls_offload * f)693*4882a593Smuzhiyun void mlxsw_sp_flower_tmplt_destroy(struct mlxsw_sp *mlxsw_sp,
694*4882a593Smuzhiyun 				   struct mlxsw_sp_flow_block *block,
695*4882a593Smuzhiyun 				   struct flow_cls_offload *f)
696*4882a593Smuzhiyun {
697*4882a593Smuzhiyun 	struct mlxsw_sp_acl_ruleset *ruleset;
698*4882a593Smuzhiyun 
699*4882a593Smuzhiyun 	ruleset = mlxsw_sp_acl_ruleset_get(mlxsw_sp, block,
700*4882a593Smuzhiyun 					   f->common.chain_index,
701*4882a593Smuzhiyun 					   MLXSW_SP_ACL_PROFILE_FLOWER, NULL);
702*4882a593Smuzhiyun 	if (IS_ERR(ruleset))
703*4882a593Smuzhiyun 		return;
704*4882a593Smuzhiyun 	/* put the reference to the ruleset kept in create */
705*4882a593Smuzhiyun 	mlxsw_sp_acl_ruleset_put(mlxsw_sp, ruleset);
706*4882a593Smuzhiyun 	mlxsw_sp_acl_ruleset_put(mlxsw_sp, ruleset);
707*4882a593Smuzhiyun }
708*4882a593Smuzhiyun 
mlxsw_sp_flower_prio_get(struct mlxsw_sp * mlxsw_sp,struct mlxsw_sp_flow_block * block,u32 chain_index,unsigned int * p_min_prio,unsigned int * p_max_prio)709*4882a593Smuzhiyun int mlxsw_sp_flower_prio_get(struct mlxsw_sp *mlxsw_sp,
710*4882a593Smuzhiyun 			     struct mlxsw_sp_flow_block *block,
711*4882a593Smuzhiyun 			     u32 chain_index, unsigned int *p_min_prio,
712*4882a593Smuzhiyun 			     unsigned int *p_max_prio)
713*4882a593Smuzhiyun {
714*4882a593Smuzhiyun 	struct mlxsw_sp_acl_ruleset *ruleset;
715*4882a593Smuzhiyun 
716*4882a593Smuzhiyun 	ruleset = mlxsw_sp_acl_ruleset_lookup(mlxsw_sp, block,
717*4882a593Smuzhiyun 					      chain_index,
718*4882a593Smuzhiyun 					      MLXSW_SP_ACL_PROFILE_FLOWER);
719*4882a593Smuzhiyun 	if (IS_ERR(ruleset))
720*4882a593Smuzhiyun 		/* In case there are no flower rules, the caller
721*4882a593Smuzhiyun 		 * receives -ENOENT to indicate there is no need
722*4882a593Smuzhiyun 		 * to check the priorities.
723*4882a593Smuzhiyun 		 */
724*4882a593Smuzhiyun 		return PTR_ERR(ruleset);
725*4882a593Smuzhiyun 	mlxsw_sp_acl_ruleset_prio_get(ruleset, p_min_prio, p_max_prio);
726*4882a593Smuzhiyun 	return 0;
727*4882a593Smuzhiyun }
728