xref: /dpdk/drivers/net/dpaa/dpaa_rxtx.c (revision cb440babbd45a80c059f8bc80e87c48d09086fd7)
1 /* SPDX-License-Identifier: BSD-3-Clause
2  *
3  *   Copyright 2016 Freescale Semiconductor, Inc. All rights reserved.
4  *   Copyright 2017,2019 NXP
5  *
6  */
7 
8 /* System headers */
9 #include <inttypes.h>
10 #include <unistd.h>
11 #include <stdio.h>
12 #include <limits.h>
13 #include <sched.h>
14 #include <pthread.h>
15 
16 #include <rte_byteorder.h>
17 #include <rte_common.h>
18 #include <rte_interrupts.h>
19 #include <rte_log.h>
20 #include <rte_debug.h>
21 #include <rte_pci.h>
22 #include <rte_atomic.h>
23 #include <rte_branch_prediction.h>
24 #include <rte_memory.h>
25 #include <rte_tailq.h>
26 #include <rte_eal.h>
27 #include <rte_alarm.h>
28 #include <rte_ether.h>
29 #include <rte_ethdev_driver.h>
30 #include <rte_malloc.h>
31 #include <rte_ring.h>
32 #include <rte_ip.h>
33 #include <rte_tcp.h>
34 #include <rte_udp.h>
35 #include <rte_net.h>
36 #include <rte_eventdev.h>
37 
38 #include "dpaa_ethdev.h"
39 #include "dpaa_rxtx.h"
40 #include <rte_dpaa_bus.h>
41 #include <dpaa_mempool.h>
42 
43 #include <qman.h>
44 #include <fsl_usd.h>
45 #include <fsl_qman.h>
46 #include <fsl_bman.h>
47 #include <dpaa_of.h>
48 #include <netcfg.h>
49 
50 #define DPAA_MBUF_TO_CONTIG_FD(_mbuf, _fd, _bpid) \
51 	do { \
52 		(_fd)->cmd = 0; \
53 		(_fd)->opaque_addr = 0; \
54 		(_fd)->opaque = QM_FD_CONTIG << DPAA_FD_FORMAT_SHIFT; \
55 		(_fd)->opaque |= ((_mbuf)->data_off) << DPAA_FD_OFFSET_SHIFT; \
56 		(_fd)->opaque |= (_mbuf)->pkt_len; \
57 		(_fd)->addr = (_mbuf)->buf_iova; \
58 		(_fd)->bpid = _bpid; \
59 	} while (0)
60 
61 #if (defined RTE_LIBRTE_DPAA_DEBUG_DRIVER)
62 static void dpaa_display_frame(const struct qm_fd *fd)
63 {
64 	int ii;
65 	char *ptr;
66 
67 	printf("%s::bpid %x addr %08x%08x, format %d off %d, len %d stat %x\n",
68 	       __func__, fd->bpid, fd->addr_hi, fd->addr_lo, fd->format,
69 		fd->offset, fd->length20, fd->status);
70 
71 	ptr = (char *)rte_dpaa_mem_ptov(fd->addr);
72 	ptr += fd->offset;
73 	printf("%02x ", *ptr);
74 	for (ii = 1; ii < fd->length20; ii++) {
75 		printf("%02x ", *ptr);
76 		if ((ii % 16) == 0)
77 			printf("\n");
78 		ptr++;
79 	}
80 	printf("\n");
81 }
82 #else
83 #define dpaa_display_frame(a)
84 #endif
85 
86 static inline void dpaa_slow_parsing(struct rte_mbuf *m __rte_unused,
87 				     uint64_t prs __rte_unused)
88 {
89 	DPAA_DP_LOG(DEBUG, "Slow parsing");
90 	/*TBD:XXX: to be implemented*/
91 }
92 
93 static inline void dpaa_eth_packet_info(struct rte_mbuf *m, void *fd_virt_addr)
94 {
95 	struct annotations_t *annot = GET_ANNOTATIONS(fd_virt_addr);
96 	uint64_t prs = *((uintptr_t *)(&annot->parse)) & DPAA_PARSE_MASK;
97 
98 	DPAA_DP_LOG(DEBUG, " Parsing mbuf: %p with annotations: %p", m, annot);
99 
100 	switch (prs) {
101 	case DPAA_PKT_TYPE_IPV4:
102 		m->packet_type = RTE_PTYPE_L2_ETHER |
103 			RTE_PTYPE_L3_IPV4;
104 		break;
105 	case DPAA_PKT_TYPE_IPV6:
106 		m->packet_type = RTE_PTYPE_L2_ETHER |
107 			RTE_PTYPE_L3_IPV6;
108 		break;
109 	case DPAA_PKT_TYPE_ETHER:
110 		m->packet_type = RTE_PTYPE_L2_ETHER;
111 		break;
112 	case DPAA_PKT_TYPE_IPV4_FRAG:
113 	case DPAA_PKT_TYPE_IPV4_FRAG_UDP:
114 	case DPAA_PKT_TYPE_IPV4_FRAG_TCP:
115 	case DPAA_PKT_TYPE_IPV4_FRAG_SCTP:
116 		m->packet_type = RTE_PTYPE_L2_ETHER |
117 			RTE_PTYPE_L3_IPV4 | RTE_PTYPE_L4_FRAG;
118 		break;
119 	case DPAA_PKT_TYPE_IPV6_FRAG:
120 	case DPAA_PKT_TYPE_IPV6_FRAG_UDP:
121 	case DPAA_PKT_TYPE_IPV6_FRAG_TCP:
122 	case DPAA_PKT_TYPE_IPV6_FRAG_SCTP:
123 		m->packet_type = RTE_PTYPE_L2_ETHER |
124 			RTE_PTYPE_L3_IPV6 | RTE_PTYPE_L4_FRAG;
125 		break;
126 	case DPAA_PKT_TYPE_IPV4_EXT:
127 		m->packet_type = RTE_PTYPE_L2_ETHER |
128 			RTE_PTYPE_L3_IPV4_EXT;
129 		break;
130 	case DPAA_PKT_TYPE_IPV6_EXT:
131 		m->packet_type = RTE_PTYPE_L2_ETHER |
132 			RTE_PTYPE_L3_IPV6_EXT;
133 		break;
134 	case DPAA_PKT_TYPE_IPV4_TCP:
135 		m->packet_type = RTE_PTYPE_L2_ETHER |
136 			RTE_PTYPE_L3_IPV4 | RTE_PTYPE_L4_TCP;
137 		break;
138 	case DPAA_PKT_TYPE_IPV6_TCP:
139 		m->packet_type = RTE_PTYPE_L2_ETHER |
140 			RTE_PTYPE_L3_IPV6 | RTE_PTYPE_L4_TCP;
141 		break;
142 	case DPAA_PKT_TYPE_IPV4_UDP:
143 		m->packet_type = RTE_PTYPE_L2_ETHER |
144 			RTE_PTYPE_L3_IPV4 | RTE_PTYPE_L4_UDP;
145 		break;
146 	case DPAA_PKT_TYPE_IPV6_UDP:
147 		m->packet_type = RTE_PTYPE_L2_ETHER |
148 			RTE_PTYPE_L3_IPV6 | RTE_PTYPE_L4_UDP;
149 		break;
150 	case DPAA_PKT_TYPE_IPV4_EXT_UDP:
151 		m->packet_type = RTE_PTYPE_L2_ETHER |
152 			RTE_PTYPE_L3_IPV4_EXT | RTE_PTYPE_L4_UDP;
153 		break;
154 	case DPAA_PKT_TYPE_IPV6_EXT_UDP:
155 		m->packet_type = RTE_PTYPE_L2_ETHER |
156 			RTE_PTYPE_L3_IPV6_EXT | RTE_PTYPE_L4_UDP;
157 		break;
158 	case DPAA_PKT_TYPE_IPV4_EXT_TCP:
159 		m->packet_type = RTE_PTYPE_L2_ETHER |
160 			RTE_PTYPE_L3_IPV4_EXT | RTE_PTYPE_L4_TCP;
161 		break;
162 	case DPAA_PKT_TYPE_IPV6_EXT_TCP:
163 		m->packet_type = RTE_PTYPE_L2_ETHER |
164 			RTE_PTYPE_L3_IPV6_EXT | RTE_PTYPE_L4_TCP;
165 		break;
166 	case DPAA_PKT_TYPE_IPV4_SCTP:
167 		m->packet_type = RTE_PTYPE_L2_ETHER |
168 			RTE_PTYPE_L3_IPV4 | RTE_PTYPE_L4_SCTP;
169 		break;
170 	case DPAA_PKT_TYPE_IPV6_SCTP:
171 		m->packet_type = RTE_PTYPE_L2_ETHER |
172 			RTE_PTYPE_L3_IPV6 | RTE_PTYPE_L4_SCTP;
173 		break;
174 	case DPAA_PKT_TYPE_NONE:
175 		m->packet_type = 0;
176 		break;
177 	/* More switch cases can be added */
178 	default:
179 		dpaa_slow_parsing(m, prs);
180 	}
181 
182 	m->tx_offload = annot->parse.ip_off[0];
183 	m->tx_offload |= (annot->parse.l4_off - annot->parse.ip_off[0])
184 					<< DPAA_PKT_L3_LEN_SHIFT;
185 
186 	/* Set the hash values */
187 	m->hash.rss = (uint32_t)(annot->hash);
188 	/* All packets with Bad checksum are dropped by interface (and
189 	 * corresponding notification issued to RX error queues).
190 	 */
191 	m->ol_flags = PKT_RX_RSS_HASH | PKT_RX_IP_CKSUM_GOOD;
192 
193 	/* Check if Vlan is present */
194 	if (prs & DPAA_PARSE_VLAN_MASK)
195 		m->ol_flags |= PKT_RX_VLAN;
196 	/* Packet received without stripping the vlan */
197 }
198 
199 static inline void dpaa_checksum(struct rte_mbuf *mbuf)
200 {
201 	struct rte_ether_hdr *eth_hdr =
202 		rte_pktmbuf_mtod(mbuf, struct rte_ether_hdr *);
203 	char *l3_hdr = (char *)eth_hdr + mbuf->l2_len;
204 	struct rte_ipv4_hdr *ipv4_hdr = (struct rte_ipv4_hdr *)l3_hdr;
205 	struct rte_ipv6_hdr *ipv6_hdr = (struct rte_ipv6_hdr *)l3_hdr;
206 
207 	DPAA_DP_LOG(DEBUG, "Calculating checksum for mbuf: %p", mbuf);
208 
209 	if (((mbuf->packet_type & RTE_PTYPE_L3_MASK) == RTE_PTYPE_L3_IPV4) ||
210 	    ((mbuf->packet_type & RTE_PTYPE_L3_MASK) ==
211 	    RTE_PTYPE_L3_IPV4_EXT)) {
212 		ipv4_hdr = (struct rte_ipv4_hdr *)l3_hdr;
213 		ipv4_hdr->hdr_checksum = 0;
214 		ipv4_hdr->hdr_checksum = rte_ipv4_cksum(ipv4_hdr);
215 	} else if (((mbuf->packet_type & RTE_PTYPE_L3_MASK) ==
216 		   RTE_PTYPE_L3_IPV6) ||
217 		   ((mbuf->packet_type & RTE_PTYPE_L3_MASK) ==
218 		   RTE_PTYPE_L3_IPV6_EXT))
219 		ipv6_hdr = (struct rte_ipv6_hdr *)l3_hdr;
220 
221 	if ((mbuf->packet_type & RTE_PTYPE_L4_MASK) == RTE_PTYPE_L4_TCP) {
222 		struct rte_tcp_hdr *tcp_hdr = (struct rte_tcp_hdr *)(l3_hdr +
223 					  mbuf->l3_len);
224 		tcp_hdr->cksum = 0;
225 		if (eth_hdr->ether_type == htons(RTE_ETHER_TYPE_IPV4))
226 			tcp_hdr->cksum = rte_ipv4_udptcp_cksum(ipv4_hdr,
227 							       tcp_hdr);
228 		else /* assume ethertype == RTE_ETHER_TYPE_IPV6 */
229 			tcp_hdr->cksum = rte_ipv6_udptcp_cksum(ipv6_hdr,
230 							       tcp_hdr);
231 	} else if ((mbuf->packet_type & RTE_PTYPE_L4_MASK) ==
232 		   RTE_PTYPE_L4_UDP) {
233 		struct rte_udp_hdr *udp_hdr = (struct rte_udp_hdr *)(l3_hdr +
234 							     mbuf->l3_len);
235 		udp_hdr->dgram_cksum = 0;
236 		if (eth_hdr->ether_type == htons(RTE_ETHER_TYPE_IPV4))
237 			udp_hdr->dgram_cksum = rte_ipv4_udptcp_cksum(ipv4_hdr,
238 								     udp_hdr);
239 		else /* assume ethertype == RTE_ETHER_TYPE_IPV6 */
240 			udp_hdr->dgram_cksum = rte_ipv6_udptcp_cksum(ipv6_hdr,
241 								     udp_hdr);
242 	}
243 }
244 
245 static inline void dpaa_checksum_offload(struct rte_mbuf *mbuf,
246 					 struct qm_fd *fd, char *prs_buf)
247 {
248 	struct dpaa_eth_parse_results_t *prs;
249 
250 	DPAA_DP_LOG(DEBUG, " Offloading checksum for mbuf: %p", mbuf);
251 
252 	prs = GET_TX_PRS(prs_buf);
253 	prs->l3r = 0;
254 	prs->l4r = 0;
255 	if (((mbuf->packet_type & RTE_PTYPE_L3_MASK) == RTE_PTYPE_L3_IPV4) ||
256 	   ((mbuf->packet_type & RTE_PTYPE_L3_MASK) ==
257 	   RTE_PTYPE_L3_IPV4_EXT))
258 		prs->l3r = DPAA_L3_PARSE_RESULT_IPV4;
259 	else if (((mbuf->packet_type & RTE_PTYPE_L3_MASK) ==
260 		   RTE_PTYPE_L3_IPV6) ||
261 		 ((mbuf->packet_type & RTE_PTYPE_L3_MASK) ==
262 		RTE_PTYPE_L3_IPV6_EXT))
263 		prs->l3r = DPAA_L3_PARSE_RESULT_IPV6;
264 
265 	if ((mbuf->packet_type & RTE_PTYPE_L4_MASK) == RTE_PTYPE_L4_TCP)
266 		prs->l4r = DPAA_L4_PARSE_RESULT_TCP;
267 	else if ((mbuf->packet_type & RTE_PTYPE_L4_MASK) == RTE_PTYPE_L4_UDP)
268 		prs->l4r = DPAA_L4_PARSE_RESULT_UDP;
269 
270 	prs->ip_off[0] = mbuf->l2_len;
271 	prs->l4_off = mbuf->l3_len + mbuf->l2_len;
272 	/* Enable L3 (and L4, if TCP or UDP) HW checksum*/
273 	fd->cmd = DPAA_FD_CMD_RPD | DPAA_FD_CMD_DTC;
274 }
275 
276 static inline void
277 dpaa_unsegmented_checksum(struct rte_mbuf *mbuf, struct qm_fd *fd_arr)
278 {
279 	if (!mbuf->packet_type) {
280 		struct rte_net_hdr_lens hdr_lens;
281 
282 		mbuf->packet_type = rte_net_get_ptype(mbuf, &hdr_lens,
283 				RTE_PTYPE_L2_MASK | RTE_PTYPE_L3_MASK
284 				| RTE_PTYPE_L4_MASK);
285 		mbuf->l2_len = hdr_lens.l2_len;
286 		mbuf->l3_len = hdr_lens.l3_len;
287 	}
288 	if (mbuf->data_off < (DEFAULT_TX_ICEOF +
289 	    sizeof(struct dpaa_eth_parse_results_t))) {
290 		DPAA_DP_LOG(DEBUG, "Checksum offload Err: "
291 			"Not enough Headroom "
292 			"space for correct Checksum offload."
293 			"So Calculating checksum in Software.");
294 		dpaa_checksum(mbuf);
295 	} else {
296 		dpaa_checksum_offload(mbuf, fd_arr, mbuf->buf_addr);
297 	}
298 }
299 
300 struct rte_mbuf *
301 dpaa_eth_sg_to_mbuf(const struct qm_fd *fd, uint32_t ifid)
302 {
303 	struct dpaa_bp_info *bp_info = DPAA_BPID_TO_POOL_INFO(fd->bpid);
304 	struct rte_mbuf *first_seg, *prev_seg, *cur_seg, *temp;
305 	struct qm_sg_entry *sgt, *sg_temp;
306 	void *vaddr, *sg_vaddr;
307 	int i = 0;
308 	uint16_t fd_offset = fd->offset;
309 
310 	vaddr = DPAA_MEMPOOL_PTOV(bp_info, qm_fd_addr(fd));
311 	if (!vaddr) {
312 		DPAA_PMD_ERR("unable to convert physical address");
313 		return NULL;
314 	}
315 	sgt = vaddr + fd_offset;
316 	sg_temp = &sgt[i++];
317 	hw_sg_to_cpu(sg_temp);
318 	temp = (struct rte_mbuf *)((char *)vaddr - bp_info->meta_data_size);
319 	sg_vaddr = DPAA_MEMPOOL_PTOV(bp_info, qm_sg_entry_get64(sg_temp));
320 
321 	first_seg = (struct rte_mbuf *)((char *)sg_vaddr -
322 						bp_info->meta_data_size);
323 	first_seg->data_off = sg_temp->offset;
324 	first_seg->data_len = sg_temp->length;
325 	first_seg->pkt_len = sg_temp->length;
326 	rte_mbuf_refcnt_set(first_seg, 1);
327 
328 	first_seg->port = ifid;
329 	first_seg->nb_segs = 1;
330 	first_seg->ol_flags = 0;
331 	prev_seg = first_seg;
332 	while (i < DPAA_SGT_MAX_ENTRIES) {
333 		sg_temp = &sgt[i++];
334 		hw_sg_to_cpu(sg_temp);
335 		sg_vaddr = DPAA_MEMPOOL_PTOV(bp_info,
336 					     qm_sg_entry_get64(sg_temp));
337 		cur_seg = (struct rte_mbuf *)((char *)sg_vaddr -
338 						      bp_info->meta_data_size);
339 		cur_seg->data_off = sg_temp->offset;
340 		cur_seg->data_len = sg_temp->length;
341 		first_seg->pkt_len += sg_temp->length;
342 		first_seg->nb_segs += 1;
343 		rte_mbuf_refcnt_set(cur_seg, 1);
344 		prev_seg->next = cur_seg;
345 		if (sg_temp->final) {
346 			cur_seg->next = NULL;
347 			break;
348 		}
349 		prev_seg = cur_seg;
350 	}
351 	DPAA_DP_LOG(DEBUG, "Received an SG frame len =%d, num_sg =%d",
352 			first_seg->pkt_len, first_seg->nb_segs);
353 
354 	dpaa_eth_packet_info(first_seg, vaddr);
355 	rte_pktmbuf_free_seg(temp);
356 
357 	return first_seg;
358 }
359 
360 static inline struct rte_mbuf *
361 dpaa_eth_fd_to_mbuf(const struct qm_fd *fd, uint32_t ifid)
362 {
363 	struct rte_mbuf *mbuf;
364 	struct dpaa_bp_info *bp_info = DPAA_BPID_TO_POOL_INFO(fd->bpid);
365 	void *ptr;
366 	uint8_t format =
367 		(fd->opaque & DPAA_FD_FORMAT_MASK) >> DPAA_FD_FORMAT_SHIFT;
368 	uint16_t offset;
369 	uint32_t length;
370 
371 	if (unlikely(format == qm_fd_sg))
372 		return dpaa_eth_sg_to_mbuf(fd, ifid);
373 
374 	offset = (fd->opaque & DPAA_FD_OFFSET_MASK) >> DPAA_FD_OFFSET_SHIFT;
375 	length = fd->opaque & DPAA_FD_LENGTH_MASK;
376 
377 	DPAA_DP_LOG(DEBUG, " FD--->MBUF off %d len = %d", offset, length);
378 
379 	/* Ignoring case when format != qm_fd_contig */
380 	dpaa_display_frame(fd);
381 	ptr = DPAA_MEMPOOL_PTOV(bp_info, qm_fd_addr(fd));
382 
383 	mbuf = (struct rte_mbuf *)((char *)ptr - bp_info->meta_data_size);
384 	/* Prefetch the Parse results and packet data to L1 */
385 	rte_prefetch0((void *)((uint8_t *)ptr + DEFAULT_RX_ICEOF));
386 
387 	mbuf->data_off = offset;
388 	mbuf->data_len = length;
389 	mbuf->pkt_len = length;
390 
391 	mbuf->port = ifid;
392 	mbuf->nb_segs = 1;
393 	mbuf->ol_flags = 0;
394 	mbuf->next = NULL;
395 	rte_mbuf_refcnt_set(mbuf, 1);
396 	dpaa_eth_packet_info(mbuf, mbuf->buf_addr);
397 
398 	return mbuf;
399 }
400 
401 uint16_t
402 dpaa_free_mbuf(const struct qm_fd *fd)
403 {
404 	struct rte_mbuf *mbuf;
405 	struct dpaa_bp_info *bp_info;
406 	uint8_t format;
407 	void *ptr;
408 
409 	bp_info = DPAA_BPID_TO_POOL_INFO(fd->bpid);
410 	format = (fd->opaque & DPAA_FD_FORMAT_MASK) >> DPAA_FD_FORMAT_SHIFT;
411 	if (unlikely(format == qm_fd_sg)) {
412 		struct rte_mbuf *first_seg, *prev_seg, *cur_seg, *temp;
413 		struct qm_sg_entry *sgt, *sg_temp;
414 		void *vaddr, *sg_vaddr;
415 		int i = 0;
416 		uint16_t fd_offset = fd->offset;
417 
418 		vaddr = DPAA_MEMPOOL_PTOV(bp_info, qm_fd_addr(fd));
419 		if (!vaddr) {
420 			DPAA_PMD_ERR("unable to convert physical address");
421 			return -1;
422 		}
423 		sgt = vaddr + fd_offset;
424 		sg_temp = &sgt[i++];
425 		hw_sg_to_cpu(sg_temp);
426 		temp = (struct rte_mbuf *)
427 			((char *)vaddr - bp_info->meta_data_size);
428 		sg_vaddr = DPAA_MEMPOOL_PTOV(bp_info,
429 						qm_sg_entry_get64(sg_temp));
430 
431 		first_seg = (struct rte_mbuf *)((char *)sg_vaddr -
432 						bp_info->meta_data_size);
433 		first_seg->nb_segs = 1;
434 		prev_seg = first_seg;
435 		while (i < DPAA_SGT_MAX_ENTRIES) {
436 			sg_temp = &sgt[i++];
437 			hw_sg_to_cpu(sg_temp);
438 			sg_vaddr = DPAA_MEMPOOL_PTOV(bp_info,
439 						qm_sg_entry_get64(sg_temp));
440 			cur_seg = (struct rte_mbuf *)((char *)sg_vaddr -
441 						      bp_info->meta_data_size);
442 			first_seg->nb_segs += 1;
443 			prev_seg->next = cur_seg;
444 			if (sg_temp->final) {
445 				cur_seg->next = NULL;
446 				break;
447 			}
448 			prev_seg = cur_seg;
449 		}
450 
451 		rte_pktmbuf_free_seg(temp);
452 		rte_pktmbuf_free_seg(first_seg);
453 		return 0;
454 	}
455 
456 	ptr = DPAA_MEMPOOL_PTOV(bp_info, qm_fd_addr(fd));
457 	mbuf = (struct rte_mbuf *)((char *)ptr - bp_info->meta_data_size);
458 
459 	rte_pktmbuf_free(mbuf);
460 
461 	return 0;
462 }
463 
464 /* Specific for LS1043 */
465 void
466 dpaa_rx_cb_no_prefetch(struct qman_fq **fq, struct qm_dqrr_entry **dqrr,
467 	   void **bufs, int num_bufs)
468 {
469 	struct rte_mbuf *mbuf;
470 	struct dpaa_bp_info *bp_info;
471 	const struct qm_fd *fd;
472 	void *ptr;
473 	struct dpaa_if *dpaa_intf;
474 	uint16_t offset, i;
475 	uint32_t length;
476 	uint8_t format;
477 
478 	bp_info = DPAA_BPID_TO_POOL_INFO(dqrr[0]->fd.bpid);
479 	ptr = rte_dpaa_mem_ptov(qm_fd_addr(&dqrr[0]->fd));
480 	rte_prefetch0((void *)((uint8_t *)ptr + DEFAULT_RX_ICEOF));
481 	bufs[0] = (struct rte_mbuf *)((char *)ptr - bp_info->meta_data_size);
482 
483 	for (i = 0; i < num_bufs; i++) {
484 		if (i < num_bufs - 1) {
485 			bp_info = DPAA_BPID_TO_POOL_INFO(dqrr[i + 1]->fd.bpid);
486 			ptr = rte_dpaa_mem_ptov(qm_fd_addr(&dqrr[i + 1]->fd));
487 			rte_prefetch0((void *)((uint8_t *)ptr +
488 					DEFAULT_RX_ICEOF));
489 			bufs[i + 1] = (struct rte_mbuf *)((char *)ptr -
490 					bp_info->meta_data_size);
491 		}
492 
493 		fd = &dqrr[i]->fd;
494 		dpaa_intf = fq[0]->dpaa_intf;
495 
496 		format = (fd->opaque & DPAA_FD_FORMAT_MASK) >>
497 				DPAA_FD_FORMAT_SHIFT;
498 		if (unlikely(format == qm_fd_sg)) {
499 			bufs[i] = dpaa_eth_sg_to_mbuf(fd, dpaa_intf->ifid);
500 			continue;
501 		}
502 
503 		offset = (fd->opaque & DPAA_FD_OFFSET_MASK) >>
504 				DPAA_FD_OFFSET_SHIFT;
505 		length = fd->opaque & DPAA_FD_LENGTH_MASK;
506 
507 		mbuf = bufs[i];
508 		mbuf->data_off = offset;
509 		mbuf->data_len = length;
510 		mbuf->pkt_len = length;
511 		mbuf->port = dpaa_intf->ifid;
512 
513 		mbuf->nb_segs = 1;
514 		mbuf->ol_flags = 0;
515 		mbuf->next = NULL;
516 		rte_mbuf_refcnt_set(mbuf, 1);
517 		dpaa_eth_packet_info(mbuf, mbuf->buf_addr);
518 	}
519 }
520 
521 void
522 dpaa_rx_cb(struct qman_fq **fq, struct qm_dqrr_entry **dqrr,
523 	   void **bufs, int num_bufs)
524 {
525 	struct rte_mbuf *mbuf;
526 	const struct qm_fd *fd;
527 	struct dpaa_if *dpaa_intf;
528 	uint16_t offset, i;
529 	uint32_t length;
530 	uint8_t format;
531 
532 	for (i = 0; i < num_bufs; i++) {
533 		fd = &dqrr[i]->fd;
534 		dpaa_intf = fq[0]->dpaa_intf;
535 
536 		format = (fd->opaque & DPAA_FD_FORMAT_MASK) >>
537 				DPAA_FD_FORMAT_SHIFT;
538 		if (unlikely(format == qm_fd_sg)) {
539 			bufs[i] = dpaa_eth_sg_to_mbuf(fd, dpaa_intf->ifid);
540 			continue;
541 		}
542 
543 		offset = (fd->opaque & DPAA_FD_OFFSET_MASK) >>
544 				DPAA_FD_OFFSET_SHIFT;
545 		length = fd->opaque & DPAA_FD_LENGTH_MASK;
546 
547 		mbuf = bufs[i];
548 		mbuf->data_off = offset;
549 		mbuf->data_len = length;
550 		mbuf->pkt_len = length;
551 		mbuf->port = dpaa_intf->ifid;
552 
553 		mbuf->nb_segs = 1;
554 		mbuf->ol_flags = 0;
555 		mbuf->next = NULL;
556 		rte_mbuf_refcnt_set(mbuf, 1);
557 		dpaa_eth_packet_info(mbuf, mbuf->buf_addr);
558 	}
559 }
560 
561 void dpaa_rx_cb_prepare(struct qm_dqrr_entry *dq, void **bufs)
562 {
563 	struct dpaa_bp_info *bp_info = DPAA_BPID_TO_POOL_INFO(dq->fd.bpid);
564 	void *ptr = rte_dpaa_mem_ptov(qm_fd_addr(&dq->fd));
565 
566 	/* In case of LS1046, annotation stashing is disabled due to L2 cache
567 	 * being bottleneck in case of multicore scanario for this platform.
568 	 * So we prefetch the annoation beforehand, so that it is available
569 	 * in cache when accessed.
570 	 */
571 	rte_prefetch0((void *)((uint8_t *)ptr + DEFAULT_RX_ICEOF));
572 
573 	*bufs = (struct rte_mbuf *)((char *)ptr - bp_info->meta_data_size);
574 }
575 
576 static uint16_t
577 dpaa_eth_queue_portal_rx(struct qman_fq *fq,
578 			 struct rte_mbuf **bufs,
579 			 uint16_t nb_bufs)
580 {
581 	int ret;
582 
583 	if (unlikely(!fq->qp_initialized)) {
584 		ret = rte_dpaa_portal_fq_init((void *)0, fq);
585 		if (ret) {
586 			DPAA_PMD_ERR("Failure in affining portal %d", ret);
587 			return 0;
588 		}
589 		fq->qp_initialized = 1;
590 	}
591 
592 	return qman_portal_poll_rx(nb_bufs, (void **)bufs, fq->qp);
593 }
594 
595 enum qman_cb_dqrr_result
596 dpaa_rx_cb_parallel(void *event,
597 		    struct qman_portal *qm __always_unused,
598 		    struct qman_fq *fq,
599 		    const struct qm_dqrr_entry *dqrr,
600 		    void **bufs)
601 {
602 	u32 ifid = ((struct dpaa_if *)fq->dpaa_intf)->ifid;
603 	struct rte_mbuf *mbuf;
604 	struct rte_event *ev = (struct rte_event *)event;
605 
606 	mbuf = dpaa_eth_fd_to_mbuf(&dqrr->fd, ifid);
607 	ev->event_ptr = (void *)mbuf;
608 	ev->flow_id = fq->ev.flow_id;
609 	ev->sub_event_type = fq->ev.sub_event_type;
610 	ev->event_type = RTE_EVENT_TYPE_ETHDEV;
611 	ev->op = RTE_EVENT_OP_NEW;
612 	ev->sched_type = fq->ev.sched_type;
613 	ev->queue_id = fq->ev.queue_id;
614 	ev->priority = fq->ev.priority;
615 	ev->impl_opaque = (uint8_t)DPAA_INVALID_MBUF_SEQN;
616 	mbuf->seqn = DPAA_INVALID_MBUF_SEQN;
617 	*bufs = mbuf;
618 
619 	return qman_cb_dqrr_consume;
620 }
621 
622 enum qman_cb_dqrr_result
623 dpaa_rx_cb_atomic(void *event,
624 		  struct qman_portal *qm __always_unused,
625 		  struct qman_fq *fq,
626 		  const struct qm_dqrr_entry *dqrr,
627 		  void **bufs)
628 {
629 	u8 index;
630 	u32 ifid = ((struct dpaa_if *)fq->dpaa_intf)->ifid;
631 	struct rte_mbuf *mbuf;
632 	struct rte_event *ev = (struct rte_event *)event;
633 
634 	mbuf = dpaa_eth_fd_to_mbuf(&dqrr->fd, ifid);
635 	ev->event_ptr = (void *)mbuf;
636 	ev->flow_id = fq->ev.flow_id;
637 	ev->sub_event_type = fq->ev.sub_event_type;
638 	ev->event_type = RTE_EVENT_TYPE_ETHDEV;
639 	ev->op = RTE_EVENT_OP_NEW;
640 	ev->sched_type = fq->ev.sched_type;
641 	ev->queue_id = fq->ev.queue_id;
642 	ev->priority = fq->ev.priority;
643 
644 	/* Save active dqrr entries */
645 	index = DQRR_PTR2IDX(dqrr);
646 	DPAA_PER_LCORE_DQRR_SIZE++;
647 	DPAA_PER_LCORE_DQRR_HELD |= 1 << index;
648 	DPAA_PER_LCORE_DQRR_MBUF(index) = mbuf;
649 	ev->impl_opaque = index + 1;
650 	mbuf->seqn = (uint32_t)index + 1;
651 	*bufs = mbuf;
652 
653 	return qman_cb_dqrr_defer;
654 }
655 
656 uint16_t dpaa_eth_queue_rx(void *q,
657 			   struct rte_mbuf **bufs,
658 			   uint16_t nb_bufs)
659 {
660 	struct qman_fq *fq = q;
661 	struct qm_dqrr_entry *dq;
662 	uint32_t num_rx = 0, ifid = ((struct dpaa_if *)fq->dpaa_intf)->ifid;
663 	int num_rx_bufs, ret;
664 	uint32_t vdqcr_flags = 0;
665 
666 	if (unlikely(rte_dpaa_bpid_info == NULL &&
667 				rte_eal_process_type() == RTE_PROC_SECONDARY))
668 		rte_dpaa_bpid_info = fq->bp_array;
669 
670 	if (likely(fq->is_static))
671 		return dpaa_eth_queue_portal_rx(fq, bufs, nb_bufs);
672 
673 	if (unlikely(!DPAA_PER_LCORE_PORTAL)) {
674 		ret = rte_dpaa_portal_init((void *)0);
675 		if (ret) {
676 			DPAA_PMD_ERR("Failure in affining portal");
677 			return 0;
678 		}
679 	}
680 
681 	/* Until request for four buffers, we provide exact number of buffers.
682 	 * Otherwise we do not set the QM_VDQCR_EXACT flag.
683 	 * Not setting QM_VDQCR_EXACT flag can provide two more buffers than
684 	 * requested, so we request two less in this case.
685 	 */
686 	if (nb_bufs < 4) {
687 		vdqcr_flags = QM_VDQCR_EXACT;
688 		num_rx_bufs = nb_bufs;
689 	} else {
690 		num_rx_bufs = nb_bufs > DPAA_MAX_DEQUEUE_NUM_FRAMES ?
691 			(DPAA_MAX_DEQUEUE_NUM_FRAMES - 2) : (nb_bufs - 2);
692 	}
693 	ret = qman_set_vdq(fq, num_rx_bufs, vdqcr_flags);
694 	if (ret)
695 		return 0;
696 
697 	do {
698 		dq = qman_dequeue(fq);
699 		if (!dq)
700 			continue;
701 		bufs[num_rx++] = dpaa_eth_fd_to_mbuf(&dq->fd, ifid);
702 		qman_dqrr_consume(fq, dq);
703 	} while (fq->flags & QMAN_FQ_STATE_VDQCR);
704 
705 	return num_rx;
706 }
707 
708 int
709 dpaa_eth_mbuf_to_sg_fd(struct rte_mbuf *mbuf,
710 		struct qm_fd *fd,
711 		uint32_t bpid)
712 {
713 	struct rte_mbuf *cur_seg = mbuf, *prev_seg = NULL;
714 	struct dpaa_bp_info *bp_info = DPAA_BPID_TO_POOL_INFO(bpid);
715 	struct rte_mbuf *temp, *mi;
716 	struct qm_sg_entry *sg_temp, *sgt;
717 	int i = 0;
718 
719 	DPAA_DP_LOG(DEBUG, "Creating SG FD to transmit");
720 
721 	temp = rte_pktmbuf_alloc(bp_info->mp);
722 	if (!temp) {
723 		DPAA_PMD_ERR("Failure in allocation of mbuf");
724 		return -1;
725 	}
726 	if (temp->buf_len < ((mbuf->nb_segs * sizeof(struct qm_sg_entry))
727 				+ temp->data_off)) {
728 		DPAA_PMD_ERR("Insufficient space in mbuf for SG entries");
729 		return -1;
730 	}
731 
732 	fd->cmd = 0;
733 	fd->opaque_addr = 0;
734 
735 	if (mbuf->ol_flags & DPAA_TX_CKSUM_OFFLOAD_MASK) {
736 		if (!mbuf->packet_type) {
737 			struct rte_net_hdr_lens hdr_lens;
738 
739 			mbuf->packet_type = rte_net_get_ptype(mbuf, &hdr_lens,
740 					RTE_PTYPE_L2_MASK | RTE_PTYPE_L3_MASK
741 					| RTE_PTYPE_L4_MASK);
742 			mbuf->l2_len = hdr_lens.l2_len;
743 			mbuf->l3_len = hdr_lens.l3_len;
744 		}
745 		if (temp->data_off < DEFAULT_TX_ICEOF
746 			+ sizeof(struct dpaa_eth_parse_results_t))
747 			temp->data_off = DEFAULT_TX_ICEOF
748 				+ sizeof(struct dpaa_eth_parse_results_t);
749 		dcbz_64(temp->buf_addr);
750 		dpaa_checksum_offload(mbuf, fd, temp->buf_addr);
751 	}
752 
753 	sgt = temp->buf_addr + temp->data_off;
754 	fd->format = QM_FD_SG;
755 	fd->addr = temp->buf_iova;
756 	fd->offset = temp->data_off;
757 	fd->bpid = bpid;
758 	fd->length20 = mbuf->pkt_len;
759 
760 	while (i < DPAA_SGT_MAX_ENTRIES) {
761 		sg_temp = &sgt[i++];
762 		sg_temp->opaque = 0;
763 		sg_temp->val = 0;
764 		sg_temp->addr = cur_seg->buf_iova;
765 		sg_temp->offset = cur_seg->data_off;
766 		sg_temp->length = cur_seg->data_len;
767 		if (RTE_MBUF_DIRECT(cur_seg)) {
768 			if (rte_mbuf_refcnt_read(cur_seg) > 1) {
769 				/*If refcnt > 1, invalid bpid is set to ensure
770 				 * buffer is not freed by HW.
771 				 */
772 				sg_temp->bpid = 0xff;
773 				rte_mbuf_refcnt_update(cur_seg, -1);
774 			} else {
775 				sg_temp->bpid =
776 					DPAA_MEMPOOL_TO_BPID(cur_seg->pool);
777 			}
778 			cur_seg = cur_seg->next;
779 		} else {
780 			/* Get owner MBUF from indirect buffer */
781 			mi = rte_mbuf_from_indirect(cur_seg);
782 			if (rte_mbuf_refcnt_read(mi) > 1) {
783 				/*If refcnt > 1, invalid bpid is set to ensure
784 				 * owner buffer is not freed by HW.
785 				 */
786 				sg_temp->bpid = 0xff;
787 			} else {
788 				sg_temp->bpid = DPAA_MEMPOOL_TO_BPID(mi->pool);
789 				rte_mbuf_refcnt_update(mi, 1);
790 			}
791 			prev_seg = cur_seg;
792 			cur_seg = cur_seg->next;
793 			prev_seg->next = NULL;
794 			rte_pktmbuf_free(prev_seg);
795 		}
796 		if (cur_seg == NULL) {
797 			sg_temp->final = 1;
798 			cpu_to_hw_sg(sg_temp);
799 			break;
800 		}
801 		cpu_to_hw_sg(sg_temp);
802 	}
803 	return 0;
804 }
805 
806 /* Handle mbufs which are not segmented (non SG) */
807 static inline void
808 tx_on_dpaa_pool_unsegmented(struct rte_mbuf *mbuf,
809 			    struct dpaa_bp_info *bp_info,
810 			    struct qm_fd *fd_arr)
811 {
812 	struct rte_mbuf *mi = NULL;
813 
814 	if (RTE_MBUF_DIRECT(mbuf)) {
815 		if (rte_mbuf_refcnt_read(mbuf) > 1) {
816 			/* In case of direct mbuf and mbuf being cloned,
817 			 * BMAN should _not_ release buffer.
818 			 */
819 			DPAA_MBUF_TO_CONTIG_FD(mbuf, fd_arr, 0xff);
820 			/* Buffer should be releasd by EAL */
821 			rte_mbuf_refcnt_update(mbuf, -1);
822 		} else {
823 			/* In case of direct mbuf and no cloning, mbuf can be
824 			 * released by BMAN.
825 			 */
826 			DPAA_MBUF_TO_CONTIG_FD(mbuf, fd_arr, bp_info->bpid);
827 		}
828 	} else {
829 		/* This is data-containing core mbuf: 'mi' */
830 		mi = rte_mbuf_from_indirect(mbuf);
831 		if (rte_mbuf_refcnt_read(mi) > 1) {
832 			/* In case of indirect mbuf, and mbuf being cloned,
833 			 * BMAN should _not_ release it and let EAL release
834 			 * it through pktmbuf_free below.
835 			 */
836 			DPAA_MBUF_TO_CONTIG_FD(mbuf, fd_arr, 0xff);
837 		} else {
838 			/* In case of indirect mbuf, and no cloning, core mbuf
839 			 * should be released by BMAN.
840 			 * Increate refcnt of core mbuf so that when
841 			 * pktmbuf_free is called and mbuf is released, EAL
842 			 * doesn't try to release core mbuf which would have
843 			 * been released by BMAN.
844 			 */
845 			rte_mbuf_refcnt_update(mi, 1);
846 			DPAA_MBUF_TO_CONTIG_FD(mbuf, fd_arr, bp_info->bpid);
847 		}
848 		rte_pktmbuf_free(mbuf);
849 	}
850 
851 	if (mbuf->ol_flags & DPAA_TX_CKSUM_OFFLOAD_MASK)
852 		dpaa_unsegmented_checksum(mbuf, fd_arr);
853 }
854 
855 /* Handle all mbufs on dpaa BMAN managed pool */
856 static inline uint16_t
857 tx_on_dpaa_pool(struct rte_mbuf *mbuf,
858 		struct dpaa_bp_info *bp_info,
859 		struct qm_fd *fd_arr)
860 {
861 	DPAA_DP_LOG(DEBUG, "BMAN offloaded buffer, mbuf: %p", mbuf);
862 
863 	if (mbuf->nb_segs == 1) {
864 		/* Case for non-segmented buffers */
865 		tx_on_dpaa_pool_unsegmented(mbuf, bp_info, fd_arr);
866 	} else if (mbuf->nb_segs > 1 &&
867 		   mbuf->nb_segs <= DPAA_SGT_MAX_ENTRIES) {
868 		if (dpaa_eth_mbuf_to_sg_fd(mbuf, fd_arr, bp_info->bpid)) {
869 			DPAA_PMD_DEBUG("Unable to create Scatter Gather FD");
870 			return 1;
871 		}
872 	} else {
873 		DPAA_PMD_DEBUG("Number of Segments not supported");
874 		return 1;
875 	}
876 
877 	return 0;
878 }
879 
880 /* Handle all mbufs on an external pool (non-dpaa) */
881 static inline struct rte_mbuf *
882 reallocate_mbuf(struct qman_fq *txq, struct rte_mbuf *mbuf)
883 {
884 	struct dpaa_if *dpaa_intf = txq->dpaa_intf;
885 	struct dpaa_bp_info *bp_info = dpaa_intf->bp_info;
886 	struct rte_mbuf *new_mbufs[DPAA_SGT_MAX_ENTRIES + 1] = {0};
887 	struct rte_mbuf *temp_mbuf;
888 	int num_new_segs, mbuf_greater, ret, extra_seg = 0, i = 0;
889 	uint64_t mbufs_size, bytes_to_copy, offset1 = 0, offset2 = 0;
890 	char *data;
891 
892 	DPAA_DP_LOG(DEBUG, "Reallocating transmit buffer");
893 
894 	mbufs_size = bp_info->size -
895 		bp_info->meta_data_size - RTE_PKTMBUF_HEADROOM;
896 	extra_seg = !!(mbuf->pkt_len % mbufs_size);
897 	num_new_segs = (mbuf->pkt_len / mbufs_size) + extra_seg;
898 
899 	ret = rte_pktmbuf_alloc_bulk(bp_info->mp, new_mbufs, num_new_segs);
900 	if (ret != 0) {
901 		DPAA_DP_LOG(DEBUG, "Allocation for new buffers failed");
902 		return NULL;
903 	}
904 
905 	temp_mbuf = mbuf;
906 
907 	while (temp_mbuf) {
908 		/* If mbuf data is less than new mbuf remaining memory */
909 		if ((temp_mbuf->data_len - offset1) < (mbufs_size - offset2)) {
910 			bytes_to_copy = temp_mbuf->data_len - offset1;
911 			mbuf_greater = -1;
912 		/* If mbuf data is greater than new mbuf remaining memory */
913 		} else if ((temp_mbuf->data_len - offset1) >
914 			   (mbufs_size - offset2)) {
915 			bytes_to_copy = mbufs_size - offset2;
916 			mbuf_greater = 1;
917 		/* if mbuf data is equal to new mbuf remaining memory */
918 		} else {
919 			bytes_to_copy = temp_mbuf->data_len - offset1;
920 			mbuf_greater = 0;
921 		}
922 
923 		/* Copy the data */
924 		data = rte_pktmbuf_append(new_mbufs[0], bytes_to_copy);
925 
926 		rte_memcpy((uint8_t *)data, rte_pktmbuf_mtod_offset(mbuf,
927 			   void *, offset1), bytes_to_copy);
928 
929 		/* Set new offsets and the temp buffers */
930 		if (mbuf_greater == -1) {
931 			offset1 = 0;
932 			offset2 += bytes_to_copy;
933 			temp_mbuf = temp_mbuf->next;
934 		} else if (mbuf_greater == 1) {
935 			offset2 = 0;
936 			offset1 += bytes_to_copy;
937 			new_mbufs[i]->next = new_mbufs[i + 1];
938 			new_mbufs[0]->nb_segs++;
939 			i++;
940 		} else {
941 			offset1 = 0;
942 			offset2 = 0;
943 			temp_mbuf = temp_mbuf->next;
944 			new_mbufs[i]->next = new_mbufs[i + 1];
945 			if (new_mbufs[i + 1])
946 				new_mbufs[0]->nb_segs++;
947 			i++;
948 		}
949 	}
950 
951 	/* Copy other required fields */
952 	new_mbufs[0]->ol_flags = mbuf->ol_flags;
953 	new_mbufs[0]->packet_type = mbuf->packet_type;
954 	new_mbufs[0]->tx_offload = mbuf->tx_offload;
955 
956 	rte_pktmbuf_free(mbuf);
957 
958 	return new_mbufs[0];
959 }
960 
961 uint16_t
962 dpaa_eth_queue_tx(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
963 {
964 	struct rte_mbuf *mbuf, *mi = NULL;
965 	struct rte_mempool *mp;
966 	struct dpaa_bp_info *bp_info;
967 	struct qm_fd fd_arr[DPAA_TX_BURST_SIZE];
968 	uint32_t frames_to_send, loop, sent = 0;
969 	uint16_t state;
970 	int ret, realloc_mbuf = 0;
971 	uint32_t seqn, index, flags[DPAA_TX_BURST_SIZE] = {0};
972 
973 	if (unlikely(!DPAA_PER_LCORE_PORTAL)) {
974 		ret = rte_dpaa_portal_init((void *)0);
975 		if (ret) {
976 			DPAA_PMD_ERR("Failure in affining portal");
977 			return 0;
978 		}
979 	}
980 
981 	DPAA_DP_LOG(DEBUG, "Transmitting %d buffers on queue: %p", nb_bufs, q);
982 
983 	while (nb_bufs) {
984 		frames_to_send = (nb_bufs > DPAA_TX_BURST_SIZE) ?
985 				DPAA_TX_BURST_SIZE : nb_bufs;
986 		for (loop = 0; loop < frames_to_send; loop++) {
987 			mbuf = *(bufs++);
988 			/* In case the data offset is not multiple of 16,
989 			 * FMAN can stall because of an errata. So reallocate
990 			 * the buffer in such case.
991 			 */
992 			if (dpaa_svr_family == SVR_LS1043A_FAMILY &&
993 					(mbuf->data_off & 0x7F) != 0x0)
994 				realloc_mbuf = 1;
995 			seqn = mbuf->seqn;
996 			if (seqn != DPAA_INVALID_MBUF_SEQN) {
997 				index = seqn - 1;
998 				if (DPAA_PER_LCORE_DQRR_HELD & (1 << index)) {
999 					flags[loop] =
1000 					   ((index & QM_EQCR_DCA_IDXMASK) << 8);
1001 					flags[loop] |= QMAN_ENQUEUE_FLAG_DCA;
1002 					DPAA_PER_LCORE_DQRR_SIZE--;
1003 					DPAA_PER_LCORE_DQRR_HELD &=
1004 								~(1 << index);
1005 				}
1006 			}
1007 
1008 			if (likely(RTE_MBUF_DIRECT(mbuf))) {
1009 				mp = mbuf->pool;
1010 				bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
1011 				if (likely(mp->ops_index ==
1012 						bp_info->dpaa_ops_index &&
1013 					mbuf->nb_segs == 1 &&
1014 					realloc_mbuf == 0 &&
1015 					rte_mbuf_refcnt_read(mbuf) == 1)) {
1016 					DPAA_MBUF_TO_CONTIG_FD(mbuf,
1017 						&fd_arr[loop], bp_info->bpid);
1018 					if (mbuf->ol_flags &
1019 						DPAA_TX_CKSUM_OFFLOAD_MASK)
1020 						dpaa_unsegmented_checksum(mbuf,
1021 							&fd_arr[loop]);
1022 					continue;
1023 				}
1024 			} else {
1025 				mi = rte_mbuf_from_indirect(mbuf);
1026 				mp = mi->pool;
1027 			}
1028 
1029 			bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
1030 			if (unlikely(mp->ops_index != bp_info->dpaa_ops_index ||
1031 				     realloc_mbuf == 1)) {
1032 				struct rte_mbuf *temp_mbuf;
1033 
1034 				temp_mbuf = reallocate_mbuf(q, mbuf);
1035 				if (!temp_mbuf) {
1036 					/* Set frames_to_send & nb_bufs so
1037 					 * that packets are transmitted till
1038 					 * previous frame.
1039 					 */
1040 					frames_to_send = loop;
1041 					nb_bufs = loop;
1042 					goto send_pkts;
1043 				}
1044 				mbuf = temp_mbuf;
1045 				realloc_mbuf = 0;
1046 			}
1047 
1048 			state = tx_on_dpaa_pool(mbuf, bp_info,
1049 						&fd_arr[loop]);
1050 			if (unlikely(state)) {
1051 				/* Set frames_to_send & nb_bufs so
1052 				 * that packets are transmitted till
1053 				 * previous frame.
1054 				 */
1055 				frames_to_send = loop;
1056 				nb_bufs = loop;
1057 				goto send_pkts;
1058 			}
1059 		}
1060 
1061 send_pkts:
1062 		loop = 0;
1063 		while (loop < frames_to_send) {
1064 			loop += qman_enqueue_multi(q, &fd_arr[loop],
1065 						   &flags[loop],
1066 						   frames_to_send - loop);
1067 		}
1068 		nb_bufs -= frames_to_send;
1069 		sent += frames_to_send;
1070 	}
1071 
1072 	DPAA_DP_LOG(DEBUG, "Transmitted %d buffers on queue: %p", sent, q);
1073 
1074 	return sent;
1075 }
1076 
1077 uint16_t
1078 dpaa_eth_queue_tx_slow(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
1079 {
1080 	qman_ern_poll_free();
1081 
1082 	return dpaa_eth_queue_tx(q, bufs, nb_bufs);
1083 }
1084 
1085 uint16_t dpaa_eth_tx_drop_all(void *q  __rte_unused,
1086 			      struct rte_mbuf **bufs __rte_unused,
1087 		uint16_t nb_bufs __rte_unused)
1088 {
1089 	DPAA_DP_LOG(DEBUG, "Drop all packets");
1090 
1091 	/* Drop all incoming packets. No need to free packets here
1092 	 * because the rte_eth f/w frees up the packets through tx_buffer
1093 	 * callback in case this functions returns count less than nb_bufs
1094 	 */
1095 	return 0;
1096 }
1097