load_balancer/runtime.c

/*-
 *   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 <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <inttypes.h>
#include <sys/types.h>
#include <string.h>
#include <sys/queue.h>
#include <stdarg.h>
#include <errno.h>
#include <getopt.h>

#include <rte_common.h>
#include <rte_byteorder.h>
#include <rte_log.h>
#include <rte_memory.h>
#include <rte_memcpy.h>
#include <rte_memzone.h>
#include <rte_eal.h>
#include <rte_per_lcore.h>
#include <rte_launch.h>
#include <rte_atomic.h>
#include <rte_cycles.h>
#include <rte_prefetch.h>
#include <rte_lcore.h>
#include <rte_per_lcore.h>
#include <rte_branch_prediction.h>
#include <rte_interrupts.h>
#include <rte_pci.h>
#include <rte_random.h>
#include <rte_debug.h>
#include <rte_ether.h>
#include <rte_ethdev.h>
#include <rte_ring.h>
#include <rte_mempool.h>
#include <rte_mbuf.h>
#include <rte_ip.h>
#include <rte_tcp.h>
#include <rte_lpm.h>

#include "main.h"

#ifndef APP_LCORE_IO_FLUSH
#define APP_LCORE_IO_FLUSH           1000000
#endif

#ifndef APP_LCORE_WORKER_FLUSH
#define APP_LCORE_WORKER_FLUSH       1000000
#endif

#ifndef APP_STATS
#define APP_STATS                    1000000
#endif

#define APP_IO_RX_DROP_ALL_PACKETS   0
#define APP_WORKER_DROP_ALL_PACKETS  0
#define APP_IO_TX_DROP_ALL_PACKETS   0

#ifndef APP_IO_RX_PREFETCH_ENABLE
#define APP_IO_RX_PREFETCH_ENABLE    1
#endif

#ifndef APP_WORKER_PREFETCH_ENABLE
#define APP_WORKER_PREFETCH_ENABLE   1
#endif

#ifndef APP_IO_TX_PREFETCH_ENABLE
#define APP_IO_TX_PREFETCH_ENABLE    1
#endif

#if APP_IO_RX_PREFETCH_ENABLE
#define APP_IO_RX_PREFETCH0(p)       rte_prefetch0(p)
#define APP_IO_RX_PREFETCH1(p)       rte_prefetch1(p)
#else
#define APP_IO_RX_PREFETCH0(p)
#define APP_IO_RX_PREFETCH1(p)
#endif

#if APP_WORKER_PREFETCH_ENABLE
#define APP_WORKER_PREFETCH0(p)      rte_prefetch0(p)
#define APP_WORKER_PREFETCH1(p)      rte_prefetch1(p)
#else
#define APP_WORKER_PREFETCH0(p)
#define APP_WORKER_PREFETCH1(p)
#endif

#if APP_IO_TX_PREFETCH_ENABLE
#define APP_IO_TX_PREFETCH0(p)       rte_prefetch0(p)
#define APP_IO_TX_PREFETCH1(p)       rte_prefetch1(p)
#else
#define APP_IO_TX_PREFETCH0(p)
#define APP_IO_TX_PREFETCH1(p)
#endif

static inline void
app_lcore_io_rx_buffer_to_send (
        struct app_lcore_params_io *lp,
        uint32_t worker,
        struct rte_mbuf *mbuf,
        uint32_t bsz)
{
        uint32_t pos;
        int ret;

        pos = lp->rx.mbuf_out[worker].n_mbufs;
        lp->rx.mbuf_out[worker].array[pos ++] = mbuf;
        if (likely(pos < bsz)) {
                lp->rx.mbuf_out[worker].n_mbufs = pos;
                return;
        }

        ret = rte_ring_sp_enqueue_bulk(
                lp->rx.rings[worker],
                (void **) lp->rx.mbuf_out[worker].array,
                bsz);

        if (unlikely(ret == -ENOBUFS)) {
                uint32_t k;
                for (k = 0; k < bsz; k ++) {
                        struct rte_mbuf *m = lp->rx.mbuf_out[worker].array[k];
                        rte_pktmbuf_free(m);
                }
        }

        lp->rx.mbuf_out[worker].n_mbufs = 0;
        lp->rx.mbuf_out_flush[worker] = 0;

#if APP_STATS
        lp->rx.rings_iters[worker] ++;
        if (likely(ret == 0)) {
                lp->rx.rings_count[worker] ++;
        }
        if (unlikely(lp->rx.rings_iters[worker] == APP_STATS)) {
                unsigned lcore = rte_lcore_id();

                printf("\tI/O RX %u out (worker %u): enq success rate = %.2f\n",
                        lcore,
                        (unsigned)worker,
                        ((double) lp->rx.rings_count[worker]) / ((double) lp->rx.rings_iters[worker]));
                lp->rx.rings_iters[worker] = 0;
                lp->rx.rings_count[worker] = 0;
        }
#endif
}

static inline void
app_lcore_io_rx(
        struct app_lcore_params_io *lp,
        uint32_t n_workers,
        uint32_t bsz_rd,
        uint32_t bsz_wr,
        uint8_t pos_lb)
{
        struct rte_mbuf *mbuf_1_0, *mbuf_1_1, *mbuf_2_0, *mbuf_2_1;
        uint8_t *data_1_0, *data_1_1 = NULL;
        uint32_t i;

        for (i = 0; i < lp->rx.n_nic_queues; i ++) {
                uint8_t port = lp->rx.nic_queues[i].port;
                uint8_t queue = lp->rx.nic_queues[i].queue;
                uint32_t n_mbufs, j;

                n_mbufs = rte_eth_rx_burst(
                        port,
                        queue,
                        lp->rx.mbuf_in.array,
                        (uint16_t) bsz_rd);

                if (unlikely(n_mbufs == 0)) {
                        continue;
                }

#if APP_STATS
                lp->rx.nic_queues_iters[i] ++;
                lp->rx.nic_queues_count[i] += n_mbufs;
                if (unlikely(lp->rx.nic_queues_iters[i] == APP_STATS)) {
                        struct rte_eth_stats stats;
                        unsigned lcore = rte_lcore_id();

                        rte_eth_stats_get(port, &stats);

                        printf("I/O RX %u in (NIC port %u): NIC drop ratio = %.2f avg burst size = %.2f\n",
                                lcore,
                                (unsigned) port,
                                (double) stats.imissed / (double) (stats.imissed + stats.ipackets),
                                ((double) lp->rx.nic_queues_count[i]) / ((double) lp->rx.nic_queues_iters[i]));
                        lp->rx.nic_queues_iters[i] = 0;
                        lp->rx.nic_queues_count[i] = 0;
                }
#endif

#if APP_IO_RX_DROP_ALL_PACKETS
                for (j = 0; j < n_mbufs; j ++) {
                        struct rte_mbuf *pkt = lp->rx.mbuf_in.array[j];
                        rte_pktmbuf_free(pkt);
                }

                continue;
#endif

                mbuf_1_0 = lp->rx.mbuf_in.array[0];
                mbuf_1_1 = lp->rx.mbuf_in.array[1];
                data_1_0 = rte_pktmbuf_mtod(mbuf_1_0, uint8_t *);
                if (likely(n_mbufs > 1)) {
                        data_1_1 = rte_pktmbuf_mtod(mbuf_1_1, uint8_t *);
                }

                mbuf_2_0 = lp->rx.mbuf_in.array[2];
                mbuf_2_1 = lp->rx.mbuf_in.array[3];
                APP_IO_RX_PREFETCH0(mbuf_2_0);
                APP_IO_RX_PREFETCH0(mbuf_2_1);

                for (j = 0; j + 3 < n_mbufs; j += 2) {
                        struct rte_mbuf *mbuf_0_0, *mbuf_0_1;
                        uint8_t *data_0_0, *data_0_1;
                        uint32_t worker_0, worker_1;

                        mbuf_0_0 = mbuf_1_0;
                        mbuf_0_1 = mbuf_1_1;
                        data_0_0 = data_1_0;
                        data_0_1 = data_1_1;

                        mbuf_1_0 = mbuf_2_0;
                        mbuf_1_1 = mbuf_2_1;
                        data_1_0 = rte_pktmbuf_mtod(mbuf_2_0, uint8_t *);
                        data_1_1 = rte_pktmbuf_mtod(mbuf_2_1, uint8_t *);
                        APP_IO_RX_PREFETCH0(data_1_0);
                        APP_IO_RX_PREFETCH0(data_1_1);

                        mbuf_2_0 = lp->rx.mbuf_in.array[j+4];
                        mbuf_2_1 = lp->rx.mbuf_in.array[j+5];
                        APP_IO_RX_PREFETCH0(mbuf_2_0);
                        APP_IO_RX_PREFETCH0(mbuf_2_1);

                        worker_0 = data_0_0[pos_lb] & (n_workers - 1);
                        worker_1 = data_0_1[pos_lb] & (n_workers - 1);

                        app_lcore_io_rx_buffer_to_send(lp, worker_0, mbuf_0_0, bsz_wr);
                        app_lcore_io_rx_buffer_to_send(lp, worker_1, mbuf_0_1, bsz_wr);
                }

                /* Handle the last 1, 2 (when n_mbufs is even) or 3 (when n_mbufs is odd) packets  */
                for ( ; j < n_mbufs; j += 1) {
                        struct rte_mbuf *mbuf;
                        uint8_t *data;
                        uint32_t worker;

                        mbuf = mbuf_1_0;
                        mbuf_1_0 = mbuf_1_1;
                        mbuf_1_1 = mbuf_2_0;
                        mbuf_2_0 = mbuf_2_1;

                        data = rte_pktmbuf_mtod(mbuf, uint8_t *);

                        APP_IO_RX_PREFETCH0(mbuf_1_0);

                        worker = data[pos_lb] & (n_workers - 1);

                        app_lcore_io_rx_buffer_to_send(lp, worker, mbuf, bsz_wr);
                }
        }
}

static inline void
app_lcore_io_rx_flush(struct app_lcore_params_io *lp, uint32_t n_workers)
{
        uint32_t worker;

        for (worker = 0; worker < n_workers; worker ++) {
                int ret;

                if (likely((lp->rx.mbuf_out_flush[worker] == 0) ||
                           (lp->rx.mbuf_out[worker].n_mbufs == 0))) {
                        lp->rx.mbuf_out_flush[worker] = 1;
                        continue;
                }

                ret = rte_ring_sp_enqueue_bulk(
                        lp->rx.rings[worker],
                        (void **) lp->rx.mbuf_out[worker].array,
                        lp->rx.mbuf_out[worker].n_mbufs);

                if (unlikely(ret < 0)) {
                        uint32_t k;
                        for (k = 0; k < lp->rx.mbuf_out[worker].n_mbufs; k ++) {
                                struct rte_mbuf *pkt_to_free = lp->rx.mbuf_out[worker].array[k];
                                rte_pktmbuf_free(pkt_to_free);
                        }
                }

                lp->rx.mbuf_out[worker].n_mbufs = 0;
                lp->rx.mbuf_out_flush[worker] = 1;
        }
}

static inline void
app_lcore_io_tx(
        struct app_lcore_params_io *lp,
        uint32_t n_workers,
        uint32_t bsz_rd,
        uint32_t bsz_wr)
{
        uint32_t worker;

        for (worker = 0; worker < n_workers; worker ++) {
                uint32_t i;

                for (i = 0; i < lp->tx.n_nic_ports; i ++) {
                        uint8_t port = lp->tx.nic_ports[i];
                        struct rte_ring *ring = lp->tx.rings[port][worker];
                        uint32_t n_mbufs, n_pkts;
                        int ret;

                        n_mbufs = lp->tx.mbuf_out[port].n_mbufs;
                        ret = rte_ring_sc_dequeue_bulk(
                                ring,
                                (void **) &lp->tx.mbuf_out[port].array[n_mbufs],
                                bsz_rd);

                        if (unlikely(ret == -ENOENT)) {
                                continue;
                        }

                        n_mbufs += bsz_rd;

#if APP_IO_TX_DROP_ALL_PACKETS
                        {
                                uint32_t j;
                                APP_IO_TX_PREFETCH0(lp->tx.mbuf_out[port].array[0]);
                                APP_IO_TX_PREFETCH0(lp->tx.mbuf_out[port].array[1]);

                                for (j = 0; j < n_mbufs; j ++) {
                                        if (likely(j < n_mbufs - 2)) {
                                                APP_IO_TX_PREFETCH0(lp->tx.mbuf_out[port].array[j + 2]);
                                        }

                                        rte_pktmbuf_free(lp->tx.mbuf_out[port].array[j]);
                                }

                                lp->tx.mbuf_out[port].n_mbufs = 0;

                                continue;
                        }
#endif

                        if (unlikely(n_mbufs < bsz_wr)) {
                                lp->tx.mbuf_out[port].n_mbufs = n_mbufs;
                                continue;
                        }

                        n_pkts = rte_eth_tx_burst(
                                port,
                                0,
                                lp->tx.mbuf_out[port].array,
                                (uint16_t) n_mbufs);

#if APP_STATS
                        lp->tx.nic_ports_iters[port] ++;
                        lp->tx.nic_ports_count[port] += n_pkts;
                        if (unlikely(lp->tx.nic_ports_iters[port] == APP_STATS)) {
                                unsigned lcore = rte_lcore_id();

                                printf("\t\t\tI/O TX %u out (port %u): avg burst size = %.2f\n",
                                        lcore,
                                        (unsigned) port,
                                        ((double) lp->tx.nic_ports_count[port]) / ((double) lp->tx.nic_ports_iters[port]));
                                lp->tx.nic_ports_iters[port] = 0;
                                lp->tx.nic_ports_count[port] = 0;
                        }
#endif

                        if (unlikely(n_pkts < n_mbufs)) {
                                uint32_t k;
                                for (k = n_pkts; k < n_mbufs; k ++) {
                                        struct rte_mbuf *pkt_to_free = lp->tx.mbuf_out[port].array[k];
                                        rte_pktmbuf_free(pkt_to_free);
                                }
                        }
                        lp->tx.mbuf_out[port].n_mbufs = 0;
                        lp->tx.mbuf_out_flush[port] = 0;
                }
        }
}

static inline void
app_lcore_io_tx_flush(struct app_lcore_params_io *lp)
{
        uint8_t port;

        for (port = 0; port < lp->tx.n_nic_ports; port ++) {
                uint32_t n_pkts;

                if (likely((lp->tx.mbuf_out_flush[port] == 0) ||
                           (lp->tx.mbuf_out[port].n_mbufs == 0))) {
                        lp->tx.mbuf_out_flush[port] = 1;
                        continue;
                }

                n_pkts = rte_eth_tx_burst(
                        port,
                        0,
                        lp->tx.mbuf_out[port].array,
                        (uint16_t) lp->tx.mbuf_out[port].n_mbufs);

                if (unlikely(n_pkts < lp->tx.mbuf_out[port].n_mbufs)) {
                        uint32_t k;
                        for (k = n_pkts; k < lp->tx.mbuf_out[port].n_mbufs; k ++) {
                                struct rte_mbuf *pkt_to_free = lp->tx.mbuf_out[port].array[k];
                                rte_pktmbuf_free(pkt_to_free);
                        }
                }

                lp->tx.mbuf_out[port].n_mbufs = 0;
                lp->tx.mbuf_out_flush[port] = 1;
        }
}

static void
app_lcore_main_loop_io(void)
{
        uint32_t lcore = rte_lcore_id();
        struct app_lcore_params_io *lp = &app.lcore_params[lcore].io;
        uint32_t n_workers = app_get_lcores_worker();
        uint64_t i = 0;

        uint32_t bsz_rx_rd = app.burst_size_io_rx_read;
        uint32_t bsz_rx_wr = app.burst_size_io_rx_write;
        uint32_t bsz_tx_rd = app.burst_size_io_tx_read;
        uint32_t bsz_tx_wr = app.burst_size_io_tx_write;

        uint8_t pos_lb = app.pos_lb;

        for ( ; ; ) {
                if (APP_LCORE_IO_FLUSH && (unlikely(i == APP_LCORE_IO_FLUSH))) {
                        if (likely(lp->rx.n_nic_queues > 0)) {
                                app_lcore_io_rx_flush(lp, n_workers);
                        }

                        if (likely(lp->tx.n_nic_ports > 0)) {
                                app_lcore_io_tx_flush(lp);
                        }

                        i = 0;
                }

                if (likely(lp->rx.n_nic_queues > 0)) {
                        app_lcore_io_rx(lp, n_workers, bsz_rx_rd, bsz_rx_wr, pos_lb);
                }

                if (likely(lp->tx.n_nic_ports > 0)) {
                        app_lcore_io_tx(lp, n_workers, bsz_tx_rd, bsz_tx_wr);
                }

                i ++;
        }
}

static inline void
app_lcore_worker(
        struct app_lcore_params_worker *lp,
        uint32_t bsz_rd,
        uint32_t bsz_wr)
{
        uint32_t i;

        for (i = 0; i < lp->n_rings_in; i ++) {
                struct rte_ring *ring_in = lp->rings_in[i];
                uint32_t j;
                int ret;

                ret = rte_ring_sc_dequeue_bulk(
                        ring_in,
                        (void **) lp->mbuf_in.array,
                        bsz_rd);

                if (unlikely(ret == -ENOENT)) {
                        continue;
                }

#if APP_WORKER_DROP_ALL_PACKETS
                for (j = 0; j < bsz_rd; j ++) {
                        struct rte_mbuf *pkt = lp->mbuf_in.array[j];
                        rte_pktmbuf_free(pkt);
                }

                continue;
#endif

                APP_WORKER_PREFETCH1(rte_pktmbuf_mtod(lp->mbuf_in.array[0], unsigned char *));
                APP_WORKER_PREFETCH0(lp->mbuf_in.array[1]);

                for (j = 0; j < bsz_rd; j ++) {
                        struct rte_mbuf *pkt;
                        struct ipv4_hdr *ipv4_hdr;
                        uint32_t ipv4_dst, pos;
                        uint32_t port;

                        if (likely(j < bsz_rd - 1)) {
                                APP_WORKER_PREFETCH1(rte_pktmbuf_mtod(lp->mbuf_in.array[j+1], unsigned char *));
                        }
                        if (likely(j < bsz_rd - 2)) {
                                APP_WORKER_PREFETCH0(lp->mbuf_in.array[j+2]);
                        }

                        pkt = lp->mbuf_in.array[j];
                        ipv4_hdr = rte_pktmbuf_mtod_offset(pkt,
                                                           struct ipv4_hdr *,
                                                           sizeof(struct ether_hdr));
                        ipv4_dst = rte_be_to_cpu_32(ipv4_hdr->dst_addr);

                        if (unlikely(rte_lpm_lookup(lp->lpm_table, ipv4_dst, &port) != 0)) {
                                port = pkt->port;
                        }

                        pos = lp->mbuf_out[port].n_mbufs;

                        lp->mbuf_out[port].array[pos ++] = pkt;
                        if (likely(pos < bsz_wr)) {
                                lp->mbuf_out[port].n_mbufs = pos;
                                continue;
                        }

                        ret = rte_ring_sp_enqueue_bulk(
                                lp->rings_out[port],
                                (void **) lp->mbuf_out[port].array,
                                bsz_wr);

#if APP_STATS
                        lp->rings_out_iters[port] ++;
                        if (ret == 0) {
                                lp->rings_out_count[port] += 1;
                        }
                        if (lp->rings_out_iters[port] == APP_STATS){
                                printf("\t\tWorker %u out (NIC port %u): enq success rate = %.2f\n",
                                        (unsigned) lp->worker_id,
                                        (unsigned) port,
                                        ((double) lp->rings_out_count[port]) / ((double) lp->rings_out_iters[port]));
                                lp->rings_out_iters[port] = 0;
                                lp->rings_out_count[port] = 0;
                        }
#endif

                        if (unlikely(ret == -ENOBUFS)) {
                                uint32_t k;
                                for (k = 0; k < bsz_wr; k ++) {
                                        struct rte_mbuf *pkt_to_free = lp->mbuf_out[port].array[k];
                                        rte_pktmbuf_free(pkt_to_free);
                                }
                        }

                        lp->mbuf_out[port].n_mbufs = 0;
                        lp->mbuf_out_flush[port] = 0;
                }
        }
}

static inline void
app_lcore_worker_flush(struct app_lcore_params_worker *lp)
{
        uint32_t port;

        for (port = 0; port < APP_MAX_NIC_PORTS; port ++) {
                int ret;

                if (unlikely(lp->rings_out[port] == NULL)) {
                        continue;
                }

                if (likely((lp->mbuf_out_flush[port] == 0) ||
                           (lp->mbuf_out[port].n_mbufs == 0))) {
                        lp->mbuf_out_flush[port] = 1;
                        continue;
                }

                ret = rte_ring_sp_enqueue_bulk(
                        lp->rings_out[port],
                        (void **) lp->mbuf_out[port].array,
                        lp->mbuf_out[port].n_mbufs);

                if (unlikely(ret < 0)) {
                        uint32_t k;
                        for (k = 0; k < lp->mbuf_out[port].n_mbufs; k ++) {
                                struct rte_mbuf *pkt_to_free = lp->mbuf_out[port].array[k];
                                rte_pktmbuf_free(pkt_to_free);
                        }
                }

                lp->mbuf_out[port].n_mbufs = 0;
                lp->mbuf_out_flush[port] = 1;
        }
}

static void
app_lcore_main_loop_worker(void) {
        uint32_t lcore = rte_lcore_id();
        struct app_lcore_params_worker *lp = &app.lcore_params[lcore].worker;
        uint64_t i = 0;

        uint32_t bsz_rd = app.burst_size_worker_read;
        uint32_t bsz_wr = app.burst_size_worker_write;

        for ( ; ; ) {
                if (APP_LCORE_WORKER_FLUSH && (unlikely(i == APP_LCORE_WORKER_FLUSH))) {
                        app_lcore_worker_flush(lp);
                        i = 0;
                }

                app_lcore_worker(lp, bsz_rd, bsz_wr);

                i ++;
        }
}

int
app_lcore_main_loop(__attribute__((unused)) void *arg)
{
        struct app_lcore_params *lp;
        unsigned lcore;

        lcore = rte_lcore_id();
        lp = &app.lcore_params[lcore];

        if (lp->type == e_APP_LCORE_IO) {
                printf("Logical core %u (I/O) main loop.\n", lcore);
                app_lcore_main_loop_io();
        }

        if (lp->type == e_APP_LCORE_WORKER) {
                printf("Logical core %u (worker %u) main loop.\n",
                        lcore,
                        (unsigned) lp->worker.worker_id);
                app_lcore_main_loop_worker();
        }

        return 0;
}