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