/*-
 *   BSD LICENSE
 *
 *   Copyright(c) 2010-2015 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 <stdint.h>
#include <inttypes.h>
#include <rte_eal.h>
#include <rte_ethdev.h>
#include <rte_cycles.h>
#include <rte_lcore.h>
#include <rte_mbuf.h>

#define RX_RING_SIZE 128
#define TX_RING_SIZE 512

#define NUM_MBUFS 8191
#define MBUF_CACHE_SIZE 250
#define BURST_SIZE 1//32

static const struct rte_eth_conf port_conf_default = {
	.rxmode = { .max_rx_pkt_len = ETHER_MAX_LEN }
};

/* basicfwd.c: Basic DPDK skeleton forwarding example. */

/*
 * Initializes a given port using global settings and with the RX buffers
 * coming from the mbuf_pool passed as a parameter.
 */
static inline int
port_init(uint8_t port, struct rte_mempool *mbuf_pool)
{
	struct rte_eth_conf port_conf = port_conf_default;
	const uint16_t rx_rings = 1, tx_rings = 1;
	int retval;
	uint16_t q;

	if (port >= rte_eth_dev_count())
		return -1;

	/* Configure the Ethernet device. */
	retval = rte_eth_dev_configure(port, rx_rings, tx_rings, &port_conf);
	if (retval != 0)
		return retval;

	/* Allocate and set up 1 RX queue per Ethernet port. */
	for (q = 0; q < rx_rings; q++) {
		retval = rte_eth_rx_queue_setup(port, q, RX_RING_SIZE,
				rte_eth_dev_socket_id(port), NULL, mbuf_pool);
		if (retval < 0)
			return retval;
	}

	/* Allocate and set up 1 TX queue per Ethernet port. */
	for (q = 0; q < tx_rings; q++) {
		retval = rte_eth_tx_queue_setup(port, q, TX_RING_SIZE,
				rte_eth_dev_socket_id(port), NULL);
		if (retval < 0)
			return retval;
	}

	/* Start the Ethernet port. */
	retval = rte_eth_dev_start(port);
	if (retval < 0)
		return retval;

	/* Display the port MAC address. */
	struct ether_addr addr;
	rte_eth_macaddr_get(port, &addr);
	printf("Port %u MAC: %02" PRIx8 " %02" PRIx8 " %02" PRIx8
			   " %02" PRIx8 " %02" PRIx8 " %02" PRIx8 "\n",
			(unsigned)port,
			addr.addr_bytes[0], addr.addr_bytes[1],
			addr.addr_bytes[2], addr.addr_bytes[3],
			addr.addr_bytes[4], addr.addr_bytes[5]);

	return 0;
}



struct payload
{
	int type;
	int index;
	char msg[100];
};

struct eth_header
{
	char dst[6];
	char src[6];
	char protocol[2];
};



/*
 * The lcore main. This is the main thread that does the work, reading from
 * an input port and writing to an output port.
 */
static __attribute__((noreturn)) void
lcore_main(void)
{
	uint8_t src_port = 0, dst_port = 1;
	unsigned int /*ch_index, */data_len;
	unsigned int ready_pkts = 0;
	//unsigned int pkt_index;
	struct rte_mbuf *bufs;
	struct payload ready_payload;
	struct payload* payload_ref;
	struct payload* payload_loc;
	struct eth_header ready_eth_header;
	struct eth_header* eth_header_ref;
	struct eth_header* eth_header_loc;
	struct rte_mempool *mbuf_pool;

	mbuf_pool = rte_pktmbuf_pool_create("MBUF_POOL", NUM_MBUFS,
		MBUF_CACHE_SIZE, 0, RTE_MBUF_DEFAULT_BUF_SIZE, rte_socket_id());

	if (mbuf_pool == NULL)
	{
		rte_exit(EXIT_FAILURE, "Cannot create mbuf pool\n");
	}

	if (port_init(src_port, mbuf_pool) != 0)
	{
		rte_exit(EXIT_FAILURE, "Cannot init port %"PRIu8 "\n",
				src_port);
	}

	if (port_init(dst_port, mbuf_pool) != 0)
	{
		rte_exit(EXIT_FAILURE, "Cannot init port %"PRIu8 "\n",
				dst_port);
	}


	/*
	 * Check that the port is on the same NUMA node as the polling thread
	 * for best performance.
	 */
	 if (rte_eth_dev_socket_id(src_port) > 0 &&
				rte_eth_dev_socket_id(src_port) !=
						(int)rte_socket_id())
	 {
			printf("WARNING, port %u is on remote NUMA node to "
					"polling thread.\n\tPerformance will "
					"not be optimal.\n", src_port);
	}

	printf("\nCore %u forwarding packets. [Ctrl+C to quit]\n",
			rte_lcore_id());




	ready_payload.type = 4;
	ready_payload.index = 546;
	rte_memcpy(ready_payload.msg, "Read Me\n\0", 9);

	ready_eth_header.dst[0] = 255;
	ready_eth_header.dst[1] = 255;
	ready_eth_header.dst[2] = 255;
	ready_eth_header.dst[3] = 255;
	ready_eth_header.dst[4] = 255;
	ready_eth_header.dst[5] = 255;
	ready_eth_header.src[0] = 0;
	ready_eth_header.src[1] = 0;
	ready_eth_header.src[2] = 0;
	ready_eth_header.src[3] = 0;
	ready_eth_header.src[4] = 0;
	ready_eth_header.src[5] = 1;
	ready_eth_header.protocol[0] = 8;
	ready_eth_header.protocol[1] = 0;

	/* Run until the application is quit or killed. */
	for (;;)
	{


			bufs = rte_pktmbuf_alloc(mbuf_pool);
			payload_ref = &ready_payload;
			eth_header_ref = &ready_eth_header;

			if (bufs != NULL)
			{
				eth_header_loc = rte_pktmbuf_append(bufs, sizeof(struct eth_header) + sizeof(struct payload));
				payload_loc = eth_header_loc + sizeof(struct eth_header);//rte_pktmbuf_append(bufs, sizeof(struct eth_header) + sizeof(struct payload));
			}

			rte_memcpy(eth_header_loc, eth_header_ref, sizeof(struct eth_header));
			rte_memcpy(payload_loc, payload_ref, sizeof(struct payload));



		//data_len = bufs[0]->data_len;
		//printf("rx = %d\ndata_len = %u\n", ready_pkts, data_len);




		/* Send burst of TX packets, to second port of pair. */
		const uint16_t nb_tx = rte_eth_tx_burst(dst_port, 0,
				&bufs, BURST_SIZE/*ready_pkts*/);


		/* Free any unsent packets. */
		//if (unlikely(nb_tx < ready_pkts)) {
			//uint16_t buf;
			//for (buf = nb_tx; buf < ready_pkts; buf++)
			//{
				//rte_pktmbuf_free(bufs);
				//}
		//}

		/*if (bufs != NULL)
		{
			memset((bufs->buf_addr + 128), 0, sizeof(struct payload));
			ready_pkts = rte_eth_rx_burst(dst_port, 0,
					&bufs, BURST_SIZE);

			data_len = bufs->data_len;
			printf("rx = %d\ndata_len = %u\n", ready_pkts, data_len);
		}
		else
		{
			printf("null\n");
		}*/
		//sleep(1);

	}
}

/*
 * The main function, which does initialization and calls the per-lcore
 * functions.
 */
int
main(int argc, char *argv[])
{
	//struct rte_mempool *mbuf_pool;
	unsigned nb_ports;
	//uint8_t portid;

	/* Initialize the Environment Abstraction Layer (EAL). */
	int ret = rte_eal_init(argc, argv);
	if (ret < 0)
		rte_exit(EXIT_FAILURE, "Error with EAL initialization\n");

	argc -= ret;
	argv += ret;

	/* Check that there is an even number of ports to send/receive on. */
	nb_ports = rte_eth_dev_count();
	if (nb_ports < 2 || (nb_ports & 1))
		rte_exit(EXIT_FAILURE, "Error: number of ports must be even\n");

	/* Creates a new mempool in memory to hold the mbufs. */
	// mbuf_pool = rte_pktmbuf_pool_create("MBUF_POOL", NUM_MBUFS * nb_ports,
	// 	MBUF_CACHE_SIZE, 0, RTE_MBUF_DEFAULT_BUF_SIZE, rte_socket_id());

	// if (mbuf_pool == NULL)
	// 	rte_exit(EXIT_FAILURE, "Cannot create mbuf pool\n");

	/* Initialize all ports. */
	// for (portid = 0; portid < nb_ports; portid++)
	// 	if (port_init(portid, mbuf_pool) != 0)
	// 		rte_exit(EXIT_FAILURE, "Cannot init port %"PRIu8 "\n",
	// 				portid);

	if (rte_lcore_count() > 1)
		printf("\nWARNING: Too many lcores enabled. Only 1 used.\n");

	/* Call lcore_main on the master core only. */
	lcore_main();

	return 0;
}