1 /* SPDX-License-Identifier: BSD-3-Clause
3 * Copyright 2016 Freescale Semiconductor, Inc. All rights reserved.
16 #include <rte_byteorder.h>
17 #include <rte_common.h>
18 #include <rte_interrupts.h>
20 #include <rte_debug.h>
22 #include <rte_atomic.h>
23 #include <rte_branch_prediction.h>
24 #include <rte_memory.h>
25 #include <rte_tailq.h>
27 #include <rte_alarm.h>
28 #include <rte_ether.h>
29 #include <rte_ethdev_driver.h>
30 #include <rte_malloc.h>
36 #include <rte_eventdev.h>
38 #include "dpaa_ethdev.h"
39 #include "dpaa_rxtx.h"
40 #include <rte_dpaa_bus.h>
41 #include <dpaa_mempool.h>
50 #define DPAA_MBUF_TO_CONTIG_FD(_mbuf, _fd, _bpid) \
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; \
61 #if (defined RTE_LIBRTE_DPAA_DEBUG_DRIVER)
62 void dpaa_display_frame(const struct qm_fd *fd)
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);
71 ptr = (char *)rte_dpaa_mem_ptov(fd->addr);
73 printf("%02x ", *ptr);
74 for (ii = 1; ii < fd->length20; ii++) {
75 printf("%02x ", *ptr);
83 #define dpaa_display_frame(a)
86 static inline void dpaa_slow_parsing(struct rte_mbuf *m __rte_unused,
87 uint64_t prs __rte_unused)
89 DPAA_DP_LOG(DEBUG, "Slow parsing");
90 /*TBD:XXX: to be implemented*/
93 static inline void dpaa_eth_packet_info(struct rte_mbuf *m,
94 uint64_t fd_virt_addr)
96 struct annotations_t *annot = GET_ANNOTATIONS(fd_virt_addr);
97 uint64_t prs = *((uint64_t *)(&annot->parse)) & DPAA_PARSE_MASK;
99 DPAA_DP_LOG(DEBUG, " Parsing mbuf: %p with annotations: %p", m, annot);
102 case DPAA_PKT_TYPE_IPV4:
103 m->packet_type = RTE_PTYPE_L2_ETHER |
106 case DPAA_PKT_TYPE_IPV6:
107 m->packet_type = RTE_PTYPE_L2_ETHER |
110 case DPAA_PKT_TYPE_ETHER:
111 m->packet_type = RTE_PTYPE_L2_ETHER;
113 case DPAA_PKT_TYPE_IPV4_FRAG:
114 case DPAA_PKT_TYPE_IPV4_FRAG_UDP:
115 case DPAA_PKT_TYPE_IPV4_FRAG_TCP:
116 case DPAA_PKT_TYPE_IPV4_FRAG_SCTP:
117 m->packet_type = RTE_PTYPE_L2_ETHER |
118 RTE_PTYPE_L3_IPV4 | RTE_PTYPE_L4_FRAG;
120 case DPAA_PKT_TYPE_IPV6_FRAG:
121 case DPAA_PKT_TYPE_IPV6_FRAG_UDP:
122 case DPAA_PKT_TYPE_IPV6_FRAG_TCP:
123 case DPAA_PKT_TYPE_IPV6_FRAG_SCTP:
124 m->packet_type = RTE_PTYPE_L2_ETHER |
125 RTE_PTYPE_L3_IPV6 | RTE_PTYPE_L4_FRAG;
127 case DPAA_PKT_TYPE_IPV4_EXT:
128 m->packet_type = RTE_PTYPE_L2_ETHER |
129 RTE_PTYPE_L3_IPV4_EXT;
131 case DPAA_PKT_TYPE_IPV6_EXT:
132 m->packet_type = RTE_PTYPE_L2_ETHER |
133 RTE_PTYPE_L3_IPV6_EXT;
135 case DPAA_PKT_TYPE_IPV4_TCP:
136 m->packet_type = RTE_PTYPE_L2_ETHER |
137 RTE_PTYPE_L3_IPV4 | RTE_PTYPE_L4_TCP;
139 case DPAA_PKT_TYPE_IPV6_TCP:
140 m->packet_type = RTE_PTYPE_L2_ETHER |
141 RTE_PTYPE_L3_IPV6 | RTE_PTYPE_L4_TCP;
143 case DPAA_PKT_TYPE_IPV4_UDP:
144 m->packet_type = RTE_PTYPE_L2_ETHER |
145 RTE_PTYPE_L3_IPV4 | RTE_PTYPE_L4_UDP;
147 case DPAA_PKT_TYPE_IPV6_UDP:
148 m->packet_type = RTE_PTYPE_L2_ETHER |
149 RTE_PTYPE_L3_IPV6 | RTE_PTYPE_L4_UDP;
151 case DPAA_PKT_TYPE_IPV4_EXT_UDP:
152 m->packet_type = RTE_PTYPE_L2_ETHER |
153 RTE_PTYPE_L3_IPV4_EXT | RTE_PTYPE_L4_UDP;
155 case DPAA_PKT_TYPE_IPV6_EXT_UDP:
156 m->packet_type = RTE_PTYPE_L2_ETHER |
157 RTE_PTYPE_L3_IPV6_EXT | RTE_PTYPE_L4_UDP;
159 case DPAA_PKT_TYPE_IPV4_EXT_TCP:
160 m->packet_type = RTE_PTYPE_L2_ETHER |
161 RTE_PTYPE_L3_IPV4_EXT | RTE_PTYPE_L4_TCP;
163 case DPAA_PKT_TYPE_IPV6_EXT_TCP:
164 m->packet_type = RTE_PTYPE_L2_ETHER |
165 RTE_PTYPE_L3_IPV6_EXT | RTE_PTYPE_L4_TCP;
167 case DPAA_PKT_TYPE_IPV4_SCTP:
168 m->packet_type = RTE_PTYPE_L2_ETHER |
169 RTE_PTYPE_L3_IPV4 | RTE_PTYPE_L4_SCTP;
171 case DPAA_PKT_TYPE_IPV6_SCTP:
172 m->packet_type = RTE_PTYPE_L2_ETHER |
173 RTE_PTYPE_L3_IPV6 | RTE_PTYPE_L4_SCTP;
175 case DPAA_PKT_TYPE_NONE:
178 /* More switch cases can be added */
180 dpaa_slow_parsing(m, prs);
183 m->tx_offload = annot->parse.ip_off[0];
184 m->tx_offload |= (annot->parse.l4_off - annot->parse.ip_off[0])
185 << DPAA_PKT_L3_LEN_SHIFT;
187 /* Set the hash values */
188 m->hash.rss = (uint32_t)(annot->hash);
189 /* All packets with Bad checksum are dropped by interface (and
190 * corresponding notification issued to RX error queues).
192 m->ol_flags = PKT_RX_RSS_HASH | PKT_RX_IP_CKSUM_GOOD;
194 /* Check if Vlan is present */
195 if (prs & DPAA_PARSE_VLAN_MASK)
196 m->ol_flags |= PKT_RX_VLAN;
197 /* Packet received without stripping the vlan */
200 static inline void dpaa_checksum(struct rte_mbuf *mbuf)
202 struct ether_hdr *eth_hdr = rte_pktmbuf_mtod(mbuf, struct ether_hdr *);
203 char *l3_hdr = (char *)eth_hdr + mbuf->l2_len;
204 struct ipv4_hdr *ipv4_hdr = (struct ipv4_hdr *)l3_hdr;
205 struct ipv6_hdr *ipv6_hdr = (struct ipv6_hdr *)l3_hdr;
207 DPAA_DP_LOG(DEBUG, "Calculating checksum for mbuf: %p", mbuf);
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 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 ipv6_hdr *)l3_hdr;
221 if ((mbuf->packet_type & RTE_PTYPE_L4_MASK) == RTE_PTYPE_L4_TCP) {
222 struct tcp_hdr *tcp_hdr = (struct tcp_hdr *)(l3_hdr +
225 if (eth_hdr->ether_type == htons(ETHER_TYPE_IPv4))
226 tcp_hdr->cksum = rte_ipv4_udptcp_cksum(ipv4_hdr,
228 else /* assume ethertype == ETHER_TYPE_IPv6 */
229 tcp_hdr->cksum = rte_ipv6_udptcp_cksum(ipv6_hdr,
231 } else if ((mbuf->packet_type & RTE_PTYPE_L4_MASK) ==
233 struct udp_hdr *udp_hdr = (struct udp_hdr *)(l3_hdr +
235 udp_hdr->dgram_cksum = 0;
236 if (eth_hdr->ether_type == htons(ETHER_TYPE_IPv4))
237 udp_hdr->dgram_cksum = rte_ipv4_udptcp_cksum(ipv4_hdr,
239 else /* assume ethertype == ETHER_TYPE_IPv6 */
240 udp_hdr->dgram_cksum = rte_ipv6_udptcp_cksum(ipv6_hdr,
245 static inline void dpaa_checksum_offload(struct rte_mbuf *mbuf,
246 struct qm_fd *fd, char *prs_buf)
248 struct dpaa_eth_parse_results_t *prs;
250 DPAA_DP_LOG(DEBUG, " Offloading checksum for mbuf: %p", mbuf);
252 prs = GET_TX_PRS(prs_buf);
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;
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;
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;
277 dpaa_unsegmented_checksum(struct rte_mbuf *mbuf, struct qm_fd *fd_arr)
279 if (!mbuf->packet_type) {
280 struct rte_net_hdr_lens hdr_lens;
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;
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.");
296 dpaa_checksum_offload(mbuf, fd_arr, mbuf->buf_addr);
301 dpaa_eth_sg_to_mbuf(const struct qm_fd *fd, uint32_t ifid)
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;
308 uint8_t fd_offset = fd->offset;
310 DPAA_DP_LOG(DEBUG, "Received an SG frame");
312 vaddr = DPAA_MEMPOOL_PTOV(bp_info, qm_fd_addr(fd));
314 DPAA_PMD_ERR("unable to convert physical address");
317 sgt = vaddr + fd_offset;
319 hw_sg_to_cpu(sg_temp);
320 temp = (struct rte_mbuf *)((char *)vaddr - bp_info->meta_data_size);
321 sg_vaddr = DPAA_MEMPOOL_PTOV(bp_info, qm_sg_entry_get64(sg_temp));
323 first_seg = (struct rte_mbuf *)((char *)sg_vaddr -
324 bp_info->meta_data_size);
325 first_seg->data_off = sg_temp->offset;
326 first_seg->data_len = sg_temp->length;
327 first_seg->pkt_len = sg_temp->length;
328 rte_mbuf_refcnt_set(first_seg, 1);
330 first_seg->port = ifid;
331 first_seg->nb_segs = 1;
332 first_seg->ol_flags = 0;
333 prev_seg = first_seg;
334 while (i < DPAA_SGT_MAX_ENTRIES) {
336 hw_sg_to_cpu(sg_temp);
337 sg_vaddr = DPAA_MEMPOOL_PTOV(bp_info,
338 qm_sg_entry_get64(sg_temp));
339 cur_seg = (struct rte_mbuf *)((char *)sg_vaddr -
340 bp_info->meta_data_size);
341 cur_seg->data_off = sg_temp->offset;
342 cur_seg->data_len = sg_temp->length;
343 first_seg->pkt_len += sg_temp->length;
344 first_seg->nb_segs += 1;
345 rte_mbuf_refcnt_set(cur_seg, 1);
346 prev_seg->next = cur_seg;
347 if (sg_temp->final) {
348 cur_seg->next = NULL;
354 dpaa_eth_packet_info(first_seg, (uint64_t)vaddr);
355 rte_pktmbuf_free_seg(temp);
360 static inline struct rte_mbuf *
361 dpaa_eth_fd_to_mbuf(const struct qm_fd *fd, uint32_t ifid)
363 struct rte_mbuf *mbuf;
364 struct dpaa_bp_info *bp_info = DPAA_BPID_TO_POOL_INFO(fd->bpid);
367 (fd->opaque & DPAA_FD_FORMAT_MASK) >> DPAA_FD_FORMAT_SHIFT;
371 DPAA_DP_LOG(DEBUG, " FD--->MBUF");
373 if (unlikely(format == qm_fd_sg))
374 return dpaa_eth_sg_to_mbuf(fd, ifid);
376 ptr = DPAA_MEMPOOL_PTOV(bp_info, qm_fd_addr(fd));
378 rte_prefetch0((void *)((uint8_t *)ptr + DEFAULT_RX_ICEOF));
380 offset = (fd->opaque & DPAA_FD_OFFSET_MASK) >> DPAA_FD_OFFSET_SHIFT;
381 length = fd->opaque & DPAA_FD_LENGTH_MASK;
383 /* Ignoring case when format != qm_fd_contig */
384 dpaa_display_frame(fd);
386 mbuf = (struct rte_mbuf *)((char *)ptr - bp_info->meta_data_size);
388 mbuf->data_off = offset;
389 mbuf->data_len = length;
390 mbuf->pkt_len = length;
396 rte_mbuf_refcnt_set(mbuf, 1);
397 dpaa_eth_packet_info(mbuf, (uint64_t)mbuf->buf_addr);
402 enum qman_cb_dqrr_result dpaa_rx_cb(void *event __always_unused,
403 struct qman_portal *qm __always_unused,
405 const struct qm_dqrr_entry *dqrr,
408 const struct qm_fd *fd = &dqrr->fd;
410 *bufs = dpaa_eth_fd_to_mbuf(fd,
411 ((struct dpaa_if *)fq->dpaa_intf)->ifid);
412 return qman_cb_dqrr_consume;
416 dpaa_eth_queue_portal_rx(struct qman_fq *fq,
417 struct rte_mbuf **bufs,
422 if (unlikely(fq->qp == NULL)) {
423 ret = rte_dpaa_portal_fq_init((void *)0, fq);
425 DPAA_PMD_ERR("Failure in affining portal %d", ret);
430 return qman_portal_poll_rx(nb_bufs, (void **)bufs, fq->qp);
433 enum qman_cb_dqrr_result
434 dpaa_rx_cb_parallel(void *event,
435 struct qman_portal *qm __always_unused,
437 const struct qm_dqrr_entry *dqrr,
440 u32 ifid = ((struct dpaa_if *)fq->dpaa_intf)->ifid;
441 struct rte_mbuf *mbuf;
442 struct rte_event *ev = (struct rte_event *)event;
444 mbuf = dpaa_eth_fd_to_mbuf(&dqrr->fd, ifid);
445 ev->event_ptr = (void *)mbuf;
446 ev->flow_id = fq->ev.flow_id;
447 ev->sub_event_type = fq->ev.sub_event_type;
448 ev->event_type = RTE_EVENT_TYPE_ETHDEV;
449 ev->op = RTE_EVENT_OP_NEW;
450 ev->sched_type = fq->ev.sched_type;
451 ev->queue_id = fq->ev.queue_id;
452 ev->priority = fq->ev.priority;
453 ev->impl_opaque = (uint8_t)DPAA_INVALID_MBUF_SEQN;
454 mbuf->seqn = DPAA_INVALID_MBUF_SEQN;
457 return qman_cb_dqrr_consume;
460 enum qman_cb_dqrr_result
461 dpaa_rx_cb_atomic(void *event,
462 struct qman_portal *qm __always_unused,
464 const struct qm_dqrr_entry *dqrr,
468 u32 ifid = ((struct dpaa_if *)fq->dpaa_intf)->ifid;
469 struct rte_mbuf *mbuf;
470 struct rte_event *ev = (struct rte_event *)event;
472 mbuf = dpaa_eth_fd_to_mbuf(&dqrr->fd, ifid);
473 ev->event_ptr = (void *)mbuf;
474 ev->flow_id = fq->ev.flow_id;
475 ev->sub_event_type = fq->ev.sub_event_type;
476 ev->event_type = RTE_EVENT_TYPE_ETHDEV;
477 ev->op = RTE_EVENT_OP_NEW;
478 ev->sched_type = fq->ev.sched_type;
479 ev->queue_id = fq->ev.queue_id;
480 ev->priority = fq->ev.priority;
482 /* Save active dqrr entries */
483 index = DQRR_PTR2IDX(dqrr);
484 DPAA_PER_LCORE_DQRR_SIZE++;
485 DPAA_PER_LCORE_DQRR_HELD |= 1 << index;
486 DPAA_PER_LCORE_DQRR_MBUF(index) = mbuf;
487 ev->impl_opaque = index + 1;
488 mbuf->seqn = (uint32_t)index + 1;
491 return qman_cb_dqrr_defer;
494 uint16_t dpaa_eth_queue_rx(void *q,
495 struct rte_mbuf **bufs,
498 struct qman_fq *fq = q;
499 struct qm_dqrr_entry *dq;
500 uint32_t num_rx = 0, ifid = ((struct dpaa_if *)fq->dpaa_intf)->ifid;
503 if (likely(fq->is_static))
504 return dpaa_eth_queue_portal_rx(fq, bufs, nb_bufs);
506 ret = rte_dpaa_portal_init((void *)0);
508 DPAA_PMD_ERR("Failure in affining portal");
512 ret = qman_set_vdq(fq, (nb_bufs > DPAA_MAX_DEQUEUE_NUM_FRAMES) ?
513 DPAA_MAX_DEQUEUE_NUM_FRAMES : nb_bufs);
518 dq = qman_dequeue(fq);
521 bufs[num_rx++] = dpaa_eth_fd_to_mbuf(&dq->fd, ifid);
522 qman_dqrr_consume(fq, dq);
523 } while (fq->flags & QMAN_FQ_STATE_VDQCR);
528 static void *dpaa_get_pktbuf(struct dpaa_bp_info *bp_info)
532 struct bm_buffer bufs;
534 ret = bman_acquire(bp_info->bp, &bufs, 1, 0);
536 DPAA_PMD_WARN("Failed to allocate buffers %d", ret);
540 DPAA_DP_LOG(DEBUG, "got buffer 0x%lx from pool %d",
541 (uint64_t)bufs.addr, bufs.bpid);
543 buf = (uint64_t)DPAA_MEMPOOL_PTOV(bp_info, bufs.addr)
544 - bp_info->meta_data_size;
552 static struct rte_mbuf *dpaa_get_dmable_mbuf(struct rte_mbuf *mbuf,
553 struct dpaa_if *dpaa_intf)
555 struct rte_mbuf *dpaa_mbuf;
557 /* allocate pktbuffer on bpid for dpaa port */
558 dpaa_mbuf = dpaa_get_pktbuf(dpaa_intf->bp_info);
562 memcpy((uint8_t *)(dpaa_mbuf->buf_addr) + RTE_PKTMBUF_HEADROOM, (void *)
563 ((uint8_t *)(mbuf->buf_addr) + mbuf->data_off), mbuf->pkt_len);
565 /* Copy only the required fields */
566 dpaa_mbuf->data_off = RTE_PKTMBUF_HEADROOM;
567 dpaa_mbuf->pkt_len = mbuf->pkt_len;
568 dpaa_mbuf->ol_flags = mbuf->ol_flags;
569 dpaa_mbuf->packet_type = mbuf->packet_type;
570 dpaa_mbuf->tx_offload = mbuf->tx_offload;
571 rte_pktmbuf_free(mbuf);
576 dpaa_eth_mbuf_to_sg_fd(struct rte_mbuf *mbuf,
580 struct rte_mbuf *cur_seg = mbuf, *prev_seg = NULL;
581 struct dpaa_bp_info *bp_info = DPAA_BPID_TO_POOL_INFO(bpid);
582 struct rte_mbuf *temp, *mi;
583 struct qm_sg_entry *sg_temp, *sgt;
586 DPAA_DP_LOG(DEBUG, "Creating SG FD to transmit");
588 temp = rte_pktmbuf_alloc(bp_info->mp);
590 DPAA_PMD_ERR("Failure in allocation of mbuf");
593 if (temp->buf_len < ((mbuf->nb_segs * sizeof(struct qm_sg_entry))
595 DPAA_PMD_ERR("Insufficient space in mbuf for SG entries");
602 if (mbuf->ol_flags & DPAA_TX_CKSUM_OFFLOAD_MASK) {
603 if (!mbuf->packet_type) {
604 struct rte_net_hdr_lens hdr_lens;
606 mbuf->packet_type = rte_net_get_ptype(mbuf, &hdr_lens,
607 RTE_PTYPE_L2_MASK | RTE_PTYPE_L3_MASK
608 | RTE_PTYPE_L4_MASK);
609 mbuf->l2_len = hdr_lens.l2_len;
610 mbuf->l3_len = hdr_lens.l3_len;
612 if (temp->data_off < DEFAULT_TX_ICEOF
613 + sizeof(struct dpaa_eth_parse_results_t))
614 temp->data_off = DEFAULT_TX_ICEOF
615 + sizeof(struct dpaa_eth_parse_results_t);
616 dcbz_64(temp->buf_addr);
617 dpaa_checksum_offload(mbuf, fd, temp->buf_addr);
620 sgt = temp->buf_addr + temp->data_off;
621 fd->format = QM_FD_SG;
622 fd->addr = temp->buf_iova;
623 fd->offset = temp->data_off;
625 fd->length20 = mbuf->pkt_len;
627 while (i < DPAA_SGT_MAX_ENTRIES) {
631 sg_temp->addr = cur_seg->buf_iova;
632 sg_temp->offset = cur_seg->data_off;
633 sg_temp->length = cur_seg->data_len;
634 if (RTE_MBUF_DIRECT(cur_seg)) {
635 if (rte_mbuf_refcnt_read(cur_seg) > 1) {
636 /*If refcnt > 1, invalid bpid is set to ensure
637 * buffer is not freed by HW.
639 sg_temp->bpid = 0xff;
640 rte_mbuf_refcnt_update(cur_seg, -1);
643 DPAA_MEMPOOL_TO_BPID(cur_seg->pool);
645 cur_seg = cur_seg->next;
647 /* Get owner MBUF from indirect buffer */
648 mi = rte_mbuf_from_indirect(cur_seg);
649 if (rte_mbuf_refcnt_read(mi) > 1) {
650 /*If refcnt > 1, invalid bpid is set to ensure
651 * owner buffer is not freed by HW.
653 sg_temp->bpid = 0xff;
655 sg_temp->bpid = DPAA_MEMPOOL_TO_BPID(mi->pool);
656 rte_mbuf_refcnt_update(mi, 1);
659 cur_seg = cur_seg->next;
660 prev_seg->next = NULL;
661 rte_pktmbuf_free(prev_seg);
663 if (cur_seg == NULL) {
665 cpu_to_hw_sg(sg_temp);
668 cpu_to_hw_sg(sg_temp);
673 /* Handle mbufs which are not segmented (non SG) */
675 tx_on_dpaa_pool_unsegmented(struct rte_mbuf *mbuf,
676 struct dpaa_bp_info *bp_info,
677 struct qm_fd *fd_arr)
679 struct rte_mbuf *mi = NULL;
681 if (RTE_MBUF_DIRECT(mbuf)) {
682 if (rte_mbuf_refcnt_read(mbuf) > 1) {
683 /* In case of direct mbuf and mbuf being cloned,
684 * BMAN should _not_ release buffer.
686 DPAA_MBUF_TO_CONTIG_FD(mbuf, fd_arr, 0xff);
687 /* Buffer should be releasd by EAL */
688 rte_mbuf_refcnt_update(mbuf, -1);
690 /* In case of direct mbuf and no cloning, mbuf can be
693 DPAA_MBUF_TO_CONTIG_FD(mbuf, fd_arr, bp_info->bpid);
696 /* This is data-containing core mbuf: 'mi' */
697 mi = rte_mbuf_from_indirect(mbuf);
698 if (rte_mbuf_refcnt_read(mi) > 1) {
699 /* In case of indirect mbuf, and mbuf being cloned,
700 * BMAN should _not_ release it and let EAL release
701 * it through pktmbuf_free below.
703 DPAA_MBUF_TO_CONTIG_FD(mbuf, fd_arr, 0xff);
705 /* In case of indirect mbuf, and no cloning, core mbuf
706 * should be released by BMAN.
707 * Increate refcnt of core mbuf so that when
708 * pktmbuf_free is called and mbuf is released, EAL
709 * doesn't try to release core mbuf which would have
710 * been released by BMAN.
712 rte_mbuf_refcnt_update(mi, 1);
713 DPAA_MBUF_TO_CONTIG_FD(mbuf, fd_arr, bp_info->bpid);
715 rte_pktmbuf_free(mbuf);
718 if (mbuf->ol_flags & DPAA_TX_CKSUM_OFFLOAD_MASK)
719 dpaa_unsegmented_checksum(mbuf, fd_arr);
722 /* Handle all mbufs on dpaa BMAN managed pool */
723 static inline uint16_t
724 tx_on_dpaa_pool(struct rte_mbuf *mbuf,
725 struct dpaa_bp_info *bp_info,
726 struct qm_fd *fd_arr)
728 DPAA_DP_LOG(DEBUG, "BMAN offloaded buffer, mbuf: %p", mbuf);
730 if (mbuf->nb_segs == 1) {
731 /* Case for non-segmented buffers */
732 tx_on_dpaa_pool_unsegmented(mbuf, bp_info, fd_arr);
733 } else if (mbuf->nb_segs > 1 &&
734 mbuf->nb_segs <= DPAA_SGT_MAX_ENTRIES) {
735 if (dpaa_eth_mbuf_to_sg_fd(mbuf, fd_arr, bp_info->bpid)) {
736 DPAA_PMD_DEBUG("Unable to create Scatter Gather FD");
740 DPAA_PMD_DEBUG("Number of Segments not supported");
747 /* Handle all mbufs on an external pool (non-dpaa) */
748 static inline uint16_t
749 tx_on_external_pool(struct qman_fq *txq, struct rte_mbuf *mbuf,
750 struct qm_fd *fd_arr)
752 struct dpaa_if *dpaa_intf = txq->dpaa_intf;
753 struct rte_mbuf *dmable_mbuf;
755 DPAA_DP_LOG(DEBUG, "Non-BMAN offloaded buffer."
756 "Allocating an offloaded buffer");
757 dmable_mbuf = dpaa_get_dmable_mbuf(mbuf, dpaa_intf);
759 DPAA_DP_LOG(DEBUG, "no dpaa buffers.");
763 DPAA_MBUF_TO_CONTIG_FD(dmable_mbuf, fd_arr, dpaa_intf->bp_info->bpid);
769 dpaa_eth_queue_tx(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
771 struct rte_mbuf *mbuf, *mi = NULL;
772 struct rte_mempool *mp;
773 struct dpaa_bp_info *bp_info;
774 struct qm_fd fd_arr[DPAA_TX_BURST_SIZE];
775 uint32_t frames_to_send, loop, sent = 0;
778 uint32_t seqn, index, flags[DPAA_TX_BURST_SIZE] = {0};
780 ret = rte_dpaa_portal_init((void *)0);
782 DPAA_PMD_ERR("Failure in affining portal");
786 DPAA_DP_LOG(DEBUG, "Transmitting %d buffers on queue: %p", nb_bufs, q);
789 frames_to_send = (nb_bufs > DPAA_TX_BURST_SIZE) ?
790 DPAA_TX_BURST_SIZE : nb_bufs;
791 for (loop = 0; loop < frames_to_send; loop++) {
793 if (likely(RTE_MBUF_DIRECT(mbuf))) {
795 bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
796 if (likely(mp->ops_index ==
797 bp_info->dpaa_ops_index &&
798 mbuf->nb_segs == 1 &&
799 rte_mbuf_refcnt_read(mbuf) == 1)) {
800 DPAA_MBUF_TO_CONTIG_FD(mbuf,
801 &fd_arr[loop], bp_info->bpid);
803 DPAA_TX_CKSUM_OFFLOAD_MASK)
804 dpaa_unsegmented_checksum(mbuf,
809 mi = rte_mbuf_from_indirect(mbuf);
813 bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
814 if (likely(mp->ops_index == bp_info->dpaa_ops_index)) {
815 state = tx_on_dpaa_pool(mbuf, bp_info,
817 if (unlikely(state)) {
818 /* Set frames_to_send & nb_bufs so
819 * that packets are transmitted till
822 frames_to_send = loop;
827 state = tx_on_external_pool(q, mbuf,
829 if (unlikely(state)) {
830 /* Set frames_to_send & nb_bufs so
831 * that packets are transmitted till
834 frames_to_send = loop;
840 if (seqn != DPAA_INVALID_MBUF_SEQN) {
842 if (DPAA_PER_LCORE_DQRR_HELD & (1 << index)) {
844 ((index & QM_EQCR_DCA_IDXMASK) << 8);
845 flags[loop] |= QMAN_ENQUEUE_FLAG_DCA;
846 DPAA_PER_LCORE_DQRR_SIZE--;
847 DPAA_PER_LCORE_DQRR_HELD &=
855 while (loop < frames_to_send) {
856 loop += qman_enqueue_multi(q, &fd_arr[loop],
858 frames_to_send - loop);
860 nb_bufs -= frames_to_send;
861 sent += frames_to_send;
864 DPAA_DP_LOG(DEBUG, "Transmitted %d buffers on queue: %p", sent, q);
869 uint16_t dpaa_eth_tx_drop_all(void *q __rte_unused,
870 struct rte_mbuf **bufs __rte_unused,
871 uint16_t nb_bufs __rte_unused)
873 DPAA_DP_LOG(DEBUG, "Drop all packets");
875 /* Drop all incoming packets. No need to free packets here
876 * because the rte_eth f/w frees up the packets through tx_buffer
877 * callback in case this functions returns count less than nb_bufs