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