2014-06-04 18:08:21 +00:00
|
|
|
/*-
|
|
|
|
* BSD LICENSE
|
|
|
|
*
|
|
|
|
* Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
|
|
|
|
* All rights reserved.
|
|
|
|
*
|
|
|
|
* Redistribution and use in source and binary forms, with or without
|
|
|
|
* modification, are permitted provided that the following conditions
|
|
|
|
* are met:
|
|
|
|
*
|
|
|
|
* * Redistributions of source code must retain the above copyright
|
|
|
|
* notice, this list of conditions and the following disclaimer.
|
|
|
|
* * Redistributions in binary form must reproduce the above copyright
|
|
|
|
* notice, this list of conditions and the following disclaimer in
|
|
|
|
* the documentation and/or other materials provided with the
|
|
|
|
* distribution.
|
|
|
|
* * Neither the name of Intel Corporation nor the names of its
|
|
|
|
* contributors may be used to endorse or promote products derived
|
|
|
|
* from this software without specific prior written permission.
|
|
|
|
*
|
|
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
|
|
|
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
|
|
|
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
|
|
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
|
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
|
|
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
*/
|
|
|
|
#include <string.h>
|
2015-05-21 12:28:44 +00:00
|
|
|
#include <stdint.h>
|
2014-06-04 18:08:21 +00:00
|
|
|
|
|
|
|
#include <rte_mbuf.h>
|
|
|
|
#include <rte_ring.h>
|
|
|
|
#include <rte_malloc.h>
|
|
|
|
|
|
|
|
#include "rte_port_ring.h"
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Port RING Reader
|
|
|
|
*/
|
2015-06-19 09:41:19 +00:00
|
|
|
#ifdef RTE_PORT_STATS_COLLECT
|
|
|
|
|
|
|
|
#define RTE_PORT_RING_READER_STATS_PKTS_IN_ADD(port, val) \
|
|
|
|
port->stats.n_pkts_in += val
|
|
|
|
#define RTE_PORT_RING_READER_STATS_PKTS_DROP_ADD(port, val) \
|
|
|
|
port->stats.n_pkts_drop += val
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define RTE_PORT_RING_READER_STATS_PKTS_IN_ADD(port, val)
|
|
|
|
#define RTE_PORT_RING_READER_STATS_PKTS_DROP_ADD(port, val)
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
struct rte_port_ring_reader {
|
2015-06-19 09:41:19 +00:00
|
|
|
struct rte_port_in_stats stats;
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
struct rte_ring *ring;
|
|
|
|
};
|
|
|
|
|
|
|
|
static void *
|
2015-10-28 13:30:43 +00:00
|
|
|
rte_port_ring_reader_create_internal(void *params, int socket_id,
|
|
|
|
uint32_t is_multi)
|
2014-06-04 18:08:21 +00:00
|
|
|
{
|
|
|
|
struct rte_port_ring_reader_params *conf =
|
|
|
|
(struct rte_port_ring_reader_params *) params;
|
|
|
|
struct rte_port_ring_reader *port;
|
|
|
|
|
|
|
|
/* Check input parameters */
|
2015-10-28 13:30:43 +00:00
|
|
|
if ((conf == NULL) ||
|
|
|
|
(conf->ring == NULL) ||
|
2017-03-29 15:21:18 +00:00
|
|
|
(conf->ring->cons.single && is_multi) ||
|
|
|
|
(!(conf->ring->cons.single) && !is_multi)) {
|
2015-10-28 13:30:43 +00:00
|
|
|
RTE_LOG(ERR, PORT, "%s: Invalid Parameters\n", __func__);
|
2014-06-04 18:08:21 +00:00
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Memory allocation */
|
|
|
|
port = rte_zmalloc_socket("PORT", sizeof(*port),
|
2014-11-19 12:26:06 +00:00
|
|
|
RTE_CACHE_LINE_SIZE, socket_id);
|
2014-06-04 18:08:21 +00:00
|
|
|
if (port == NULL) {
|
|
|
|
RTE_LOG(ERR, PORT, "%s: Failed to allocate port\n", __func__);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Initialization */
|
|
|
|
port->ring = conf->ring;
|
|
|
|
|
|
|
|
return port;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static void *
|
|
|
|
rte_port_ring_reader_create(void *params, int socket_id)
|
|
|
|
{
|
|
|
|
return rte_port_ring_reader_create_internal(params, socket_id, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void *
|
|
|
|
rte_port_ring_multi_reader_create(void *params, int socket_id)
|
|
|
|
{
|
|
|
|
return rte_port_ring_reader_create_internal(params, socket_id, 1);
|
|
|
|
}
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_reader_rx(void *port, struct rte_mbuf **pkts, uint32_t n_pkts)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_reader *p = (struct rte_port_ring_reader *) port;
|
2015-06-19 09:41:19 +00:00
|
|
|
uint32_t nb_rx;
|
2014-06-04 18:08:21 +00:00
|
|
|
|
2015-06-19 09:41:19 +00:00
|
|
|
nb_rx = rte_ring_sc_dequeue_burst(p->ring, (void **) pkts, n_pkts);
|
|
|
|
RTE_PORT_RING_READER_STATS_PKTS_IN_ADD(p, nb_rx);
|
|
|
|
|
|
|
|
return nb_rx;
|
2014-06-04 18:08:21 +00:00
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_multi_reader_rx(void *port, struct rte_mbuf **pkts,
|
|
|
|
uint32_t n_pkts)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_reader *p = (struct rte_port_ring_reader *) port;
|
|
|
|
uint32_t nb_rx;
|
|
|
|
|
|
|
|
nb_rx = rte_ring_mc_dequeue_burst(p->ring, (void **) pkts, n_pkts);
|
|
|
|
RTE_PORT_RING_READER_STATS_PKTS_IN_ADD(p, nb_rx);
|
|
|
|
|
|
|
|
return nb_rx;
|
|
|
|
}
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_reader_free(void *port)
|
|
|
|
{
|
|
|
|
if (port == NULL) {
|
|
|
|
RTE_LOG(ERR, PORT, "%s: port is NULL\n", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
rte_free(port);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-06-19 09:41:19 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_reader_stats_read(void *port,
|
|
|
|
struct rte_port_in_stats *stats, int clear)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_reader *p =
|
|
|
|
(struct rte_port_ring_reader *) port;
|
|
|
|
|
|
|
|
if (stats != NULL)
|
|
|
|
memcpy(stats, &p->stats, sizeof(p->stats));
|
|
|
|
|
|
|
|
if (clear)
|
|
|
|
memset(&p->stats, 0, sizeof(p->stats));
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
/*
|
|
|
|
* Port RING Writer
|
|
|
|
*/
|
2015-06-19 09:41:19 +00:00
|
|
|
#ifdef RTE_PORT_STATS_COLLECT
|
|
|
|
|
|
|
|
#define RTE_PORT_RING_WRITER_STATS_PKTS_IN_ADD(port, val) \
|
|
|
|
port->stats.n_pkts_in += val
|
|
|
|
#define RTE_PORT_RING_WRITER_STATS_PKTS_DROP_ADD(port, val) \
|
|
|
|
port->stats.n_pkts_drop += val
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define RTE_PORT_RING_WRITER_STATS_PKTS_IN_ADD(port, val)
|
|
|
|
#define RTE_PORT_RING_WRITER_STATS_PKTS_DROP_ADD(port, val)
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
struct rte_port_ring_writer {
|
2015-06-19 09:41:19 +00:00
|
|
|
struct rte_port_out_stats stats;
|
|
|
|
|
2016-04-11 17:55:37 +00:00
|
|
|
struct rte_mbuf *tx_buf[2 * RTE_PORT_IN_BURST_SIZE_MAX];
|
2014-06-04 18:08:21 +00:00
|
|
|
struct rte_ring *ring;
|
|
|
|
uint32_t tx_burst_sz;
|
|
|
|
uint32_t tx_buf_count;
|
2015-05-21 12:28:42 +00:00
|
|
|
uint64_t bsz_mask;
|
2015-10-28 13:30:43 +00:00
|
|
|
uint32_t is_multi;
|
2014-06-04 18:08:21 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static void *
|
2015-10-28 13:30:43 +00:00
|
|
|
rte_port_ring_writer_create_internal(void *params, int socket_id,
|
|
|
|
uint32_t is_multi)
|
2014-06-04 18:08:21 +00:00
|
|
|
{
|
|
|
|
struct rte_port_ring_writer_params *conf =
|
|
|
|
(struct rte_port_ring_writer_params *) params;
|
|
|
|
struct rte_port_ring_writer *port;
|
|
|
|
|
|
|
|
/* Check input parameters */
|
|
|
|
if ((conf == NULL) ||
|
2015-10-28 13:30:43 +00:00
|
|
|
(conf->ring == NULL) ||
|
2017-03-29 15:21:18 +00:00
|
|
|
(conf->ring->prod.single && is_multi) ||
|
|
|
|
(!(conf->ring->prod.single) && !is_multi) ||
|
2014-06-04 18:08:21 +00:00
|
|
|
(conf->tx_burst_sz > RTE_PORT_IN_BURST_SIZE_MAX)) {
|
|
|
|
RTE_LOG(ERR, PORT, "%s: Invalid Parameters\n", __func__);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Memory allocation */
|
|
|
|
port = rte_zmalloc_socket("PORT", sizeof(*port),
|
2014-11-19 12:26:06 +00:00
|
|
|
RTE_CACHE_LINE_SIZE, socket_id);
|
2014-06-04 18:08:21 +00:00
|
|
|
if (port == NULL) {
|
|
|
|
RTE_LOG(ERR, PORT, "%s: Failed to allocate port\n", __func__);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Initialization */
|
|
|
|
port->ring = conf->ring;
|
|
|
|
port->tx_burst_sz = conf->tx_burst_sz;
|
|
|
|
port->tx_buf_count = 0;
|
2015-05-21 12:28:42 +00:00
|
|
|
port->bsz_mask = 1LLU << (conf->tx_burst_sz - 1);
|
2015-10-28 13:30:43 +00:00
|
|
|
port->is_multi = is_multi;
|
2014-06-04 18:08:21 +00:00
|
|
|
|
|
|
|
return port;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static void *
|
|
|
|
rte_port_ring_writer_create(void *params, int socket_id)
|
|
|
|
{
|
|
|
|
return rte_port_ring_writer_create_internal(params, socket_id, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void *
|
|
|
|
rte_port_ring_multi_writer_create(void *params, int socket_id)
|
|
|
|
{
|
|
|
|
return rte_port_ring_writer_create_internal(params, socket_id, 1);
|
|
|
|
}
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
static inline void
|
|
|
|
send_burst(struct rte_port_ring_writer *p)
|
|
|
|
{
|
|
|
|
uint32_t nb_tx;
|
|
|
|
|
|
|
|
nb_tx = rte_ring_sp_enqueue_burst(p->ring, (void **)p->tx_buf,
|
|
|
|
p->tx_buf_count);
|
|
|
|
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_STATS_PKTS_DROP_ADD(p, p->tx_buf_count - nb_tx);
|
2014-06-04 18:08:21 +00:00
|
|
|
for ( ; nb_tx < p->tx_buf_count; nb_tx++)
|
|
|
|
rte_pktmbuf_free(p->tx_buf[nb_tx]);
|
|
|
|
|
|
|
|
p->tx_buf_count = 0;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static inline void
|
|
|
|
send_burst_mp(struct rte_port_ring_writer *p)
|
|
|
|
{
|
|
|
|
uint32_t nb_tx;
|
|
|
|
|
|
|
|
nb_tx = rte_ring_mp_enqueue_burst(p->ring, (void **)p->tx_buf,
|
|
|
|
p->tx_buf_count);
|
|
|
|
|
|
|
|
RTE_PORT_RING_WRITER_STATS_PKTS_DROP_ADD(p, p->tx_buf_count - nb_tx);
|
|
|
|
for ( ; nb_tx < p->tx_buf_count; nb_tx++)
|
|
|
|
rte_pktmbuf_free(p->tx_buf[nb_tx]);
|
|
|
|
|
|
|
|
p->tx_buf_count = 0;
|
|
|
|
}
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_tx(void *port, struct rte_mbuf *pkt)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer *p = (struct rte_port_ring_writer *) port;
|
|
|
|
|
|
|
|
p->tx_buf[p->tx_buf_count++] = pkt;
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_STATS_PKTS_IN_ADD(p, 1);
|
2014-06-04 18:08:21 +00:00
|
|
|
if (p->tx_buf_count >= p->tx_burst_sz)
|
|
|
|
send_burst(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
2015-10-28 13:30:43 +00:00
|
|
|
rte_port_ring_multi_writer_tx(void *port, struct rte_mbuf *pkt)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer *p = (struct rte_port_ring_writer *) port;
|
|
|
|
|
|
|
|
p->tx_buf[p->tx_buf_count++] = pkt;
|
|
|
|
RTE_PORT_RING_WRITER_STATS_PKTS_IN_ADD(p, 1);
|
|
|
|
if (p->tx_buf_count >= p->tx_burst_sz)
|
|
|
|
send_burst_mp(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int __attribute__((always_inline))
|
|
|
|
rte_port_ring_writer_tx_bulk_internal(void *port,
|
2014-06-04 18:08:21 +00:00
|
|
|
struct rte_mbuf **pkts,
|
2015-10-28 13:30:43 +00:00
|
|
|
uint64_t pkts_mask,
|
|
|
|
uint32_t is_multi)
|
2014-06-04 18:08:21 +00:00
|
|
|
{
|
2015-05-21 12:28:42 +00:00
|
|
|
struct rte_port_ring_writer *p =
|
|
|
|
(struct rte_port_ring_writer *) port;
|
|
|
|
|
2016-04-11 17:54:46 +00:00
|
|
|
uint64_t bsz_mask = p->bsz_mask;
|
2015-05-21 12:28:42 +00:00
|
|
|
uint32_t tx_buf_count = p->tx_buf_count;
|
|
|
|
uint64_t expr = (pkts_mask & (pkts_mask + 1)) |
|
|
|
|
((pkts_mask & bsz_mask) ^ bsz_mask);
|
2014-06-04 18:08:21 +00:00
|
|
|
|
2015-05-21 12:28:42 +00:00
|
|
|
if (expr == 0) {
|
2014-06-04 18:08:21 +00:00
|
|
|
uint64_t n_pkts = __builtin_popcountll(pkts_mask);
|
2015-05-21 12:28:42 +00:00
|
|
|
uint32_t n_pkts_ok;
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
if (tx_buf_count) {
|
|
|
|
if (is_multi)
|
|
|
|
send_burst_mp(p);
|
|
|
|
else
|
|
|
|
send_burst(p);
|
|
|
|
}
|
2014-06-04 18:08:21 +00:00
|
|
|
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_STATS_PKTS_IN_ADD(p, n_pkts);
|
2015-10-28 13:30:43 +00:00
|
|
|
if (is_multi)
|
|
|
|
n_pkts_ok = rte_ring_mp_enqueue_burst(p->ring, (void **)pkts,
|
|
|
|
n_pkts);
|
|
|
|
else
|
|
|
|
n_pkts_ok = rte_ring_sp_enqueue_burst(p->ring, (void **)pkts,
|
|
|
|
n_pkts);
|
2014-06-04 18:08:21 +00:00
|
|
|
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_STATS_PKTS_DROP_ADD(p, n_pkts - n_pkts_ok);
|
2015-05-21 12:28:42 +00:00
|
|
|
for ( ; n_pkts_ok < n_pkts; n_pkts_ok++) {
|
|
|
|
struct rte_mbuf *pkt = pkts[n_pkts_ok];
|
|
|
|
|
|
|
|
rte_pktmbuf_free(pkt);
|
2014-06-04 18:08:21 +00:00
|
|
|
}
|
|
|
|
} else {
|
|
|
|
for ( ; pkts_mask; ) {
|
|
|
|
uint32_t pkt_index = __builtin_ctzll(pkts_mask);
|
|
|
|
uint64_t pkt_mask = 1LLU << pkt_index;
|
|
|
|
struct rte_mbuf *pkt = pkts[pkt_index];
|
|
|
|
|
2015-05-21 12:28:42 +00:00
|
|
|
p->tx_buf[tx_buf_count++] = pkt;
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_STATS_PKTS_IN_ADD(p, 1);
|
2014-06-04 18:08:21 +00:00
|
|
|
pkts_mask &= ~pkt_mask;
|
|
|
|
}
|
2015-05-21 12:28:42 +00:00
|
|
|
|
|
|
|
p->tx_buf_count = tx_buf_count;
|
2015-10-28 13:30:43 +00:00
|
|
|
if (tx_buf_count >= p->tx_burst_sz) {
|
|
|
|
if (is_multi)
|
|
|
|
send_burst_mp(p);
|
|
|
|
else
|
|
|
|
send_burst(p);
|
|
|
|
}
|
2014-06-04 18:08:21 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_tx_bulk(void *port,
|
|
|
|
struct rte_mbuf **pkts,
|
|
|
|
uint64_t pkts_mask)
|
|
|
|
{
|
|
|
|
return rte_port_ring_writer_tx_bulk_internal(port, pkts, pkts_mask, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
rte_port_ring_multi_writer_tx_bulk(void *port,
|
|
|
|
struct rte_mbuf **pkts,
|
|
|
|
uint64_t pkts_mask)
|
|
|
|
{
|
|
|
|
return rte_port_ring_writer_tx_bulk_internal(port, pkts, pkts_mask, 1);
|
|
|
|
}
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_flush(void *port)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer *p = (struct rte_port_ring_writer *) port;
|
|
|
|
|
|
|
|
if (p->tx_buf_count > 0)
|
|
|
|
send_burst(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_multi_writer_flush(void *port)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer *p = (struct rte_port_ring_writer *) port;
|
|
|
|
|
|
|
|
if (p->tx_buf_count > 0)
|
|
|
|
send_burst_mp(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_free(void *port)
|
|
|
|
{
|
2015-10-28 13:30:43 +00:00
|
|
|
struct rte_port_ring_writer *p = (struct rte_port_ring_writer *) port;
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
if (port == NULL) {
|
|
|
|
RTE_LOG(ERR, PORT, "%s: Port is NULL\n", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
if (p->is_multi)
|
|
|
|
rte_port_ring_multi_writer_flush(port);
|
|
|
|
else
|
|
|
|
rte_port_ring_writer_flush(port);
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
rte_free(port);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-06-19 09:41:19 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_stats_read(void *port,
|
|
|
|
struct rte_port_out_stats *stats, int clear)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer *p =
|
|
|
|
(struct rte_port_ring_writer *) port;
|
|
|
|
|
|
|
|
if (stats != NULL)
|
|
|
|
memcpy(stats, &p->stats, sizeof(p->stats));
|
|
|
|
|
|
|
|
if (clear)
|
|
|
|
memset(&p->stats, 0, sizeof(p->stats));
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
/*
|
|
|
|
* Port RING Writer Nodrop
|
|
|
|
*/
|
2015-06-19 09:41:19 +00:00
|
|
|
#ifdef RTE_PORT_STATS_COLLECT
|
|
|
|
|
|
|
|
#define RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_IN_ADD(port, val) \
|
|
|
|
port->stats.n_pkts_in += val
|
|
|
|
#define RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_DROP_ADD(port, val) \
|
|
|
|
port->stats.n_pkts_drop += val
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_IN_ADD(port, val)
|
|
|
|
#define RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_DROP_ADD(port, val)
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
struct rte_port_ring_writer_nodrop {
|
2015-06-19 09:41:19 +00:00
|
|
|
struct rte_port_out_stats stats;
|
|
|
|
|
2016-04-11 17:55:37 +00:00
|
|
|
struct rte_mbuf *tx_buf[2 * RTE_PORT_IN_BURST_SIZE_MAX];
|
2015-05-21 12:28:44 +00:00
|
|
|
struct rte_ring *ring;
|
|
|
|
uint32_t tx_burst_sz;
|
|
|
|
uint32_t tx_buf_count;
|
|
|
|
uint64_t bsz_mask;
|
|
|
|
uint64_t n_retries;
|
2015-10-28 13:30:43 +00:00
|
|
|
uint32_t is_multi;
|
2015-05-21 12:28:44 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
static void *
|
2015-10-28 13:30:43 +00:00
|
|
|
rte_port_ring_writer_nodrop_create_internal(void *params, int socket_id,
|
|
|
|
uint32_t is_multi)
|
2015-05-21 12:28:44 +00:00
|
|
|
{
|
|
|
|
struct rte_port_ring_writer_nodrop_params *conf =
|
|
|
|
(struct rte_port_ring_writer_nodrop_params *) params;
|
|
|
|
struct rte_port_ring_writer_nodrop *port;
|
|
|
|
|
|
|
|
/* Check input parameters */
|
|
|
|
if ((conf == NULL) ||
|
2015-10-28 13:30:43 +00:00
|
|
|
(conf->ring == NULL) ||
|
2017-03-29 15:21:18 +00:00
|
|
|
(conf->ring->prod.single && is_multi) ||
|
|
|
|
(!(conf->ring->prod.single) && !is_multi) ||
|
2015-05-21 12:28:44 +00:00
|
|
|
(conf->tx_burst_sz > RTE_PORT_IN_BURST_SIZE_MAX)) {
|
|
|
|
RTE_LOG(ERR, PORT, "%s: Invalid Parameters\n", __func__);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Memory allocation */
|
|
|
|
port = rte_zmalloc_socket("PORT", sizeof(*port),
|
|
|
|
RTE_CACHE_LINE_SIZE, socket_id);
|
|
|
|
if (port == NULL) {
|
|
|
|
RTE_LOG(ERR, PORT, "%s: Failed to allocate port\n", __func__);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Initialization */
|
|
|
|
port->ring = conf->ring;
|
|
|
|
port->tx_burst_sz = conf->tx_burst_sz;
|
|
|
|
port->tx_buf_count = 0;
|
|
|
|
port->bsz_mask = 1LLU << (conf->tx_burst_sz - 1);
|
2015-10-28 13:30:43 +00:00
|
|
|
port->is_multi = is_multi;
|
2015-05-21 12:28:44 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* When n_retries is 0 it means that we should wait for every packet to
|
|
|
|
* send no matter how many retries should it take. To limit number of
|
|
|
|
* branches in fast path, we use UINT64_MAX instead of branching.
|
|
|
|
*/
|
|
|
|
port->n_retries = (conf->n_retries == 0) ? UINT64_MAX : conf->n_retries;
|
|
|
|
|
|
|
|
return port;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static void *
|
|
|
|
rte_port_ring_writer_nodrop_create(void *params, int socket_id)
|
|
|
|
{
|
|
|
|
return rte_port_ring_writer_nodrop_create_internal(params, socket_id, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void *
|
|
|
|
rte_port_ring_multi_writer_nodrop_create(void *params, int socket_id)
|
|
|
|
{
|
|
|
|
return rte_port_ring_writer_nodrop_create_internal(params, socket_id, 1);
|
|
|
|
}
|
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
static inline void
|
|
|
|
send_burst_nodrop(struct rte_port_ring_writer_nodrop *p)
|
|
|
|
{
|
|
|
|
uint32_t nb_tx = 0, i;
|
|
|
|
|
|
|
|
nb_tx = rte_ring_sp_enqueue_burst(p->ring, (void **)p->tx_buf,
|
|
|
|
p->tx_buf_count);
|
|
|
|
|
|
|
|
/* We sent all the packets in a first try */
|
2016-03-02 21:19:58 +00:00
|
|
|
if (nb_tx >= p->tx_buf_count) {
|
|
|
|
p->tx_buf_count = 0;
|
2015-05-21 12:28:44 +00:00
|
|
|
return;
|
2016-03-02 21:19:58 +00:00
|
|
|
}
|
2015-05-21 12:28:44 +00:00
|
|
|
|
|
|
|
for (i = 0; i < p->n_retries; i++) {
|
|
|
|
nb_tx += rte_ring_sp_enqueue_burst(p->ring,
|
|
|
|
(void **) (p->tx_buf + nb_tx), p->tx_buf_count - nb_tx);
|
|
|
|
|
|
|
|
/* We sent all the packets in more than one try */
|
2016-03-02 21:19:58 +00:00
|
|
|
if (nb_tx >= p->tx_buf_count) {
|
|
|
|
p->tx_buf_count = 0;
|
2015-05-21 12:28:44 +00:00
|
|
|
return;
|
2016-03-02 21:19:58 +00:00
|
|
|
}
|
2015-05-21 12:28:44 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* We didn't send the packets in maximum allowed attempts */
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_DROP_ADD(p, p->tx_buf_count - nb_tx);
|
2015-05-21 12:28:44 +00:00
|
|
|
for ( ; nb_tx < p->tx_buf_count; nb_tx++)
|
|
|
|
rte_pktmbuf_free(p->tx_buf[nb_tx]);
|
|
|
|
|
|
|
|
p->tx_buf_count = 0;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static inline void
|
|
|
|
send_burst_mp_nodrop(struct rte_port_ring_writer_nodrop *p)
|
|
|
|
{
|
|
|
|
uint32_t nb_tx = 0, i;
|
|
|
|
|
|
|
|
nb_tx = rte_ring_mp_enqueue_burst(p->ring, (void **)p->tx_buf,
|
|
|
|
p->tx_buf_count);
|
|
|
|
|
|
|
|
/* We sent all the packets in a first try */
|
2016-03-02 21:19:58 +00:00
|
|
|
if (nb_tx >= p->tx_buf_count) {
|
|
|
|
p->tx_buf_count = 0;
|
2015-10-28 13:30:43 +00:00
|
|
|
return;
|
2016-03-02 21:19:58 +00:00
|
|
|
}
|
2015-10-28 13:30:43 +00:00
|
|
|
|
|
|
|
for (i = 0; i < p->n_retries; i++) {
|
|
|
|
nb_tx += rte_ring_mp_enqueue_burst(p->ring,
|
|
|
|
(void **) (p->tx_buf + nb_tx), p->tx_buf_count - nb_tx);
|
|
|
|
|
|
|
|
/* We sent all the packets in more than one try */
|
2016-03-02 21:19:58 +00:00
|
|
|
if (nb_tx >= p->tx_buf_count) {
|
|
|
|
p->tx_buf_count = 0;
|
2015-10-28 13:30:43 +00:00
|
|
|
return;
|
2016-03-02 21:19:58 +00:00
|
|
|
}
|
2015-10-28 13:30:43 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* We didn't send the packets in maximum allowed attempts */
|
|
|
|
RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_DROP_ADD(p, p->tx_buf_count - nb_tx);
|
|
|
|
for ( ; nb_tx < p->tx_buf_count; nb_tx++)
|
|
|
|
rte_pktmbuf_free(p->tx_buf[nb_tx]);
|
|
|
|
|
|
|
|
p->tx_buf_count = 0;
|
|
|
|
}
|
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_nodrop_tx(void *port, struct rte_mbuf *pkt)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer_nodrop *p =
|
|
|
|
(struct rte_port_ring_writer_nodrop *) port;
|
|
|
|
|
|
|
|
p->tx_buf[p->tx_buf_count++] = pkt;
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_IN_ADD(p, 1);
|
2015-05-21 12:28:44 +00:00
|
|
|
if (p->tx_buf_count >= p->tx_burst_sz)
|
|
|
|
send_burst_nodrop(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
2015-10-28 13:30:43 +00:00
|
|
|
rte_port_ring_multi_writer_nodrop_tx(void *port, struct rte_mbuf *pkt)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer_nodrop *p =
|
|
|
|
(struct rte_port_ring_writer_nodrop *) port;
|
|
|
|
|
|
|
|
p->tx_buf[p->tx_buf_count++] = pkt;
|
|
|
|
RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_IN_ADD(p, 1);
|
|
|
|
if (p->tx_buf_count >= p->tx_burst_sz)
|
|
|
|
send_burst_mp_nodrop(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int __attribute__((always_inline))
|
|
|
|
rte_port_ring_writer_nodrop_tx_bulk_internal(void *port,
|
2015-05-21 12:28:44 +00:00
|
|
|
struct rte_mbuf **pkts,
|
2015-10-28 13:30:43 +00:00
|
|
|
uint64_t pkts_mask,
|
|
|
|
uint32_t is_multi)
|
2015-05-21 12:28:44 +00:00
|
|
|
{
|
|
|
|
struct rte_port_ring_writer_nodrop *p =
|
|
|
|
(struct rte_port_ring_writer_nodrop *) port;
|
|
|
|
|
2016-04-11 17:54:46 +00:00
|
|
|
uint64_t bsz_mask = p->bsz_mask;
|
2015-05-21 12:28:44 +00:00
|
|
|
uint32_t tx_buf_count = p->tx_buf_count;
|
|
|
|
uint64_t expr = (pkts_mask & (pkts_mask + 1)) |
|
|
|
|
((pkts_mask & bsz_mask) ^ bsz_mask);
|
|
|
|
|
|
|
|
if (expr == 0) {
|
|
|
|
uint64_t n_pkts = __builtin_popcountll(pkts_mask);
|
|
|
|
uint32_t n_pkts_ok;
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
if (tx_buf_count) {
|
|
|
|
if (is_multi)
|
|
|
|
send_burst_mp_nodrop(p);
|
|
|
|
else
|
|
|
|
send_burst_nodrop(p);
|
|
|
|
}
|
2015-05-21 12:28:44 +00:00
|
|
|
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_IN_ADD(p, n_pkts);
|
2015-10-28 13:30:43 +00:00
|
|
|
if (is_multi)
|
|
|
|
n_pkts_ok =
|
|
|
|
rte_ring_mp_enqueue_burst(p->ring, (void **)pkts, n_pkts);
|
|
|
|
else
|
|
|
|
n_pkts_ok =
|
|
|
|
rte_ring_sp_enqueue_burst(p->ring, (void **)pkts, n_pkts);
|
2015-05-21 12:28:44 +00:00
|
|
|
|
|
|
|
if (n_pkts_ok >= n_pkts)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
/*
|
2015-10-28 13:30:43 +00:00
|
|
|
* If we didn't manage to send all packets in single burst, move
|
2015-05-21 12:28:44 +00:00
|
|
|
* remaining packets to the buffer and call send burst.
|
|
|
|
*/
|
|
|
|
for (; n_pkts_ok < n_pkts; n_pkts_ok++) {
|
|
|
|
struct rte_mbuf *pkt = pkts[n_pkts_ok];
|
2015-10-28 13:30:43 +00:00
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
p->tx_buf[p->tx_buf_count++] = pkt;
|
|
|
|
}
|
2015-10-28 13:30:43 +00:00
|
|
|
if (is_multi)
|
|
|
|
send_burst_mp_nodrop(p);
|
|
|
|
else
|
|
|
|
send_burst_nodrop(p);
|
2015-05-21 12:28:44 +00:00
|
|
|
} else {
|
|
|
|
for ( ; pkts_mask; ) {
|
|
|
|
uint32_t pkt_index = __builtin_ctzll(pkts_mask);
|
|
|
|
uint64_t pkt_mask = 1LLU << pkt_index;
|
|
|
|
struct rte_mbuf *pkt = pkts[pkt_index];
|
|
|
|
|
|
|
|
p->tx_buf[tx_buf_count++] = pkt;
|
2015-06-19 09:41:19 +00:00
|
|
|
RTE_PORT_RING_WRITER_NODROP_STATS_PKTS_IN_ADD(p, 1);
|
2015-05-21 12:28:44 +00:00
|
|
|
pkts_mask &= ~pkt_mask;
|
|
|
|
}
|
|
|
|
|
|
|
|
p->tx_buf_count = tx_buf_count;
|
2015-10-28 13:30:43 +00:00
|
|
|
if (tx_buf_count >= p->tx_burst_sz) {
|
|
|
|
if (is_multi)
|
|
|
|
send_burst_mp_nodrop(p);
|
|
|
|
else
|
|
|
|
send_burst_nodrop(p);
|
|
|
|
}
|
2015-05-21 12:28:44 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_nodrop_tx_bulk(void *port,
|
|
|
|
struct rte_mbuf **pkts,
|
|
|
|
uint64_t pkts_mask)
|
|
|
|
{
|
|
|
|
return
|
|
|
|
rte_port_ring_writer_nodrop_tx_bulk_internal(port, pkts, pkts_mask, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
rte_port_ring_multi_writer_nodrop_tx_bulk(void *port,
|
|
|
|
struct rte_mbuf **pkts,
|
|
|
|
uint64_t pkts_mask)
|
|
|
|
{
|
|
|
|
return
|
|
|
|
rte_port_ring_writer_nodrop_tx_bulk_internal(port, pkts, pkts_mask, 1);
|
|
|
|
}
|
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_nodrop_flush(void *port)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer_nodrop *p =
|
|
|
|
(struct rte_port_ring_writer_nodrop *) port;
|
|
|
|
|
|
|
|
if (p->tx_buf_count > 0)
|
|
|
|
send_burst_nodrop(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_multi_writer_nodrop_flush(void *port)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer_nodrop *p =
|
|
|
|
(struct rte_port_ring_writer_nodrop *) port;
|
|
|
|
|
|
|
|
if (p->tx_buf_count > 0)
|
|
|
|
send_burst_mp_nodrop(p);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_nodrop_free(void *port)
|
|
|
|
{
|
2015-10-28 13:30:43 +00:00
|
|
|
struct rte_port_ring_writer_nodrop *p =
|
|
|
|
(struct rte_port_ring_writer_nodrop *) port;
|
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
if (port == NULL) {
|
|
|
|
RTE_LOG(ERR, PORT, "%s: Port is NULL\n", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2015-10-28 13:30:43 +00:00
|
|
|
if (p->is_multi)
|
|
|
|
rte_port_ring_multi_writer_nodrop_flush(port);
|
|
|
|
else
|
|
|
|
rte_port_ring_writer_nodrop_flush(port);
|
|
|
|
|
2015-05-21 12:28:44 +00:00
|
|
|
rte_free(port);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-06-19 09:41:19 +00:00
|
|
|
static int
|
|
|
|
rte_port_ring_writer_nodrop_stats_read(void *port,
|
|
|
|
struct rte_port_out_stats *stats, int clear)
|
|
|
|
{
|
|
|
|
struct rte_port_ring_writer_nodrop *p =
|
|
|
|
(struct rte_port_ring_writer_nodrop *) port;
|
|
|
|
|
|
|
|
if (stats != NULL)
|
|
|
|
memcpy(stats, &p->stats, sizeof(p->stats));
|
|
|
|
|
|
|
|
if (clear)
|
|
|
|
memset(&p->stats, 0, sizeof(p->stats));
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-06-04 18:08:21 +00:00
|
|
|
/*
|
|
|
|
* Summary of port operations
|
|
|
|
*/
|
|
|
|
struct rte_port_in_ops rte_port_ring_reader_ops = {
|
|
|
|
.f_create = rte_port_ring_reader_create,
|
|
|
|
.f_free = rte_port_ring_reader_free,
|
|
|
|
.f_rx = rte_port_ring_reader_rx,
|
2015-06-19 09:41:19 +00:00
|
|
|
.f_stats = rte_port_ring_reader_stats_read,
|
2014-06-04 18:08:21 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
struct rte_port_out_ops rte_port_ring_writer_ops = {
|
|
|
|
.f_create = rte_port_ring_writer_create,
|
|
|
|
.f_free = rte_port_ring_writer_free,
|
|
|
|
.f_tx = rte_port_ring_writer_tx,
|
|
|
|
.f_tx_bulk = rte_port_ring_writer_tx_bulk,
|
|
|
|
.f_flush = rte_port_ring_writer_flush,
|
2015-06-19 09:41:19 +00:00
|
|
|
.f_stats = rte_port_ring_writer_stats_read,
|
2014-06-04 18:08:21 +00:00
|
|
|
};
|
2015-05-21 12:28:44 +00:00
|
|
|
|
|
|
|
struct rte_port_out_ops rte_port_ring_writer_nodrop_ops = {
|
|
|
|
.f_create = rte_port_ring_writer_nodrop_create,
|
|
|
|
.f_free = rte_port_ring_writer_nodrop_free,
|
|
|
|
.f_tx = rte_port_ring_writer_nodrop_tx,
|
|
|
|
.f_tx_bulk = rte_port_ring_writer_nodrop_tx_bulk,
|
|
|
|
.f_flush = rte_port_ring_writer_nodrop_flush,
|
2015-06-19 09:41:19 +00:00
|
|
|
.f_stats = rte_port_ring_writer_nodrop_stats_read,
|
2015-05-21 12:28:44 +00:00
|
|
|
};
|
2015-10-28 13:30:43 +00:00
|
|
|
|
|
|
|
struct rte_port_in_ops rte_port_ring_multi_reader_ops = {
|
|
|
|
.f_create = rte_port_ring_multi_reader_create,
|
|
|
|
.f_free = rte_port_ring_reader_free,
|
|
|
|
.f_rx = rte_port_ring_multi_reader_rx,
|
|
|
|
.f_stats = rte_port_ring_reader_stats_read,
|
|
|
|
};
|
|
|
|
|
|
|
|
struct rte_port_out_ops rte_port_ring_multi_writer_ops = {
|
|
|
|
.f_create = rte_port_ring_multi_writer_create,
|
|
|
|
.f_free = rte_port_ring_writer_free,
|
|
|
|
.f_tx = rte_port_ring_multi_writer_tx,
|
|
|
|
.f_tx_bulk = rte_port_ring_multi_writer_tx_bulk,
|
|
|
|
.f_flush = rte_port_ring_multi_writer_flush,
|
|
|
|
.f_stats = rte_port_ring_writer_stats_read,
|
|
|
|
};
|
|
|
|
|
|
|
|
struct rte_port_out_ops rte_port_ring_multi_writer_nodrop_ops = {
|
|
|
|
.f_create = rte_port_ring_multi_writer_nodrop_create,
|
|
|
|
.f_free = rte_port_ring_writer_nodrop_free,
|
|
|
|
.f_tx = rte_port_ring_multi_writer_nodrop_tx,
|
|
|
|
.f_tx_bulk = rte_port_ring_multi_writer_nodrop_tx_bulk,
|
|
|
|
.f_flush = rte_port_ring_multi_writer_nodrop_flush,
|
|
|
|
.f_stats = rte_port_ring_writer_nodrop_stats_read,
|
|
|
|
};
|