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