drivers/net/kni/rte_eth_kni.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2017 Intel Corporation
   3  */
   4
   5 #include <fcntl.h>
   6 #include <pthread.h>
   7 #include <unistd.h>
   8
   9 #include <rte_string_fns.h>
  10 #include <rte_ethdev_driver.h>
  11 #include <rte_ethdev_vdev.h>
  12 #include <rte_kni.h>
  13 #include <rte_kvargs.h>
  14 #include <rte_malloc.h>
  15 #include <rte_bus_vdev.h>
  16
  17 /* Only single queue supported */
  18 #define KNI_MAX_QUEUE_PER_PORT 1
  19
  20 #define MAX_KNI_PORTS 8
  21
  22 #define KNI_ETHER_MTU(mbuf_size)       \
  23         ((mbuf_size) - RTE_ETHER_HDR_LEN) /**< Ethernet MTU. */
  24
  25 #define ETH_KNI_NO_REQUEST_THREAD_ARG   "no_request_thread"
  26 static const char * const valid_arguments[] = {
  27         ETH_KNI_NO_REQUEST_THREAD_ARG,
  28         NULL
  29 };
  30
  31 struct eth_kni_args {
  32         int no_request_thread;
  33 };
  34
  35 struct pmd_queue_stats {
  36         uint64_t pkts;
  37         uint64_t bytes;
  38 };
  39
  40 struct pmd_queue {
  41         struct pmd_internals *internals;
  42         struct rte_mempool *mb_pool;
  43
  44         struct pmd_queue_stats rx;
  45         struct pmd_queue_stats tx;
  46 };
  47
  48 struct pmd_internals {
  49         struct rte_kni *kni;
  50         int is_kni_started;
  51
  52         pthread_t thread;
  53         int stop_thread;
  54         int no_request_thread;
  55
  56         struct rte_ether_addr eth_addr;
  57
  58         struct pmd_queue rx_queues[KNI_MAX_QUEUE_PER_PORT];
  59         struct pmd_queue tx_queues[KNI_MAX_QUEUE_PER_PORT];
  60 };
  61
  62 static const struct rte_eth_link pmd_link = {
  63                 .link_speed = ETH_SPEED_NUM_10G,
  64                 .link_duplex = ETH_LINK_FULL_DUPLEX,
  65                 .link_status = ETH_LINK_DOWN,
  66                 .link_autoneg = ETH_LINK_FIXED,
  67 };
  68 static int is_kni_initialized;
  69
  70 static int eth_kni_logtype;
  71
  72 #define PMD_LOG(level, fmt, args...) \
  73         rte_log(RTE_LOG_ ## level, eth_kni_logtype, \
  74                 "%s(): " fmt "\n", __func__, ##args)
  75 static uint16_t
  76 eth_kni_rx(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
  77 {
  78         struct pmd_queue *kni_q = q;
  79         struct rte_kni *kni = kni_q->internals->kni;
  80         uint16_t nb_pkts;
  81
  82         nb_pkts = rte_kni_rx_burst(kni, bufs, nb_bufs);
  83
  84         kni_q->rx.pkts += nb_pkts;
  85
  86         return nb_pkts;
  87 }
  88
  89 static uint16_t
  90 eth_kni_tx(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
  91 {
  92         struct pmd_queue *kni_q = q;
  93         struct rte_kni *kni = kni_q->internals->kni;
  94         uint16_t nb_pkts;
  95
  96         nb_pkts =  rte_kni_tx_burst(kni, bufs, nb_bufs);
  97
  98         kni_q->tx.pkts += nb_pkts;
  99
 100         return nb_pkts;
 101 }
 102
 103 static void *
 104 kni_handle_request(void *param)
 105 {
 106         struct pmd_internals *internals = param;
 107 #define MS 1000
 108
 109         while (!internals->stop_thread) {
 110                 rte_kni_handle_request(internals->kni);
 111                 usleep(500 * MS);
 112         }
 113
 114         return param;
 115 }
 116
 117 static int
 118 eth_kni_start(struct rte_eth_dev *dev)
 119 {
 120         struct pmd_internals *internals = dev->data->dev_private;
 121         uint16_t port_id = dev->data->port_id;
 122         struct rte_mempool *mb_pool;
 123         struct rte_kni_conf conf;
 124         const char *name = dev->device->name + 4; /* remove net_ */
 125
 126         mb_pool = internals->rx_queues[0].mb_pool;
 127         strlcpy(conf.name, name, RTE_KNI_NAMESIZE);
 128         conf.force_bind = 0;
 129         conf.group_id = port_id;
 130         conf.mbuf_size =
 131                 rte_pktmbuf_data_room_size(mb_pool) - RTE_PKTMBUF_HEADROOM;
 132         conf.mtu = KNI_ETHER_MTU(conf.mbuf_size);
 133
 134         internals->kni = rte_kni_alloc(mb_pool, &conf, NULL);
 135         if (internals->kni == NULL) {
 136                 PMD_LOG(ERR,
 137                         "Fail to create kni interface for port: %d",
 138                         port_id);
 139                 return -1;
 140         }
 141
 142         return 0;
 143 }
 144
 145 static int
 146 eth_kni_dev_start(struct rte_eth_dev *dev)
 147 {
 148         struct pmd_internals *internals = dev->data->dev_private;
 149         int ret;
 150
 151         if (internals->is_kni_started == 0) {
 152                 ret = eth_kni_start(dev);
 153                 if (ret)
 154                         return -1;
 155                 internals->is_kni_started = 1;
 156         }
 157
 158         if (internals->no_request_thread == 0) {
 159                 ret = rte_ctrl_thread_create(&internals->thread,
 160                         "kni_handle_req", NULL,
 161                         kni_handle_request, internals);
 162                 if (ret) {
 163                         PMD_LOG(ERR,
 164                                 "Fail to create kni request thread");
 165                         return -1;
 166                 }
 167         }
 168
 169         dev->data->dev_link.link_status = 1;
 170
 171         return 0;
 172 }
 173
 174 static void
 175 eth_kni_dev_stop(struct rte_eth_dev *dev)
 176 {
 177         struct pmd_internals *internals = dev->data->dev_private;
 178         int ret;
 179
 180         if (internals->no_request_thread == 0) {
 181                 internals->stop_thread = 1;
 182
 183                 ret = pthread_cancel(internals->thread);
 184                 if (ret)
 185                         PMD_LOG(ERR, "Can't cancel the thread");
 186
 187                 ret = pthread_join(internals->thread, NULL);
 188                 if (ret)
 189                         PMD_LOG(ERR, "Can't join the thread");
 190
 191                 internals->stop_thread = 0;
 192         }
 193
 194         dev->data->dev_link.link_status = 0;
 195 }
 196
 197 static void
 198 eth_kni_close(struct rte_eth_dev *eth_dev)
 199 {
 200         struct pmd_internals *internals;
 201         int ret;
 202
 203         eth_kni_dev_stop(eth_dev);
 204
 205         /* mac_addrs must not be freed alone because part of dev_private */
 206         eth_dev->data->mac_addrs = NULL;
 207
 208         internals = eth_dev->data->dev_private;
 209         ret = rte_kni_release(internals->kni);
 210         if (ret)
 211                 PMD_LOG(WARNING, "Not able to release kni for %s",
 212                         eth_dev->data->name);
 213 }
 214
 215 static int
 216 eth_kni_dev_configure(struct rte_eth_dev *dev __rte_unused)
 217 {
 218         return 0;
 219 }
 220
 221 static int
 222 eth_kni_dev_info(struct rte_eth_dev *dev __rte_unused,
 223                 struct rte_eth_dev_info *dev_info)
 224 {
 225         dev_info->max_mac_addrs = 1;
 226         dev_info->max_rx_pktlen = UINT32_MAX;
 227         dev_info->max_rx_queues = KNI_MAX_QUEUE_PER_PORT;
 228         dev_info->max_tx_queues = KNI_MAX_QUEUE_PER_PORT;
 229         dev_info->min_rx_bufsize = 0;
 230
 231         return 0;
 232 }
 233
 234 static int
 235 eth_kni_rx_queue_setup(struct rte_eth_dev *dev,
 236                 uint16_t rx_queue_id,
 237                 uint16_t nb_rx_desc __rte_unused,
 238                 unsigned int socket_id __rte_unused,
 239                 const struct rte_eth_rxconf *rx_conf __rte_unused,
 240                 struct rte_mempool *mb_pool)
 241 {
 242         struct pmd_internals *internals = dev->data->dev_private;
 243         struct pmd_queue *q;
 244
 245         q = &internals->rx_queues[rx_queue_id];
 246         q->internals = internals;
 247         q->mb_pool = mb_pool;
 248
 249         dev->data->rx_queues[rx_queue_id] = q;
 250
 251         return 0;
 252 }
 253
 254 static int
 255 eth_kni_tx_queue_setup(struct rte_eth_dev *dev,
 256                 uint16_t tx_queue_id,
 257                 uint16_t nb_tx_desc __rte_unused,
 258                 unsigned int socket_id __rte_unused,
 259                 const struct rte_eth_txconf *tx_conf __rte_unused)
 260 {
 261         struct pmd_internals *internals = dev->data->dev_private;
 262         struct pmd_queue *q;
 263
 264         q = &internals->tx_queues[tx_queue_id];
 265         q->internals = internals;
 266
 267         dev->data->tx_queues[tx_queue_id] = q;
 268
 269         return 0;
 270 }
 271
 272 static void
 273 eth_kni_queue_release(void *q __rte_unused)
 274 {
 275 }
 276
 277 static int
 278 eth_kni_link_update(struct rte_eth_dev *dev __rte_unused,
 279                 int wait_to_complete __rte_unused)
 280 {
 281         return 0;
 282 }
 283
 284 static int
 285 eth_kni_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
 286 {
 287         unsigned long rx_packets_total = 0, rx_bytes_total = 0;
 288         unsigned long tx_packets_total = 0, tx_bytes_total = 0;
 289         struct rte_eth_dev_data *data = dev->data;
 290         unsigned int i, num_stats;
 291         struct pmd_queue *q;
 292
 293         num_stats = RTE_MIN((unsigned int)RTE_ETHDEV_QUEUE_STAT_CNTRS,
 294                         data->nb_rx_queues);
 295         for (i = 0; i < num_stats; i++) {
 296                 q = data->rx_queues[i];
 297                 stats->q_ipackets[i] = q->rx.pkts;
 298                 stats->q_ibytes[i] = q->rx.bytes;
 299                 rx_packets_total += stats->q_ipackets[i];
 300                 rx_bytes_total += stats->q_ibytes[i];
 301         }
 302
 303         num_stats = RTE_MIN((unsigned int)RTE_ETHDEV_QUEUE_STAT_CNTRS,
 304                         data->nb_tx_queues);
 305         for (i = 0; i < num_stats; i++) {
 306                 q = data->tx_queues[i];
 307                 stats->q_opackets[i] = q->tx.pkts;
 308                 stats->q_obytes[i] = q->tx.bytes;
 309                 tx_packets_total += stats->q_opackets[i];
 310                 tx_bytes_total += stats->q_obytes[i];
 311         }
 312
 313         stats->ipackets = rx_packets_total;
 314         stats->ibytes = rx_bytes_total;
 315         stats->opackets = tx_packets_total;
 316         stats->obytes = tx_bytes_total;
 317
 318         return 0;
 319 }
 320
 321 static void
 322 eth_kni_stats_reset(struct rte_eth_dev *dev)
 323 {
 324         struct rte_eth_dev_data *data = dev->data;
 325         struct pmd_queue *q;
 326         unsigned int i;
 327
 328         for (i = 0; i < data->nb_rx_queues; i++) {
 329                 q = data->rx_queues[i];
 330                 q->rx.pkts = 0;
 331                 q->rx.bytes = 0;
 332         }
 333         for (i = 0; i < data->nb_tx_queues; i++) {
 334                 q = data->tx_queues[i];
 335                 q->tx.pkts = 0;
 336                 q->tx.bytes = 0;
 337         }
 338 }
 339
 340 static const struct eth_dev_ops eth_kni_ops = {
 341         .dev_start = eth_kni_dev_start,
 342         .dev_stop = eth_kni_dev_stop,
 343         .dev_close = eth_kni_close,
 344         .dev_configure = eth_kni_dev_configure,
 345         .dev_infos_get = eth_kni_dev_info,
 346         .rx_queue_setup = eth_kni_rx_queue_setup,
 347         .tx_queue_setup = eth_kni_tx_queue_setup,
 348         .rx_queue_release = eth_kni_queue_release,
 349         .tx_queue_release = eth_kni_queue_release,
 350         .link_update = eth_kni_link_update,
 351         .stats_get = eth_kni_stats_get,
 352         .stats_reset = eth_kni_stats_reset,
 353 };
 354
 355 static struct rte_eth_dev *
 356 eth_kni_create(struct rte_vdev_device *vdev,
 357                 struct eth_kni_args *args,
 358                 unsigned int numa_node)
 359 {
 360         struct pmd_internals *internals;
 361         struct rte_eth_dev_data *data;
 362         struct rte_eth_dev *eth_dev;
 363
 364         PMD_LOG(INFO, "Creating kni ethdev on numa socket %u",
 365                         numa_node);
 366
 367         /* reserve an ethdev entry */
 368         eth_dev = rte_eth_vdev_allocate(vdev, sizeof(*internals));
 369         if (!eth_dev)
 370                 return NULL;
 371
 372         internals = eth_dev->data->dev_private;
 373         data = eth_dev->data;
 374         data->nb_rx_queues = 1;
 375         data->nb_tx_queues = 1;
 376         data->dev_link = pmd_link;
 377         data->mac_addrs = &internals->eth_addr;
 378
 379         data->dev_flags |= RTE_ETH_DEV_CLOSE_REMOVE;
 380
 381         rte_eth_random_addr(internals->eth_addr.addr_bytes);
 382
 383         eth_dev->dev_ops = &eth_kni_ops;
 384
 385         internals->no_request_thread = args->no_request_thread;
 386
 387         return eth_dev;
 388 }
 389
 390 static int
 391 kni_init(void)
 392 {
 393         if (is_kni_initialized == 0)
 394                 rte_kni_init(MAX_KNI_PORTS);
 395
 396         is_kni_initialized++;
 397
 398         return 0;
 399 }
 400
 401 static int
 402 eth_kni_kvargs_process(struct eth_kni_args *args, const char *params)
 403 {
 404         struct rte_kvargs *kvlist;
 405
 406         kvlist = rte_kvargs_parse(params, valid_arguments);
 407         if (kvlist == NULL)
 408                 return -1;
 409
 410         memset(args, 0, sizeof(struct eth_kni_args));
 411
 412         if (rte_kvargs_count(kvlist, ETH_KNI_NO_REQUEST_THREAD_ARG) == 1)
 413                 args->no_request_thread = 1;
 414
 415         rte_kvargs_free(kvlist);
 416
 417         return 0;
 418 }
 419
 420 static int
 421 eth_kni_probe(struct rte_vdev_device *vdev)
 422 {
 423         struct rte_eth_dev *eth_dev;
 424         struct eth_kni_args args;
 425         const char *name;
 426         const char *params;
 427         int ret;
 428
 429         name = rte_vdev_device_name(vdev);
 430         params = rte_vdev_device_args(vdev);
 431         PMD_LOG(INFO, "Initializing eth_kni for %s", name);
 432
 433         if (rte_eal_process_type() == RTE_PROC_SECONDARY) {
 434                 eth_dev = rte_eth_dev_attach_secondary(name);
 435                 if (!eth_dev) {
 436                         PMD_LOG(ERR, "Failed to probe %s", name);
 437                         return -1;
 438                 }
 439                 /* TODO: request info from primary to set up Rx and Tx */
 440                 eth_dev->dev_ops = &eth_kni_ops;
 441                 eth_dev->device = &vdev->device;
 442                 rte_eth_dev_probing_finish(eth_dev);
 443                 return 0;
 444         }
 445
 446         ret = eth_kni_kvargs_process(&args, params);
 447         if (ret < 0)
 448                 return ret;
 449
 450         ret = kni_init();
 451         if (ret < 0)
 452                 return ret;
 453
 454         eth_dev = eth_kni_create(vdev, &args, rte_socket_id());
 455         if (eth_dev == NULL)
 456                 goto kni_uninit;
 457
 458         eth_dev->rx_pkt_burst = eth_kni_rx;
 459         eth_dev->tx_pkt_burst = eth_kni_tx;
 460
 461         rte_eth_dev_probing_finish(eth_dev);
 462         return 0;
 463
 464 kni_uninit:
 465         is_kni_initialized--;
 466         if (is_kni_initialized == 0)
 467                 rte_kni_close();
 468         return -1;
 469 }
 470
 471 static int
 472 eth_kni_remove(struct rte_vdev_device *vdev)
 473 {
 474         struct rte_eth_dev *eth_dev;
 475         const char *name;
 476
 477         name = rte_vdev_device_name(vdev);
 478         PMD_LOG(INFO, "Un-Initializing eth_kni for %s", name);
 479
 480         /* find the ethdev entry */
 481         eth_dev = rte_eth_dev_allocated(name);
 482         if (eth_dev == NULL)
 483                 return -1;
 484
 485         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
 486                 eth_kni_dev_stop(eth_dev);
 487                 return rte_eth_dev_release_port(eth_dev);
 488         }
 489
 490         eth_kni_close(eth_dev);
 491         rte_eth_dev_release_port(eth_dev);
 492
 493         is_kni_initialized--;
 494         if (is_kni_initialized == 0)
 495                 rte_kni_close();
 496
 497         return 0;
 498 }
 499
 500 static struct rte_vdev_driver eth_kni_drv = {
 501         .probe = eth_kni_probe,
 502         .remove = eth_kni_remove,
 503 };
 504
 505 RTE_PMD_REGISTER_VDEV(net_kni, eth_kni_drv);
 506 RTE_PMD_REGISTER_PARAM_STRING(net_kni, ETH_KNI_NO_REQUEST_THREAD_ARG "=<int>");
 507
 508 RTE_INIT(eth_kni_init_log)
 509 {
 510         eth_kni_logtype = rte_log_register("pmd.net.kni");
 511         if (eth_kni_logtype >= 0)
 512                 rte_log_set_level(eth_kni_logtype, RTE_LOG_NOTICE);
 513 }