[ceph.git] / ceph / src / spdk / dpdk / app / test-pmd / softnicfwd.c

/* SPDX-License-Identifier: BSD-3-Clause
 * Copyright(c) 2017 Intel Corporation
 */
#include <stdio.h>
#include <sys/stat.h>

#include <rte_cycles.h>
#include <rte_mbuf.h>
#include <rte_malloc.h>
#include <rte_ethdev.h>
#include <rte_flow.h>
#include <rte_meter.h>
#include <rte_eth_softnic.h>
#include <rte_tm.h>

#include "testpmd.h"

#define SUBPORT_NODES_PER_PORT		1
#define PIPE_NODES_PER_SUBPORT		4096
#define TC_NODES_PER_PIPE			4
#define QUEUE_NODES_PER_TC			4

#define NUM_PIPE_NODES						\
	(SUBPORT_NODES_PER_PORT * PIPE_NODES_PER_SUBPORT)

#define NUM_TC_NODES						\
	(NUM_PIPE_NODES * TC_NODES_PER_PIPE)

#define ROOT_NODE_ID				1000000
#define SUBPORT_NODES_START_ID		900000
#define PIPE_NODES_START_ID			800000
#define TC_NODES_START_ID			700000

#define STATS_MASK_DEFAULT					\
	(RTE_TM_STATS_N_PKTS |					\
	RTE_TM_STATS_N_BYTES |					\
	RTE_TM_STATS_N_PKTS_GREEN_DROPPED |			\
	RTE_TM_STATS_N_BYTES_GREEN_DROPPED)

#define STATS_MASK_QUEUE					\
	(STATS_MASK_DEFAULT |					\
	RTE_TM_STATS_N_PKTS_QUEUED)

#define BYTES_IN_MBPS				(1000 * 1000 / 8)
#define TOKEN_BUCKET_SIZE			1000000

/* TM Hierarchy Levels */
enum tm_hierarchy_level {
	TM_NODE_LEVEL_PORT = 0,
	TM_NODE_LEVEL_SUBPORT,
	TM_NODE_LEVEL_PIPE,
	TM_NODE_LEVEL_TC,
	TM_NODE_LEVEL_QUEUE,
	TM_NODE_LEVEL_MAX,
};

struct tm_hierarchy {
	/* TM Nodes */
	uint32_t root_node_id;
	uint32_t subport_node_id[SUBPORT_NODES_PER_PORT];
	uint32_t pipe_node_id[SUBPORT_NODES_PER_PORT][PIPE_NODES_PER_SUBPORT];
	uint32_t tc_node_id[NUM_PIPE_NODES][TC_NODES_PER_PIPE];
	uint32_t queue_node_id[NUM_TC_NODES][QUEUE_NODES_PER_TC];

	/* TM Hierarchy Nodes Shaper Rates */
	uint32_t root_node_shaper_rate;
	uint32_t subport_node_shaper_rate;
	uint32_t pipe_node_shaper_rate;
	uint32_t tc_node_shaper_rate;
	uint32_t tc_node_shared_shaper_rate;

	uint32_t n_shapers;
};

static struct fwd_lcore *softnic_fwd_lcore;
static uint16_t softnic_port_id;
struct fwd_engine softnic_fwd_engine;

/*
 * Softnic packet forward
 */
static void
softnic_fwd(struct fwd_stream *fs)
{
	struct rte_mbuf *pkts_burst[MAX_PKT_BURST];
	uint16_t nb_rx;
	uint16_t nb_tx;
	uint32_t retry;

#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
	uint64_t start_tsc;
	uint64_t end_tsc;
	uint64_t core_cycles;
#endif

#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
	start_tsc = rte_rdtsc();
#endif

	/*  Packets Receive */
	nb_rx = rte_eth_rx_burst(fs->rx_port, fs->rx_queue,
			pkts_burst, nb_pkt_per_burst);
	fs->rx_packets += nb_rx;

#ifdef RTE_TEST_PMD_RECORD_BURST_STATS
	fs->rx_burst_stats.pkt_burst_spread[nb_rx]++;
#endif

	nb_tx = rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
			pkts_burst, nb_rx);

	/* Retry if necessary */
	if (unlikely(nb_tx < nb_rx) && fs->retry_enabled) {
		retry = 0;
		while (nb_tx < nb_rx && retry++ < burst_tx_retry_num) {
			rte_delay_us(burst_tx_delay_time);
			nb_tx += rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
					&pkts_burst[nb_tx], nb_rx - nb_tx);
		}
	}
	fs->tx_packets += nb_tx;

#ifdef RTE_TEST_PMD_RECORD_BURST_STATS
	fs->tx_burst_stats.pkt_burst_spread[nb_tx]++;
#endif

	if (unlikely(nb_tx < nb_rx)) {
		fs->fwd_dropped += (nb_rx - nb_tx);
		do {
			rte_pktmbuf_free(pkts_burst[nb_tx]);
		} while (++nb_tx < nb_rx);
	}
#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
	end_tsc = rte_rdtsc();
	core_cycles = (end_tsc - start_tsc);
	fs->core_cycles = (uint64_t) (fs->core_cycles + core_cycles);
#endif
}

static void
softnic_fwd_run(struct fwd_stream *fs)
{
	rte_pmd_softnic_run(softnic_port_id);
	softnic_fwd(fs);
}

/**
 * Softnic init
 */
static int
softnic_begin(void *arg __rte_unused)
{
	for (;;) {
		if (!softnic_fwd_lcore->stopped)
			break;
	}

	do {
		/* Run softnic */
		rte_pmd_softnic_run(softnic_port_id);
	} while (!softnic_fwd_lcore->stopped);

	return 0;
}

static void
set_tm_hiearchy_nodes_shaper_rate(portid_t port_id,
	struct tm_hierarchy *h)
{
	struct rte_eth_link link_params;
	uint64_t tm_port_rate;

	memset(&link_params, 0, sizeof(link_params));

	rte_eth_link_get(port_id, &link_params);
	tm_port_rate = (uint64_t)ETH_SPEED_NUM_10G * BYTES_IN_MBPS;

	/* Set tm hierarchy shapers rate */
	h->root_node_shaper_rate = tm_port_rate;
	h->subport_node_shaper_rate =
		tm_port_rate / SUBPORT_NODES_PER_PORT;
	h->pipe_node_shaper_rate
		= h->subport_node_shaper_rate / PIPE_NODES_PER_SUBPORT;
	h->tc_node_shaper_rate = h->pipe_node_shaper_rate;
	h->tc_node_shared_shaper_rate = h->subport_node_shaper_rate;
}

static int
softport_tm_root_node_add(portid_t port_id, struct tm_hierarchy *h,
	struct rte_tm_error *error)
{
	struct rte_tm_node_params rnp;
	struct rte_tm_shaper_params rsp;
	uint32_t priority, weight, level_id, shaper_profile_id;

	memset(&rsp, 0, sizeof(struct rte_tm_shaper_params));
	memset(&rnp, 0, sizeof(struct rte_tm_node_params));

	/* Shaper profile Parameters */
	rsp.peak.rate = h->root_node_shaper_rate;
	rsp.peak.size = TOKEN_BUCKET_SIZE;
	rsp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;
	shaper_profile_id = 0;

	if (rte_tm_shaper_profile_add(port_id, shaper_profile_id,
		&rsp, error)) {
		printf("%s ERROR(%d)-%s!(shaper_id %u)\n ",
			__func__, error->type, error->message,
			shaper_profile_id);
		return -1;
	}

	/* Root Node Parameters */
	h->root_node_id = ROOT_NODE_ID;
	weight = 1;
	priority = 0;
	level_id = TM_NODE_LEVEL_PORT;
	rnp.shaper_profile_id = shaper_profile_id;
	rnp.nonleaf.n_sp_priorities = 1;
	rnp.stats_mask = STATS_MASK_DEFAULT;

	/* Add Node to TM Hierarchy */
	if (rte_tm_node_add(port_id, h->root_node_id, RTE_TM_NODE_ID_NULL,
		priority, weight, level_id, &rnp, error)) {
		printf("%s ERROR(%d)-%s!(node_id %u, parent_id %u, level %u)\n",
			__func__, error->type, error->message,
			h->root_node_id, RTE_TM_NODE_ID_NULL,
			level_id);
		return -1;
	}
	/* Update */
	h->n_shapers++;

	printf("  Root node added (Start id %u, Count %u, level %u)\n",
		h->root_node_id, 1, level_id);

	return 0;
}

static int
softport_tm_subport_node_add(portid_t port_id,
	struct tm_hierarchy *h,
	struct rte_tm_error *error)
{
	uint32_t subport_parent_node_id, subport_node_id = 0;
	struct rte_tm_node_params snp;
	struct rte_tm_shaper_params ssp;
	uint32_t priority, weight, level_id, shaper_profile_id;
	uint32_t i;

	memset(&ssp, 0, sizeof(struct rte_tm_shaper_params));
	memset(&snp, 0, sizeof(struct rte_tm_node_params));

	shaper_profile_id = h->n_shapers;

	/* Add Shaper Profile to TM Hierarchy */
	for (i = 0; i < SUBPORT_NODES_PER_PORT; i++) {
		ssp.peak.rate = h->subport_node_shaper_rate;
		ssp.peak.size = TOKEN_BUCKET_SIZE;
		ssp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;

		if (rte_tm_shaper_profile_add(port_id, shaper_profile_id,
			&ssp, error)) {
			printf("%s ERROR(%d)-%s!(shaper_id %u)\n ",
				__func__, error->type, error->message,
				shaper_profile_id);
			return -1;
		}

		/* Node Parameters */
		h->subport_node_id[i] = SUBPORT_NODES_START_ID + i;
		subport_parent_node_id = h->root_node_id;
		weight = 1;
		priority = 0;
		level_id = TM_NODE_LEVEL_SUBPORT;
		snp.shaper_profile_id = shaper_profile_id;
		snp.nonleaf.n_sp_priorities = 1;
		snp.stats_mask = STATS_MASK_DEFAULT;

		/* Add Node to TM Hiearchy */
		if (rte_tm_node_add(port_id,
				h->subport_node_id[i],
				subport_parent_node_id,
				priority, weight,
				level_id,
				&snp,
				error)) {
			printf("%s ERROR(%d)-%s!(node %u,parent %u,level %u)\n",
					__func__,
					error->type,
					error->message,
					h->subport_node_id[i],
					subport_parent_node_id,
					level_id);
			return -1;
		}
		shaper_profile_id++;
		subport_node_id++;
	}
	/* Update */
	h->n_shapers = shaper_profile_id;

	printf("  Subport nodes added (Start id %u, Count %u, level %u)\n",
		h->subport_node_id[0], SUBPORT_NODES_PER_PORT, level_id);

	return 0;
}

static int
softport_tm_pipe_node_add(portid_t port_id,
	struct tm_hierarchy *h,
	struct rte_tm_error *error)
{
	uint32_t pipe_parent_node_id;
	struct rte_tm_node_params pnp;
	struct rte_tm_shaper_params psp;
	uint32_t priority, weight, level_id, shaper_profile_id;
	uint32_t i, j;

	memset(&psp, 0, sizeof(struct rte_tm_shaper_params));
	memset(&pnp, 0, sizeof(struct rte_tm_node_params));

	shaper_profile_id = h->n_shapers;

	/* Shaper Profile Parameters */
	psp.peak.rate = h->pipe_node_shaper_rate;
	psp.peak.size = TOKEN_BUCKET_SIZE;
	psp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;

	/* Pipe Node Parameters */
	weight = 1;
	priority = 0;
	level_id = TM_NODE_LEVEL_PIPE;
	pnp.nonleaf.n_sp_priorities = 4;
	pnp.stats_mask = STATS_MASK_DEFAULT;

	/* Add Shaper Profiles and Nodes to TM Hierarchy */
	for (i = 0; i < SUBPORT_NODES_PER_PORT; i++) {
		for (j = 0; j < PIPE_NODES_PER_SUBPORT; j++) {
			if (rte_tm_shaper_profile_add(port_id,
				shaper_profile_id, &psp, error)) {
				printf("%s ERROR(%d)-%s!(shaper_id %u)\n ",
					__func__, error->type, error->message,
					shaper_profile_id);
				return -1;
			}
			pnp.shaper_profile_id = shaper_profile_id;
			pipe_parent_node_id = h->subport_node_id[i];
			h->pipe_node_id[i][j] = PIPE_NODES_START_ID +
				(i * PIPE_NODES_PER_SUBPORT) + j;

			if (rte_tm_node_add(port_id,
					h->pipe_node_id[i][j],
					pipe_parent_node_id,
					priority, weight, level_id,
					&pnp,
					error)) {
				printf("%s ERROR(%d)-%s!(node %u,parent %u )\n",
					__func__,
					error->type,
					error->message,
					h->pipe_node_id[i][j],
					pipe_parent_node_id);

				return -1;
			}
			shaper_profile_id++;
		}
	}
	/* Update */
	h->n_shapers = shaper_profile_id;

	printf("  Pipe nodes added (Start id %u, Count %u, level %u)\n",
		h->pipe_node_id[0][0], NUM_PIPE_NODES, level_id);

	return 0;
}

static int
softport_tm_tc_node_add(portid_t port_id,
	struct tm_hierarchy *h,
	struct rte_tm_error *error)
{
	uint32_t tc_parent_node_id;
	struct rte_tm_node_params tnp;
	struct rte_tm_shaper_params tsp, tssp;
	uint32_t shared_shaper_profile_id[TC_NODES_PER_PIPE];
	uint32_t priority, weight, level_id, shaper_profile_id;
	uint32_t pos, n_tc_nodes, i, j, k;

	memset(&tsp, 0, sizeof(struct rte_tm_shaper_params));
	memset(&tssp, 0, sizeof(struct rte_tm_shaper_params));
	memset(&tnp, 0, sizeof(struct rte_tm_node_params));

	shaper_profile_id = h->n_shapers;

	/* Private Shaper Profile (TC) Parameters */
	tsp.peak.rate = h->tc_node_shaper_rate;
	tsp.peak.size = TOKEN_BUCKET_SIZE;
	tsp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;

	/* Shared Shaper Profile (TC) Parameters */
	tssp.peak.rate = h->tc_node_shared_shaper_rate;
	tssp.peak.size = TOKEN_BUCKET_SIZE;
	tssp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;

	/* TC Node Parameters */
	weight = 1;
	level_id = TM_NODE_LEVEL_TC;
	tnp.n_shared_shapers = 1;
	tnp.nonleaf.n_sp_priorities = 1;
	tnp.stats_mask = STATS_MASK_DEFAULT;

	/* Add Shared Shaper Profiles to TM Hierarchy */
	for (i = 0; i < TC_NODES_PER_PIPE; i++) {
		shared_shaper_profile_id[i] = shaper_profile_id;

		if (rte_tm_shaper_profile_add(port_id,
			shared_shaper_profile_id[i], &tssp, error)) {
			printf("%s ERROR(%d)-%s!(Shared shaper profileid %u)\n",
				__func__, error->type, error->message,
				shared_shaper_profile_id[i]);

			return -1;
		}
		if (rte_tm_shared_shaper_add_update(port_id,  i,
			shared_shaper_profile_id[i], error)) {
			printf("%s ERROR(%d)-%s!(Shared shaper id %u)\n",
				__func__, error->type, error->message, i);

			return -1;
		}
		shaper_profile_id++;
	}

	/* Add Shaper Profiles and Nodes to TM Hierarchy */
	n_tc_nodes = 0;
	for (i = 0; i < SUBPORT_NODES_PER_PORT; i++) {
		for (j = 0; j < PIPE_NODES_PER_SUBPORT; j++) {
			for (k = 0; k < TC_NODES_PER_PIPE ; k++) {
				priority = k;
				tc_parent_node_id = h->pipe_node_id[i][j];
				tnp.shared_shaper_id =
					(uint32_t *)calloc(1, sizeof(uint32_t));
				if (tnp.shared_shaper_id == NULL) {
					printf("Shared shaper mem alloc err\n");
					return -1;
				}
				tnp.shared_shaper_id[0] = k;
				pos = j + (i * PIPE_NODES_PER_SUBPORT);
				h->tc_node_id[pos][k] =
					TC_NODES_START_ID + n_tc_nodes;

				if (rte_tm_shaper_profile_add(port_id,
					shaper_profile_id, &tsp, error)) {
					printf("%s ERROR(%d)-%s!(shaper %u)\n",
						__func__, error->type,
						error->message,
						shaper_profile_id);

					free(tnp.shared_shaper_id);
					return -1;
				}
				tnp.shaper_profile_id = shaper_profile_id;
				if (rte_tm_node_add(port_id,
						h->tc_node_id[pos][k],
						tc_parent_node_id,
						priority, weight,
						level_id,
						&tnp, error)) {
					printf("%s ERROR(%d)-%s!(node id %u)\n",
						__func__,
						error->type,
						error->message,
						h->tc_node_id[pos][k]);

					free(tnp.shared_shaper_id);
					return -1;
				}
				shaper_profile_id++;
				n_tc_nodes++;
			}
		}
	}
	/* Update */
	h->n_shapers = shaper_profile_id;

	printf("  TC nodes added (Start id %u, Count %u, level %u)\n",
		h->tc_node_id[0][0], n_tc_nodes, level_id);

	return 0;
}

static int
softport_tm_queue_node_add(portid_t port_id, struct tm_hierarchy *h,
	struct rte_tm_error *error)
{
	uint32_t queue_parent_node_id;
	struct rte_tm_node_params qnp;
	uint32_t priority, weight, level_id, pos;
	uint32_t n_queue_nodes, i, j, k;

	memset(&qnp, 0, sizeof(struct rte_tm_node_params));

	/* Queue Node Parameters */
	priority = 0;
	weight = 1;
	level_id = TM_NODE_LEVEL_QUEUE;
	qnp.shaper_profile_id = RTE_TM_SHAPER_PROFILE_ID_NONE;
	qnp.leaf.cman = RTE_TM_CMAN_TAIL_DROP;
	qnp.stats_mask = STATS_MASK_QUEUE;

	/* Add Queue Nodes to TM Hierarchy */
	n_queue_nodes = 0;
	for (i = 0; i < NUM_PIPE_NODES; i++) {
		for (j = 0; j < TC_NODES_PER_PIPE; j++) {
			queue_parent_node_id = h->tc_node_id[i][j];
			for (k = 0; k < QUEUE_NODES_PER_TC; k++) {
				pos = j + (i * TC_NODES_PER_PIPE);
				h->queue_node_id[pos][k] = n_queue_nodes;
				if (rte_tm_node_add(port_id,
						h->queue_node_id[pos][k],
						queue_parent_node_id,
						priority,
						weight,
						level_id,
						&qnp, error)) {
					printf("%s ERROR(%d)-%s!(node %u)\n",
						__func__,
						error->type,
						error->message,
						h->queue_node_id[pos][k]);

					return -1;
				}
				n_queue_nodes++;
			}
		}
	}
	printf("  Queue nodes added (Start id %u, Count %u, level %u)\n",
		h->queue_node_id[0][0], n_queue_nodes, level_id);

	return 0;
}

static int
softport_tm_hierarchy_specify(portid_t port_id,
	struct rte_tm_error *error)
{

	struct tm_hierarchy h;
	int status;

	memset(&h, 0, sizeof(struct tm_hierarchy));

	/* TM hierarchy shapers rate */
	set_tm_hiearchy_nodes_shaper_rate(port_id, &h);

	/* Add root node (level 0) */
	status = softport_tm_root_node_add(port_id, &h, error);
	if (status)
		return status;

	/* Add subport node (level 1) */
	status = softport_tm_subport_node_add(port_id, &h, error);
	if (status)
		return status;

	/* Add pipe nodes (level 2) */
	status = softport_tm_pipe_node_add(port_id, &h, error);
	if (status)
		return status;

	/* Add traffic class nodes (level 3) */
	status = softport_tm_tc_node_add(port_id, &h, error);
	if (status)
		return status;

	/* Add queue nodes (level 4) */
	status = softport_tm_queue_node_add(port_id, &h, error);
	if (status)
		return status;

	return 0;
}

/*
 * Softnic TM default configuration
 */
static void
softnic_tm_default_config(portid_t pi)
{
	struct rte_port *port = &ports[pi];
	struct rte_tm_error error;
	int status;

	/* Stop port */
	rte_eth_dev_stop(pi);

	/* TM hierarchy specification */
	status = softport_tm_hierarchy_specify(pi, &error);
	if (status) {
		printf("  TM Hierarchy built error(%d) - %s\n",
			error.type, error.message);
		return;
	}
	printf("\n  TM Hierarchy Specified!\n");

	/* TM hierarchy commit */
	status = rte_tm_hierarchy_commit(pi, 0, &error);
	if (status) {
		printf("  Hierarchy commit error(%d) - %s\n",
			error.type, error.message);
		return;
	}
	printf("  Hierarchy Committed (port %u)!\n", pi);

	/* Start port */
	status = rte_eth_dev_start(pi);
	if (status) {
		printf("\n  Port %u start error!\n", pi);
		return;
	}

	/* Reset the default hierarchy flag */
	port->softport.default_tm_hierarchy_enable = 0;
}

/*
 * Softnic forwarding init
 */
static void
softnic_fwd_begin(portid_t pi)
{
	struct rte_port *port = &ports[pi];
	uint32_t lcore, fwd_core_present = 0, softnic_run_launch = 0;
	int	status;

	softnic_fwd_lcore = port->softport.fwd_lcore_arg[0];
	softnic_port_id = pi;

	/* Launch softnic_run function on lcores */
	for (lcore = 0; lcore < RTE_MAX_LCORE; lcore++) {
		if (!rte_lcore_is_enabled(lcore))
			continue;

		if (lcore == rte_get_master_lcore())
			continue;

		if (fwd_core_present == 0) {
			fwd_core_present++;
			continue;
		}

		status = rte_eal_remote_launch(softnic_begin, NULL, lcore);
		if (status)
			printf("softnic launch on lcore %u failed (%d)\n",
				       lcore, status);

		softnic_run_launch = 1;
	}

	if (!softnic_run_launch)
		softnic_fwd_engine.packet_fwd = softnic_fwd_run;

	/* Softnic TM default configuration */
	if (port->softport.default_tm_hierarchy_enable == 1)
		softnic_tm_default_config(pi);
}

struct fwd_engine softnic_fwd_engine = {
	.fwd_mode_name  = "softnic",
	.port_fwd_begin = softnic_fwd_begin,
	.port_fwd_end   = NULL,
	.packet_fwd     = softnic_fwd,
};
Commit	Line	Data
11fdf7f2 TL	1	/* SPDX-License-Identifier: BSD-3-Clause
	2	* Copyright(c) 2017 Intel Corporation
	3	*/
	4	#include <stdio.h>
	5	#include <sys/stat.h>
	6
	7	#include <rte_cycles.h>
	8	#include <rte_mbuf.h>
	9	#include <rte_malloc.h>
	10	#include <rte_ethdev.h>
	11	#include <rte_flow.h>
	12	#include <rte_meter.h>
	13	#include <rte_eth_softnic.h>
	14	#include <rte_tm.h>
	15
	16	#include "testpmd.h"
	17
	18	#define SUBPORT_NODES_PER_PORT 1
	19	#define PIPE_NODES_PER_SUBPORT 4096
	20	#define TC_NODES_PER_PIPE 4
	21	#define QUEUE_NODES_PER_TC 4
	22
	23	#define NUM_PIPE_NODES \
	24	(SUBPORT_NODES_PER_PORT * PIPE_NODES_PER_SUBPORT)
	25
	26	#define NUM_TC_NODES \
	27	(NUM_PIPE_NODES * TC_NODES_PER_PIPE)
	28
	29	#define ROOT_NODE_ID 1000000
	30	#define SUBPORT_NODES_START_ID 900000
	31	#define PIPE_NODES_START_ID 800000
	32	#define TC_NODES_START_ID 700000
	33
	34	#define STATS_MASK_DEFAULT \
	35	(RTE_TM_STATS_N_PKTS \| \
	36	RTE_TM_STATS_N_BYTES \| \
	37	RTE_TM_STATS_N_PKTS_GREEN_DROPPED \| \
	38	RTE_TM_STATS_N_BYTES_GREEN_DROPPED)
	39
	40	#define STATS_MASK_QUEUE \
	41	(STATS_MASK_DEFAULT \| \
	42	RTE_TM_STATS_N_PKTS_QUEUED)
	43
	44	#define BYTES_IN_MBPS (1000 * 1000 / 8)
	45	#define TOKEN_BUCKET_SIZE 1000000
	46
	47	/* TM Hierarchy Levels */
	48	enum tm_hierarchy_level {
	49	TM_NODE_LEVEL_PORT = 0,
	50	TM_NODE_LEVEL_SUBPORT,
	51	TM_NODE_LEVEL_PIPE,
	52	TM_NODE_LEVEL_TC,
	53	TM_NODE_LEVEL_QUEUE,
	54	TM_NODE_LEVEL_MAX,
	55	};
	56
	57	struct tm_hierarchy {
	58	/* TM Nodes */
	59	uint32_t root_node_id;
	60	uint32_t subport_node_id[SUBPORT_NODES_PER_PORT];
	61	uint32_t pipe_node_id[SUBPORT_NODES_PER_PORT][PIPE_NODES_PER_SUBPORT];
	62	uint32_t tc_node_id[NUM_PIPE_NODES][TC_NODES_PER_PIPE];
	63	uint32_t queue_node_id[NUM_TC_NODES][QUEUE_NODES_PER_TC];
	64
65	/* TM Hierarchy Nodes Shaper Rates */
66	uint32_t root_node_shaper_rate;
67	uint32_t subport_node_shaper_rate;
68	uint32_t pipe_node_shaper_rate;
69	uint32_t tc_node_shaper_rate;
70	uint32_t tc_node_shared_shaper_rate;
71
72	uint32_t n_shapers;
73	};
74
75	static struct fwd_lcore *softnic_fwd_lcore;
76	static uint16_t softnic_port_id;
77	struct fwd_engine softnic_fwd_engine;
78
79	/*
80	* Softnic packet forward
81	*/
82	static void
83	softnic_fwd(struct fwd_stream *fs)
84	{
85	struct rte_mbuf *pkts_burst[MAX_PKT_BURST];
86	uint16_t nb_rx;
87	uint16_t nb_tx;
88	uint32_t retry;
89
90	#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
91	uint64_t start_tsc;
92	uint64_t end_tsc;
93	uint64_t core_cycles;
94	#endif
95
96	#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
97	start_tsc = rte_rdtsc();
98	#endif
99
100	/* Packets Receive */
101	nb_rx = rte_eth_rx_burst(fs->rx_port, fs->rx_queue,
102	pkts_burst, nb_pkt_per_burst);
103	fs->rx_packets += nb_rx;
104
105	#ifdef RTE_TEST_PMD_RECORD_BURST_STATS
106	fs->rx_burst_stats.pkt_burst_spread[nb_rx]++;
107	#endif
108
109	nb_tx = rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
110	pkts_burst, nb_rx);
111
112	/* Retry if necessary */
113	if (unlikely(nb_tx < nb_rx) && fs->retry_enabled) {
114	retry = 0;
115	while (nb_tx < nb_rx && retry++ < burst_tx_retry_num) {
116	rte_delay_us(burst_tx_delay_time);
117	nb_tx += rte_eth_tx_burst(fs->tx_port, fs->tx_queue,
118	&pkts_burst[nb_tx], nb_rx - nb_tx);
119	}
120	}
121	fs->tx_packets += nb_tx;
122
123	#ifdef RTE_TEST_PMD_RECORD_BURST_STATS
124	fs->tx_burst_stats.pkt_burst_spread[nb_tx]++;
125	#endif
126
127	if (unlikely(nb_tx < nb_rx)) {
128	fs->fwd_dropped += (nb_rx - nb_tx);
129	do {
130	rte_pktmbuf_free(pkts_burst[nb_tx]);
131	} while (++nb_tx < nb_rx);
132	}
133	#ifdef RTE_TEST_PMD_RECORD_CORE_CYCLES
134	end_tsc = rte_rdtsc();
135	core_cycles = (end_tsc - start_tsc);
136	fs->core_cycles = (uint64_t) (fs->core_cycles + core_cycles);
137	#endif
138	}
139
140	static void
141	softnic_fwd_run(struct fwd_stream *fs)
142	{
143	rte_pmd_softnic_run(softnic_port_id);
144	softnic_fwd(fs);
145	}
146
147	/**
148	* Softnic init
149	*/
150	static int
151	softnic_begin(void *arg __rte_unused)
152	{
153	for (;;) {
154	if (!softnic_fwd_lcore->stopped)
155	break;
156	}
157
158	do {
159	/* Run softnic */
160	rte_pmd_softnic_run(softnic_port_id);
161	} while (!softnic_fwd_lcore->stopped);
162
163	return 0;
164	}
165
166	static void
167	set_tm_hiearchy_nodes_shaper_rate(portid_t port_id,
168	struct tm_hierarchy *h)
169	{
170	struct rte_eth_link link_params;
171	uint64_t tm_port_rate;
172
173	memset(&link_params, 0, sizeof(link_params));
174
175	rte_eth_link_get(port_id, &link_params);
176	tm_port_rate = (uint64_t)ETH_SPEED_NUM_10G * BYTES_IN_MBPS;
177
178	/* Set tm hierarchy shapers rate */
179	h->root_node_shaper_rate = tm_port_rate;
180	h->subport_node_shaper_rate =
181	tm_port_rate / SUBPORT_NODES_PER_PORT;
182	h->pipe_node_shaper_rate
183	= h->subport_node_shaper_rate / PIPE_NODES_PER_SUBPORT;
184	h->tc_node_shaper_rate = h->pipe_node_shaper_rate;
185	h->tc_node_shared_shaper_rate = h->subport_node_shaper_rate;
186	}
187
188	static int
189	softport_tm_root_node_add(portid_t port_id, struct tm_hierarchy *h,
190	struct rte_tm_error *error)
191	{
192	struct rte_tm_node_params rnp;
193	struct rte_tm_shaper_params rsp;
194	uint32_t priority, weight, level_id, shaper_profile_id;
195
196	memset(&rsp, 0, sizeof(struct rte_tm_shaper_params));
197	memset(&rnp, 0, sizeof(struct rte_tm_node_params));
198
199	/* Shaper profile Parameters */
200	rsp.peak.rate = h->root_node_shaper_rate;
201	rsp.peak.size = TOKEN_BUCKET_SIZE;
202	rsp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;
203	shaper_profile_id = 0;
204
205	if (rte_tm_shaper_profile_add(port_id, shaper_profile_id,
206	&rsp, error)) {
207	printf("%s ERROR(%d)-%s!(shaper_id %u)\n ",
208	__func__, error->type, error->message,
209	shaper_profile_id);
210	return -1;
211	}
212
213	/* Root Node Parameters */
214	h->root_node_id = ROOT_NODE_ID;
215	weight = 1;
216	priority = 0;
217	level_id = TM_NODE_LEVEL_PORT;
218	rnp.shaper_profile_id = shaper_profile_id;
219	rnp.nonleaf.n_sp_priorities = 1;
220	rnp.stats_mask = STATS_MASK_DEFAULT;
221
222	/* Add Node to TM Hierarchy */
223	if (rte_tm_node_add(port_id, h->root_node_id, RTE_TM_NODE_ID_NULL,
224	priority, weight, level_id, &rnp, error)) {
225	printf("%s ERROR(%d)-%s!(node_id %u, parent_id %u, level %u)\n",
226	__func__, error->type, error->message,
227	h->root_node_id, RTE_TM_NODE_ID_NULL,
228	level_id);
229	return -1;
230	}
231	/* Update */
232	h->n_shapers++;
233
234	printf(" Root node added (Start id %u, Count %u, level %u)\n",
235	h->root_node_id, 1, level_id);
236
237	return 0;
238	}
239
240	static int
241	softport_tm_subport_node_add(portid_t port_id,
242	struct tm_hierarchy *h,
243	struct rte_tm_error *error)
244	{
245	uint32_t subport_parent_node_id, subport_node_id = 0;
246	struct rte_tm_node_params snp;
247	struct rte_tm_shaper_params ssp;
248	uint32_t priority, weight, level_id, shaper_profile_id;
249	uint32_t i;
250
251	memset(&ssp, 0, sizeof(struct rte_tm_shaper_params));
252	memset(&snp, 0, sizeof(struct rte_tm_node_params));
253
254	shaper_profile_id = h->n_shapers;
255
256	/* Add Shaper Profile to TM Hierarchy */
257	for (i = 0; i < SUBPORT_NODES_PER_PORT; i++) {
258	ssp.peak.rate = h->subport_node_shaper_rate;
259	ssp.peak.size = TOKEN_BUCKET_SIZE;
260	ssp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;
261
262	if (rte_tm_shaper_profile_add(port_id, shaper_profile_id,
263	&ssp, error)) {
264	printf("%s ERROR(%d)-%s!(shaper_id %u)\n ",
265	__func__, error->type, error->message,
266	shaper_profile_id);
267	return -1;
268	}
269
270	/* Node Parameters */
271	h->subport_node_id[i] = SUBPORT_NODES_START_ID + i;
272	subport_parent_node_id = h->root_node_id;
273	weight = 1;
274	priority = 0;
275	level_id = TM_NODE_LEVEL_SUBPORT;
276	snp.shaper_profile_id = shaper_profile_id;
277	snp.nonleaf.n_sp_priorities = 1;
278	snp.stats_mask = STATS_MASK_DEFAULT;
279
280	/* Add Node to TM Hiearchy */
281	if (rte_tm_node_add(port_id,
282	h->subport_node_id[i],
283	subport_parent_node_id,
284	priority, weight,
285	level_id,
286	&snp,
287	error)) {
288	printf("%s ERROR(%d)-%s!(node %u,parent %u,level %u)\n",
289	__func__,
290	error->type,
291	error->message,
292	h->subport_node_id[i],
293	subport_parent_node_id,
294	level_id);
295	return -1;
296	}
297	shaper_profile_id++;
298	subport_node_id++;
299	}
300	/* Update */
301	h->n_shapers = shaper_profile_id;
302
303	printf(" Subport nodes added (Start id %u, Count %u, level %u)\n",
304	h->subport_node_id[0], SUBPORT_NODES_PER_PORT, level_id);
305
306	return 0;
307	}
308
309	static int
310	softport_tm_pipe_node_add(portid_t port_id,
311	struct tm_hierarchy *h,
312	struct rte_tm_error *error)
313	{
314	uint32_t pipe_parent_node_id;
315	struct rte_tm_node_params pnp;
316	struct rte_tm_shaper_params psp;
317	uint32_t priority, weight, level_id, shaper_profile_id;
318	uint32_t i, j;
319
320	memset(&psp, 0, sizeof(struct rte_tm_shaper_params));
321	memset(&pnp, 0, sizeof(struct rte_tm_node_params));
322
323	shaper_profile_id = h->n_shapers;
324
325	/* Shaper Profile Parameters */
326	psp.peak.rate = h->pipe_node_shaper_rate;
327	psp.peak.size = TOKEN_BUCKET_SIZE;
328	psp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;
329
330	/* Pipe Node Parameters */
331	weight = 1;
332	priority = 0;
333	level_id = TM_NODE_LEVEL_PIPE;
334	pnp.nonleaf.n_sp_priorities = 4;
335	pnp.stats_mask = STATS_MASK_DEFAULT;
336
337	/* Add Shaper Profiles and Nodes to TM Hierarchy */
338	for (i = 0; i < SUBPORT_NODES_PER_PORT; i++) {
339	for (j = 0; j < PIPE_NODES_PER_SUBPORT; j++) {
340	if (rte_tm_shaper_profile_add(port_id,
341	shaper_profile_id, &psp, error)) {
342	printf("%s ERROR(%d)-%s!(shaper_id %u)\n ",
343	__func__, error->type, error->message,
344	shaper_profile_id);
345	return -1;
346	}
347	pnp.shaper_profile_id = shaper_profile_id;
348	pipe_parent_node_id = h->subport_node_id[i];
349	h->pipe_node_id[i][j] = PIPE_NODES_START_ID +
350	(i * PIPE_NODES_PER_SUBPORT) + j;
351
352	if (rte_tm_node_add(port_id,
353	h->pipe_node_id[i][j],
354	pipe_parent_node_id,
355	priority, weight, level_id,
356	&pnp,
357	error)) {
358	printf("%s ERROR(%d)-%s!(node %u,parent %u )\n",
359	__func__,
360	error->type,
361	error->message,
362	h->pipe_node_id[i][j],
363	pipe_parent_node_id);
364
365	return -1;
366	}
367	shaper_profile_id++;
368	}
369	}
370	/* Update */
371	h->n_shapers = shaper_profile_id;
372
373	printf(" Pipe nodes added (Start id %u, Count %u, level %u)\n",
374	h->pipe_node_id[0][0], NUM_PIPE_NODES, level_id);
375
376	return 0;
377	}
378
379	static int
380	softport_tm_tc_node_add(portid_t port_id,
381	struct tm_hierarchy *h,
382	struct rte_tm_error *error)
383	{
384	uint32_t tc_parent_node_id;
385	struct rte_tm_node_params tnp;
386	struct rte_tm_shaper_params tsp, tssp;
387	uint32_t shared_shaper_profile_id[TC_NODES_PER_PIPE];
388	uint32_t priority, weight, level_id, shaper_profile_id;
389	uint32_t pos, n_tc_nodes, i, j, k;
390
391	memset(&tsp, 0, sizeof(struct rte_tm_shaper_params));
392	memset(&tssp, 0, sizeof(struct rte_tm_shaper_params));
393	memset(&tnp, 0, sizeof(struct rte_tm_node_params));
394
395	shaper_profile_id = h->n_shapers;
396
397	/* Private Shaper Profile (TC) Parameters */
398	tsp.peak.rate = h->tc_node_shaper_rate;
399	tsp.peak.size = TOKEN_BUCKET_SIZE;
400	tsp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;
401
402	/* Shared Shaper Profile (TC) Parameters */
403	tssp.peak.rate = h->tc_node_shared_shaper_rate;
404	tssp.peak.size = TOKEN_BUCKET_SIZE;
405	tssp.pkt_length_adjust = RTE_TM_ETH_FRAMING_OVERHEAD_FCS;
406
407	/* TC Node Parameters */
408	weight = 1;
409	level_id = TM_NODE_LEVEL_TC;
410	tnp.n_shared_shapers = 1;
411	tnp.nonleaf.n_sp_priorities = 1;
412	tnp.stats_mask = STATS_MASK_DEFAULT;
413
414	/* Add Shared Shaper Profiles to TM Hierarchy */
415	for (i = 0; i < TC_NODES_PER_PIPE; i++) {
416	shared_shaper_profile_id[i] = shaper_profile_id;
417
418	if (rte_tm_shaper_profile_add(port_id,
419	shared_shaper_profile_id[i], &tssp, error)) {
420	printf("%s ERROR(%d)-%s!(Shared shaper profileid %u)\n",
421	__func__, error->type, error->message,
422	shared_shaper_profile_id[i]);
423
424	return -1;
425	}
426	if (rte_tm_shared_shaper_add_update(port_id, i,
427	shared_shaper_profile_id[i], error)) {
428	printf("%s ERROR(%d)-%s!(Shared shaper id %u)\n",
429	__func__, error->type, error->message, i);
430
431	return -1;
432	}
433	shaper_profile_id++;
434	}
435
436	/* Add Shaper Profiles and Nodes to TM Hierarchy */
437	n_tc_nodes = 0;
438	for (i = 0; i < SUBPORT_NODES_PER_PORT; i++) {
439	for (j = 0; j < PIPE_NODES_PER_SUBPORT; j++) {
440	for (k = 0; k < TC_NODES_PER_PIPE ; k++) {
441	priority = k;
442	tc_parent_node_id = h->pipe_node_id[i][j];
443	tnp.shared_shaper_id =
444	(uint32_t *)calloc(1, sizeof(uint32_t));
445	if (tnp.shared_shaper_id == NULL) {
446	printf("Shared shaper mem alloc err\n");
447	return -1;
448	}
449	tnp.shared_shaper_id[0] = k;
450	pos = j + (i * PIPE_NODES_PER_SUBPORT);
451	h->tc_node_id[pos][k] =
452	TC_NODES_START_ID + n_tc_nodes;
453
454	if (rte_tm_shaper_profile_add(port_id,
455	shaper_profile_id, &tsp, error)) {
456	printf("%s ERROR(%d)-%s!(shaper %u)\n",
457	__func__, error->type,
458	error->message,
459	shaper_profile_id);
460
9f95a23c	461	free(tnp.shared_shaper_id);
11fdf7f2 TL	462	return -1;
	463	}
	464	tnp.shaper_profile_id = shaper_profile_id;
	465	if (rte_tm_node_add(port_id,
	466	h->tc_node_id[pos][k],
	467	tc_parent_node_id,
	468	priority, weight,
	469	level_id,
	470	&tnp, error)) {
	471	printf("%s ERROR(%d)-%s!(node id %u)\n",
	472	__func__,
	473	error->type,
	474	error->message,
	475	h->tc_node_id[pos][k]);
	476
9f95a23c	477	free(tnp.shared_shaper_id);
11fdf7f2 TL	478	return -1;
	479	}
	480	shaper_profile_id++;
	481	n_tc_nodes++;
	482	}
	483	}
	484	}
	485	/* Update */
	486	h->n_shapers = shaper_profile_id;
	487
	488	printf(" TC nodes added (Start id %u, Count %u, level %u)\n",
	489	h->tc_node_id[0][0], n_tc_nodes, level_id);
	490
	491	return 0;
	492	}
	493
	494	static int
	495	softport_tm_queue_node_add(portid_t port_id, struct tm_hierarchy *h,
	496	struct rte_tm_error *error)
	497	{
	498	uint32_t queue_parent_node_id;
	499	struct rte_tm_node_params qnp;
	500	uint32_t priority, weight, level_id, pos;
	501	uint32_t n_queue_nodes, i, j, k;
	502
	503	memset(&qnp, 0, sizeof(struct rte_tm_node_params));
	504
	505	/* Queue Node Parameters */
	506	priority = 0;
	507	weight = 1;
	508	level_id = TM_NODE_LEVEL_QUEUE;
	509	qnp.shaper_profile_id = RTE_TM_SHAPER_PROFILE_ID_NONE;
	510	qnp.leaf.cman = RTE_TM_CMAN_TAIL_DROP;
	511	qnp.stats_mask = STATS_MASK_QUEUE;
	512
	513	/* Add Queue Nodes to TM Hierarchy */
	514	n_queue_nodes = 0;
	515	for (i = 0; i < NUM_PIPE_NODES; i++) {
	516	for (j = 0; j < TC_NODES_PER_PIPE; j++) {
	517	queue_parent_node_id = h->tc_node_id[i][j];
	518	for (k = 0; k < QUEUE_NODES_PER_TC; k++) {
	519	pos = j + (i * TC_NODES_PER_PIPE);
	520	h->queue_node_id[pos][k] = n_queue_nodes;
	521	if (rte_tm_node_add(port_id,
	522	h->queue_node_id[pos][k],
	523	queue_parent_node_id,
	524	priority,
	525	weight,
	526	level_id,
	527	&qnp, error)) {
	528	printf("%s ERROR(%d)-%s!(node %u)\n",
	529	__func__,
	530	error->type,
	531	error->message,
	532	h->queue_node_id[pos][k]);
	533
	534	return -1;
	535	}
	536	n_queue_nodes++;
	537	}
	538	}
	539	}
	540	printf(" Queue nodes added (Start id %u, Count %u, level %u)\n",
	541	h->queue_node_id[0][0], n_queue_nodes, level_id);
542
543	return 0;
544	}
545
546	static int
547	softport_tm_hierarchy_specify(portid_t port_id,
548	struct rte_tm_error *error)
549	{
550
551	struct tm_hierarchy h;
552	int status;
553
554	memset(&h, 0, sizeof(struct tm_hierarchy));
555
556	/* TM hierarchy shapers rate */
557	set_tm_hiearchy_nodes_shaper_rate(port_id, &h);
558
559	/* Add root node (level 0) */
560	status = softport_tm_root_node_add(port_id, &h, error);
561	if (status)
562	return status;
563
564	/* Add subport node (level 1) */
565	status = softport_tm_subport_node_add(port_id, &h, error);
566	if (status)
567	return status;
568
569	/* Add pipe nodes (level 2) */
570	status = softport_tm_pipe_node_add(port_id, &h, error);
571	if (status)
572	return status;
573
574	/* Add traffic class nodes (level 3) */
575	status = softport_tm_tc_node_add(port_id, &h, error);
576	if (status)
577	return status;
578
579	/* Add queue nodes (level 4) */
580	status = softport_tm_queue_node_add(port_id, &h, error);
581	if (status)
582	return status;
583
584	return 0;
585	}
586
587	/*
588	* Softnic TM default configuration
589	*/
590	static void
591	softnic_tm_default_config(portid_t pi)
592	{
593	struct rte_port *port = &ports[pi];
594	struct rte_tm_error error;
595	int status;
596
597	/* Stop port */
598	rte_eth_dev_stop(pi);
599
600	/* TM hierarchy specification */
601	status = softport_tm_hierarchy_specify(pi, &error);
602	if (status) {
603	printf(" TM Hierarchy built error(%d) - %s\n",
604	error.type, error.message);
605	return;
606	}
607	printf("\n TM Hierarchy Specified!\n");
608
609	/* TM hierarchy commit */
610	status = rte_tm_hierarchy_commit(pi, 0, &error);
611	if (status) {
612	printf(" Hierarchy commit error(%d) - %s\n",
613	error.type, error.message);
614	return;
615	}
616	printf(" Hierarchy Committed (port %u)!\n", pi);
617
618	/* Start port */
619	status = rte_eth_dev_start(pi);
620	if (status) {
621	printf("\n Port %u start error!\n", pi);
622	return;
623	}
624
625	/* Reset the default hierarchy flag */
626	port->softport.default_tm_hierarchy_enable = 0;
627	}
628
629	/*
630	* Softnic forwarding init
631	*/
632	static void
633	softnic_fwd_begin(portid_t pi)
634	{
635	struct rte_port *port = &ports[pi];
636	uint32_t lcore, fwd_core_present = 0, softnic_run_launch = 0;
637	int status;
638
639	softnic_fwd_lcore = port->softport.fwd_lcore_arg[0];
640	softnic_port_id = pi;
641
642	/* Launch softnic_run function on lcores */
643	for (lcore = 0; lcore < RTE_MAX_LCORE; lcore++) {
644	if (!rte_lcore_is_enabled(lcore))
645	continue;
646
647	if (lcore == rte_get_master_lcore())
648	continue;
649
650	if (fwd_core_present == 0) {
651	fwd_core_present++;
652	continue;
653	}
654
655	status = rte_eal_remote_launch(softnic_begin, NULL, lcore);
656	if (status)
657	printf("softnic launch on lcore %u failed (%d)\n",
658	lcore, status);
659
660	softnic_run_launch = 1;
661	}
662
663	if (!softnic_run_launch)
664	softnic_fwd_engine.packet_fwd = softnic_fwd_run;
665
666	/* Softnic TM default configuration */
667	if (port->softport.default_tm_hierarchy_enable == 1)
668	softnic_tm_default_config(pi);
669	}
670
671	struct fwd_engine softnic_fwd_engine = {
672	.fwd_mode_name = "softnic",
673	.port_fwd_begin = softnic_fwd_begin,
674	.port_fwd_end = NULL,
675	.packet_fwd = softnic_fwd,
676	};