xref: /dpdk/drivers/net/cxgbe/cxgbe_flow.c (revision 200bc52e5aa0d72e70464c9cd22b55cf536ed13c)
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2018 Chelsio Communications.
3  * All rights reserved.
4  */
5 #include "base/common.h"
6 #include "cxgbe_flow.h"
7 
8 #define __CXGBE_FILL_FS(__v, __m, fs, elem, e) \
9 do { \
10 	if ((fs)->mask.elem && ((fs)->val.elem != (__v))) \
11 		return rte_flow_error_set(e, EINVAL, RTE_FLOW_ERROR_TYPE_ITEM, \
12 					  NULL, "Redefined match item with" \
13 					  " different values found"); \
14 	(fs)->val.elem = (__v); \
15 	(fs)->mask.elem = (__m); \
16 } while (0)
17 
18 #define __CXGBE_FILL_FS_MEMCPY(__v, __m, fs, elem) \
19 do { \
20 	memcpy(&(fs)->val.elem, &(__v), sizeof(__v)); \
21 	memcpy(&(fs)->mask.elem, &(__m), sizeof(__m)); \
22 } while (0)
23 
24 #define CXGBE_FILL_FS(v, m, elem) \
25 	__CXGBE_FILL_FS(v, m, fs, elem, e)
26 
27 #define CXGBE_FILL_FS_MEMCPY(v, m, elem) \
28 	__CXGBE_FILL_FS_MEMCPY(v, m, fs, elem)
29 
30 static int
31 cxgbe_validate_item(const struct rte_flow_item *i, struct rte_flow_error *e)
32 {
33 	/* rte_flow specification does not allow it. */
34 	if (!i->spec && (i->mask ||  i->last))
35 		return rte_flow_error_set(e, EINVAL, RTE_FLOW_ERROR_TYPE_ITEM,
36 				   i, "last or mask given without spec");
37 	/*
38 	 * We don't support it.
39 	 * Although, we can support values in last as 0's or last == spec.
40 	 * But this will not provide user with any additional functionality
41 	 * and will only increase the complexity for us.
42 	 */
43 	if (i->last)
44 		return rte_flow_error_set(e, ENOTSUP, RTE_FLOW_ERROR_TYPE_ITEM,
45 				   i, "last is not supported by chelsio pmd");
46 	return 0;
47 }
48 
49 static void
50 cxgbe_fill_filter_region(struct adapter *adap,
51 			 struct ch_filter_specification *fs)
52 {
53 	struct tp_params *tp = &adap->params.tp;
54 	u64 hash_filter_mask = tp->hash_filter_mask;
55 	u64 ntuple_mask = 0;
56 
57 	fs->cap = 0;
58 
59 	if (!is_hashfilter(adap))
60 		return;
61 
62 	if (fs->type) {
63 		uint8_t biton[16] = {0xff, 0xff, 0xff, 0xff,
64 				     0xff, 0xff, 0xff, 0xff,
65 				     0xff, 0xff, 0xff, 0xff,
66 				     0xff, 0xff, 0xff, 0xff};
67 		uint8_t bitoff[16] = {0};
68 
69 		if (!memcmp(fs->val.lip, bitoff, sizeof(bitoff)) ||
70 		    !memcmp(fs->val.fip, bitoff, sizeof(bitoff)) ||
71 		    memcmp(fs->mask.lip, biton, sizeof(biton)) ||
72 		    memcmp(fs->mask.fip, biton, sizeof(biton)))
73 			return;
74 	} else {
75 		uint32_t biton  = 0xffffffff;
76 		uint32_t bitoff = 0x0U;
77 
78 		if (!memcmp(fs->val.lip, &bitoff, sizeof(bitoff)) ||
79 		    !memcmp(fs->val.fip, &bitoff, sizeof(bitoff)) ||
80 		    memcmp(fs->mask.lip, &biton, sizeof(biton)) ||
81 		    memcmp(fs->mask.fip, &biton, sizeof(biton)))
82 			return;
83 	}
84 
85 	if (!fs->val.lport || fs->mask.lport != 0xffff)
86 		return;
87 	if (!fs->val.fport || fs->mask.fport != 0xffff)
88 		return;
89 
90 	if (tp->protocol_shift >= 0)
91 		ntuple_mask |= (u64)fs->mask.proto << tp->protocol_shift;
92 	if (tp->ethertype_shift >= 0)
93 		ntuple_mask |= (u64)fs->mask.ethtype << tp->ethertype_shift;
94 	if (tp->port_shift >= 0)
95 		ntuple_mask |= (u64)fs->mask.iport << tp->port_shift;
96 	if (tp->macmatch_shift >= 0)
97 		ntuple_mask |= (u64)fs->mask.macidx << tp->macmatch_shift;
98 
99 	if (ntuple_mask != hash_filter_mask)
100 		return;
101 
102 	fs->cap = 1;	/* use hash region */
103 }
104 
105 static int
106 ch_rte_parsetype_eth(const void *dmask, const struct rte_flow_item *item,
107 		     struct ch_filter_specification *fs,
108 		     struct rte_flow_error *e)
109 {
110 	const struct rte_flow_item_eth *spec = item->spec;
111 	const struct rte_flow_item_eth *umask = item->mask;
112 	const struct rte_flow_item_eth *mask;
113 
114 	/* If user has not given any mask, then use chelsio supported mask. */
115 	mask = umask ? umask : (const struct rte_flow_item_eth *)dmask;
116 
117 	/* we don't support SRC_MAC filtering*/
118 	if (!rte_is_zero_ether_addr(&mask->src))
119 		return rte_flow_error_set(e, ENOTSUP, RTE_FLOW_ERROR_TYPE_ITEM,
120 					  item,
121 					  "src mac filtering not supported");
122 
123 	if (!rte_is_zero_ether_addr(&mask->dst)) {
124 		const u8 *addr = (const u8 *)&spec->dst.addr_bytes[0];
125 		const u8 *m = (const u8 *)&mask->dst.addr_bytes[0];
126 		struct rte_flow *flow = (struct rte_flow *)fs->private;
127 		struct port_info *pi = (struct port_info *)
128 					(flow->dev->data->dev_private);
129 		int idx;
130 
131 		idx = cxgbe_mpstcam_alloc(pi, addr, m);
132 		if (idx <= 0)
133 			return rte_flow_error_set(e, idx,
134 						  RTE_FLOW_ERROR_TYPE_ITEM,
135 						  NULL, "unable to allocate mac"
136 						  " entry in h/w");
137 		CXGBE_FILL_FS(idx, 0x1ff, macidx);
138 	}
139 
140 	CXGBE_FILL_FS(be16_to_cpu(spec->type),
141 		      be16_to_cpu(mask->type), ethtype);
142 	return 0;
143 }
144 
145 static int
146 ch_rte_parsetype_port(const void *dmask, const struct rte_flow_item *item,
147 		      struct ch_filter_specification *fs,
148 		      struct rte_flow_error *e)
149 {
150 	const struct rte_flow_item_phy_port *val = item->spec;
151 	const struct rte_flow_item_phy_port *umask = item->mask;
152 	const struct rte_flow_item_phy_port *mask;
153 
154 	mask = umask ? umask : (const struct rte_flow_item_phy_port *)dmask;
155 
156 	if (val->index > 0x7)
157 		return rte_flow_error_set(e, EINVAL, RTE_FLOW_ERROR_TYPE_ITEM,
158 					  item,
159 					  "port index upto 0x7 is supported");
160 
161 	CXGBE_FILL_FS(val->index, mask->index, iport);
162 
163 	return 0;
164 }
165 
166 static int
167 ch_rte_parsetype_udp(const void *dmask, const struct rte_flow_item *item,
168 		     struct ch_filter_specification *fs,
169 		     struct rte_flow_error *e)
170 {
171 	const struct rte_flow_item_udp *val = item->spec;
172 	const struct rte_flow_item_udp *umask = item->mask;
173 	const struct rte_flow_item_udp *mask;
174 
175 	mask = umask ? umask : (const struct rte_flow_item_udp *)dmask;
176 
177 	if (mask->hdr.dgram_len || mask->hdr.dgram_cksum)
178 		return rte_flow_error_set(e, ENOTSUP, RTE_FLOW_ERROR_TYPE_ITEM,
179 					  item,
180 					  "udp: only src/dst port supported");
181 
182 	CXGBE_FILL_FS(IPPROTO_UDP, 0xff, proto);
183 	if (!val)
184 		return 0;
185 	CXGBE_FILL_FS(be16_to_cpu(val->hdr.src_port),
186 		      be16_to_cpu(mask->hdr.src_port), fport);
187 	CXGBE_FILL_FS(be16_to_cpu(val->hdr.dst_port),
188 		      be16_to_cpu(mask->hdr.dst_port), lport);
189 	return 0;
190 }
191 
192 static int
193 ch_rte_parsetype_tcp(const void *dmask, const struct rte_flow_item *item,
194 		     struct ch_filter_specification *fs,
195 		     struct rte_flow_error *e)
196 {
197 	const struct rte_flow_item_tcp *val = item->spec;
198 	const struct rte_flow_item_tcp *umask = item->mask;
199 	const struct rte_flow_item_tcp *mask;
200 
201 	mask = umask ? umask : (const struct rte_flow_item_tcp *)dmask;
202 
203 	if (mask->hdr.sent_seq || mask->hdr.recv_ack || mask->hdr.data_off ||
204 	    mask->hdr.tcp_flags || mask->hdr.rx_win || mask->hdr.cksum ||
205 	    mask->hdr.tcp_urp)
206 		return rte_flow_error_set(e, ENOTSUP, RTE_FLOW_ERROR_TYPE_ITEM,
207 					  item,
208 					  "tcp: only src/dst port supported");
209 
210 	CXGBE_FILL_FS(IPPROTO_TCP, 0xff, proto);
211 	if (!val)
212 		return 0;
213 	CXGBE_FILL_FS(be16_to_cpu(val->hdr.src_port),
214 		      be16_to_cpu(mask->hdr.src_port), fport);
215 	CXGBE_FILL_FS(be16_to_cpu(val->hdr.dst_port),
216 		      be16_to_cpu(mask->hdr.dst_port), lport);
217 	return 0;
218 }
219 
220 static int
221 ch_rte_parsetype_ipv4(const void *dmask, const struct rte_flow_item *item,
222 		      struct ch_filter_specification *fs,
223 		      struct rte_flow_error *e)
224 {
225 	const struct rte_flow_item_ipv4 *val = item->spec;
226 	const struct rte_flow_item_ipv4 *umask = item->mask;
227 	const struct rte_flow_item_ipv4 *mask;
228 
229 	mask = umask ? umask : (const struct rte_flow_item_ipv4 *)dmask;
230 
231 	if (mask->hdr.time_to_live || mask->hdr.type_of_service)
232 		return rte_flow_error_set(e, ENOTSUP, RTE_FLOW_ERROR_TYPE_ITEM,
233 					  item, "ttl/tos are not supported");
234 
235 	fs->type = FILTER_TYPE_IPV4;
236 	CXGBE_FILL_FS(RTE_ETHER_TYPE_IPv4, 0xffff, ethtype);
237 	if (!val)
238 		return 0; /* ipv4 wild card */
239 
240 	CXGBE_FILL_FS(val->hdr.next_proto_id, mask->hdr.next_proto_id, proto);
241 	CXGBE_FILL_FS_MEMCPY(val->hdr.dst_addr, mask->hdr.dst_addr, lip);
242 	CXGBE_FILL_FS_MEMCPY(val->hdr.src_addr, mask->hdr.src_addr, fip);
243 
244 	return 0;
245 }
246 
247 static int
248 ch_rte_parsetype_ipv6(const void *dmask, const struct rte_flow_item *item,
249 		      struct ch_filter_specification *fs,
250 		      struct rte_flow_error *e)
251 {
252 	const struct rte_flow_item_ipv6 *val = item->spec;
253 	const struct rte_flow_item_ipv6 *umask = item->mask;
254 	const struct rte_flow_item_ipv6 *mask;
255 
256 	mask = umask ? umask : (const struct rte_flow_item_ipv6 *)dmask;
257 
258 	if (mask->hdr.vtc_flow ||
259 	    mask->hdr.payload_len || mask->hdr.hop_limits)
260 		return rte_flow_error_set(e, ENOTSUP, RTE_FLOW_ERROR_TYPE_ITEM,
261 					  item,
262 					  "tc/flow/hop are not supported");
263 
264 	fs->type = FILTER_TYPE_IPV6;
265 	CXGBE_FILL_FS(RTE_ETHER_TYPE_IPv6, 0xffff, ethtype);
266 	if (!val)
267 		return 0; /* ipv6 wild card */
268 
269 	CXGBE_FILL_FS(val->hdr.proto, mask->hdr.proto, proto);
270 	CXGBE_FILL_FS_MEMCPY(val->hdr.dst_addr, mask->hdr.dst_addr, lip);
271 	CXGBE_FILL_FS_MEMCPY(val->hdr.src_addr, mask->hdr.src_addr, fip);
272 
273 	return 0;
274 }
275 
276 static int
277 cxgbe_rtef_parse_attr(struct rte_flow *flow, const struct rte_flow_attr *attr,
278 		      struct rte_flow_error *e)
279 {
280 	if (attr->egress)
281 		return rte_flow_error_set(e, ENOTSUP, RTE_FLOW_ERROR_TYPE_ATTR,
282 					  attr, "attribute:<egress> is"
283 					  " not supported !");
284 	if (attr->group > 0)
285 		return rte_flow_error_set(e, ENOTSUP, RTE_FLOW_ERROR_TYPE_ATTR,
286 					  attr, "group parameter is"
287 					  " not supported.");
288 
289 	flow->fidx = attr->priority ? attr->priority - 1 : FILTER_ID_MAX;
290 
291 	return 0;
292 }
293 
294 static inline int check_rxq(struct rte_eth_dev *dev, uint16_t rxq)
295 {
296 	struct port_info *pi = ethdev2pinfo(dev);
297 
298 	if (rxq > pi->n_rx_qsets)
299 		return -EINVAL;
300 	return 0;
301 }
302 
303 static int cxgbe_validate_fidxondel(struct filter_entry *f, unsigned int fidx)
304 {
305 	struct adapter *adap = ethdev2adap(f->dev);
306 	struct ch_filter_specification fs = f->fs;
307 
308 	if (fidx >= adap->tids.nftids) {
309 		dev_err(adap, "invalid flow index %d.\n", fidx);
310 		return -EINVAL;
311 	}
312 	if (!is_filter_set(&adap->tids, fidx, fs.type)) {
313 		dev_err(adap, "Already free fidx:%d f:%p\n", fidx, f);
314 		return -EINVAL;
315 	}
316 
317 	return 0;
318 }
319 
320 static int
321 cxgbe_validate_fidxonadd(struct ch_filter_specification *fs,
322 			 struct adapter *adap, unsigned int fidx)
323 {
324 	if (is_filter_set(&adap->tids, fidx, fs->type)) {
325 		dev_err(adap, "filter index: %d is busy.\n", fidx);
326 		return -EBUSY;
327 	}
328 	if (fidx >= adap->tids.nftids) {
329 		dev_err(adap, "filter index (%u) >= max(%u)\n",
330 			fidx, adap->tids.nftids);
331 		return -ERANGE;
332 	}
333 
334 	return 0;
335 }
336 
337 static int
338 cxgbe_verify_fidx(struct rte_flow *flow, unsigned int fidx, uint8_t del)
339 {
340 	if (flow->fs.cap)
341 		return 0; /* Hash filters */
342 	return del ? cxgbe_validate_fidxondel(flow->f, fidx) :
343 		cxgbe_validate_fidxonadd(&flow->fs,
344 					 ethdev2adap(flow->dev), fidx);
345 }
346 
347 static int cxgbe_get_fidx(struct rte_flow *flow, unsigned int *fidx)
348 {
349 	struct ch_filter_specification *fs = &flow->fs;
350 	struct adapter *adap = ethdev2adap(flow->dev);
351 
352 	/* For tcam get the next available slot, if default value specified */
353 	if (flow->fidx == FILTER_ID_MAX) {
354 		int idx;
355 
356 		idx = cxgbe_alloc_ftid(adap, fs->type);
357 		if (idx < 0) {
358 			dev_err(adap, "unable to get a filter index in tcam\n");
359 			return -ENOMEM;
360 		}
361 		*fidx = (unsigned int)idx;
362 	} else {
363 		*fidx = flow->fidx;
364 	}
365 
366 	return 0;
367 }
368 
369 static int
370 cxgbe_get_flow_item_index(const struct rte_flow_item items[], u32 type)
371 {
372 	const struct rte_flow_item *i;
373 	int j, index = -ENOENT;
374 
375 	for (i = items, j = 0; i->type != RTE_FLOW_ITEM_TYPE_END; i++, j++) {
376 		if (i->type == type) {
377 			index = j;
378 			break;
379 		}
380 	}
381 
382 	return index;
383 }
384 
385 static int
386 ch_rte_parse_nat(uint8_t nmode, struct ch_filter_specification *fs)
387 {
388 	/* nmode:
389 	 * BIT_0 = [src_ip],   BIT_1 = [dst_ip]
390 	 * BIT_2 = [src_port], BIT_3 = [dst_port]
391 	 *
392 	 * Only below cases are supported as per our spec.
393 	 */
394 	switch (nmode) {
395 	case 0:  /* 0000b */
396 		fs->nat_mode = NAT_MODE_NONE;
397 		break;
398 	case 2:  /* 0010b */
399 		fs->nat_mode = NAT_MODE_DIP;
400 		break;
401 	case 5:  /* 0101b */
402 		fs->nat_mode = NAT_MODE_SIP_SP;
403 		break;
404 	case 7:  /* 0111b */
405 		fs->nat_mode = NAT_MODE_DIP_SIP_SP;
406 		break;
407 	case 10: /* 1010b */
408 		fs->nat_mode = NAT_MODE_DIP_DP;
409 		break;
410 	case 11: /* 1011b */
411 		fs->nat_mode = NAT_MODE_DIP_DP_SIP;
412 		break;
413 	case 14: /* 1110b */
414 		fs->nat_mode = NAT_MODE_DIP_DP_SP;
415 		break;
416 	case 15: /* 1111b */
417 		fs->nat_mode = NAT_MODE_ALL;
418 		break;
419 	default:
420 		return -EINVAL;
421 	}
422 
423 	return 0;
424 }
425 
426 static int
427 ch_rte_parse_atype_switch(const struct rte_flow_action *a,
428 			  const struct rte_flow_item items[],
429 			  uint8_t *nmode,
430 			  struct ch_filter_specification *fs,
431 			  struct rte_flow_error *e)
432 {
433 	const struct rte_flow_action_of_set_vlan_vid *vlanid;
434 	const struct rte_flow_action_of_push_vlan *pushvlan;
435 	const struct rte_flow_action_set_ipv4 *ipv4;
436 	const struct rte_flow_action_set_ipv6 *ipv6;
437 	const struct rte_flow_action_set_tp *tp_port;
438 	const struct rte_flow_action_phy_port *port;
439 	int item_index;
440 
441 	switch (a->type) {
442 	case RTE_FLOW_ACTION_TYPE_OF_SET_VLAN_VID:
443 		vlanid = (const struct rte_flow_action_of_set_vlan_vid *)
444 			  a->conf;
445 		fs->newvlan = VLAN_REWRITE;
446 		fs->vlan = vlanid->vlan_vid;
447 		break;
448 	case RTE_FLOW_ACTION_TYPE_OF_PUSH_VLAN:
449 		pushvlan = (const struct rte_flow_action_of_push_vlan *)
450 			    a->conf;
451 		if (pushvlan->ethertype != RTE_ETHER_TYPE_VLAN)
452 			return rte_flow_error_set(e, EINVAL,
453 						  RTE_FLOW_ERROR_TYPE_ACTION, a,
454 						  "only ethertype 0x8100 "
455 						  "supported for push vlan.");
456 		fs->newvlan = VLAN_INSERT;
457 		break;
458 	case RTE_FLOW_ACTION_TYPE_OF_POP_VLAN:
459 		fs->newvlan = VLAN_REMOVE;
460 		break;
461 	case RTE_FLOW_ACTION_TYPE_PHY_PORT:
462 		port = (const struct rte_flow_action_phy_port *)a->conf;
463 		fs->eport = port->index;
464 		break;
465 	case RTE_FLOW_ACTION_TYPE_SET_IPV4_SRC:
466 		item_index = cxgbe_get_flow_item_index(items,
467 						       RTE_FLOW_ITEM_TYPE_IPV4);
468 		if (item_index < 0)
469 			return rte_flow_error_set(e, EINVAL,
470 						  RTE_FLOW_ERROR_TYPE_ACTION, a,
471 						  "No RTE_FLOW_ITEM_TYPE_IPV4 "
472 						  "found.");
473 
474 		ipv4 = (const struct rte_flow_action_set_ipv4 *)a->conf;
475 		memcpy(fs->nat_fip, &ipv4->ipv4_addr, sizeof(ipv4->ipv4_addr));
476 		*nmode |= 1 << 0;
477 		break;
478 	case RTE_FLOW_ACTION_TYPE_SET_IPV4_DST:
479 		item_index = cxgbe_get_flow_item_index(items,
480 						       RTE_FLOW_ITEM_TYPE_IPV4);
481 		if (item_index < 0)
482 			return rte_flow_error_set(e, EINVAL,
483 						  RTE_FLOW_ERROR_TYPE_ACTION, a,
484 						  "No RTE_FLOW_ITEM_TYPE_IPV4 "
485 						  "found.");
486 
487 		ipv4 = (const struct rte_flow_action_set_ipv4 *)a->conf;
488 		memcpy(fs->nat_lip, &ipv4->ipv4_addr, sizeof(ipv4->ipv4_addr));
489 		*nmode |= 1 << 1;
490 		break;
491 	case RTE_FLOW_ACTION_TYPE_SET_IPV6_SRC:
492 		item_index = cxgbe_get_flow_item_index(items,
493 						       RTE_FLOW_ITEM_TYPE_IPV6);
494 		if (item_index < 0)
495 			return rte_flow_error_set(e, EINVAL,
496 						  RTE_FLOW_ERROR_TYPE_ACTION, a,
497 						  "No RTE_FLOW_ITEM_TYPE_IPV6 "
498 						  "found.");
499 
500 		ipv6 = (const struct rte_flow_action_set_ipv6 *)a->conf;
501 		memcpy(fs->nat_fip, ipv6->ipv6_addr, sizeof(ipv6->ipv6_addr));
502 		*nmode |= 1 << 0;
503 		break;
504 	case RTE_FLOW_ACTION_TYPE_SET_IPV6_DST:
505 		item_index = cxgbe_get_flow_item_index(items,
506 						       RTE_FLOW_ITEM_TYPE_IPV6);
507 		if (item_index < 0)
508 			return rte_flow_error_set(e, EINVAL,
509 						  RTE_FLOW_ERROR_TYPE_ACTION, a,
510 						  "No RTE_FLOW_ITEM_TYPE_IPV6 "
511 						  "found.");
512 
513 		ipv6 = (const struct rte_flow_action_set_ipv6 *)a->conf;
514 		memcpy(fs->nat_lip, ipv6->ipv6_addr, sizeof(ipv6->ipv6_addr));
515 		*nmode |= 1 << 1;
516 		break;
517 	case RTE_FLOW_ACTION_TYPE_SET_TP_SRC:
518 		item_index = cxgbe_get_flow_item_index(items,
519 						       RTE_FLOW_ITEM_TYPE_TCP);
520 		if (item_index < 0) {
521 			item_index =
522 				cxgbe_get_flow_item_index(items,
523 						RTE_FLOW_ITEM_TYPE_UDP);
524 			if (item_index < 0)
525 				return rte_flow_error_set(e, EINVAL,
526 						RTE_FLOW_ERROR_TYPE_ACTION, a,
527 						"No RTE_FLOW_ITEM_TYPE_TCP or "
528 						"RTE_FLOW_ITEM_TYPE_UDP found");
529 		}
530 
531 		tp_port = (const struct rte_flow_action_set_tp *)a->conf;
532 		fs->nat_fport = be16_to_cpu(tp_port->port);
533 		*nmode |= 1 << 2;
534 		break;
535 	case RTE_FLOW_ACTION_TYPE_SET_TP_DST:
536 		item_index = cxgbe_get_flow_item_index(items,
537 						       RTE_FLOW_ITEM_TYPE_TCP);
538 		if (item_index < 0) {
539 			item_index =
540 				cxgbe_get_flow_item_index(items,
541 						RTE_FLOW_ITEM_TYPE_UDP);
542 			if (item_index < 0)
543 				return rte_flow_error_set(e, EINVAL,
544 						RTE_FLOW_ERROR_TYPE_ACTION, a,
545 						"No RTE_FLOW_ITEM_TYPE_TCP or "
546 						"RTE_FLOW_ITEM_TYPE_UDP found");
547 		}
548 
549 		tp_port = (const struct rte_flow_action_set_tp *)a->conf;
550 		fs->nat_lport = be16_to_cpu(tp_port->port);
551 		*nmode |= 1 << 3;
552 		break;
553 	case RTE_FLOW_ACTION_TYPE_MAC_SWAP:
554 		item_index = cxgbe_get_flow_item_index(items,
555 						       RTE_FLOW_ITEM_TYPE_ETH);
556 		if (item_index < 0)
557 			return rte_flow_error_set(e, EINVAL,
558 						  RTE_FLOW_ERROR_TYPE_ACTION, a,
559 						  "No RTE_FLOW_ITEM_TYPE_ETH "
560 						  "found");
561 		fs->swapmac = 1;
562 		break;
563 	default:
564 		/* We are not supposed to come here */
565 		return rte_flow_error_set(e, EINVAL,
566 					  RTE_FLOW_ERROR_TYPE_ACTION, a,
567 					  "Action not supported");
568 	}
569 
570 	return 0;
571 }
572 
573 static int
574 cxgbe_rtef_parse_actions(struct rte_flow *flow,
575 			 const struct rte_flow_item items[],
576 			 const struct rte_flow_action action[],
577 			 struct rte_flow_error *e)
578 {
579 	struct ch_filter_specification *fs = &flow->fs;
580 	uint8_t nmode = 0, nat_ipv4 = 0, nat_ipv6 = 0;
581 	const struct rte_flow_action_queue *q;
582 	const struct rte_flow_action *a;
583 	char abit = 0;
584 	int ret;
585 
586 	for (a = action; a->type != RTE_FLOW_ACTION_TYPE_END; a++) {
587 		switch (a->type) {
588 		case RTE_FLOW_ACTION_TYPE_VOID:
589 			continue;
590 		case RTE_FLOW_ACTION_TYPE_DROP:
591 			if (abit++)
592 				return rte_flow_error_set(e, EINVAL,
593 						RTE_FLOW_ERROR_TYPE_ACTION, a,
594 						"specify only 1 pass/drop");
595 			fs->action = FILTER_DROP;
596 			break;
597 		case RTE_FLOW_ACTION_TYPE_QUEUE:
598 			q = (const struct rte_flow_action_queue *)a->conf;
599 			if (!q)
600 				return rte_flow_error_set(e, EINVAL,
601 						RTE_FLOW_ERROR_TYPE_ACTION, q,
602 						"specify rx queue index");
603 			if (check_rxq(flow->dev, q->index))
604 				return rte_flow_error_set(e, EINVAL,
605 						RTE_FLOW_ERROR_TYPE_ACTION, q,
606 						"Invalid rx queue");
607 			if (abit++)
608 				return rte_flow_error_set(e, EINVAL,
609 						RTE_FLOW_ERROR_TYPE_ACTION, a,
610 						"specify only 1 pass/drop");
611 			fs->action = FILTER_PASS;
612 			fs->dirsteer = 1;
613 			fs->iq = q->index;
614 			break;
615 		case RTE_FLOW_ACTION_TYPE_COUNT:
616 			fs->hitcnts = 1;
617 			break;
618 		case RTE_FLOW_ACTION_TYPE_OF_SET_VLAN_VID:
619 		case RTE_FLOW_ACTION_TYPE_OF_PUSH_VLAN:
620 		case RTE_FLOW_ACTION_TYPE_OF_POP_VLAN:
621 		case RTE_FLOW_ACTION_TYPE_PHY_PORT:
622 		case RTE_FLOW_ACTION_TYPE_MAC_SWAP:
623 		case RTE_FLOW_ACTION_TYPE_SET_IPV4_SRC:
624 		case RTE_FLOW_ACTION_TYPE_SET_IPV4_DST:
625 			nat_ipv4++;
626 			goto action_switch;
627 		case RTE_FLOW_ACTION_TYPE_SET_IPV6_SRC:
628 		case RTE_FLOW_ACTION_TYPE_SET_IPV6_DST:
629 			nat_ipv6++;
630 			goto action_switch;
631 		case RTE_FLOW_ACTION_TYPE_SET_TP_SRC:
632 		case RTE_FLOW_ACTION_TYPE_SET_TP_DST:
633 action_switch:
634 			/* We allow multiple switch actions, but switch is
635 			 * not compatible with either queue or drop
636 			 */
637 			if (abit++ && fs->action != FILTER_SWITCH)
638 				return rte_flow_error_set(e, EINVAL,
639 						RTE_FLOW_ERROR_TYPE_ACTION, a,
640 						"overlapping action specified");
641 			if (nat_ipv4 && nat_ipv6)
642 				return rte_flow_error_set(e, EINVAL,
643 					RTE_FLOW_ERROR_TYPE_ACTION, a,
644 					"Can't have one address ipv4 and the"
645 					" other ipv6");
646 
647 			ret = ch_rte_parse_atype_switch(a, items, &nmode, fs,
648 							e);
649 			if (ret)
650 				return ret;
651 			fs->action = FILTER_SWITCH;
652 			break;
653 		default:
654 			/* Not supported action : return error */
655 			return rte_flow_error_set(e, ENOTSUP,
656 						  RTE_FLOW_ERROR_TYPE_ACTION,
657 						  a, "Action not supported");
658 		}
659 	}
660 
661 	if (ch_rte_parse_nat(nmode, fs))
662 		return rte_flow_error_set(e, EINVAL,
663 					  RTE_FLOW_ERROR_TYPE_ACTION, a,
664 					  "invalid settings for swich action");
665 	return 0;
666 }
667 
668 static struct chrte_fparse parseitem[] = {
669 	[RTE_FLOW_ITEM_TYPE_ETH] = {
670 		.fptr  = ch_rte_parsetype_eth,
671 		.dmask = &(const struct rte_flow_item_eth){
672 			.dst.addr_bytes = "\xff\xff\xff\xff\xff\xff",
673 			.src.addr_bytes = "\x00\x00\x00\x00\x00\x00",
674 			.type = 0xffff,
675 		}
676 	},
677 
678 	[RTE_FLOW_ITEM_TYPE_PHY_PORT] = {
679 		.fptr = ch_rte_parsetype_port,
680 		.dmask = &(const struct rte_flow_item_phy_port){
681 			.index = 0x7,
682 		}
683 	},
684 
685 	[RTE_FLOW_ITEM_TYPE_IPV4] = {
686 		.fptr  = ch_rte_parsetype_ipv4,
687 		.dmask = &rte_flow_item_ipv4_mask,
688 	},
689 
690 	[RTE_FLOW_ITEM_TYPE_IPV6] = {
691 		.fptr  = ch_rte_parsetype_ipv6,
692 		.dmask = &rte_flow_item_ipv6_mask,
693 	},
694 
695 	[RTE_FLOW_ITEM_TYPE_UDP] = {
696 		.fptr  = ch_rte_parsetype_udp,
697 		.dmask = &rte_flow_item_udp_mask,
698 	},
699 
700 	[RTE_FLOW_ITEM_TYPE_TCP] = {
701 		.fptr  = ch_rte_parsetype_tcp,
702 		.dmask = &rte_flow_item_tcp_mask,
703 	},
704 };
705 
706 static int
707 cxgbe_rtef_parse_items(struct rte_flow *flow,
708 		       const struct rte_flow_item items[],
709 		       struct rte_flow_error *e)
710 {
711 	struct adapter *adap = ethdev2adap(flow->dev);
712 	const struct rte_flow_item *i;
713 	char repeat[ARRAY_SIZE(parseitem)] = {0};
714 
715 	for (i = items; i->type != RTE_FLOW_ITEM_TYPE_END; i++) {
716 		struct chrte_fparse *idx;
717 		int ret;
718 
719 		if (i->type >= ARRAY_SIZE(parseitem))
720 			return rte_flow_error_set(e, ENOTSUP,
721 						  RTE_FLOW_ERROR_TYPE_ITEM,
722 						  i, "Item not supported");
723 
724 		switch (i->type) {
725 		case RTE_FLOW_ITEM_TYPE_VOID:
726 			continue;
727 		default:
728 			/* check if item is repeated */
729 			if (repeat[i->type])
730 				return rte_flow_error_set(e, ENOTSUP,
731 						RTE_FLOW_ERROR_TYPE_ITEM, i,
732 						"parse items cannot be repeated (except void)");
733 			repeat[i->type] = 1;
734 
735 			/* No spec found for this pattern item. Skip it */
736 			if (!i->spec)
737 				break;
738 
739 			/* validate the item */
740 			ret = cxgbe_validate_item(i, e);
741 			if (ret)
742 				return ret;
743 
744 			idx = &flow->item_parser[i->type];
745 			if (!idx || !idx->fptr) {
746 				return rte_flow_error_set(e, ENOTSUP,
747 						RTE_FLOW_ERROR_TYPE_ITEM, i,
748 						"Item not supported");
749 			} else {
750 				ret = idx->fptr(idx->dmask, i, &flow->fs, e);
751 				if (ret)
752 					return ret;
753 			}
754 		}
755 	}
756 
757 	cxgbe_fill_filter_region(adap, &flow->fs);
758 
759 	return 0;
760 }
761 
762 static int
763 cxgbe_flow_parse(struct rte_flow *flow,
764 		 const struct rte_flow_attr *attr,
765 		 const struct rte_flow_item item[],
766 		 const struct rte_flow_action action[],
767 		 struct rte_flow_error *e)
768 {
769 	int ret;
770 	/* parse user request into ch_filter_specification */
771 	ret = cxgbe_rtef_parse_attr(flow, attr, e);
772 	if (ret)
773 		return ret;
774 	ret = cxgbe_rtef_parse_items(flow, item, e);
775 	if (ret)
776 		return ret;
777 	return cxgbe_rtef_parse_actions(flow, item, action, e);
778 }
779 
780 static int __cxgbe_flow_create(struct rte_eth_dev *dev, struct rte_flow *flow)
781 {
782 	struct ch_filter_specification *fs = &flow->fs;
783 	struct adapter *adap = ethdev2adap(dev);
784 	struct tid_info *t = &adap->tids;
785 	struct filter_ctx ctx;
786 	unsigned int fidx;
787 	int err;
788 
789 	if (cxgbe_get_fidx(flow, &fidx))
790 		return -ENOMEM;
791 	if (cxgbe_verify_fidx(flow, fidx, 0))
792 		return -1;
793 
794 	t4_init_completion(&ctx.completion);
795 	/* go create the filter */
796 	err = cxgbe_set_filter(dev, fidx, fs, &ctx);
797 	if (err) {
798 		dev_err(adap, "Error %d while creating filter.\n", err);
799 		return err;
800 	}
801 
802 	/* Poll the FW for reply */
803 	err = cxgbe_poll_for_completion(&adap->sge.fw_evtq,
804 					CXGBE_FLOW_POLL_MS,
805 					CXGBE_FLOW_POLL_CNT,
806 					&ctx.completion);
807 	if (err) {
808 		dev_err(adap, "Filter set operation timed out (%d)\n", err);
809 		return err;
810 	}
811 	if (ctx.result) {
812 		dev_err(adap, "Hardware error %d while creating the filter.\n",
813 			ctx.result);
814 		return ctx.result;
815 	}
816 
817 	if (fs->cap) { /* to destroy the filter */
818 		flow->fidx = ctx.tid;
819 		flow->f = lookup_tid(t, ctx.tid);
820 	} else {
821 		flow->fidx = fidx;
822 		flow->f = &adap->tids.ftid_tab[fidx];
823 	}
824 
825 	return 0;
826 }
827 
828 static struct rte_flow *
829 cxgbe_flow_create(struct rte_eth_dev *dev,
830 		  const struct rte_flow_attr *attr,
831 		  const struct rte_flow_item item[],
832 		  const struct rte_flow_action action[],
833 		  struct rte_flow_error *e)
834 {
835 	struct rte_flow *flow;
836 	int ret;
837 
838 	flow = t4_os_alloc(sizeof(struct rte_flow));
839 	if (!flow) {
840 		rte_flow_error_set(e, ENOMEM, RTE_FLOW_ERROR_TYPE_HANDLE,
841 				   NULL, "Unable to allocate memory for"
842 				   " filter_entry");
843 		return NULL;
844 	}
845 
846 	flow->item_parser = parseitem;
847 	flow->dev = dev;
848 	flow->fs.private = (void *)flow;
849 
850 	if (cxgbe_flow_parse(flow, attr, item, action, e)) {
851 		t4_os_free(flow);
852 		return NULL;
853 	}
854 
855 	/* go, interact with cxgbe_filter */
856 	ret = __cxgbe_flow_create(dev, flow);
857 	if (ret) {
858 		rte_flow_error_set(e, ret, RTE_FLOW_ERROR_TYPE_HANDLE,
859 				   NULL, "Unable to create flow rule");
860 		t4_os_free(flow);
861 		return NULL;
862 	}
863 
864 	flow->f->private = flow; /* Will be used during flush */
865 
866 	return flow;
867 }
868 
869 static int __cxgbe_flow_destroy(struct rte_eth_dev *dev, struct rte_flow *flow)
870 {
871 	struct adapter *adap = ethdev2adap(dev);
872 	struct filter_entry *f = flow->f;
873 	struct ch_filter_specification *fs;
874 	struct filter_ctx ctx;
875 	int err;
876 
877 	fs = &f->fs;
878 	if (cxgbe_verify_fidx(flow, flow->fidx, 1))
879 		return -1;
880 
881 	t4_init_completion(&ctx.completion);
882 	err = cxgbe_del_filter(dev, flow->fidx, fs, &ctx);
883 	if (err) {
884 		dev_err(adap, "Error %d while deleting filter.\n", err);
885 		return err;
886 	}
887 
888 	/* Poll the FW for reply */
889 	err = cxgbe_poll_for_completion(&adap->sge.fw_evtq,
890 					CXGBE_FLOW_POLL_MS,
891 					CXGBE_FLOW_POLL_CNT,
892 					&ctx.completion);
893 	if (err) {
894 		dev_err(adap, "Filter delete operation timed out (%d)\n", err);
895 		return err;
896 	}
897 	if (ctx.result) {
898 		dev_err(adap, "Hardware error %d while deleting the filter.\n",
899 			ctx.result);
900 		return ctx.result;
901 	}
902 
903 	fs = &flow->fs;
904 	if (fs->mask.macidx) {
905 		struct port_info *pi = (struct port_info *)
906 					(dev->data->dev_private);
907 		int ret;
908 
909 		ret = cxgbe_mpstcam_remove(pi, fs->val.macidx);
910 		if (!ret)
911 			return ret;
912 	}
913 
914 	return 0;
915 }
916 
917 static int
918 cxgbe_flow_destroy(struct rte_eth_dev *dev, struct rte_flow *flow,
919 		   struct rte_flow_error *e)
920 {
921 	int ret;
922 
923 	ret = __cxgbe_flow_destroy(dev, flow);
924 	if (ret)
925 		return rte_flow_error_set(e, ret, RTE_FLOW_ERROR_TYPE_HANDLE,
926 					  flow, "error destroying filter.");
927 	t4_os_free(flow);
928 	return 0;
929 }
930 
931 static int __cxgbe_flow_query(struct rte_flow *flow, u64 *count,
932 			      u64 *byte_count)
933 {
934 	struct adapter *adap = ethdev2adap(flow->dev);
935 	struct ch_filter_specification fs = flow->f->fs;
936 	unsigned int fidx = flow->fidx;
937 	int ret = 0;
938 
939 	ret = cxgbe_get_filter_count(adap, fidx, count, fs.cap, 0);
940 	if (ret)
941 		return ret;
942 	return cxgbe_get_filter_count(adap, fidx, byte_count, fs.cap, 1);
943 }
944 
945 static int
946 cxgbe_flow_query(struct rte_eth_dev *dev, struct rte_flow *flow,
947 		 const struct rte_flow_action *action, void *data,
948 		 struct rte_flow_error *e)
949 {
950 	struct adapter *adap = ethdev2adap(flow->dev);
951 	struct ch_filter_specification fs;
952 	struct rte_flow_query_count *c;
953 	struct filter_entry *f;
954 	int ret;
955 
956 	RTE_SET_USED(dev);
957 
958 	f = flow->f;
959 	fs = f->fs;
960 
961 	if (action->type != RTE_FLOW_ACTION_TYPE_COUNT)
962 		return rte_flow_error_set(e, ENOTSUP,
963 					  RTE_FLOW_ERROR_TYPE_ACTION, NULL,
964 					  "only count supported for query");
965 
966 	/*
967 	 * This is a valid operation, Since we are allowed to do chelsio
968 	 * specific operations in rte side of our code but not vise-versa
969 	 *
970 	 * So, fs can be queried/modified here BUT rte_flow_query_count
971 	 * cannot be worked on by the lower layer since we want to maintain
972 	 * it as rte_flow agnostic.
973 	 */
974 	if (!fs.hitcnts)
975 		return rte_flow_error_set(e, EINVAL, RTE_FLOW_ERROR_TYPE_ACTION,
976 					  &fs, "filter hit counters were not"
977 					  " enabled during filter creation");
978 
979 	c = (struct rte_flow_query_count *)data;
980 	ret = __cxgbe_flow_query(flow, &c->hits, &c->bytes);
981 	if (ret)
982 		return rte_flow_error_set(e, -ret, RTE_FLOW_ERROR_TYPE_ACTION,
983 					  f, "cxgbe pmd failed to"
984 					  " perform query");
985 
986 	/* Query was successful */
987 	c->bytes_set = 1;
988 	c->hits_set = 1;
989 	if (c->reset)
990 		cxgbe_clear_filter_count(adap, flow->fidx, f->fs.cap, true);
991 
992 	return 0; /* success / partial_success */
993 }
994 
995 static int
996 cxgbe_flow_validate(struct rte_eth_dev *dev,
997 		    const struct rte_flow_attr *attr,
998 		    const struct rte_flow_item item[],
999 		    const struct rte_flow_action action[],
1000 		    struct rte_flow_error *e)
1001 {
1002 	struct adapter *adap = ethdev2adap(dev);
1003 	struct rte_flow *flow;
1004 	unsigned int fidx;
1005 	int ret;
1006 
1007 	flow = t4_os_alloc(sizeof(struct rte_flow));
1008 	if (!flow)
1009 		return rte_flow_error_set(e, ENOMEM, RTE_FLOW_ERROR_TYPE_HANDLE,
1010 				NULL,
1011 				"Unable to allocate memory for filter_entry");
1012 
1013 	flow->item_parser = parseitem;
1014 	flow->dev = dev;
1015 
1016 	ret = cxgbe_flow_parse(flow, attr, item, action, e);
1017 	if (ret) {
1018 		t4_os_free(flow);
1019 		return ret;
1020 	}
1021 
1022 	if (validate_filter(adap, &flow->fs)) {
1023 		t4_os_free(flow);
1024 		return rte_flow_error_set(e, EINVAL, RTE_FLOW_ERROR_TYPE_HANDLE,
1025 				NULL,
1026 				"validation failed. Check f/w config file.");
1027 	}
1028 
1029 	if (cxgbe_get_fidx(flow, &fidx)) {
1030 		t4_os_free(flow);
1031 		return rte_flow_error_set(e, ENOMEM, RTE_FLOW_ERROR_TYPE_HANDLE,
1032 					  NULL, "no memory in tcam.");
1033 	}
1034 
1035 	if (cxgbe_verify_fidx(flow, fidx, 0)) {
1036 		t4_os_free(flow);
1037 		return rte_flow_error_set(e, EINVAL, RTE_FLOW_ERROR_TYPE_HANDLE,
1038 					  NULL, "validation failed");
1039 	}
1040 
1041 	t4_os_free(flow);
1042 	return 0;
1043 }
1044 
1045 /*
1046  * @ret : > 0 filter destroyed succsesfully
1047  *        < 0 error destroying filter
1048  *        == 1 filter not active / not found
1049  */
1050 static int
1051 cxgbe_check_n_destroy(struct filter_entry *f, struct rte_eth_dev *dev,
1052 		      struct rte_flow_error *e)
1053 {
1054 	if (f && (f->valid || f->pending) &&
1055 	    f->dev == dev && /* Only if user has asked for this port */
1056 	     f->private) /* We (rte_flow) created this filter */
1057 		return cxgbe_flow_destroy(dev, (struct rte_flow *)f->private,
1058 					  e);
1059 	return 1;
1060 }
1061 
1062 static int cxgbe_flow_flush(struct rte_eth_dev *dev, struct rte_flow_error *e)
1063 {
1064 	struct adapter *adap = ethdev2adap(dev);
1065 	unsigned int i;
1066 	int ret = 0;
1067 
1068 	if (adap->tids.ftid_tab) {
1069 		struct filter_entry *f = &adap->tids.ftid_tab[0];
1070 
1071 		for (i = 0; i < adap->tids.nftids; i++, f++) {
1072 			ret = cxgbe_check_n_destroy(f, dev, e);
1073 			if (ret < 0)
1074 				goto out;
1075 		}
1076 	}
1077 
1078 	if (is_hashfilter(adap) && adap->tids.tid_tab) {
1079 		struct filter_entry *f;
1080 
1081 		for (i = adap->tids.hash_base; i <= adap->tids.ntids; i++) {
1082 			f = (struct filter_entry *)adap->tids.tid_tab[i];
1083 
1084 			ret = cxgbe_check_n_destroy(f, dev, e);
1085 			if (ret < 0)
1086 				goto out;
1087 		}
1088 	}
1089 
1090 out:
1091 	return ret >= 0 ? 0 : ret;
1092 }
1093 
1094 static const struct rte_flow_ops cxgbe_flow_ops = {
1095 	.validate	= cxgbe_flow_validate,
1096 	.create		= cxgbe_flow_create,
1097 	.destroy	= cxgbe_flow_destroy,
1098 	.flush		= cxgbe_flow_flush,
1099 	.query		= cxgbe_flow_query,
1100 	.isolate	= NULL,
1101 };
1102 
1103 int
1104 cxgbe_dev_filter_ctrl(struct rte_eth_dev *dev,
1105 		      enum rte_filter_type filter_type,
1106 		      enum rte_filter_op filter_op,
1107 		      void *arg)
1108 {
1109 	int ret = 0;
1110 
1111 	RTE_SET_USED(dev);
1112 	switch (filter_type) {
1113 	case RTE_ETH_FILTER_GENERIC:
1114 		if (filter_op != RTE_ETH_FILTER_GET)
1115 			return -EINVAL;
1116 		*(const void **)arg = &cxgbe_flow_ops;
1117 		break;
1118 	default:
1119 		ret = -ENOTSUP;
1120 		break;
1121 	}
1122 	return ret;
1123 }
1124