app/test/test_link_bonding_mode4.c

   1 /*-
   2  *   BSD LICENSE
   3  *
   4  *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
   5  *   All rights reserved.
   6  *
   7  *   Redistribution and use in source and binary forms, with or without
   8  *   modification, are permitted provided that the following conditions
   9  *   are met:
  10  *
  11  *     * Redistributions of source code must retain the above copyright
  12  *       notice, this list of conditions and the following disclaimer.
  13  *     * Redistributions in binary form must reproduce the above copyright
  14  *       notice, this list of conditions and the following disclaimer in
  15  *       the documentation and/or other materials provided with the
  16  *       distribution.
  17  *     * Neither the name of Intel Corporation nor the names of its
  18  *       contributors may be used to endorse or promote products derived
  19  *       from this software without specific prior written permission.
  20  *
  21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32  */
  33
  34 #include <string.h>
  35 #include <stdarg.h>
  36 #include <stdio.h>
  37 #include <stdlib.h>
  38 #include <stdint.h>
  39 #include <inttypes.h>
  40 #include <errno.h>
  41 #include <rte_cycles.h>
  42 #include <sys/queue.h>
  43
  44 #include <rte_byteorder.h>
  45 #include <rte_common.h>
  46 #include <rte_debug.h>
  47 #include <rte_ethdev.h>
  48 #include <rte_log.h>
  49 #include <rte_lcore.h>
  50 #include <rte_memory.h>
  51
  52 #include <rte_string_fns.h>
  53
  54 #include <rte_eth_ring.h>
  55 #include <rte_errno.h>
  56 #include <rte_eth_bond.h>
  57 #include <rte_eth_bond_8023ad.h>
  58
  59 #include "packet_burst_generator.h"
  60
  61 #include "test.h"
  62
  63 #define SLAVE_COUNT (4)
  64
  65 #define RX_RING_SIZE 128
  66 #define TX_RING_SIZE 512
  67
  68 #define MBUF_PAYLOAD_SIZE           (2048)
  69 #define MBUF_SIZE (MBUF_PAYLOAD_SIZE + sizeof(struct rte_mbuf) + \
  70         RTE_PKTMBUF_HEADROOM)
  71 #define MBUF_CACHE_SIZE         (250)
  72 #define BURST_SIZE              (32)
  73
  74 #define DEFAULT_MBUF_DATA_SIZE  (2048)
  75 #define TEST_RX_DESC_MAX        (2048)
  76 #define TEST_TX_DESC_MAX        (2048)
  77 #define MAX_PKT_BURST           (32)
  78 #define DEF_PKT_BURST           (16)
  79
  80 #define BONDED_DEV_NAME         ("unit_test_mode4_bond_dev")
  81
  82 #define SLAVE_DEV_NAME_FMT      ("unit_test_mode4_slave_%d")
  83 #define SLAVE_RX_QUEUE_FMT      ("unit_test_mode4_slave_%d_rx")
  84 #define SLAVE_TX_QUEUE_FMT      ("unit_test_mode4_slave_%d_tx")
  85
  86 #define INVALID_SOCKET_ID       (-1)
  87 #define INVALID_PORT_ID         (0xFF)
  88 #define INVALID_BONDING_MODE    (-1)
  89
  90 static const struct ether_addr slave_mac_default = {
  91         { 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00 }
  92 };
  93
  94 static const struct ether_addr parnter_mac_default = {
  95         { 0x22, 0xBB, 0xFF, 0xBB, 0x00, 0x00 }
  96 };
  97
  98 static const struct ether_addr parnter_system = {
  99         { 0x33, 0xFF, 0xBB, 0xFF, 0x00, 0x00 }
 100 };
 101
 102 static const struct ether_addr slow_protocol_mac_addr = {
 103         { 0x01, 0x80, 0xC2, 0x00, 0x00, 0x02 }
 104 };
 105
 106 struct slave_conf {
 107         struct rte_ring *rx_queue;
 108         struct rte_ring *tx_queue;
 109         uint8_t port_id;
 110         uint8_t bonded : 1;
 111
 112         uint8_t lacp_parnter_state;
 113 };
 114
 115 struct ether_vlan_hdr {
 116         struct ether_hdr pkt_eth_hdr;
 117         struct vlan_hdr vlan_hdr;
 118 };
 119
 120 struct link_bonding_unittest_params {
 121         uint8_t bonded_port_id;
 122         struct slave_conf slave_ports[SLAVE_COUNT];
 123
 124         struct rte_mempool *mbuf_pool;
 125 };
 126
 127 #define TEST_DEFAULT_SLAVE_COUNT     RTE_DIM(test_params.slave_ports)
 128 #define TEST_RX_SLAVE_COUT           TEST_DEFAULT_SLAVE_COUNT
 129 #define TEST_TX_SLAVE_COUNT          TEST_DEFAULT_SLAVE_COUNT
 130 #define TEST_MARKER_SLAVE_COUT       TEST_DEFAULT_SLAVE_COUNT
 131 #define TEST_EXPIRED_SLAVE_COUNT     TEST_DEFAULT_SLAVE_COUNT
 132 #define TEST_PROMISC_SLAVE_COUNT     TEST_DEFAULT_SLAVE_COUNT
 133
 134 static struct link_bonding_unittest_params test_params  = {
 135         .bonded_port_id = INVALID_PORT_ID,
 136         .slave_ports = { [0 ... SLAVE_COUNT - 1] = { .port_id = INVALID_PORT_ID} },
 137
 138         .mbuf_pool = NULL,
 139 };
 140
 141 static struct rte_eth_conf default_pmd_conf = {
 142         .rxmode = {
 143                 .mq_mode = ETH_MQ_RX_NONE,
 144                 .max_rx_pkt_len = ETHER_MAX_LEN,
 145                 .split_hdr_size = 0,
 146                 .header_split   = 0, /**< Header Split disabled */
 147                 .hw_ip_checksum = 0, /**< IP checksum offload enabled */
 148                 .hw_vlan_filter = 0, /**< VLAN filtering disabled */
 149                 .jumbo_frame    = 0, /**< Jumbo Frame Support disabled */
 150                 .hw_strip_crc   = 0, /**< CRC stripped by hardware */
 151         },
 152         .txmode = {
 153                 .mq_mode = ETH_MQ_TX_NONE,
 154         },
 155         .lpbk_mode = 0,
 156 };
 157
 158 #define FOR_EACH(_i, _item, _array, _size) \
 159         for (_i = 0, _item = &_array[0]; _i < _size && (_item = &_array[_i]); _i++)
 160
 161 /* Macro for iterating over every port that can be used as a slave
 162  * in this test.
 163  * _i variable used as an index in test_params->slave_ports
 164  * _slave pointer to &test_params->slave_ports[_idx]
 165  */
 166 #define FOR_EACH_PORT(_i, _port) \
 167         FOR_EACH(_i, _port, test_params.slave_ports, \
 168                 RTE_DIM(test_params.slave_ports))
 169
 170 /* Macro for iterating over every port that can be used as a slave
 171  * in this test and satisfy given condition.
 172  *
 173  * _i variable used as an index in test_params->slave_ports
 174  * _slave pointer to &test_params->slave_ports[_idx]
 175  * _condition condition that need to be checked
 176  */
 177 #define FOR_EACH_PORT_IF(_i, _port, _condition) FOR_EACH_PORT((_i), (_port)) \
 178         if (!!(_condition))
 179
 180 /* Macro for iterating over every port that is currently a slave of a bonded
 181  * device.
 182  * _i variable used as an index in test_params->slave_ports
 183  * _slave pointer to &test_params->slave_ports[_idx]
 184  * */
 185 #define FOR_EACH_SLAVE(_i, _slave) \
 186         FOR_EACH_PORT_IF(_i, _slave, (_slave)->bonded != 0)
 187
 188 /*
 189  * Returns packets from slaves TX queue.
 190  * slave slave port
 191  * buffer for packets
 192  * size size of buffer
 193  * return number of packets or negative error number
 194  */
 195 static int
 196 slave_get_pkts(struct slave_conf *slave, struct rte_mbuf **buf, uint16_t size)
 197 {
 198         return rte_ring_dequeue_burst(slave->tx_queue, (void **)buf, size);
 199 }
 200
 201 /*
 202  * Injects given packets into slaves RX queue.
 203  * slave slave port
 204  * buffer for packets
 205  * size number of packets to be injected
 206  * return number of queued packets or negative error number
 207  */
 208 static int
 209 slave_put_pkts(struct slave_conf *slave, struct rte_mbuf **buf, uint16_t size)
 210 {
 211         return rte_ring_enqueue_burst(slave->rx_queue, (void **)buf, size);
 212 }
 213
 214 static uint16_t
 215 bond_rx(struct rte_mbuf **buf, uint16_t size)
 216 {
 217         return rte_eth_rx_burst(test_params.bonded_port_id, 0, buf, size);
 218 }
 219
 220 static uint16_t
 221 bond_tx(struct rte_mbuf **buf, uint16_t size)
 222 {
 223         return rte_eth_tx_burst(test_params.bonded_port_id, 0, buf, size);
 224 }
 225
 226 static void
 227 free_pkts(struct rte_mbuf **pkts, uint16_t count)
 228 {
 229         uint16_t i;
 230
 231         for (i = 0; i < count; i++) {
 232                 if (pkts[i] != NULL)
 233                         rte_pktmbuf_free(pkts[i]);
 234         }
 235 }
 236
 237 static int
 238 configure_ethdev(uint8_t port_id, uint8_t start)
 239 {
 240         TEST_ASSERT(rte_eth_dev_configure(port_id, 1, 1, &default_pmd_conf) == 0,
 241                 "Failed to configure device %u", port_id);
 242
 243         TEST_ASSERT(rte_eth_rx_queue_setup(port_id, 0, RX_RING_SIZE,
 244                 rte_eth_dev_socket_id(port_id), NULL, test_params.mbuf_pool) == 0,
 245                 "Failed to setup rx queue.");
 246
 247         TEST_ASSERT(rte_eth_tx_queue_setup(port_id, 0, TX_RING_SIZE,
 248                 rte_eth_dev_socket_id(port_id), NULL) == 0,
 249                 "Failed to setup tx queue.");
 250
 251         if (start) {
 252                 TEST_ASSERT(rte_eth_dev_start(port_id) == 0,
 253                 "Failed to start device (%d).", port_id);
 254         }
 255         return 0;
 256 }
 257
 258 static int
 259 add_slave(struct slave_conf *slave, uint8_t start)
 260 {
 261         struct ether_addr addr, addr_check;
 262
 263         /* Some sanity check */
 264         RTE_VERIFY(test_params.slave_ports <= slave &&
 265                 slave - test_params.slave_ports < (int)RTE_DIM(test_params.slave_ports));
 266         RTE_VERIFY(slave->bonded == 0);
 267         RTE_VERIFY(slave->port_id != INVALID_PORT_ID);
 268
 269         ether_addr_copy(&slave_mac_default, &addr);
 270         addr.addr_bytes[ETHER_ADDR_LEN - 1] = slave->port_id;
 271
 272         rte_eth_dev_mac_addr_remove(slave->port_id, &addr);
 273
 274         TEST_ASSERT_SUCCESS(rte_eth_dev_mac_addr_add(slave->port_id, &addr, 0),
 275                 "Failed to set slave MAC address");
 276
 277         TEST_ASSERT_SUCCESS(rte_eth_bond_slave_add(test_params.bonded_port_id,
 278                 slave->port_id),
 279                         "Failed to add slave (idx=%u, id=%u) to bonding (id=%u)",
 280                         (uint8_t)(slave - test_params.slave_ports), slave->port_id,
 281                         test_params.bonded_port_id);
 282
 283         slave->bonded = 1;
 284         if (start) {
 285                 TEST_ASSERT_SUCCESS(rte_eth_dev_start(slave->port_id),
 286                         "Failed to start slave %u", slave->port_id);
 287         }
 288
 289         rte_eth_macaddr_get(slave->port_id, &addr_check);
 290         TEST_ASSERT_EQUAL(is_same_ether_addr(&addr, &addr_check), 1,
 291                         "Slave MAC address is not as expected");
 292
 293         RTE_VERIFY(slave->lacp_parnter_state == 0);
 294         return 0;
 295 }
 296
 297 static int
 298 remove_slave(struct slave_conf *slave)
 299 {
 300         ptrdiff_t slave_idx = slave - test_params.slave_ports;
 301
 302         RTE_VERIFY(test_params.slave_ports <= slave &&
 303                 slave_idx < (ptrdiff_t)RTE_DIM(test_params.slave_ports));
 304
 305         RTE_VERIFY(slave->bonded == 1);
 306         RTE_VERIFY(slave->port_id != INVALID_PORT_ID);
 307
 308         TEST_ASSERT_EQUAL(rte_ring_count(slave->rx_queue), 0,
 309                 "Slave %u tx queue not empty while removing from bonding.",
 310                 slave->port_id);
 311
 312         TEST_ASSERT_EQUAL(rte_ring_count(slave->rx_queue), 0,
 313                 "Slave %u tx queue not empty while removing from bonding.",
 314                 slave->port_id);
 315
 316         TEST_ASSERT_EQUAL(rte_eth_bond_slave_remove(test_params.bonded_port_id,
 317                         slave->port_id), 0,
 318                         "Failed to remove slave (idx=%u, id=%u) from bonding (id=%u)",
 319                         (uint8_t)slave_idx, slave->port_id,
 320                         test_params.bonded_port_id);
 321
 322         slave->bonded = 0;
 323         slave->lacp_parnter_state = 0;
 324         return 0;
 325 }
 326
 327 static int
 328 initialize_bonded_device_with_slaves(uint8_t slave_count, uint8_t start)
 329 {
 330         uint8_t i;
 331
 332         RTE_VERIFY(test_params.bonded_port_id != INVALID_PORT_ID);
 333
 334         for (i = 0; i < slave_count; i++) {
 335                 TEST_ASSERT_SUCCESS(add_slave(&test_params.slave_ports[i], 1),
 336                         "Failed to add port %u to bonded device.\n",
 337                         test_params.slave_ports[i].port_id);
 338         }
 339
 340         /* Reset mode 4 configuration */
 341         rte_eth_bond_8023ad_setup(test_params.bonded_port_id, NULL);
 342         rte_eth_promiscuous_disable(test_params.bonded_port_id);
 343
 344         if (start)
 345                 TEST_ASSERT_SUCCESS(rte_eth_dev_start(test_params.bonded_port_id),
 346                         "Failed to start bonded device");
 347
 348         return TEST_SUCCESS;
 349 }
 350
 351 static int
 352 remove_slaves_and_stop_bonded_device(void)
 353 {
 354         struct slave_conf *slave;
 355         int retval;
 356         uint8_t slaves[RTE_MAX_ETHPORTS];
 357         uint8_t i;
 358
 359         rte_eth_dev_stop(test_params.bonded_port_id);
 360
 361         FOR_EACH_SLAVE(i, slave)
 362                 remove_slave(slave);
 363
 364         retval = rte_eth_bond_slaves_get(test_params.bonded_port_id, slaves,
 365                 RTE_DIM(slaves));
 366
 367         TEST_ASSERT_EQUAL(retval, 0,
 368                 "Expected bonded device %u have 0 slaves but returned %d.",
 369                         test_params.bonded_port_id, retval);
 370
 371         FOR_EACH_PORT(i, slave) {
 372                 rte_eth_dev_stop(slave->port_id);
 373
 374                 TEST_ASSERT(slave->bonded == 0,
 375                         "Port id=%u is still marked as enslaved.", slave->port_id);
 376         }
 377
 378         return TEST_SUCCESS;
 379 }
 380
 381 static int
 382 test_setup(void)
 383 {
 384         int retval, nb_mbuf_per_pool;
 385         char name[RTE_ETH_NAME_MAX_LEN];
 386         struct slave_conf *port;
 387         const uint8_t socket_id = rte_socket_id();
 388         uint8_t i;
 389
 390         if (test_params.mbuf_pool == NULL) {
 391                 nb_mbuf_per_pool = TEST_RX_DESC_MAX + DEF_PKT_BURST +
 392                                         TEST_TX_DESC_MAX + MAX_PKT_BURST;
 393                 test_params.mbuf_pool = rte_mempool_create("TEST_MODE4",
 394                                 nb_mbuf_per_pool, MBUF_SIZE, MBUF_CACHE_SIZE,
 395                                 sizeof(struct rte_pktmbuf_pool_private),
 396                                 rte_pktmbuf_pool_init, NULL, rte_pktmbuf_init, NULL,
 397                                 socket_id, 0);
 398
 399                 TEST_ASSERT(test_params.mbuf_pool != NULL,
 400                         "rte_mempool_create failed\n");
 401         }
 402
 403         /* Create / initialize ring eth devs. */
 404         FOR_EACH_PORT(i, port) {
 405                 port = &test_params.slave_ports[i];
 406
 407                 if (port->rx_queue == NULL) {
 408                         retval = snprintf(name, RTE_DIM(name), SLAVE_RX_QUEUE_FMT, i);
 409                         TEST_ASSERT(retval <= (int)RTE_DIM(name) - 1, "Name too long");
 410                         port->rx_queue = rte_ring_create(name, RX_RING_SIZE, socket_id, 0);
 411                         TEST_ASSERT(port->rx_queue != NULL,
 412                                 "Failed to allocate rx ring '%s': %s", name,
 413                                 rte_strerror(rte_errno));
 414                 }
 415
 416                 if (port->tx_queue == NULL) {
 417                         retval = snprintf(name, RTE_DIM(name), SLAVE_TX_QUEUE_FMT, i);
 418                         TEST_ASSERT(retval <= (int)RTE_DIM(name) - 1, "Name too long");
 419                         port->tx_queue = rte_ring_create(name, TX_RING_SIZE, socket_id, 0);
 420                         TEST_ASSERT_NOT_NULL(port->tx_queue,
 421                                 "Failed to allocate tx ring '%s': %s", name,
 422                                 rte_strerror(rte_errno));
 423                 }
 424
 425                 if (port->port_id == INVALID_PORT_ID) {
 426                         retval = snprintf(name, RTE_DIM(name), SLAVE_DEV_NAME_FMT, i);
 427                         TEST_ASSERT(retval < (int)RTE_DIM(name) - 1, "Name too long");
 428                         retval = rte_eth_from_rings(name, &port->rx_queue, 1,
 429                                         &port->tx_queue, 1, socket_id);
 430                         TEST_ASSERT(retval >= 0,
 431                                 "Failed to create ring ethdev '%s'\n", name);
 432
 433                         port->port_id = rte_eth_dev_count() - 1;
 434                 }
 435
 436                 retval = configure_ethdev(port->port_id, 1);
 437                 TEST_ASSERT_SUCCESS(retval, "Failed to configure virtual ethdev %s\n",
 438                         name);
 439         }
 440
 441         if (test_params.bonded_port_id == INVALID_PORT_ID) {
 442                 retval = rte_eth_bond_create(BONDED_DEV_NAME, BONDING_MODE_8023AD,
 443                                 socket_id);
 444
 445                 TEST_ASSERT(retval >= 0, "Failed to create bonded ethdev %s",
 446                                 BONDED_DEV_NAME);
 447
 448                 test_params.bonded_port_id = retval;
 449                 TEST_ASSERT_SUCCESS(configure_ethdev(test_params.bonded_port_id, 0),
 450                                 "Failed to configure bonded ethdev %s", BONDED_DEV_NAME);
 451         } else if (rte_eth_bond_mode_get(test_params.bonded_port_id) !=
 452                         BONDING_MODE_8023AD) {
 453                 TEST_ASSERT(rte_eth_bond_mode_set(test_params.bonded_port_id,
 454                         BONDING_MODE_8023AD) == 0,
 455                         "Failed to set ethdev %d to mode %d",
 456                         test_params.bonded_port_id, BONDING_MODE_8023AD);
 457         }
 458
 459         return 0;
 460 }
 461
 462 static int
 463 testsuite_teardown(void)
 464 {
 465         struct slave_conf *port;
 466         uint8_t i;
 467
 468         /* Only stop ports.
 469          * Any cleanup/reset state is done when particular test is
 470          * started. */
 471
 472         rte_eth_dev_stop(test_params.bonded_port_id);
 473
 474         FOR_EACH_PORT(i, port)
 475                 rte_eth_dev_stop(port->port_id);
 476
 477         return 0;
 478 }
 479
 480 /*
 481  * Check if given LACP packet. If it is, make make replay packet to force
 482  * COLLECTING state.
 483  * return 0 when pkt is LACP frame, 1 if it is not slow frame, 2 if it is slow
 484  * frame but not LACP
 485  */
 486 static int
 487 make_lacp_reply(struct slave_conf *slave, struct rte_mbuf *pkt)
 488 {
 489         struct ether_hdr *hdr;
 490         struct slow_protocol_frame *slow_hdr;
 491         struct lacpdu *lacp;
 492
 493         /* look for LACP */
 494         hdr = rte_pktmbuf_mtod(pkt, struct ether_hdr *);
 495         if (hdr->ether_type != rte_cpu_to_be_16(ETHER_TYPE_SLOW))
 496                 return 1;
 497
 498         slow_hdr = rte_pktmbuf_mtod(pkt, struct slow_protocol_frame *);
 499         /* ignore packets of other types */
 500         if (slow_hdr->slow_protocol.subtype != SLOW_SUBTYPE_LACP)
 501                 return 2;
 502
 503         slow_hdr = rte_pktmbuf_mtod(pkt, struct slow_protocol_frame *);
 504
 505         /* Change source address to partner address */
 506         ether_addr_copy(&parnter_mac_default, &slow_hdr->eth_hdr.s_addr);
 507         slow_hdr->eth_hdr.s_addr.addr_bytes[ETHER_ADDR_LEN - 1] = slave->port_id;
 508
 509         lacp = (struct lacpdu *) &slow_hdr->slow_protocol;
 510         /* Save last received state */
 511         slave->lacp_parnter_state = lacp->actor.state;
 512         /* Change it into LACP replay by matching parameters. */
 513         memcpy(&lacp->partner.port_params, &lacp->actor.port_params,
 514                 sizeof(struct port_params));
 515
 516         lacp->partner.state = lacp->actor.state;
 517
 518         ether_addr_copy(&parnter_system, &lacp->actor.port_params.system);
 519         lacp->actor.state = STATE_LACP_ACTIVE |
 520                                                 STATE_SYNCHRONIZATION |
 521                                                 STATE_AGGREGATION |
 522                                                 STATE_COLLECTING |
 523                                                 STATE_DISTRIBUTING;
 524
 525         return 0;
 526 }
 527
 528 /*
 529  * Reads packets from given slave, search for LACP packet and reply them.
 530  *
 531  * Receives burst of packets from slave. Looks for LACP packet. Drops
 532  * all other packets. Prepares response LACP and sends it back.
 533  *
 534  * return number of LACP received and replied, -1 on error.
 535  */
 536 static int
 537 bond_handshake_reply(struct slave_conf *slave)
 538 {
 539         int retval;
 540         struct rte_mbuf *rx_buf[MAX_PKT_BURST];
 541         struct rte_mbuf *lacp_tx_buf[MAX_PKT_BURST];
 542         uint16_t lacp_tx_buf_cnt = 0, i;
 543
 544         retval = slave_get_pkts(slave, rx_buf, RTE_DIM(rx_buf));
 545         TEST_ASSERT(retval >= 0, "Getting slave %u packets failed.",
 546                         slave->port_id);
 547
 548         for (i = 0; i < (uint16_t)retval; i++) {
 549                 if (make_lacp_reply(slave, rx_buf[i]) == 0) {
 550                         /* reply with actor's LACP */
 551                         lacp_tx_buf[lacp_tx_buf_cnt++] = rx_buf[i];
 552                 } else
 553                         rte_pktmbuf_free(rx_buf[i]);
 554         }
 555
 556         if (lacp_tx_buf_cnt == 0)
 557                 return 0;
 558
 559         retval = slave_put_pkts(slave, lacp_tx_buf, lacp_tx_buf_cnt);
 560         if (retval <= lacp_tx_buf_cnt) {
 561                 /* retval might be negative */
 562                 for (i = RTE_MAX(0, retval); retval < lacp_tx_buf_cnt; retval++)
 563                         rte_pktmbuf_free(lacp_tx_buf[i]);
 564         }
 565
 566         TEST_ASSERT_EQUAL(retval, lacp_tx_buf_cnt,
 567                 "Failed to equeue lacp packets into slave %u tx queue.",
 568                 slave->port_id);
 569
 570         return lacp_tx_buf_cnt;
 571 }
 572
 573 /*
 574  * Function check if given slave tx queue contains packets that make mode 4
 575  * handshake complete. It will drain slave queue.
 576  * return 0 if handshake not completed, 1 if handshake was complete,
 577  */
 578 static int
 579 bond_handshake_done(struct slave_conf *slave)
 580 {
 581         const uint8_t expected_state = STATE_LACP_ACTIVE | STATE_SYNCHRONIZATION |
 582                         STATE_AGGREGATION | STATE_COLLECTING | STATE_DISTRIBUTING;
 583
 584         return slave->lacp_parnter_state == expected_state;
 585 }
 586
 587 static unsigned
 588 bond_get_update_timeout_ms(void)
 589 {
 590         struct rte_eth_bond_8023ad_conf conf;
 591
 592         rte_eth_bond_8023ad_conf_get(test_params.bonded_port_id, &conf);
 593         return conf.update_timeout_ms;
 594 }
 595
 596 /*
 597  * Exchanges LACP packets with partner to achieve dynamic port configuration.
 598  * return TEST_SUCCESS if initial handshake succeed, TEST_FAILED otherwise.
 599  */
 600 static int
 601 bond_handshake(void)
 602 {
 603         struct slave_conf *slave;
 604         struct rte_mbuf *buf[MAX_PKT_BURST];
 605         uint16_t nb_pkts;
 606         uint8_t all_slaves_done, i, j;
 607         uint8_t status[RTE_DIM(test_params.slave_ports)] = { 0 };
 608         const unsigned delay = bond_get_update_timeout_ms();
 609
 610         /* Exchange LACP frames */
 611         all_slaves_done = 0;
 612         for (i = 0; i < 30 && all_slaves_done == 0; ++i) {
 613                 rte_delay_ms(delay);
 614
 615                 all_slaves_done = 1;
 616                 FOR_EACH_SLAVE(j, slave) {
 617                         /* If response already send, skip slave */
 618                         if (status[j] != 0)
 619                                 continue;
 620
 621                         if (bond_handshake_reply(slave) < 0) {
 622                                 all_slaves_done = 0;
 623                                 break;
 624                         }
 625
 626                         status[j] = bond_handshake_done(slave);
 627                         if (status[j] == 0)
 628                                 all_slaves_done = 0;
 629                 }
 630
 631                 nb_pkts = bond_tx(NULL, 0);
 632                 TEST_ASSERT_EQUAL(nb_pkts, 0, "Packets transmitted unexpectedly");
 633
 634                 nb_pkts = bond_rx(buf, RTE_DIM(buf));
 635                 free_pkts(buf, nb_pkts);
 636                 TEST_ASSERT_EQUAL(nb_pkts, 0, "Packets received unexpectedly");
 637         }
 638         /* If response didn't send - report failure */
 639         TEST_ASSERT_EQUAL(all_slaves_done, 1, "Bond handshake failed\n");
 640
 641         /* If flags doesn't match - report failure */
 642         return all_slaves_done = 1 ? TEST_SUCCESS : TEST_FAILED;
 643 }
 644
 645 #define TEST_LACP_SLAVE_COUT RTE_DIM(test_params.slave_ports)
 646 static int
 647 test_mode4_lacp(void)
 648 {
 649         int retval;
 650
 651         retval = initialize_bonded_device_with_slaves(TEST_LACP_SLAVE_COUT, 1);
 652         TEST_ASSERT_SUCCESS(retval, "Failed to initialize bonded device");
 653
 654         /* Test LACP handshake function */
 655         retval = bond_handshake();
 656         TEST_ASSERT_SUCCESS(retval, "Initial handshake failed");
 657
 658         retval = remove_slaves_and_stop_bonded_device();
 659         TEST_ASSERT_SUCCESS(retval, "Test cleanup failed.");
 660
 661         return TEST_SUCCESS;
 662 }
 663
 664 static int
 665 generate_packets(struct ether_addr *src_mac,
 666         struct ether_addr *dst_mac, uint16_t count, struct rte_mbuf **buf)
 667 {
 668         uint16_t pktlen = PACKET_BURST_GEN_PKT_LEN;
 669         uint8_t vlan_enable = 0;
 670         uint16_t vlan_id = 0;
 671         uint8_t ip4_type = 1; /* 0 - ipv6 */
 672
 673         uint16_t src_port = 10, dst_port = 20;
 674
 675         uint32_t ip_src[4] = { [0 ... 2] = 0xDEADBEEF, [3] = IPv4(192, 168, 0, 1) };
 676         uint32_t ip_dst[4] = { [0 ... 2] = 0xFEEDFACE, [3] = IPv4(192, 168, 0, 2) };
 677
 678         struct ether_hdr pkt_eth_hdr;
 679         struct udp_hdr pkt_udp_hdr;
 680         union {
 681                 struct ipv4_hdr v4;
 682                 struct ipv6_hdr v6;
 683         } pkt_ip_hdr;
 684
 685         int retval;
 686
 687         initialize_eth_header(&pkt_eth_hdr, src_mac, dst_mac, ip4_type,
 688                         vlan_enable, vlan_id);
 689
 690         if (ip4_type)
 691                 initialize_ipv4_header(&pkt_ip_hdr.v4, ip_src[3], ip_dst[3], pktlen);
 692         else
 693                 initialize_ipv6_header(&pkt_ip_hdr.v6, (uint8_t *)ip_src,
 694                         (uint8_t *)&ip_dst, pktlen);
 695
 696         initialize_udp_header(&pkt_udp_hdr, src_port, dst_port, 16);
 697
 698         retval = generate_packet_burst(test_params.mbuf_pool, buf,
 699                         &pkt_eth_hdr, vlan_enable, &pkt_ip_hdr, 1, &pkt_udp_hdr,
 700                         count, pktlen, 1);
 701
 702         if (retval > 0 && retval != count)
 703                 free_pkts(&buf[count - retval], retval);
 704
 705         TEST_ASSERT_EQUAL(retval, count, "Failed to generate %u packets",
 706                 count);
 707
 708         return count;
 709 }
 710
 711 static int
 712 generate_and_put_packets(struct slave_conf *slave, struct ether_addr *src_mac,
 713                 struct ether_addr *dst_mac, uint16_t count)
 714 {
 715         struct rte_mbuf *pkts[MAX_PKT_BURST];
 716         int retval;
 717
 718         retval = generate_packets(src_mac, dst_mac, count, pkts);
 719         if (retval != (int)count)
 720                 return retval;
 721
 722         retval = slave_put_pkts(slave, pkts, count);
 723         if (retval > 0 && retval != count)
 724                 free_pkts(&pkts[retval], count - retval);
 725
 726         TEST_ASSERT_EQUAL(retval, count,
 727                 "Failed to enqueue packets into slave %u RX queue", slave->port_id);
 728
 729         return TEST_SUCCESS;
 730 }
 731
 732 static int
 733 test_mode4_rx(void)
 734 {
 735         struct slave_conf *slave;
 736         uint16_t i, j;
 737
 738         uint16_t expected_pkts_cnt;
 739         struct rte_mbuf *pkts[MAX_PKT_BURST];
 740         int retval;
 741         unsigned delay;
 742
 743         struct ether_hdr *hdr;
 744
 745         struct ether_addr src_mac = { { 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00 } };
 746         struct ether_addr dst_mac;
 747         struct ether_addr bonded_mac;
 748
 749         retval = initialize_bonded_device_with_slaves(TEST_PROMISC_SLAVE_COUNT, 1);
 750         TEST_ASSERT_SUCCESS(retval, "Failed to initialize bonded device");
 751
 752         retval = bond_handshake();
 753         TEST_ASSERT_SUCCESS(retval, "Initial handshake failed");
 754
 755         rte_eth_macaddr_get(test_params.bonded_port_id, &bonded_mac);
 756         ether_addr_copy(&bonded_mac, &dst_mac);
 757
 758         /* Assert that dst address is not bonding address */
 759         dst_mac.addr_bytes[0]++;
 760
 761         /* First try with promiscuous mode enabled.
 762          * Add 2 packets to each slave. First with bonding MAC address, second with
 763          * different. Check if we received all of them. */
 764         rte_eth_promiscuous_enable(test_params.bonded_port_id);
 765
 766         expected_pkts_cnt = 0;
 767         FOR_EACH_SLAVE(i, slave) {
 768                 retval = generate_and_put_packets(slave, &src_mac, &bonded_mac, 1);
 769                 TEST_ASSERT_SUCCESS(retval, "Failed to enqueue packets to slave %u",
 770                         slave->port_id);
 771
 772                 retval = generate_and_put_packets(slave, &src_mac, &dst_mac, 1);
 773                 TEST_ASSERT_SUCCESS(retval, "Failed to enqueue packets to slave %u",
 774                         slave->port_id);
 775
 776                 /* Expect 2 packets per slave */
 777                 expected_pkts_cnt += 2;
 778         }
 779
 780         retval = rte_eth_rx_burst(test_params.bonded_port_id, 0, pkts,
 781                 RTE_DIM(pkts));
 782
 783         if (retval == expected_pkts_cnt) {
 784                 int cnt[2] = { 0, 0 };
 785
 786                 for (i = 0; i < expected_pkts_cnt; i++) {
 787                         hdr = rte_pktmbuf_mtod(pkts[i], struct ether_hdr *);
 788                         cnt[is_same_ether_addr(&hdr->d_addr, &bonded_mac)]++;
 789                 }
 790
 791                 free_pkts(pkts, expected_pkts_cnt);
 792
 793                 /* For division by 2 expected_pkts_cnt must be even */
 794                 RTE_VERIFY((expected_pkts_cnt & 1) == 0);
 795                 TEST_ASSERT(cnt[0] == expected_pkts_cnt / 2 &&
 796                         cnt[1] == expected_pkts_cnt / 2,
 797                         "Expected %u packets with the same MAC and %u with different but "
 798                         "got %u with the same and %u with diffrent MAC",
 799                         expected_pkts_cnt / 2, expected_pkts_cnt / 2, cnt[1], cnt[0]);
 800         } else if (retval > 0)
 801                 free_pkts(pkts, retval);
 802
 803         TEST_ASSERT_EQUAL(retval, expected_pkts_cnt,
 804                 "Expected %u packets but received only %d", expected_pkts_cnt, retval);
 805
 806         /* Now, disable promiscuous mode. When promiscuous mode is disabled we
 807          * expect to receive only packets that are directed to bonding port. */
 808         rte_eth_promiscuous_disable(test_params.bonded_port_id);
 809
 810         expected_pkts_cnt = 0;
 811         FOR_EACH_SLAVE(i, slave) {
 812                 retval = generate_and_put_packets(slave, &src_mac, &bonded_mac, 1);
 813                 TEST_ASSERT_SUCCESS(retval, "Failed to enqueue packets to slave %u",
 814                         slave->port_id);
 815
 816                 retval = generate_and_put_packets(slave, &src_mac, &dst_mac, 1);
 817                 TEST_ASSERT_SUCCESS(retval, "Failed to enqueue packets to slave %u",
 818                         slave->port_id);
 819
 820                 /* Expect only one packet per slave */
 821                 expected_pkts_cnt += 1;
 822         }
 823
 824         retval = rte_eth_rx_burst(test_params.bonded_port_id, 0, pkts,
 825                 RTE_DIM(pkts));
 826
 827         if (retval == expected_pkts_cnt) {
 828                 int eq_cnt = 0;
 829
 830                 for (i = 0; i < expected_pkts_cnt; i++) {
 831                         hdr = rte_pktmbuf_mtod(pkts[i], struct ether_hdr *);
 832                         eq_cnt += is_same_ether_addr(&hdr->d_addr, &bonded_mac);
 833                 }
 834
 835                 free_pkts(pkts, expected_pkts_cnt);
 836                 TEST_ASSERT_EQUAL(eq_cnt, expected_pkts_cnt, "Packet address mismatch");
 837         } else if (retval > 0)
 838                 free_pkts(pkts, retval);
 839
 840         TEST_ASSERT_EQUAL(retval, expected_pkts_cnt,
 841                 "Expected %u packets but received only %d", expected_pkts_cnt, retval);
 842
 843         /* Link down test: simulate link down for first slave. */
 844         delay = bond_get_update_timeout_ms();
 845
 846         uint8_t slave_down_id = INVALID_PORT_ID;
 847
 848         /* Find first slave and make link down on it*/
 849         FOR_EACH_SLAVE(i, slave) {
 850                 rte_eth_dev_set_link_down(slave->port_id);
 851                 slave_down_id = slave->port_id;
 852                 break;
 853         }
 854
 855         RTE_VERIFY(slave_down_id != INVALID_PORT_ID);
 856
 857         /* Give some time to rearrange bonding */
 858         for (i = 0; i < 3; i++) {
 859                 rte_delay_ms(delay);
 860                 bond_handshake();
 861         }
 862
 863         TEST_ASSERT_SUCCESS(bond_handshake(), "Handshake after link down failed");
 864
 865         /* Put packet to each slave */
 866         FOR_EACH_SLAVE(i, slave) {
 867                 void *pkt = NULL;
 868
 869                 dst_mac.addr_bytes[ETHER_ADDR_LEN - 1] = slave->port_id;
 870                 retval = generate_and_put_packets(slave, &src_mac, &dst_mac, 1);
 871                 TEST_ASSERT_SUCCESS(retval, "Failed to generate test packet burst.");
 872
 873                 src_mac.addr_bytes[ETHER_ADDR_LEN - 1] = slave->port_id;
 874                 retval = generate_and_put_packets(slave, &src_mac, &bonded_mac, 1);
 875                 TEST_ASSERT_SUCCESS(retval, "Failed to generate test packet burst.");
 876
 877                 retval = bond_rx(pkts, RTE_DIM(pkts));
 878
 879                 /* Clean anything */
 880                 if (retval > 0)
 881                         free_pkts(pkts, retval);
 882
 883                 while (rte_ring_dequeue(slave->rx_queue, (void **)&pkt) == 0)
 884                         rte_pktmbuf_free(pkt);
 885
 886                 if (slave_down_id == slave->port_id)
 887                         TEST_ASSERT_EQUAL(retval, 0, "Packets received unexpectedly.");
 888                 else
 889                         TEST_ASSERT_NOT_EQUAL(retval, 0,
 890                                 "Expected to receive some packets on slave %u.",
 891                                 slave->port_id);
 892                 rte_eth_dev_start(slave->port_id);
 893
 894                 for (j = 0; j < 5; j++) {
 895                         TEST_ASSERT(bond_handshake_reply(slave) >= 0,
 896                                 "Handshake after link up");
 897
 898                         if (bond_handshake_done(slave) == 1)
 899                                 break;
 900                 }
 901
 902                 TEST_ASSERT(j < 5, "Failed to agregate slave after link up");
 903         }
 904
 905         remove_slaves_and_stop_bonded_device();
 906         return TEST_SUCCESS;
 907 }
 908
 909 static int
 910 test_mode4_tx_burst(void)
 911 {
 912         struct slave_conf *slave;
 913         uint16_t i, j;
 914
 915         uint16_t exp_pkts_cnt, pkts_cnt = 0;
 916         struct rte_mbuf *pkts[MAX_PKT_BURST];
 917         int retval;
 918         unsigned delay;
 919
 920         struct ether_addr dst_mac = { { 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00 } };
 921         struct ether_addr bonded_mac;
 922
 923         retval = initialize_bonded_device_with_slaves(TEST_TX_SLAVE_COUNT, 1);
 924         TEST_ASSERT_SUCCESS(retval, "Failed to initialize bonded device");
 925
 926         retval = bond_handshake();
 927         TEST_ASSERT_SUCCESS(retval, "Initial handshake failed");
 928
 929         rte_eth_macaddr_get(test_params.bonded_port_id, &bonded_mac);
 930
 931         /* Prepare burst */
 932         for (pkts_cnt = 0; pkts_cnt < RTE_DIM(pkts); pkts_cnt++) {
 933                 dst_mac.addr_bytes[ETHER_ADDR_LEN - 1] = pkts_cnt;
 934                 retval = generate_packets(&bonded_mac, &dst_mac, 1, &pkts[pkts_cnt]);
 935
 936                 if (retval != 1)
 937                         free_pkts(pkts, pkts_cnt);
 938
 939                 TEST_ASSERT_EQUAL(retval, 1, "Failed to generate packet %u", pkts_cnt);
 940         }
 941         exp_pkts_cnt = pkts_cnt;
 942
 943         /* Transmit packets on bonded device */
 944         retval = bond_tx(pkts, pkts_cnt);
 945         if (retval > 0 && retval < pkts_cnt)
 946                 free_pkts(&pkts[retval], pkts_cnt - retval);
 947
 948         TEST_ASSERT_EQUAL(retval, pkts_cnt, "TX on bonded device failed");
 949
 950         /* Check if packets were transmitted properly. Every slave should have
 951          * at least one packet, and sum must match. Under normal operation
 952          * there should be no LACP nor MARKER frames. */
 953         pkts_cnt = 0;
 954         FOR_EACH_SLAVE(i, slave) {
 955                 uint16_t normal_cnt, slow_cnt;
 956
 957                 retval = slave_get_pkts(slave, pkts, RTE_DIM(pkts));
 958                 normal_cnt = 0;
 959                 slow_cnt = 0;
 960
 961                 for (j = 0; j < retval; j++) {
 962                         if (make_lacp_reply(slave, pkts[j]) == 1)
 963                                 normal_cnt++;
 964                         else
 965                                 slow_cnt++;
 966                 }
 967
 968                 free_pkts(pkts, normal_cnt + slow_cnt);
 969                 TEST_ASSERT_EQUAL(slow_cnt, 0,
 970                         "slave %u unexpectedly transmitted %d SLOW packets", slave->port_id,
 971                         slow_cnt);
 972
 973                 TEST_ASSERT_NOT_EQUAL(normal_cnt, 0,
 974                         "slave %u did not transmitted any packets", slave->port_id);
 975
 976                 pkts_cnt += normal_cnt;
 977         }
 978
 979         TEST_ASSERT_EQUAL(exp_pkts_cnt, pkts_cnt,
 980                 "Expected %u packets but transmitted only %d", exp_pkts_cnt, pkts_cnt);
 981
 982         /* Link down test:
 983          * simulate link down for first slave. */
 984         delay = bond_get_update_timeout_ms();
 985
 986         uint8_t slave_down_id = INVALID_PORT_ID;
 987
 988         FOR_EACH_SLAVE(i, slave) {
 989                 rte_eth_dev_set_link_down(slave->port_id);
 990                 slave_down_id = slave->port_id;
 991                 break;
 992         }
 993
 994         RTE_VERIFY(slave_down_id != INVALID_PORT_ID);
 995
 996         /* Give some time to rearrange bonding. */
 997         for (i = 0; i < 3; i++) {
 998                 bond_handshake();
 999                 rte_delay_ms(delay);
1000         }
1001
1002         TEST_ASSERT_SUCCESS(bond_handshake(), "Handshake after link down failed");
1003
1004         /* Prepare burst. */
1005         for (pkts_cnt = 0; pkts_cnt < RTE_DIM(pkts); pkts_cnt++) {
1006                 dst_mac.addr_bytes[ETHER_ADDR_LEN - 1] = pkts_cnt;
1007                 retval = generate_packets(&bonded_mac, &dst_mac, 1, &pkts[pkts_cnt]);
1008
1009                 if (retval != 1)
1010                         free_pkts(pkts, pkts_cnt);
1011
1012                 TEST_ASSERT_EQUAL(retval, 1, "Failed to generate test packet %u",
1013                         pkts_cnt);
1014         }
1015         exp_pkts_cnt = pkts_cnt;
1016
1017         /* Transmit packets on bonded device. */
1018         retval = bond_tx(pkts, pkts_cnt);
1019         if (retval > 0 && retval < pkts_cnt)
1020                 free_pkts(&pkts[retval], pkts_cnt - retval);
1021
1022         TEST_ASSERT_EQUAL(retval, pkts_cnt, "TX on bonded device failed");
1023
1024         /* Check if packets was transmitted properly. Every slave should have
1025          * at least one packet, and sum must match. Under normal operation
1026          * there should be no LACP nor MARKER frames. */
1027         pkts_cnt = 0;
1028         FOR_EACH_SLAVE(i, slave) {
1029                 uint16_t normal_cnt, slow_cnt;
1030
1031                 retval = slave_get_pkts(slave, pkts, RTE_DIM(pkts));
1032                 normal_cnt = 0;
1033                 slow_cnt = 0;
1034
1035                 for (j = 0; j < retval; j++) {
1036                         if (make_lacp_reply(slave, pkts[j]) == 1)
1037                                 normal_cnt++;
1038                         else
1039                                 slow_cnt++;
1040                 }
1041
1042                 free_pkts(pkts, normal_cnt + slow_cnt);
1043
1044                 if (slave_down_id == slave->port_id) {
1045                         TEST_ASSERT_EQUAL(normal_cnt + slow_cnt, 0,
1046                                 "slave %u enexpectedly transmitted %u packets",
1047                                 normal_cnt + slow_cnt, slave->port_id);
1048                 } else {
1049                         TEST_ASSERT_EQUAL(slow_cnt, 0,
1050                                 "slave %u unexpectedly transmitted %d SLOW packets",
1051                                 slave->port_id, slow_cnt);
1052
1053                         TEST_ASSERT_NOT_EQUAL(normal_cnt, 0,
1054                                 "slave %u did not transmitted any packets", slave->port_id);
1055                 }
1056
1057                 pkts_cnt += normal_cnt;
1058         }
1059
1060         TEST_ASSERT_EQUAL(exp_pkts_cnt, pkts_cnt,
1061                 "Expected %u packets but transmitted only %d", exp_pkts_cnt, pkts_cnt);
1062
1063         return remove_slaves_and_stop_bonded_device();
1064 }
1065
1066 static void
1067 init_marker(struct rte_mbuf *pkt, struct slave_conf *slave)
1068 {
1069         struct marker_header *marker_hdr = rte_pktmbuf_mtod(pkt,
1070                         struct marker_header *);
1071
1072         /* Copy multicast destination address */
1073         ether_addr_copy(&slow_protocol_mac_addr, &marker_hdr->eth_hdr.d_addr);
1074
1075         /* Init source address */
1076         ether_addr_copy(&parnter_mac_default, &marker_hdr->eth_hdr.s_addr);
1077         marker_hdr->eth_hdr.s_addr.addr_bytes[ETHER_ADDR_LEN-1] = slave->port_id;
1078
1079         marker_hdr->eth_hdr.ether_type = rte_cpu_to_be_16(ETHER_TYPE_SLOW);
1080
1081         marker_hdr->marker.subtype = SLOW_SUBTYPE_MARKER;
1082         marker_hdr->marker.version_number = 1;
1083         marker_hdr->marker.tlv_type_marker = MARKER_TLV_TYPE_INFO;
1084         marker_hdr->marker.info_length =
1085                         offsetof(struct marker, reserved_90) -
1086                         offsetof(struct marker, requester_port);
1087         RTE_VERIFY(marker_hdr->marker.info_length == 16);
1088         marker_hdr->marker.requester_port = slave->port_id + 1;
1089         marker_hdr->marker.tlv_type_terminator = TLV_TYPE_TERMINATOR_INFORMATION;
1090         marker_hdr->marker.terminator_length = 0;
1091 }
1092
1093 static int
1094 test_mode4_marker(void)
1095 {
1096         struct slave_conf *slave;
1097         struct rte_mbuf *pkts[MAX_PKT_BURST];
1098         struct rte_mbuf *marker_pkt;
1099         struct marker_header *marker_hdr;
1100
1101         unsigned delay;
1102         int retval;
1103         uint16_t nb_pkts;
1104         uint8_t i, j;
1105         const uint16_t ethtype_slow_be = rte_be_to_cpu_16(ETHER_TYPE_SLOW);
1106
1107         retval = initialize_bonded_device_with_slaves(TEST_MARKER_SLAVE_COUT, 1);
1108         TEST_ASSERT_SUCCESS(retval, "Failed to initialize bonded device");
1109
1110         /* Test LACP handshake function */
1111         retval = bond_handshake();
1112         TEST_ASSERT_SUCCESS(retval, "Initial handshake failed");
1113
1114         delay = bond_get_update_timeout_ms();
1115         FOR_EACH_SLAVE(i, slave) {
1116                 marker_pkt = rte_pktmbuf_alloc(test_params.mbuf_pool);
1117                 TEST_ASSERT_NOT_NULL(marker_pkt, "Failed to allocate marker packet");
1118                 init_marker(marker_pkt, slave);
1119
1120                 retval = slave_put_pkts(slave, &marker_pkt, 1);
1121                 if (retval != 1)
1122                         rte_pktmbuf_free(marker_pkt);
1123
1124                 TEST_ASSERT_EQUAL(retval, 1,
1125                         "Failed to send marker packet to slave %u", slave->port_id);
1126
1127                 for (j = 0; j < 20; ++j) {
1128                         rte_delay_ms(delay);
1129                         retval = rte_eth_rx_burst(test_params.bonded_port_id, 0, pkts,
1130                                 RTE_DIM(pkts));
1131
1132                         if (retval > 0)
1133                                 free_pkts(pkts, retval);
1134
1135                         TEST_ASSERT_EQUAL(retval, 0, "Received packets unexpectedly");
1136
1137                         retval = rte_eth_tx_burst(test_params.bonded_port_id, 0, NULL, 0);
1138                         TEST_ASSERT_EQUAL(retval, 0,
1139                                 "Requested TX of 0 packets but %d transmitted", retval);
1140
1141                         /* Check if LACP packet was send by state machines
1142                            First and only packet must be a maker response */
1143                         retval = slave_get_pkts(slave, pkts, MAX_PKT_BURST);
1144                         if (retval == 0)
1145                                 continue;
1146                         if (retval > 1)
1147                                 free_pkts(pkts, retval);
1148
1149                         TEST_ASSERT_EQUAL(retval, 1, "failed to get slave packets");
1150                         nb_pkts = retval;
1151
1152                         marker_hdr = rte_pktmbuf_mtod(pkts[0], struct marker_header *);
1153                         /* Check if it's slow packet*/
1154                         if (marker_hdr->eth_hdr.ether_type != ethtype_slow_be)
1155                                 retval = -1;
1156                         /* Check if it's marker packet */
1157                         else if (marker_hdr->marker.subtype != SLOW_SUBTYPE_MARKER)
1158                                 retval = -2;
1159                         else if (marker_hdr->marker.tlv_type_marker != MARKER_TLV_TYPE_RESP)
1160                                 retval = -3;
1161
1162                         free_pkts(pkts, nb_pkts);
1163
1164                         TEST_ASSERT_NOT_EQUAL(retval, -1, "Unexpected protocol type");
1165                         TEST_ASSERT_NOT_EQUAL(retval, -2, "Unexpected sub protocol type");
1166                         TEST_ASSERT_NOT_EQUAL(retval, -3, "Unexpected marker type");
1167                         break;
1168                 }
1169
1170                 TEST_ASSERT(j < 20, "Marker response not found");
1171         }
1172
1173         retval = remove_slaves_and_stop_bonded_device();
1174         TEST_ASSERT_SUCCESS(retval,     "Test cleanup failed.");
1175
1176         return TEST_SUCCESS;
1177 }
1178
1179 static int
1180 test_mode4_expired(void)
1181 {
1182         struct slave_conf *slave, *exp_slave = NULL;
1183         struct rte_mbuf *pkts[MAX_PKT_BURST];
1184         int retval;
1185         uint32_t old_delay;
1186
1187         uint8_t i;
1188         uint16_t j;
1189
1190         struct rte_eth_bond_8023ad_conf conf;
1191
1192         retval = initialize_bonded_device_with_slaves(TEST_EXPIRED_SLAVE_COUNT, 1);
1193         /* Set custom timeouts to make test last shorter. */
1194         rte_eth_bond_8023ad_conf_get(test_params.bonded_port_id, &conf);
1195         conf.fast_periodic_ms = 100;
1196         conf.slow_periodic_ms = 600;
1197         conf.short_timeout_ms = 300;
1198         conf.long_timeout_ms = 900;
1199         conf.aggregate_wait_timeout_ms = 200;
1200         conf.tx_period_ms = 100;
1201         old_delay = conf.update_timeout_ms;
1202         conf.update_timeout_ms = 10;
1203         rte_eth_bond_8023ad_setup(test_params.bonded_port_id, &conf);
1204
1205         /* Wait for new settings to be applied. */
1206         for (i = 0; i < old_delay/conf.update_timeout_ms * 2; i++) {
1207                 FOR_EACH_SLAVE(j, slave)
1208                         bond_handshake_reply(slave);
1209
1210                 rte_delay_ms(conf.update_timeout_ms);
1211         }
1212
1213         retval = bond_handshake();
1214         TEST_ASSERT_SUCCESS(retval, "Initial handshake failed");
1215
1216         /* Find first slave */
1217         FOR_EACH_SLAVE(i, slave) {
1218                 exp_slave = slave;
1219                 break;
1220         }
1221
1222         RTE_VERIFY(exp_slave != NULL);
1223
1224         /* When one of partners do not send or respond to LACP frame in
1225          * conf.long_timeout_ms time, internal state machines should detect this
1226          * and transit to expired state. */
1227         for (j = 0; j < conf.long_timeout_ms/conf.update_timeout_ms + 2; j++) {
1228                 rte_delay_ms(conf.update_timeout_ms);
1229
1230                 retval = bond_tx(NULL, 0);
1231                 TEST_ASSERT_EQUAL(retval, 0, "Unexpectedly received %d packets",
1232                         retval);
1233
1234                 FOR_EACH_SLAVE(i, slave) {
1235                         retval = bond_handshake_reply(slave);
1236                         TEST_ASSERT(retval >= 0, "Handshake failed");
1237
1238                         /* Remove replay for slave that supose to be expired. */
1239                         if (slave == exp_slave) {
1240                                 while (rte_ring_count(slave->rx_queue) > 0) {
1241                                         void *pkt = NULL;
1242
1243                                         rte_ring_dequeue(slave->rx_queue, &pkt);
1244                                         rte_pktmbuf_free(pkt);
1245                                 }
1246                         }
1247                 }
1248
1249                 retval = bond_rx(pkts, RTE_DIM(pkts));
1250                 if (retval > 0)
1251                         free_pkts(pkts, retval);
1252
1253                 TEST_ASSERT_EQUAL(retval, 0, "Unexpectedly received %d packets",
1254                         retval);
1255         }
1256
1257         /* After test only expected slave should be in EXPIRED state */
1258         FOR_EACH_SLAVE(i, slave) {
1259                 if (slave == exp_slave)
1260                         TEST_ASSERT(slave->lacp_parnter_state & STATE_EXPIRED,
1261                                 "Slave %u should be in expired.", slave->port_id);
1262                 else
1263                         TEST_ASSERT_EQUAL(bond_handshake_done(slave), 1,
1264                                 "Slave %u should be operational.", slave->port_id);
1265         }
1266
1267         retval = remove_slaves_and_stop_bonded_device();
1268         TEST_ASSERT_SUCCESS(retval, "Test cleanup failed.");
1269
1270         return TEST_SUCCESS;
1271 }
1272
1273 static int
1274 check_environment(void)
1275 {
1276         struct slave_conf *port;
1277         uint8_t i, env_state;
1278         uint8_t slaves[RTE_DIM(test_params.slave_ports)];
1279         int slaves_count;
1280
1281         env_state = 0;
1282         FOR_EACH_PORT(i, port) {
1283                 if (rte_ring_count(port->rx_queue) != 0)
1284                         env_state |= 0x01;
1285
1286                 if (rte_ring_count(port->tx_queue) != 0)
1287                         env_state |= 0x02;
1288
1289                 if (port->bonded != 0)
1290                         env_state |= 0x04;
1291
1292                 if (port->lacp_parnter_state != 0)
1293                         env_state |= 0x08;
1294
1295                 if (env_state != 0)
1296                         break;
1297         }
1298
1299         slaves_count = rte_eth_bond_slaves_get(test_params.bonded_port_id,
1300                         slaves, RTE_DIM(slaves));
1301
1302         if (slaves_count != 0)
1303                 env_state |= 0x10;
1304
1305         TEST_ASSERT_EQUAL(env_state, 0,
1306                 "Environment not clean (port %u):%s%s%s%s%s",
1307                 port->port_id,
1308                 env_state & 0x01 ? " slave rx queue not clean" : "",
1309                 env_state & 0x02 ? " slave tx queue not clean" : "",
1310                 env_state & 0x04 ? " port marked as enslaved" : "",
1311                 env_state & 0x80 ? " slave state is not reset" : "",
1312                 env_state & 0x10 ? " slave count not equal 0" : ".");
1313
1314
1315         return TEST_SUCCESS;
1316 }
1317
1318 static int
1319 test_mode4_executor(int (*test_func)(void))
1320 {
1321         struct slave_conf *port;
1322         int test_result;
1323         uint8_t i;
1324         void *pkt;
1325
1326         /* Check if environment is clean. Fail to launch a test if there was
1327          * a critical error before that prevented to reset environment. */
1328         TEST_ASSERT_SUCCESS(check_environment(),
1329                 "Refusing to launch test in dirty environment.");
1330
1331         RTE_VERIFY(test_func != NULL);
1332         test_result = (*test_func)();
1333
1334         /* If test succeed check if environment wast left in good condition. */
1335         if (test_result == TEST_SUCCESS)
1336                 test_result = check_environment();
1337
1338         /* Reset environment in case test failed to do that. */
1339         if (test_result != TEST_SUCCESS) {
1340                 TEST_ASSERT_SUCCESS(remove_slaves_and_stop_bonded_device(),
1341                         "Failed to stop bonded device");
1342
1343                 FOR_EACH_PORT(i, port) {
1344                         while (rte_ring_count(port->rx_queue) != 0) {
1345                                 if (rte_ring_dequeue(port->rx_queue, &pkt) == 0)
1346                                         rte_pktmbuf_free(pkt);
1347                         }
1348
1349                         while (rte_ring_count(port->tx_queue) != 0) {
1350                                 if (rte_ring_dequeue(port->tx_queue, &pkt) == 0)
1351                                         rte_pktmbuf_free(pkt);
1352                         }
1353                 }
1354         }
1355
1356         return test_result;
1357 }
1358
1359 static int
1360 test_mode4_lacp_wrapper(void)
1361 {
1362         return test_mode4_executor(&test_mode4_lacp);
1363 }
1364
1365 static int
1366 test_mode4_marker_wrapper(void)
1367 {
1368         return test_mode4_executor(&test_mode4_marker);
1369 }
1370
1371 static int
1372 test_mode4_rx_wrapper(void)
1373 {
1374         return test_mode4_executor(&test_mode4_rx);
1375 }
1376
1377 static int
1378 test_mode4_tx_burst_wrapper(void)
1379 {
1380         return test_mode4_executor(&test_mode4_tx_burst);
1381 }
1382
1383 static int
1384 test_mode4_expired_wrapper(void)
1385 {
1386         return test_mode4_executor(&test_mode4_expired);
1387 }
1388
1389 static struct unit_test_suite link_bonding_mode4_test_suite  = {
1390         .suite_name = "Link Bonding mode 4 Unit Test Suite",
1391         .setup = test_setup,
1392         .teardown = testsuite_teardown,
1393         .unit_test_cases = {
1394                 TEST_CASE_NAMED("test_mode4_lacp", test_mode4_lacp_wrapper),
1395                 TEST_CASE_NAMED("test_mode4_rx", test_mode4_rx_wrapper),
1396                 TEST_CASE_NAMED("test_mode4_tx_burst", test_mode4_tx_burst_wrapper),
1397                 TEST_CASE_NAMED("test_mode4_marker", test_mode4_marker_wrapper),
1398                 TEST_CASE_NAMED("test_mode4_expired", test_mode4_expired_wrapper),
1399                 { NULL, NULL, NULL, NULL, NULL } /**< NULL terminate unit test array */
1400         }
1401 };
1402
1403 static int
1404 test_link_bonding_mode4(void)
1405 {
1406         return unit_test_suite_runner(&link_bonding_mode4_test_suite);
1407 }
1408
1409 static struct test_command link_bonding_cmd = {
1410         .command = "link_bonding_mode4_autotest",
1411         .callback = test_link_bonding_mode4,
1412 };
1413
1414 REGISTER_TEST_COMMAND(link_bonding_cmd);