remove unused ring includes
[dpdk.git] / examples / l3fwd-power / main.c
index 12e4fd6..b65d683 100644 (file)
@@ -1,7 +1,7 @@
 /*-
  *   BSD LICENSE
  *
- *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
+ *   Copyright(c) 2010-2016 Intel Corporation. All rights reserved.
  *   All rights reserved.
  *
  *   Redistribution and use in source and binary forms, with or without
 #include <rte_common.h>
 #include <rte_byteorder.h>
 #include <rte_log.h>
+#include <rte_malloc.h>
 #include <rte_memory.h>
 #include <rte_memcpy.h>
 #include <rte_memzone.h>
-#include <rte_tailq.h>
 #include <rte_eal.h>
 #include <rte_per_lcore.h>
 #include <rte_launch.h>
@@ -66,7 +66,6 @@
 #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_string_fns.h>
 #include <rte_timer.h>
 #include <rte_power.h>
-
-#include "main.h"
+#include <rte_eal.h>
+#include <rte_spinlock.h>
 
 #define RTE_LOGTYPE_L3FWD_POWER RTE_LOGTYPE_USER1
 
 #define MAX_PKT_BURST 32
 
-#define MIN_ZERO_POLL_COUNT 5
+#define MIN_ZERO_POLL_COUNT 10
 
 /* around 100ms at 2 Ghz */
 #define TIMER_RESOLUTION_CYCLES           200000000ULL
 
 #define MEMPOOL_CACHE_SIZE 256
 
-#define MBUF_SIZE (2048 + sizeof(struct rte_mbuf) + RTE_PKTMBUF_HEADROOM)
-
 /*
  * This expression is used to calculate the number of mbufs needed depending on
  * user input, taking into account memory for rx and tx hardware rings, cache
@@ -158,6 +155,9 @@ static uint16_t nb_txd = RTE_TEST_TX_DESC_DEFAULT;
 /* ethernet addresses of ports */
 static struct ether_addr ports_eth_addr[RTE_MAX_ETHPORTS];
 
+/* ethernet addresses of ports */
+static rte_spinlock_t locks[RTE_MAX_ETHPORTS];
+
 /* mask of enabled ports */
 static uint32_t enabled_port_mask = 0;
 /* Ports set in promiscuous mode off by default. */
@@ -173,11 +173,6 @@ enum freq_scale_hint_t
        FREQ_HIGHEST  =       2
 };
 
-struct mbuf_table {
-       uint16_t len;
-       struct rte_mbuf *m_table[MAX_PKT_BURST];
-};
-
 struct lcore_rx_queue {
        uint8_t port_id;
        uint8_t queue_id;
@@ -190,6 +185,9 @@ struct lcore_rx_queue {
 #define MAX_TX_QUEUE_PER_PORT RTE_MAX_ETHPORTS
 #define MAX_RX_QUEUE_PER_PORT 128
 
+#define MAX_RX_QUEUE_INTERRUPT_PER_PORT 16
+
+
 #define MAX_LCORE_PARAMS 1024
 struct lcore_params {
        uint8_t port_id;
@@ -216,7 +214,7 @@ static uint16_t nb_lcore_params = sizeof(lcore_params_array_default) /
 
 static struct rte_eth_conf port_conf = {
        .rxmode = {
-               .mq_mode        = ETH_MQ_RX_RSS,
+               .mq_mode        = ETH_MQ_RX_RSS,
                .max_rx_pkt_len = ETHER_MAX_LEN,
                .split_hdr_size = 0,
                .header_split   = 0, /**< Header Split disabled */
@@ -228,11 +226,15 @@ static struct rte_eth_conf port_conf = {
        .rx_adv_conf = {
                .rss_conf = {
                        .rss_key = NULL,
-                       .rss_hf = ETH_RSS_IP,
+                       .rss_hf = ETH_RSS_UDP,
                },
        },
        .txmode = {
-               .mq_mode = ETH_DCB_NONE,
+               .mq_mode = ETH_MQ_TX_NONE,
+       },
+       .intr_conf = {
+               .lsc = 1,
+               .rxq = 1,
        },
 };
 
@@ -340,8 +342,10 @@ static lookup_struct_t *ipv4_l3fwd_lookup_struct[NB_SOCKETS];
 struct lcore_conf {
        uint16_t n_rx_queue;
        struct lcore_rx_queue rx_queue_list[MAX_RX_QUEUE_PER_LCORE];
+       uint16_t n_tx_port;
+       uint16_t tx_port_id[RTE_MAX_ETHPORTS];
        uint16_t tx_queue_id[RTE_MAX_ETHPORTS];
-       struct mbuf_table tx_mbufs[RTE_MAX_ETHPORTS];
+       struct rte_eth_dev_tx_buffer *tx_buffer[RTE_MAX_ETHPORTS];
        lookup_struct_t * ipv4_lookup_struct;
        lookup_struct_t * ipv6_lookup_struct;
 } __rte_cache_aligned;
@@ -404,19 +408,22 @@ power_timer_cb(__attribute__((unused)) struct rte_timer *tim,
        /* accumulate total execution time in us when callback is invoked */
        sleep_time_ratio = (float)(stats[lcore_id].sleep_time) /
                                        (float)SCALING_PERIOD;
-
        /**
         * check whether need to scale down frequency a step if it sleep a lot.
         */
-       if (sleep_time_ratio >= SCALING_DOWN_TIME_RATIO_THRESHOLD)
-               rte_power_freq_down(lcore_id);
+       if (sleep_time_ratio >= SCALING_DOWN_TIME_RATIO_THRESHOLD) {
+               if (rte_power_freq_down)
+                       rte_power_freq_down(lcore_id);
+       }
        else if ( (unsigned)(stats[lcore_id].nb_rx_processed /
-               stats[lcore_id].nb_iteration_looped) < MAX_PKT_BURST)
+               stats[lcore_id].nb_iteration_looped) < MAX_PKT_BURST) {
                /**
                 * scale down a step if average packet per iteration less
                 * than expectation.
                 */
-               rte_power_freq_down(lcore_id);
+               if (rte_power_freq_down)
+                       rte_power_freq_down(lcore_id);
+       }
 
        /**
         * initialize another timer according to current frequency to ensure
@@ -432,49 +439,19 @@ power_timer_cb(__attribute__((unused)) struct rte_timer *tim,
        stats[lcore_id].sleep_time = 0;
 }
 
-/* Send burst of packets on an output interface */
-static inline int
-send_burst(struct lcore_conf *qconf, uint16_t n, uint8_t port)
-{
-       struct rte_mbuf **m_table;
-       int ret;
-       uint16_t queueid;
-
-       queueid = qconf->tx_queue_id[port];
-       m_table = (struct rte_mbuf **)qconf->tx_mbufs[port].m_table;
-
-       ret = rte_eth_tx_burst(port, queueid, m_table, n);
-       if (unlikely(ret < n)) {
-               do {
-                       rte_pktmbuf_free(m_table[ret]);
-               } while (++ret < n);
-       }
-
-       return 0;
-}
-
 /* Enqueue a single packet, and send burst if queue is filled */
 static inline int
 send_single_packet(struct rte_mbuf *m, uint8_t port)
 {
        uint32_t lcore_id;
-       uint16_t len;
        struct lcore_conf *qconf;
 
        lcore_id = rte_lcore_id();
-
        qconf = &lcore_conf[lcore_id];
-       len = qconf->tx_mbufs[port].len;
-       qconf->tx_mbufs[port].m_table[len] = m;
-       len++;
-
-       /* enough pkts to be sent */
-       if (unlikely(len == MAX_PKT_BURST)) {
-               send_burst(qconf, MAX_PKT_BURST, port);
-               len = 0;
-       }
 
-       qconf->tx_mbufs[port].len = len;
+       rte_eth_tx_buffer(port, qconf->tx_queue_id[port],
+                       qconf->tx_buffer[port], m);
+
        return 0;
 }
 
@@ -621,7 +598,7 @@ static inline uint8_t
 get_ipv4_dst_port(struct ipv4_hdr *ipv4_hdr, uint8_t portid,
                lookup_struct_t *ipv4_l3fwd_lookup_struct)
 {
-       uint8_t next_hop;
+       uint32_t next_hop;
 
        return (uint8_t) ((rte_lpm_lookup(ipv4_l3fwd_lookup_struct,
                        rte_be_to_cpu_32(ipv4_hdr->dst_addr), &next_hop) == 0)?
@@ -640,11 +617,11 @@ l3fwd_simple_forward(struct rte_mbuf *m, uint8_t portid,
 
        eth_hdr = rte_pktmbuf_mtod(m, struct ether_hdr *);
 
-       if (m->ol_flags & PKT_RX_IPV4_HDR) {
+       if (RTE_ETH_IS_IPV4_HDR(m->packet_type)) {
                /* Handle IPv4 headers.*/
                ipv4_hdr =
-                       (struct ipv4_hdr *)(rte_pktmbuf_mtod(m, unsigned char*)
-                                               sizeof(struct ether_hdr));
+                       rte_pktmbuf_mtod_offset(m, struct ipv4_hdr *,
+                                               sizeof(struct ether_hdr));
 
 #ifdef DO_RFC_1812_CHECKS
                /* Check to make sure the packet is valid (RFC1812) */
@@ -675,15 +652,14 @@ l3fwd_simple_forward(struct rte_mbuf *m, uint8_t portid,
                ether_addr_copy(&ports_eth_addr[dst_port], &eth_hdr->s_addr);
 
                send_single_packet(m, dst_port);
-       }
-       else {
+       } else if (RTE_ETH_IS_IPV6_HDR(m->packet_type)) {
                /* Handle IPv6 headers.*/
 #if (APP_LOOKUP_METHOD == APP_LOOKUP_EXACT_MATCH)
                struct ipv6_hdr *ipv6_hdr;
 
                ipv6_hdr =
-                       (struct ipv6_hdr *)(rte_pktmbuf_mtod(m, unsigned char*)
-                                               sizeof(struct ether_hdr));
+                       rte_pktmbuf_mtod_offset(m, struct ipv6_hdr *,
+                                               sizeof(struct ether_hdr));
 
                dst_port = get_ipv6_dst_port(ipv6_hdr, portid,
                                        qconf->ipv6_lookup_struct);
@@ -705,26 +681,25 @@ l3fwd_simple_forward(struct rte_mbuf *m, uint8_t portid,
                /* We don't currently handle IPv6 packets in LPM mode. */
                rte_pktmbuf_free(m);
 #endif
-       }
+       } else
+               rte_pktmbuf_free(m);
 
 }
 
-#define SLEEP_GEAR1_THRESHOLD            100
-#define SLEEP_GEAR2_THRESHOLD            1000
+#define MINIMUM_SLEEP_TIME         1
+#define SUSPEND_THRESHOLD          300
 
 static inline uint32_t
 power_idle_heuristic(uint32_t zero_rx_packet_count)
 {
-       /* If zero count is less than 100, use it as the sleep time in us */
-       if (zero_rx_packet_count < SLEEP_GEAR1_THRESHOLD)
-               return zero_rx_packet_count;
-       /* If zero count is less than 1000, sleep time should be 100 us */
-       else if ((zero_rx_packet_count >= SLEEP_GEAR1_THRESHOLD) &&
-                       (zero_rx_packet_count < SLEEP_GEAR2_THRESHOLD))
-               return SLEEP_GEAR1_THRESHOLD;
-       /* If zero count is greater than 1000, sleep time should be 1000 us */
-       else if (zero_rx_packet_count >= SLEEP_GEAR2_THRESHOLD)
-               return SLEEP_GEAR2_THRESHOLD;
+       /* If zero count is less than 100,  sleep 1us */
+       if (zero_rx_packet_count < SUSPEND_THRESHOLD)
+               return MINIMUM_SLEEP_TIME;
+       /* If zero count is less than 1000, sleep 100 us which is the
+               minimum latency switching from C3/C6 to C0
+       */
+       else
+               return SUSPEND_THRESHOLD;
 
        return 0;
 }
@@ -764,6 +739,85 @@ power_freq_scaleup_heuristic(unsigned lcore_id,
        return FREQ_CURRENT;
 }
 
+/**
+ * force polling thread sleep until one-shot rx interrupt triggers
+ * @param port_id
+ *  Port id.
+ * @param queue_id
+ *  Rx queue id.
+ * @return
+ *  0 on success
+ */
+static int
+sleep_until_rx_interrupt(int num)
+{
+       struct rte_epoll_event event[num];
+       int n, i;
+       uint8_t port_id, queue_id;
+       void *data;
+
+       RTE_LOG(INFO, L3FWD_POWER,
+               "lcore %u sleeps until interrupt triggers\n",
+               rte_lcore_id());
+
+       n = rte_epoll_wait(RTE_EPOLL_PER_THREAD, event, num, -1);
+       for (i = 0; i < n; i++) {
+               data = event[i].epdata.data;
+               port_id = ((uintptr_t)data) >> CHAR_BIT;
+               queue_id = ((uintptr_t)data) &
+                       RTE_LEN2MASK(CHAR_BIT, uint8_t);
+               rte_eth_dev_rx_intr_disable(port_id, queue_id);
+               RTE_LOG(INFO, L3FWD_POWER,
+                       "lcore %u is waked up from rx interrupt on"
+                       " port %d queue %d\n",
+                       rte_lcore_id(), port_id, queue_id);
+       }
+
+       return 0;
+}
+
+static void turn_on_intr(struct lcore_conf *qconf)
+{
+       int i;
+       struct lcore_rx_queue *rx_queue;
+       uint8_t port_id, queue_id;
+
+       for (i = 0; i < qconf->n_rx_queue; ++i) {
+               rx_queue = &(qconf->rx_queue_list[i]);
+               port_id = rx_queue->port_id;
+               queue_id = rx_queue->queue_id;
+
+               rte_spinlock_lock(&(locks[port_id]));
+               rte_eth_dev_rx_intr_enable(port_id, queue_id);
+               rte_spinlock_unlock(&(locks[port_id]));
+       }
+}
+
+static int event_register(struct lcore_conf *qconf)
+{
+       struct lcore_rx_queue *rx_queue;
+       uint8_t portid, queueid;
+       uint32_t data;
+       int ret;
+       int i;
+
+       for (i = 0; i < qconf->n_rx_queue; ++i) {
+               rx_queue = &(qconf->rx_queue_list[i]);
+               portid = rx_queue->port_id;
+               queueid = rx_queue->queue_id;
+               data = portid << CHAR_BIT | queueid;
+
+               ret = rte_eth_dev_rx_intr_ctl_q(portid, queueid,
+                                               RTE_EPOLL_PER_THREAD,
+                                               RTE_INTR_EVENT_ADD,
+                                               (void *)((uintptr_t)data));
+               if (ret)
+                       return ret;
+       }
+
+       return 0;
+}
+
 /* main processing loop */
 static int
 main_loop(__attribute__((unused)) void *dummy)
@@ -777,9 +831,9 @@ main_loop(__attribute__((unused)) void *dummy)
        struct lcore_conf *qconf;
        struct lcore_rx_queue *rx_queue;
        enum freq_scale_hint_t lcore_scaleup_hint;
-
        uint32_t lcore_rx_idle_count = 0;
        uint32_t lcore_idle_hint = 0;
+       int intr_en = 0;
 
        const uint64_t drain_tsc = (rte_get_tsc_hz() + US_PER_S - 1) / US_PER_S * BURST_TX_DRAIN_US;
 
@@ -796,13 +850,18 @@ main_loop(__attribute__((unused)) void *dummy)
        RTE_LOG(INFO, L3FWD_POWER, "entering main loop on lcore %u\n", lcore_id);
 
        for (i = 0; i < qconf->n_rx_queue; i++) {
-
                portid = qconf->rx_queue_list[i].port_id;
                queueid = qconf->rx_queue_list[i].queue_id;
                RTE_LOG(INFO, L3FWD_POWER, " -- lcoreid=%u portid=%hhu "
                        "rxqueueid=%hhu\n", lcore_id, portid, queueid);
        }
 
+       /* add into event wait list */
+       if (event_register(qconf) == 0)
+               intr_en = 1;
+       else
+               RTE_LOG(INFO, L3FWD_POWER, "RX interrupt won't enable.\n");
+
        while (1) {
                stats[lcore_id].nb_iteration_looped++;
 
@@ -814,20 +873,12 @@ main_loop(__attribute__((unused)) void *dummy)
                 */
                diff_tsc = cur_tsc - prev_tsc;
                if (unlikely(diff_tsc > drain_tsc)) {
-
-                       /*
-                        * This could be optimized (use queueid instead of
-                        * portid), but it is not called so often
-                        */
-                       for (portid = 0; portid < RTE_MAX_ETHPORTS; portid++) {
-                               if (qconf->tx_mbufs[portid].len == 0)
-                                       continue;
-                               send_burst(&lcore_conf[lcore_id],
-                                       qconf->tx_mbufs[portid].len,
-                                       portid);
-                               qconf->tx_mbufs[portid].len = 0;
+                       for (i = 0; i < qconf->n_tx_port; ++i) {
+                               portid = qconf->tx_port_id[i];
+                               rte_eth_tx_buffer_flush(portid,
+                                               qconf->tx_queue_id[portid],
+                                               qconf->tx_buffer[portid]);
                        }
-
                        prev_tsc = cur_tsc;
                }
 
@@ -837,6 +888,7 @@ main_loop(__attribute__((unused)) void *dummy)
                        prev_tsc_power = cur_tsc_power;
                }
 
+start_rx:
                /*
                 * Read packet from RX queues
                 */
@@ -850,6 +902,7 @@ main_loop(__attribute__((unused)) void *dummy)
 
                        nb_rx = rte_eth_rx_burst(portid, queueid, pkts_burst,
                                                                MAX_PKT_BURST);
+
                        stats[lcore_id].nb_rx_processed += nb_rx;
                        if (unlikely(nb_rx == 0)) {
                                /**
@@ -878,7 +931,7 @@ main_loop(__attribute__((unused)) void *dummy)
                                rx_queue->freq_up_hint =
                                        power_freq_scaleup_heuristic(lcore_id,
                                                        portid, queueid);
-                       }
+                       }
 
                        /* Prefetch first packets */
                        for (j = 0; j < PREFETCH_OFFSET && j < nb_rx; j++) {
@@ -912,16 +965,19 @@ main_loop(__attribute__((unused)) void *dummy)
                                                rx_queue->freq_up_hint;
                        }
 
-                       if (lcore_scaleup_hint == FREQ_HIGHEST)
-                               rte_power_freq_max(lcore_id);
-                       else if (lcore_scaleup_hint == FREQ_HIGHER)
-                               rte_power_freq_up(lcore_id);
+                       if (lcore_scaleup_hint == FREQ_HIGHEST) {
+                               if (rte_power_freq_max)
+                                       rte_power_freq_max(lcore_id);
+                       } else if (lcore_scaleup_hint == FREQ_HIGHER) {
+                               if (rte_power_freq_up)
+                                       rte_power_freq_up(lcore_id);
+                       }
                } else {
                        /**
                         * All Rx queues empty in recent consecutive polls,
                         * sleep in a conservative manner, meaning sleep as
-                        * less as possible.
-                        */
+                        * less as possible.
+                        */
                        for (i = 1, lcore_idle_hint =
                                qconf->rx_queue_list[0].idle_hint;
                                        i < qconf->n_rx_queue; ++i) {
@@ -930,16 +986,23 @@ main_loop(__attribute__((unused)) void *dummy)
                                        lcore_idle_hint = rx_queue->idle_hint;
                        }
 
-                       if ( lcore_idle_hint < SLEEP_GEAR1_THRESHOLD)
+                       if (lcore_idle_hint < SUSPEND_THRESHOLD)
                                /**
                                 * execute "pause" instruction to avoid context
-                                * switch for short sleep.
-                                */
+                                * switch which generally take hundred of
+                                * microseconds for short sleep.
+                                */
                                rte_delay_us(lcore_idle_hint);
-                       else
-                               /* long sleep force runing thread to suspend */
-                               usleep(lcore_idle_hint);
-
+                       else {
+                               /* suspend until rx interrupt trigges */
+                               if (intr_en) {
+                                       turn_on_intr(qconf);
+                                       sleep_until_rx_interrupt(
+                                               qconf->n_rx_queue);
+                               }
+                               /* start receiving packets immediately */
+                               goto start_rx;
+                       }
                        stats[lcore_id].sleep_time += lcore_idle_hint;
                }
        }
@@ -1240,13 +1303,9 @@ parse_args(int argc, char **argv)
 static void
 print_ethaddr(const char *name, const struct ether_addr *eth_addr)
 {
-       printf ("%s%02X:%02X:%02X:%02X:%02X:%02X", name,
-               eth_addr->addr_bytes[0],
-               eth_addr->addr_bytes[1],
-               eth_addr->addr_bytes[2],
-               eth_addr->addr_bytes[3],
-               eth_addr->addr_bytes[4],
-               eth_addr->addr_bytes[5]);
+       char buf[ETHER_ADDR_FMT_SIZE];
+       ether_format_addr(buf, ETHER_ADDR_FMT_SIZE, eth_addr);
+       printf("%s%s", name, buf);
 }
 
 #if (APP_LOOKUP_METHOD == APP_LOOKUP_EXACT_MATCH)
@@ -1256,7 +1315,6 @@ setup_hash(int socketid)
        struct rte_hash_parameters ipv4_l3fwd_hash_params = {
                .name = NULL,
                .entries = L3FWD_HASH_ENTRIES,
-               .bucket_entries = 4,
                .key_len = sizeof(struct ipv4_5tuple),
                .hash_func = DEFAULT_HASH_FUNC,
                .hash_func_init_val = 0,
@@ -1265,7 +1323,6 @@ setup_hash(int socketid)
        struct rte_hash_parameters ipv6_l3fwd_hash_params = {
                .name = NULL,
                .entries = L3FWD_HASH_ENTRIES,
-               .bucket_entries = 4,
                .key_len = sizeof(struct ipv6_5tuple),
                .hash_func = DEFAULT_HASH_FUNC,
                .hash_func_init_val = 0,
@@ -1333,9 +1390,15 @@ setup_lpm(int socketid)
        char s[64];
 
        /* create the LPM table */
+       struct rte_lpm_config lpm_ipv4_config;
+
+       lpm_ipv4_config.max_rules = IPV4_L3FWD_LPM_MAX_RULES;
+       lpm_ipv4_config.number_tbl8s = 256;
+       lpm_ipv4_config.flags = 0;
+
        snprintf(s, sizeof(s), "IPV4_L3FWD_LPM_%d", socketid);
-       ipv4_l3fwd_lookup_struct[socketid] = rte_lpm_create(s, socketid,
-                               IPV4_L3FWD_LPM_MAX_RULES, 0);
+       ipv4_l3fwd_lookup_struct[socketid] =
+                       rte_lpm_create(s, socketid, &lpm_ipv4_config);
        if (ipv4_l3fwd_lookup_struct[socketid] == NULL)
                rte_exit(EXIT_FAILURE, "Unable to create the l3fwd LPM table"
                                " on socket %d\n", socketid);
@@ -1386,12 +1449,10 @@ init_mem(unsigned nb_mbuf)
                if (pktmbuf_pool[socketid] == NULL) {
                        snprintf(s, sizeof(s), "mbuf_pool_%d", socketid);
                        pktmbuf_pool[socketid] =
-                               rte_mempool_create(s, nb_mbuf,
-                                       MBUF_SIZE, MEMPOOL_CACHE_SIZE,
-                                       sizeof(struct rte_pktmbuf_pool_private),
-                                       rte_pktmbuf_pool_init, NULL,
-                                       rte_pktmbuf_init, NULL,
-                                       socketid, 0);
+                               rte_pktmbuf_pool_create(s, nb_mbuf,
+                                       MEMPOOL_CACHE_SIZE, 0,
+                                       RTE_MBUF_DEFAULT_BUF_SIZE,
+                                       socketid);
                        if (pktmbuf_pool[socketid] == NULL)
                                rte_exit(EXIT_FAILURE,
                                        "Cannot init mbuf pool on socket %d\n",
@@ -1447,7 +1508,7 @@ check_all_ports_link_status(uint8_t port_num, uint32_t port_mask)
                                continue;
                        }
                        /* clear all_ports_up flag if any link down */
-                       if (link.link_status == 0) {
+                       if (link.link_status == ETH_LINK_DOWN) {
                                all_ports_up = 0;
                                break;
                        }
@@ -1471,7 +1532,7 @@ check_all_ports_link_status(uint8_t port_num, uint32_t port_mask)
 }
 
 int
-MAIN(int argc, char **argv)
+main(int argc, char **argv)
 {
        struct lcore_conf *qconf;
        struct rte_eth_dev_info dev_info;
@@ -1482,6 +1543,7 @@ MAIN(int argc, char **argv)
        unsigned lcore_id;
        uint64_t hz;
        uint32_t n_tx_queue, nb_lcores;
+       uint32_t dev_rxq_num, dev_txq_num;
        uint8_t portid, nb_rx_queue, queue, socketid;
 
        /* catch SIGINT and restore cpufreq governor to ondemand */
@@ -1509,10 +1571,7 @@ MAIN(int argc, char **argv)
        if (ret < 0)
                rte_exit(EXIT_FAILURE, "init_lcore_rx_queues failed\n");
 
-
        nb_ports = rte_eth_dev_count();
-       if (nb_ports > RTE_MAX_ETHPORTS)
-               nb_ports = RTE_MAX_ETHPORTS;
 
        if (check_port_config(nb_ports) < 0)
                rte_exit(EXIT_FAILURE, "check_port_config failed\n");
@@ -1531,10 +1590,19 @@ MAIN(int argc, char **argv)
                printf("Initializing port %d ... ", portid );
                fflush(stdout);
 
+               rte_eth_dev_info_get(portid, &dev_info);
+               dev_rxq_num = dev_info.max_rx_queues;
+               dev_txq_num = dev_info.max_tx_queues;
+
                nb_rx_queue = get_port_n_rx_queues(portid);
+               if (nb_rx_queue > dev_rxq_num)
+                       rte_exit(EXIT_FAILURE,
+                               "Cannot configure not existed rxq: "
+                               "port=%d\n", portid);
+
                n_tx_queue = nb_lcores;
-               if (n_tx_queue > MAX_TX_QUEUE_PER_PORT)
-                       n_tx_queue = MAX_TX_QUEUE_PER_PORT;
+               if (n_tx_queue > dev_txq_num)
+                       n_tx_queue = dev_txq_num;
                printf("Creating queues: nb_rxq=%d nb_txq=%u... ",
                        nb_rx_queue, (unsigned)n_tx_queue );
                ret = rte_eth_dev_configure(portid, nb_rx_queue,
@@ -1552,12 +1620,31 @@ MAIN(int argc, char **argv)
                if (ret < 0)
                        rte_exit(EXIT_FAILURE, "init_mem failed\n");
 
+               for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
+                       if (rte_lcore_is_enabled(lcore_id) == 0)
+                               continue;
+
+                       /* Initialize TX buffers */
+                       qconf = &lcore_conf[lcore_id];
+                       qconf->tx_buffer[portid] = rte_zmalloc_socket("tx_buffer",
+                               RTE_ETH_TX_BUFFER_SIZE(MAX_PKT_BURST), 0,
+                               rte_eth_dev_socket_id(portid));
+                       if (qconf->tx_buffer[portid] == NULL)
+                               rte_exit(EXIT_FAILURE, "Can't allocate tx buffer for port %u\n",
+                                               (unsigned) portid);
+
+                       rte_eth_tx_buffer_init(qconf->tx_buffer[portid], MAX_PKT_BURST);
+               }
+
                /* init one TX queue per couple (lcore,port) */
                queueid = 0;
                for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
                        if (rte_lcore_is_enabled(lcore_id) == 0)
                                continue;
 
+                       if (queueid >= dev_txq_num)
+                               continue;
+
                        if (numa_on)
                                socketid = \
                                (uint8_t)rte_lcore_to_socket_id(lcore_id);
@@ -1581,6 +1668,9 @@ MAIN(int argc, char **argv)
                        qconf = &lcore_conf[lcore_id];
                        qconf->tx_queue_id[portid] = queueid;
                        queueid++;
+
+                       qconf->tx_port_id[qconf->n_tx_port] = portid;
+                       qconf->n_tx_port++;
                }
                printf("\n");
        }
@@ -1592,8 +1682,8 @@ MAIN(int argc, char **argv)
                /* init power management library */
                ret = rte_power_init(lcore_id);
                if (ret)
-                       rte_exit(EXIT_FAILURE, "Power management library "
-                               "initialization failed on core%u\n", lcore_id);
+                       RTE_LOG(ERR, POWER,
+                               "Library initialization failed on core %u\n", lcore_id);
 
                /* init timer structures for each enabled lcore */
                rte_timer_init(&power_timers[lcore_id]);
@@ -1641,7 +1731,6 @@ MAIN(int argc, char **argv)
                if (ret < 0)
                        rte_exit(EXIT_FAILURE, "rte_eth_dev_start: err=%d, "
                                                "port=%d\n", ret, portid);
-
                /*
                 * If enabled, put device in promiscuous mode.
                 * This allows IO forwarding mode to forward packets
@@ -1650,6 +1739,8 @@ MAIN(int argc, char **argv)
                 */
                if (promiscuous_on)
                        rte_eth_promiscuous_enable(portid);
+               /* initialize spinlock for each port */
+               rte_spinlock_init(&(locks[portid]));
        }
 
        check_all_ports_link_status((uint8_t)nb_ports, enabled_port_mask);