app/test/test_link_bonding_mode4.c

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