drivers/net/memif/rte_eth_memif.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright 2018-2019 Cisco Systems, Inc.  All rights reserved.
   3  */
   4
   5 #include <stdlib.h>
   6 #include <fcntl.h>
   7 #include <unistd.h>
   8 #include <sys/types.h>
   9 #include <sys/socket.h>
  10 #include <sys/un.h>
  11 #include <sys/ioctl.h>
  12 #include <sys/mman.h>
  13 #include <linux/if_ether.h>
  14 #include <errno.h>
  15 #include <sys/eventfd.h>
  16
  17 #include <rte_version.h>
  18 #include <rte_mbuf.h>
  19 #include <rte_ether.h>
  20 #include <rte_ethdev_driver.h>
  21 #include <rte_ethdev_vdev.h>
  22 #include <rte_malloc.h>
  23 #include <rte_kvargs.h>
  24 #include <rte_bus_vdev.h>
  25 #include <rte_string_fns.h>
  26
  27 #include "rte_eth_memif.h"
  28 #include "memif_socket.h"
  29
  30 #define ETH_MEMIF_ID_ARG                "id"
  31 #define ETH_MEMIF_ROLE_ARG              "role"
  32 #define ETH_MEMIF_PKT_BUFFER_SIZE_ARG   "bsize"
  33 #define ETH_MEMIF_RING_SIZE_ARG         "rsize"
  34 #define ETH_MEMIF_SOCKET_ARG            "socket"
  35 #define ETH_MEMIF_MAC_ARG               "mac"
  36 #define ETH_MEMIF_ZC_ARG                "zero-copy"
  37 #define ETH_MEMIF_SECRET_ARG            "secret"
  38
  39 static const char * const valid_arguments[] = {
  40         ETH_MEMIF_ID_ARG,
  41         ETH_MEMIF_ROLE_ARG,
  42         ETH_MEMIF_PKT_BUFFER_SIZE_ARG,
  43         ETH_MEMIF_RING_SIZE_ARG,
  44         ETH_MEMIF_SOCKET_ARG,
  45         ETH_MEMIF_MAC_ARG,
  46         ETH_MEMIF_ZC_ARG,
  47         ETH_MEMIF_SECRET_ARG,
  48         NULL
  49 };
  50
  51 #define MEMIF_MP_SEND_REGION            "memif_mp_send_region"
  52
  53 const char *
  54 memif_version(void)
  55 {
  56         return ("memif-" RTE_STR(MEMIF_VERSION_MAJOR) "." RTE_STR(MEMIF_VERSION_MINOR));
  57 }
  58
  59 /* Message header to synchronize regions */
  60 struct mp_region_msg {
  61         char port_name[RTE_DEV_NAME_MAX_LEN];
  62         memif_region_index_t idx;
  63         memif_region_size_t size;
  64 };
  65
  66 static int
  67 memif_mp_send_region(const struct rte_mp_msg *msg, const void *peer)
  68 {
  69         struct rte_eth_dev *dev;
  70         struct pmd_process_private *proc_private;
  71         const struct mp_region_msg *msg_param = (const struct mp_region_msg *)msg->param;
  72         struct rte_mp_msg reply;
  73         struct mp_region_msg *reply_param = (struct mp_region_msg *)reply.param;
  74         uint16_t port_id;
  75         int ret;
  76
  77         /* Get requested port */
  78         ret = rte_eth_dev_get_port_by_name(msg_param->port_name, &port_id);
  79         if (ret) {
  80                 MIF_LOG(ERR, "Failed to get port id for %s",
  81                         msg_param->port_name);
  82                 return -1;
  83         }
  84         dev = &rte_eth_devices[port_id];
  85         proc_private = dev->process_private;
  86
  87         memset(&reply, 0, sizeof(reply));
  88         strlcpy(reply.name, msg->name, sizeof(reply.name));
  89         reply_param->idx = msg_param->idx;
  90         if (proc_private->regions[msg_param->idx] != NULL) {
  91                 reply_param->size = proc_private->regions[msg_param->idx]->region_size;
  92                 reply.fds[0] = proc_private->regions[msg_param->idx]->fd;
  93                 reply.num_fds = 1;
  94         }
  95         reply.len_param = sizeof(*reply_param);
  96         if (rte_mp_reply(&reply, peer) < 0) {
  97                 MIF_LOG(ERR, "Failed to reply to an add region request");
  98                 return -1;
  99         }
 100
 101         return 0;
 102 }
 103
 104 /*
 105  * Request regions
 106  * Called by secondary process, when ports link status goes up.
 107  */
 108 static int
 109 memif_mp_request_regions(struct rte_eth_dev *dev)
 110 {
 111         int ret, i;
 112         struct timespec timeout = {.tv_sec = 5, .tv_nsec = 0};
 113         struct rte_mp_msg msg, *reply;
 114         struct rte_mp_reply replies;
 115         struct mp_region_msg *msg_param = (struct mp_region_msg *)msg.param;
 116         struct mp_region_msg *reply_param;
 117         struct memif_region *r;
 118         struct pmd_process_private *proc_private = dev->process_private;
 119
 120         MIF_LOG(DEBUG, "Requesting memory regions");
 121
 122         for (i = 0; i < ETH_MEMIF_MAX_REGION_NUM; i++) {
 123                 /* Prepare the message */
 124                 memset(&msg, 0, sizeof(msg));
 125                 strlcpy(msg.name, MEMIF_MP_SEND_REGION, sizeof(msg.name));
 126                 strlcpy(msg_param->port_name, dev->data->name,
 127                         sizeof(msg_param->port_name));
 128                 msg_param->idx = i;
 129                 msg.len_param = sizeof(*msg_param);
 130
 131                 /* Send message */
 132                 ret = rte_mp_request_sync(&msg, &replies, &timeout);
 133                 if (ret < 0 || replies.nb_received != 1) {
 134                         MIF_LOG(ERR, "Failed to send mp msg: %d",
 135                                 rte_errno);
 136                         return -1;
 137                 }
 138
 139                 reply = &replies.msgs[0];
 140                 reply_param = (struct mp_region_msg *)reply->param;
 141
 142                 if (reply_param->size > 0) {
 143                         r = rte_zmalloc("region", sizeof(struct memif_region), 0);
 144                         if (r == NULL) {
 145                                 MIF_LOG(ERR, "Failed to alloc memif region.");
 146                                 free(reply);
 147                                 return -ENOMEM;
 148                         }
 149                         r->region_size = reply_param->size;
 150                         if (reply->num_fds < 1) {
 151                                 MIF_LOG(ERR, "Missing file descriptor.");
 152                                 free(reply);
 153                                 return -1;
 154                         }
 155                         r->fd = reply->fds[0];
 156                         r->addr = NULL;
 157
 158                         proc_private->regions[reply_param->idx] = r;
 159                         proc_private->regions_num++;
 160                 }
 161                 free(reply);
 162         }
 163
 164         return memif_connect(dev);
 165 }
 166
 167 static void
 168 memif_dev_info(struct rte_eth_dev *dev __rte_unused, struct rte_eth_dev_info *dev_info)
 169 {
 170         dev_info->max_mac_addrs = 1;
 171         dev_info->max_rx_pktlen = (uint32_t)ETH_FRAME_LEN;
 172         dev_info->max_rx_queues = ETH_MEMIF_MAX_NUM_Q_PAIRS;
 173         dev_info->max_tx_queues = ETH_MEMIF_MAX_NUM_Q_PAIRS;
 174         dev_info->min_rx_bufsize = 0;
 175 }
 176
 177 static memif_ring_t *
 178 memif_get_ring(struct pmd_internals *pmd, struct pmd_process_private *proc_private,
 179                memif_ring_type_t type, uint16_t ring_num)
 180 {
 181         /* rings only in region 0 */
 182         void *p = proc_private->regions[0]->addr;
 183         int ring_size = sizeof(memif_ring_t) + sizeof(memif_desc_t) *
 184             (1 << pmd->run.log2_ring_size);
 185
 186         p = (uint8_t *)p + (ring_num + type * pmd->run.num_s2m_rings) * ring_size;
 187
 188         return (memif_ring_t *)p;
 189 }
 190
 191 static memif_region_offset_t
 192 memif_get_ring_offset(struct rte_eth_dev *dev, struct memif_queue *mq,
 193                       memif_ring_type_t type, uint16_t num)
 194 {
 195         struct pmd_internals *pmd = dev->data->dev_private;
 196         struct pmd_process_private *proc_private = dev->process_private;
 197
 198         return ((uint8_t *)memif_get_ring(pmd, proc_private, type, num) -
 199                 (uint8_t *)proc_private->regions[mq->region]->addr);
 200 }
 201
 202 static memif_ring_t *
 203 memif_get_ring_from_queue(struct pmd_process_private *proc_private,
 204                           struct memif_queue *mq)
 205 {
 206         struct memif_region *r;
 207
 208         r = proc_private->regions[mq->region];
 209         if (r == NULL)
 210                 return NULL;
 211
 212         return (memif_ring_t *)((uint8_t *)r->addr + mq->ring_offset);
 213 }
 214
 215 static void *
 216 memif_get_buffer(struct pmd_process_private *proc_private, memif_desc_t *d)
 217 {
 218         return ((uint8_t *)proc_private->regions[d->region]->addr + d->offset);
 219 }
 220
 221 static int
 222 memif_pktmbuf_chain(struct rte_mbuf *head, struct rte_mbuf *cur_tail,
 223                     struct rte_mbuf *tail)
 224 {
 225         /* Check for number-of-segments-overflow */
 226         if (unlikely(head->nb_segs + tail->nb_segs > RTE_MBUF_MAX_NB_SEGS))
 227                 return -EOVERFLOW;
 228
 229         /* Chain 'tail' onto the old tail */
 230         cur_tail->next = tail;
 231
 232         /* accumulate number of segments and total length. */
 233         head->nb_segs = (uint16_t)(head->nb_segs + tail->nb_segs);
 234
 235         tail->pkt_len = tail->data_len;
 236         head->pkt_len += tail->pkt_len;
 237
 238         return 0;
 239 }
 240
 241 static uint16_t
 242 eth_memif_rx(void *queue, struct rte_mbuf **bufs, uint16_t nb_pkts)
 243 {
 244         struct memif_queue *mq = queue;
 245         struct pmd_internals *pmd = rte_eth_devices[mq->in_port].data->dev_private;
 246         struct pmd_process_private *proc_private =
 247                 rte_eth_devices[mq->in_port].process_private;
 248         memif_ring_t *ring = memif_get_ring_from_queue(proc_private, mq);
 249         uint16_t cur_slot, last_slot, n_slots, ring_size, mask, s0;
 250         uint16_t n_rx_pkts = 0;
 251         uint16_t mbuf_size = rte_pktmbuf_data_room_size(mq->mempool) -
 252                 RTE_PKTMBUF_HEADROOM;
 253         uint16_t src_len, src_off, dst_len, dst_off, cp_len;
 254         memif_ring_type_t type = mq->type;
 255         memif_desc_t *d0;
 256         struct rte_mbuf *mbuf, *mbuf_head, *mbuf_tail;
 257         uint64_t b;
 258         ssize_t size __rte_unused;
 259         uint16_t head;
 260         int ret;
 261         struct rte_eth_link link;
 262
 263         if (unlikely((pmd->flags & ETH_MEMIF_FLAG_CONNECTED) == 0))
 264                 return 0;
 265         if (unlikely(ring == NULL)) {
 266                 /* Secondary process will attempt to request regions. */
 267                 rte_eth_link_get(mq->in_port, &link);
 268                 return 0;
 269         }
 270
 271         /* consume interrupt */
 272         if ((ring->flags & MEMIF_RING_FLAG_MASK_INT) == 0)
 273                 size = read(mq->intr_handle.fd, &b, sizeof(b));
 274
 275         ring_size = 1 << mq->log2_ring_size;
 276         mask = ring_size - 1;
 277
 278         cur_slot = (type == MEMIF_RING_S2M) ? mq->last_head : mq->last_tail;
 279         last_slot = (type == MEMIF_RING_S2M) ? ring->head : ring->tail;
 280         if (cur_slot == last_slot)
 281                 goto refill;
 282         n_slots = last_slot - cur_slot;
 283
 284         while (n_slots && n_rx_pkts < nb_pkts) {
 285                 mbuf_head = rte_pktmbuf_alloc(mq->mempool);
 286                 if (unlikely(mbuf_head == NULL))
 287                         goto no_free_bufs;
 288                 mbuf = mbuf_head;
 289                 mbuf->port = mq->in_port;
 290
 291 next_slot:
 292                 s0 = cur_slot & mask;
 293                 d0 = &ring->desc[s0];
 294
 295                 src_len = d0->length;
 296                 dst_off = 0;
 297                 src_off = 0;
 298
 299                 do {
 300                         dst_len = mbuf_size - dst_off;
 301                         if (dst_len == 0) {
 302                                 dst_off = 0;
 303                                 dst_len = mbuf_size;
 304
 305                                 /* store pointer to tail */
 306                                 mbuf_tail = mbuf;
 307                                 mbuf = rte_pktmbuf_alloc(mq->mempool);
 308                                 if (unlikely(mbuf == NULL))
 309                                         goto no_free_bufs;
 310                                 mbuf->port = mq->in_port;
 311                                 ret = memif_pktmbuf_chain(mbuf_head, mbuf_tail, mbuf);
 312                                 if (unlikely(ret < 0)) {
 313                                         MIF_LOG(ERR, "number-of-segments-overflow");
 314                                         rte_pktmbuf_free(mbuf);
 315                                         goto no_free_bufs;
 316                                 }
 317                         }
 318                         cp_len = RTE_MIN(dst_len, src_len);
 319
 320                         rte_pktmbuf_data_len(mbuf) += cp_len;
 321                         rte_pktmbuf_pkt_len(mbuf) = rte_pktmbuf_data_len(mbuf);
 322                         if (mbuf != mbuf_head)
 323                                 rte_pktmbuf_pkt_len(mbuf_head) += cp_len;
 324
 325                         memcpy(rte_pktmbuf_mtod_offset(mbuf, void *, dst_off),
 326                                (uint8_t *)memif_get_buffer(proc_private, d0) +
 327                                src_off, cp_len);
 328
 329                         src_off += cp_len;
 330                         dst_off += cp_len;
 331                         src_len -= cp_len;
 332                 } while (src_len);
 333
 334                 cur_slot++;
 335                 n_slots--;
 336
 337                 if (d0->flags & MEMIF_DESC_FLAG_NEXT)
 338                         goto next_slot;
 339
 340                 mq->n_bytes += rte_pktmbuf_pkt_len(mbuf_head);
 341                 *bufs++ = mbuf_head;
 342                 n_rx_pkts++;
 343         }
 344
 345 no_free_bufs:
 346         if (type == MEMIF_RING_S2M) {
 347                 rte_mb();
 348                 ring->tail = cur_slot;
 349                 mq->last_head = cur_slot;
 350         } else {
 351                 mq->last_tail = cur_slot;
 352         }
 353
 354 refill:
 355         if (type == MEMIF_RING_M2S) {
 356                 head = ring->head;
 357                 n_slots = ring_size - head + mq->last_tail;
 358
 359                 while (n_slots--) {
 360                         s0 = head++ & mask;
 361                         d0 = &ring->desc[s0];
 362                         d0->length = pmd->run.pkt_buffer_size;
 363                 }
 364                 rte_mb();
 365                 ring->head = head;
 366         }
 367
 368         mq->n_pkts += n_rx_pkts;
 369         return n_rx_pkts;
 370 }
 371
 372 static uint16_t
 373 eth_memif_tx(void *queue, struct rte_mbuf **bufs, uint16_t nb_pkts)
 374 {
 375         struct memif_queue *mq = queue;
 376         struct pmd_internals *pmd = rte_eth_devices[mq->in_port].data->dev_private;
 377         struct pmd_process_private *proc_private =
 378                 rte_eth_devices[mq->in_port].process_private;
 379         memif_ring_t *ring = memif_get_ring_from_queue(proc_private, mq);
 380         uint16_t slot, saved_slot, n_free, ring_size, mask, n_tx_pkts = 0;
 381         uint16_t src_len, src_off, dst_len, dst_off, cp_len;
 382         memif_ring_type_t type = mq->type;
 383         memif_desc_t *d0;
 384         struct rte_mbuf *mbuf;
 385         struct rte_mbuf *mbuf_head;
 386         uint64_t a;
 387         ssize_t size;
 388         struct rte_eth_link link;
 389
 390         if (unlikely((pmd->flags & ETH_MEMIF_FLAG_CONNECTED) == 0))
 391                 return 0;
 392         if (unlikely(ring == NULL)) {
 393                 /* Secondary process will attempt to request regions. */
 394                 rte_eth_link_get(mq->in_port, &link);
 395                 return 0;
 396         }
 397
 398         ring_size = 1 << mq->log2_ring_size;
 399         mask = ring_size - 1;
 400
 401         n_free = ring->tail - mq->last_tail;
 402         mq->last_tail += n_free;
 403         slot = (type == MEMIF_RING_S2M) ? ring->head : ring->tail;
 404
 405         if (type == MEMIF_RING_S2M)
 406                 n_free = ring_size - ring->head + mq->last_tail;
 407         else
 408                 n_free = ring->head - ring->tail;
 409
 410         while (n_tx_pkts < nb_pkts && n_free) {
 411                 mbuf_head = *bufs++;
 412                 mbuf = mbuf_head;
 413
 414                 saved_slot = slot;
 415                 d0 = &ring->desc[slot & mask];
 416                 dst_off = 0;
 417                 dst_len = (type == MEMIF_RING_S2M) ?
 418                         pmd->run.pkt_buffer_size : d0->length;
 419
 420 next_in_chain:
 421                 src_off = 0;
 422                 src_len = rte_pktmbuf_data_len(mbuf);
 423
 424                 while (src_len) {
 425                         if (dst_len == 0) {
 426                                 if (n_free) {
 427                                         slot++;
 428                                         n_free--;
 429                                         d0->flags |= MEMIF_DESC_FLAG_NEXT;
 430                                         d0 = &ring->desc[slot & mask];
 431                                         dst_off = 0;
 432                                         dst_len = (type == MEMIF_RING_S2M) ?
 433                                             pmd->run.pkt_buffer_size : d0->length;
 434                                         d0->flags = 0;
 435                                 } else {
 436                                         slot = saved_slot;
 437                                         goto no_free_slots;
 438                                 }
 439                         }
 440                         cp_len = RTE_MIN(dst_len, src_len);
 441
 442                         memcpy((uint8_t *)memif_get_buffer(proc_private, d0) + dst_off,
 443                                rte_pktmbuf_mtod_offset(mbuf, void *, src_off),
 444                                cp_len);
 445
 446                         mq->n_bytes += cp_len;
 447                         src_off += cp_len;
 448                         dst_off += cp_len;
 449                         src_len -= cp_len;
 450                         dst_len -= cp_len;
 451
 452                         d0->length = dst_off;
 453                 }
 454
 455                 if (rte_pktmbuf_is_contiguous(mbuf) == 0) {
 456                         mbuf = mbuf->next;
 457                         goto next_in_chain;
 458                 }
 459
 460                 n_tx_pkts++;
 461                 slot++;
 462                 n_free--;
 463                 rte_pktmbuf_free(mbuf_head);
 464         }
 465
 466 no_free_slots:
 467         rte_mb();
 468         if (type == MEMIF_RING_S2M)
 469                 ring->head = slot;
 470         else
 471                 ring->tail = slot;
 472
 473         if ((ring->flags & MEMIF_RING_FLAG_MASK_INT) == 0) {
 474                 a = 1;
 475                 size = write(mq->intr_handle.fd, &a, sizeof(a));
 476                 if (unlikely(size < 0)) {
 477                         MIF_LOG(WARNING,
 478                                 "Failed to send interrupt. %s", strerror(errno));
 479                 }
 480         }
 481
 482         mq->n_pkts += n_tx_pkts;
 483         return n_tx_pkts;
 484 }
 485
 486 void
 487 memif_free_regions(struct pmd_process_private *proc_private)
 488 {
 489         int i;
 490         struct memif_region *r;
 491
 492         MIF_LOG(DEBUG, "Free memory regions");
 493         /* regions are allocated contiguously, so it's
 494          * enough to loop until 'proc_private->regions_num'
 495          */
 496         for (i = 0; i < proc_private->regions_num; i++) {
 497                 r = proc_private->regions[i];
 498                 if (r != NULL) {
 499                         if (r->addr != NULL) {
 500                                 munmap(r->addr, r->region_size);
 501                                 if (r->fd > 0) {
 502                                         close(r->fd);
 503                                         r->fd = -1;
 504                                 }
 505                         }
 506                         rte_free(r);
 507                         proc_private->regions[i] = NULL;
 508                 }
 509         }
 510         proc_private->regions_num = 0;
 511 }
 512
 513 static int
 514 memif_region_init_shm(struct rte_eth_dev *dev, uint8_t has_buffers)
 515 {
 516         struct pmd_internals *pmd = dev->data->dev_private;
 517         struct pmd_process_private *proc_private = dev->process_private;
 518         char shm_name[ETH_MEMIF_SHM_NAME_SIZE];
 519         int ret = 0;
 520         struct memif_region *r;
 521
 522         if (proc_private->regions_num >= ETH_MEMIF_MAX_REGION_NUM) {
 523                 MIF_LOG(ERR, "Too many regions.");
 524                 return -1;
 525         }
 526
 527         r = rte_zmalloc("region", sizeof(struct memif_region), 0);
 528         if (r == NULL) {
 529                 MIF_LOG(ERR, "Failed to alloc memif region.");
 530                 return -ENOMEM;
 531         }
 532
 533         /* calculate buffer offset */
 534         r->pkt_buffer_offset = (pmd->run.num_s2m_rings + pmd->run.num_m2s_rings) *
 535             (sizeof(memif_ring_t) + sizeof(memif_desc_t) *
 536             (1 << pmd->run.log2_ring_size));
 537
 538         r->region_size = r->pkt_buffer_offset;
 539         /* if region has buffers, add buffers size to region_size */
 540         if (has_buffers == 1)
 541                 r->region_size += (uint32_t)(pmd->run.pkt_buffer_size *
 542                         (1 << pmd->run.log2_ring_size) *
 543                         (pmd->run.num_s2m_rings +
 544                          pmd->run.num_m2s_rings));
 545
 546         memset(shm_name, 0, sizeof(char) * ETH_MEMIF_SHM_NAME_SIZE);
 547         snprintf(shm_name, ETH_MEMIF_SHM_NAME_SIZE, "memif_region_%d",
 548                  proc_private->regions_num);
 549
 550         r->fd = memfd_create(shm_name, MFD_ALLOW_SEALING);
 551         if (r->fd < 0) {
 552                 MIF_LOG(ERR, "Failed to create shm file: %s.", strerror(errno));
 553                 ret = -1;
 554                 goto error;
 555         }
 556
 557         ret = fcntl(r->fd, F_ADD_SEALS, F_SEAL_SHRINK);
 558         if (ret < 0) {
 559                 MIF_LOG(ERR, "Failed to add seals to shm file: %s.", strerror(errno));
 560                 goto error;
 561         }
 562
 563         ret = ftruncate(r->fd, r->region_size);
 564         if (ret < 0) {
 565                 MIF_LOG(ERR, "Failed to truncate shm file: %s.", strerror(errno));
 566                 goto error;
 567         }
 568
 569         r->addr = mmap(NULL, r->region_size, PROT_READ |
 570                        PROT_WRITE, MAP_SHARED, r->fd, 0);
 571         if (r->addr == MAP_FAILED) {
 572                 MIF_LOG(ERR, "Failed to mmap shm region: %s.", strerror(ret));
 573                 ret = -1;
 574                 goto error;
 575         }
 576
 577         proc_private->regions[proc_private->regions_num] = r;
 578         proc_private->regions_num++;
 579
 580         return ret;
 581
 582 error:
 583         if (r->fd > 0)
 584                 close(r->fd);
 585         r->fd = -1;
 586
 587         return ret;
 588 }
 589
 590 static int
 591 memif_regions_init(struct rte_eth_dev *dev)
 592 {
 593         int ret;
 594
 595         /* create one buffer region */
 596         ret = memif_region_init_shm(dev, /* has buffer */ 1);
 597         if (ret < 0)
 598                 return ret;
 599
 600         return 0;
 601 }
 602
 603 static void
 604 memif_init_rings(struct rte_eth_dev *dev)
 605 {
 606         struct pmd_internals *pmd = dev->data->dev_private;
 607         struct pmd_process_private *proc_private = dev->process_private;
 608         memif_ring_t *ring;
 609         int i, j;
 610         uint16_t slot;
 611
 612         for (i = 0; i < pmd->run.num_s2m_rings; i++) {
 613                 ring = memif_get_ring(pmd, proc_private, MEMIF_RING_S2M, i);
 614                 ring->head = 0;
 615                 ring->tail = 0;
 616                 ring->cookie = MEMIF_COOKIE;
 617                 ring->flags = 0;
 618                 for (j = 0; j < (1 << pmd->run.log2_ring_size); j++) {
 619                         slot = i * (1 << pmd->run.log2_ring_size) + j;
 620                         ring->desc[j].region = 0;
 621                         ring->desc[j].offset =
 622                                 proc_private->regions[0]->pkt_buffer_offset +
 623                                 (uint32_t)(slot * pmd->run.pkt_buffer_size);
 624                         ring->desc[j].length = pmd->run.pkt_buffer_size;
 625                 }
 626         }
 627
 628         for (i = 0; i < pmd->run.num_m2s_rings; i++) {
 629                 ring = memif_get_ring(pmd, proc_private, MEMIF_RING_M2S, i);
 630                 ring->head = 0;
 631                 ring->tail = 0;
 632                 ring->cookie = MEMIF_COOKIE;
 633                 ring->flags = 0;
 634                 for (j = 0; j < (1 << pmd->run.log2_ring_size); j++) {
 635                         slot = (i + pmd->run.num_s2m_rings) *
 636                             (1 << pmd->run.log2_ring_size) + j;
 637                         ring->desc[j].region = 0;
 638                         ring->desc[j].offset =
 639                                 proc_private->regions[0]->pkt_buffer_offset +
 640                                 (uint32_t)(slot * pmd->run.pkt_buffer_size);
 641                         ring->desc[j].length = pmd->run.pkt_buffer_size;
 642                 }
 643         }
 644 }
 645
 646 /* called only by slave */
 647 static void
 648 memif_init_queues(struct rte_eth_dev *dev)
 649 {
 650         struct pmd_internals *pmd = dev->data->dev_private;
 651         struct memif_queue *mq;
 652         int i;
 653
 654         for (i = 0; i < pmd->run.num_s2m_rings; i++) {
 655                 mq = dev->data->tx_queues[i];
 656                 mq->log2_ring_size = pmd->run.log2_ring_size;
 657                 /* queues located only in region 0 */
 658                 mq->region = 0;
 659                 mq->ring_offset = memif_get_ring_offset(dev, mq, MEMIF_RING_S2M, i);
 660                 mq->last_head = 0;
 661                 mq->last_tail = 0;
 662                 mq->intr_handle.fd = eventfd(0, EFD_NONBLOCK);
 663                 if (mq->intr_handle.fd < 0) {
 664                         MIF_LOG(WARNING,
 665                                 "Failed to create eventfd for tx queue %d: %s.", i,
 666                                 strerror(errno));
 667                 }
 668         }
 669
 670         for (i = 0; i < pmd->run.num_m2s_rings; i++) {
 671                 mq = dev->data->rx_queues[i];
 672                 mq->log2_ring_size = pmd->run.log2_ring_size;
 673                 /* queues located only in region 0 */
 674                 mq->region = 0;
 675                 mq->ring_offset = memif_get_ring_offset(dev, mq, MEMIF_RING_M2S, i);
 676                 mq->last_head = 0;
 677                 mq->last_tail = 0;
 678                 mq->intr_handle.fd = eventfd(0, EFD_NONBLOCK);
 679                 if (mq->intr_handle.fd < 0) {
 680                         MIF_LOG(WARNING,
 681                                 "Failed to create eventfd for rx queue %d: %s.", i,
 682                                 strerror(errno));
 683                 }
 684         }
 685 }
 686
 687 int
 688 memif_init_regions_and_queues(struct rte_eth_dev *dev)
 689 {
 690         int ret;
 691
 692         ret = memif_regions_init(dev);
 693         if (ret < 0)
 694                 return ret;
 695
 696         memif_init_rings(dev);
 697
 698         memif_init_queues(dev);
 699
 700         return 0;
 701 }
 702
 703 int
 704 memif_connect(struct rte_eth_dev *dev)
 705 {
 706         struct pmd_internals *pmd = dev->data->dev_private;
 707         struct pmd_process_private *proc_private = dev->process_private;
 708         struct memif_region *mr;
 709         struct memif_queue *mq;
 710         memif_ring_t *ring;
 711         int i;
 712
 713         for (i = 0; i < proc_private->regions_num; i++) {
 714                 mr = proc_private->regions[i];
 715                 if (mr != NULL) {
 716                         if (mr->addr == NULL) {
 717                                 if (mr->fd < 0)
 718                                         return -1;
 719                                 mr->addr = mmap(NULL, mr->region_size,
 720                                                 PROT_READ | PROT_WRITE,
 721                                                 MAP_SHARED, mr->fd, 0);
 722                                 if (mr->addr == NULL)
 723                                         return -1;
 724                         }
 725                 }
 726         }
 727
 728         if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
 729                 for (i = 0; i < pmd->run.num_s2m_rings; i++) {
 730                         mq = (pmd->role == MEMIF_ROLE_SLAVE) ?
 731                             dev->data->tx_queues[i] : dev->data->rx_queues[i];
 732                         ring = memif_get_ring_from_queue(proc_private, mq);
 733                         if (ring == NULL || ring->cookie != MEMIF_COOKIE) {
 734                                 MIF_LOG(ERR, "Wrong ring");
 735                                 return -1;
 736                         }
 737                         ring->head = 0;
 738                         ring->tail = 0;
 739                         mq->last_head = 0;
 740                         mq->last_tail = 0;
 741                         /* enable polling mode */
 742                         if (pmd->role == MEMIF_ROLE_MASTER)
 743                                 ring->flags = MEMIF_RING_FLAG_MASK_INT;
 744                 }
 745                 for (i = 0; i < pmd->run.num_m2s_rings; i++) {
 746                         mq = (pmd->role == MEMIF_ROLE_SLAVE) ?
 747                             dev->data->rx_queues[i] : dev->data->tx_queues[i];
 748                         ring = memif_get_ring_from_queue(proc_private, mq);
 749                         if (ring == NULL || ring->cookie != MEMIF_COOKIE) {
 750                                 MIF_LOG(ERR, "Wrong ring");
 751                                 return -1;
 752                         }
 753                         ring->head = 0;
 754                         ring->tail = 0;
 755                         mq->last_head = 0;
 756                         mq->last_tail = 0;
 757                         /* enable polling mode */
 758                         if (pmd->role == MEMIF_ROLE_SLAVE)
 759                                 ring->flags = MEMIF_RING_FLAG_MASK_INT;
 760                 }
 761
 762                 pmd->flags &= ~ETH_MEMIF_FLAG_CONNECTING;
 763                 pmd->flags |= ETH_MEMIF_FLAG_CONNECTED;
 764                 dev->data->dev_link.link_status = ETH_LINK_UP;
 765         }
 766         MIF_LOG(INFO, "Connected.");
 767         return 0;
 768 }
 769
 770 static int
 771 memif_dev_start(struct rte_eth_dev *dev)
 772 {
 773         struct pmd_internals *pmd = dev->data->dev_private;
 774         int ret = 0;
 775
 776         switch (pmd->role) {
 777         case MEMIF_ROLE_SLAVE:
 778                 ret = memif_connect_slave(dev);
 779                 break;
 780         case MEMIF_ROLE_MASTER:
 781                 ret = memif_connect_master(dev);
 782                 break;
 783         default:
 784                 MIF_LOG(ERR, "%s: Unknown role: %d.",
 785                         rte_vdev_device_name(pmd->vdev), pmd->role);
 786                 ret = -1;
 787                 break;
 788         }
 789
 790         return ret;
 791 }
 792
 793 static void
 794 memif_dev_close(struct rte_eth_dev *dev)
 795 {
 796         struct pmd_internals *pmd = dev->data->dev_private;
 797         int i;
 798
 799         if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
 800                 memif_msg_enq_disconnect(pmd->cc, "Device closed", 0);
 801                 memif_disconnect(dev);
 802
 803                 for (i = 0; i < dev->data->nb_rx_queues; i++)
 804                         (*dev->dev_ops->rx_queue_release)(dev->data->rx_queues[i]);
 805                 for (i = 0; i < dev->data->nb_tx_queues; i++)
 806                         (*dev->dev_ops->tx_queue_release)(dev->data->tx_queues[i]);
 807
 808                 memif_socket_remove_device(dev);
 809         } else {
 810                 memif_disconnect(dev);
 811         }
 812
 813         rte_free(dev->process_private);
 814 }
 815
 816 static int
 817 memif_dev_configure(struct rte_eth_dev *dev)
 818 {
 819         struct pmd_internals *pmd = dev->data->dev_private;
 820
 821         /*
 822          * SLAVE - TXQ
 823          * MASTER - RXQ
 824          */
 825         pmd->cfg.num_s2m_rings = (pmd->role == MEMIF_ROLE_SLAVE) ?
 826                                   dev->data->nb_tx_queues : dev->data->nb_rx_queues;
 827
 828         /*
 829          * SLAVE - RXQ
 830          * MASTER - TXQ
 831          */
 832         pmd->cfg.num_m2s_rings = (pmd->role == MEMIF_ROLE_SLAVE) ?
 833                                   dev->data->nb_rx_queues : dev->data->nb_tx_queues;
 834
 835         return 0;
 836 }
 837
 838 static int
 839 memif_tx_queue_setup(struct rte_eth_dev *dev,
 840                      uint16_t qid,
 841                      uint16_t nb_tx_desc __rte_unused,
 842                      unsigned int socket_id __rte_unused,
 843                      const struct rte_eth_txconf *tx_conf __rte_unused)
 844 {
 845         struct pmd_internals *pmd = dev->data->dev_private;
 846         struct memif_queue *mq;
 847
 848         mq = rte_zmalloc("tx-queue", sizeof(struct memif_queue), 0);
 849         if (mq == NULL) {
 850                 MIF_LOG(ERR, "%s: Failed to allocate tx queue id: %u",
 851                         rte_vdev_device_name(pmd->vdev), qid);
 852                 return -ENOMEM;
 853         }
 854
 855         mq->type =
 856             (pmd->role == MEMIF_ROLE_SLAVE) ? MEMIF_RING_S2M : MEMIF_RING_M2S;
 857         mq->n_pkts = 0;
 858         mq->n_bytes = 0;
 859         mq->intr_handle.fd = -1;
 860         mq->intr_handle.type = RTE_INTR_HANDLE_EXT;
 861         dev->data->tx_queues[qid] = mq;
 862
 863         return 0;
 864 }
 865
 866 static int
 867 memif_rx_queue_setup(struct rte_eth_dev *dev,
 868                      uint16_t qid,
 869                      uint16_t nb_rx_desc __rte_unused,
 870                      unsigned int socket_id __rte_unused,
 871                      const struct rte_eth_rxconf *rx_conf __rte_unused,
 872                      struct rte_mempool *mb_pool)
 873 {
 874         struct pmd_internals *pmd = dev->data->dev_private;
 875         struct memif_queue *mq;
 876
 877         mq = rte_zmalloc("rx-queue", sizeof(struct memif_queue), 0);
 878         if (mq == NULL) {
 879                 MIF_LOG(ERR, "%s: Failed to allocate rx queue id: %u",
 880                         rte_vdev_device_name(pmd->vdev), qid);
 881                 return -ENOMEM;
 882         }
 883
 884         mq->type = (pmd->role == MEMIF_ROLE_SLAVE) ? MEMIF_RING_M2S : MEMIF_RING_S2M;
 885         mq->n_pkts = 0;
 886         mq->n_bytes = 0;
 887         mq->intr_handle.fd = -1;
 888         mq->intr_handle.type = RTE_INTR_HANDLE_EXT;
 889         mq->mempool = mb_pool;
 890         mq->in_port = dev->data->port_id;
 891         dev->data->rx_queues[qid] = mq;
 892
 893         return 0;
 894 }
 895
 896 static void
 897 memif_queue_release(void *queue)
 898 {
 899         struct memif_queue *mq = (struct memif_queue *)queue;
 900
 901         if (!mq)
 902                 return;
 903
 904         rte_free(mq);
 905 }
 906
 907 static int
 908 memif_link_update(struct rte_eth_dev *dev,
 909                   int wait_to_complete __rte_unused)
 910 {
 911         struct pmd_process_private *proc_private;
 912
 913         if (rte_eal_process_type() == RTE_PROC_SECONDARY) {
 914                 proc_private = dev->process_private;
 915                 if (dev->data->dev_link.link_status == ETH_LINK_UP &&
 916                                 proc_private->regions_num == 0) {
 917                         memif_mp_request_regions(dev);
 918                 } else if (dev->data->dev_link.link_status == ETH_LINK_DOWN &&
 919                                 proc_private->regions_num > 0) {
 920                         memif_free_regions(proc_private);
 921                 }
 922         }
 923         return 0;
 924 }
 925
 926 static int
 927 memif_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
 928 {
 929         struct pmd_internals *pmd = dev->data->dev_private;
 930         struct memif_queue *mq;
 931         int i;
 932         uint8_t tmp, nq;
 933
 934         stats->ipackets = 0;
 935         stats->ibytes = 0;
 936         stats->opackets = 0;
 937         stats->obytes = 0;
 938
 939         tmp = (pmd->role == MEMIF_ROLE_SLAVE) ? pmd->run.num_s2m_rings :
 940             pmd->run.num_m2s_rings;
 941         nq = (tmp < RTE_ETHDEV_QUEUE_STAT_CNTRS) ? tmp :
 942             RTE_ETHDEV_QUEUE_STAT_CNTRS;
 943
 944         /* RX stats */
 945         for (i = 0; i < nq; i++) {
 946                 mq = dev->data->rx_queues[i];
 947                 stats->q_ipackets[i] = mq->n_pkts;
 948                 stats->q_ibytes[i] = mq->n_bytes;
 949                 stats->ipackets += mq->n_pkts;
 950                 stats->ibytes += mq->n_bytes;
 951         }
 952
 953         tmp = (pmd->role == MEMIF_ROLE_SLAVE) ? pmd->run.num_m2s_rings :
 954             pmd->run.num_s2m_rings;
 955         nq = (tmp < RTE_ETHDEV_QUEUE_STAT_CNTRS) ? tmp :
 956             RTE_ETHDEV_QUEUE_STAT_CNTRS;
 957
 958         /* TX stats */
 959         for (i = 0; i < nq; i++) {
 960                 mq = dev->data->tx_queues[i];
 961                 stats->q_opackets[i] = mq->n_pkts;
 962                 stats->q_obytes[i] = mq->n_bytes;
 963                 stats->opackets += mq->n_pkts;
 964                 stats->obytes += mq->n_bytes;
 965         }
 966         return 0;
 967 }
 968
 969 static void
 970 memif_stats_reset(struct rte_eth_dev *dev)
 971 {
 972         struct pmd_internals *pmd = dev->data->dev_private;
 973         int i;
 974         struct memif_queue *mq;
 975
 976         for (i = 0; i < pmd->run.num_s2m_rings; i++) {
 977                 mq = (pmd->role == MEMIF_ROLE_SLAVE) ? dev->data->tx_queues[i] :
 978                     dev->data->rx_queues[i];
 979                 mq->n_pkts = 0;
 980                 mq->n_bytes = 0;
 981         }
 982         for (i = 0; i < pmd->run.num_m2s_rings; i++) {
 983                 mq = (pmd->role == MEMIF_ROLE_SLAVE) ? dev->data->rx_queues[i] :
 984                     dev->data->tx_queues[i];
 985                 mq->n_pkts = 0;
 986                 mq->n_bytes = 0;
 987         }
 988 }
 989
 990 static int
 991 memif_rx_queue_intr_enable(struct rte_eth_dev *dev __rte_unused,
 992                            uint16_t qid __rte_unused)
 993 {
 994         MIF_LOG(WARNING, "Interrupt mode not supported.");
 995
 996         return -1;
 997 }
 998
 999 static int
1000 memif_rx_queue_intr_disable(struct rte_eth_dev *dev, uint16_t qid __rte_unused)
1001 {
1002         struct pmd_internals *pmd __rte_unused = dev->data->dev_private;
1003
1004         return 0;
1005 }
1006
1007 static const struct eth_dev_ops ops = {
1008         .dev_start = memif_dev_start,
1009         .dev_close = memif_dev_close,
1010         .dev_infos_get = memif_dev_info,
1011         .dev_configure = memif_dev_configure,
1012         .tx_queue_setup = memif_tx_queue_setup,
1013         .rx_queue_setup = memif_rx_queue_setup,
1014         .rx_queue_release = memif_queue_release,
1015         .tx_queue_release = memif_queue_release,
1016         .rx_queue_intr_enable = memif_rx_queue_intr_enable,
1017         .rx_queue_intr_disable = memif_rx_queue_intr_disable,
1018         .link_update = memif_link_update,
1019         .stats_get = memif_stats_get,
1020         .stats_reset = memif_stats_reset,
1021 };
1022
1023 static int
1024 memif_create(struct rte_vdev_device *vdev, enum memif_role_t role,
1025              memif_interface_id_t id, uint32_t flags,
1026              const char *socket_filename,
1027              memif_log2_ring_size_t log2_ring_size,
1028              uint16_t pkt_buffer_size, const char *secret,
1029              struct rte_ether_addr *ether_addr)
1030 {
1031         int ret = 0;
1032         struct rte_eth_dev *eth_dev;
1033         struct rte_eth_dev_data *data;
1034         struct pmd_internals *pmd;
1035         struct pmd_process_private *process_private;
1036         const unsigned int numa_node = vdev->device.numa_node;
1037         const char *name = rte_vdev_device_name(vdev);
1038
1039         if (flags & ETH_MEMIF_FLAG_ZERO_COPY) {
1040                 MIF_LOG(ERR, "Zero-copy slave not supported.");
1041                 return -1;
1042         }
1043
1044         eth_dev = rte_eth_vdev_allocate(vdev, sizeof(*pmd));
1045         if (eth_dev == NULL) {
1046                 MIF_LOG(ERR, "%s: Unable to allocate device struct.", name);
1047                 return -1;
1048         }
1049
1050         process_private = (struct pmd_process_private *)
1051                 rte_zmalloc(name, sizeof(struct pmd_process_private),
1052                             RTE_CACHE_LINE_SIZE);
1053
1054         if (process_private == NULL) {
1055                 MIF_LOG(ERR, "Failed to alloc memory for process private");
1056                 return -1;
1057         }
1058         eth_dev->process_private = process_private;
1059
1060         pmd = eth_dev->data->dev_private;
1061         memset(pmd, 0, sizeof(*pmd));
1062
1063         pmd->id = id;
1064         pmd->flags = flags;
1065         pmd->flags |= ETH_MEMIF_FLAG_DISABLED;
1066         pmd->role = role;
1067
1068         ret = memif_socket_init(eth_dev, socket_filename);
1069         if (ret < 0)
1070                 return ret;
1071
1072         memset(pmd->secret, 0, sizeof(char) * ETH_MEMIF_SECRET_SIZE);
1073         if (secret != NULL)
1074                 strlcpy(pmd->secret, secret, sizeof(pmd->secret));
1075
1076         pmd->cfg.log2_ring_size = log2_ring_size;
1077         /* set in .dev_configure() */
1078         pmd->cfg.num_s2m_rings = 0;
1079         pmd->cfg.num_m2s_rings = 0;
1080
1081         pmd->cfg.pkt_buffer_size = pkt_buffer_size;
1082
1083         data = eth_dev->data;
1084         data->dev_private = pmd;
1085         data->numa_node = numa_node;
1086         data->mac_addrs = ether_addr;
1087
1088         eth_dev->dev_ops = &ops;
1089         eth_dev->device = &vdev->device;
1090         eth_dev->rx_pkt_burst = eth_memif_rx;
1091         eth_dev->tx_pkt_burst = eth_memif_tx;
1092
1093         eth_dev->data->dev_flags &= RTE_ETH_DEV_CLOSE_REMOVE;
1094
1095         rte_eth_dev_probing_finish(eth_dev);
1096
1097         return 0;
1098 }
1099
1100 static int
1101 memif_set_role(const char *key __rte_unused, const char *value,
1102                void *extra_args)
1103 {
1104         enum memif_role_t *role = (enum memif_role_t *)extra_args;
1105
1106         if (strstr(value, "master") != NULL) {
1107                 *role = MEMIF_ROLE_MASTER;
1108         } else if (strstr(value, "slave") != NULL) {
1109                 *role = MEMIF_ROLE_SLAVE;
1110         } else {
1111                 MIF_LOG(ERR, "Unknown role: %s.", value);
1112                 return -EINVAL;
1113         }
1114         return 0;
1115 }
1116
1117 static int
1118 memif_set_zc(const char *key __rte_unused, const char *value, void *extra_args)
1119 {
1120         uint32_t *flags = (uint32_t *)extra_args;
1121
1122         if (strstr(value, "yes") != NULL) {
1123                 *flags |= ETH_MEMIF_FLAG_ZERO_COPY;
1124         } else if (strstr(value, "no") != NULL) {
1125                 *flags &= ~ETH_MEMIF_FLAG_ZERO_COPY;
1126         } else {
1127                 MIF_LOG(ERR, "Failed to parse zero-copy param: %s.", value);
1128                 return -EINVAL;
1129         }
1130         return 0;
1131 }
1132
1133 static int
1134 memif_set_id(const char *key __rte_unused, const char *value, void *extra_args)
1135 {
1136         memif_interface_id_t *id = (memif_interface_id_t *)extra_args;
1137
1138         /* even if parsing fails, 0 is a valid id */
1139         *id = strtoul(value, NULL, 10);
1140         return 0;
1141 }
1142
1143 static int
1144 memif_set_bs(const char *key __rte_unused, const char *value, void *extra_args)
1145 {
1146         unsigned long tmp;
1147         uint16_t *pkt_buffer_size = (uint16_t *)extra_args;
1148
1149         tmp = strtoul(value, NULL, 10);
1150         if (tmp == 0 || tmp > 0xFFFF) {
1151                 MIF_LOG(ERR, "Invalid buffer size: %s.", value);
1152                 return -EINVAL;
1153         }
1154         *pkt_buffer_size = tmp;
1155         return 0;
1156 }
1157
1158 static int
1159 memif_set_rs(const char *key __rte_unused, const char *value, void *extra_args)
1160 {
1161         unsigned long tmp;
1162         memif_log2_ring_size_t *log2_ring_size =
1163             (memif_log2_ring_size_t *)extra_args;
1164
1165         tmp = strtoul(value, NULL, 10);
1166         if (tmp == 0 || tmp > ETH_MEMIF_MAX_LOG2_RING_SIZE) {
1167                 MIF_LOG(ERR, "Invalid ring size: %s (max %u).",
1168                         value, ETH_MEMIF_MAX_LOG2_RING_SIZE);
1169                 return -EINVAL;
1170         }
1171         *log2_ring_size = tmp;
1172         return 0;
1173 }
1174
1175 /* check if directory exists and if we have permission to read/write */
1176 static int
1177 memif_check_socket_filename(const char *filename)
1178 {
1179         char *dir = NULL, *tmp;
1180         uint32_t idx;
1181         int ret = 0;
1182
1183         tmp = strrchr(filename, '/');
1184         if (tmp != NULL) {
1185                 idx = tmp - filename;
1186                 dir = rte_zmalloc("memif_tmp", sizeof(char) * (idx + 1), 0);
1187                 if (dir == NULL) {
1188                         MIF_LOG(ERR, "Failed to allocate memory.");
1189                         return -1;
1190                 }
1191                 strlcpy(dir, filename, sizeof(char) * (idx + 1));
1192         }
1193
1194         if (dir == NULL || (faccessat(-1, dir, F_OK | R_OK |
1195                                         W_OK, AT_EACCESS) < 0)) {
1196                 MIF_LOG(ERR, "Invalid socket directory.");
1197                 ret = -EINVAL;
1198         }
1199
1200         if (dir != NULL)
1201                 rte_free(dir);
1202
1203         return ret;
1204 }
1205
1206 static int
1207 memif_set_socket_filename(const char *key __rte_unused, const char *value,
1208                           void *extra_args)
1209 {
1210         const char **socket_filename = (const char **)extra_args;
1211
1212         *socket_filename = value;
1213         return memif_check_socket_filename(*socket_filename);
1214 }
1215
1216 static int
1217 memif_set_mac(const char *key __rte_unused, const char *value, void *extra_args)
1218 {
1219         struct rte_ether_addr *ether_addr = (struct rte_ether_addr *)extra_args;
1220
1221         if (rte_ether_unformat_addr(value, ether_addr) < 0)
1222                 MIF_LOG(WARNING, "Failed to parse mac '%s'.", value);
1223         return 0;
1224 }
1225
1226 static int
1227 memif_set_secret(const char *key __rte_unused, const char *value, void *extra_args)
1228 {
1229         const char **secret = (const char **)extra_args;
1230
1231         *secret = value;
1232         return 0;
1233 }
1234
1235 static int
1236 rte_pmd_memif_probe(struct rte_vdev_device *vdev)
1237 {
1238         RTE_BUILD_BUG_ON(sizeof(memif_msg_t) != 128);
1239         RTE_BUILD_BUG_ON(sizeof(memif_desc_t) != 16);
1240         int ret = 0;
1241         struct rte_kvargs *kvlist;
1242         const char *name = rte_vdev_device_name(vdev);
1243         enum memif_role_t role = MEMIF_ROLE_SLAVE;
1244         memif_interface_id_t id = 0;
1245         uint16_t pkt_buffer_size = ETH_MEMIF_DEFAULT_PKT_BUFFER_SIZE;
1246         memif_log2_ring_size_t log2_ring_size = ETH_MEMIF_DEFAULT_RING_SIZE;
1247         const char *socket_filename = ETH_MEMIF_DEFAULT_SOCKET_FILENAME;
1248         uint32_t flags = 0;
1249         const char *secret = NULL;
1250         struct rte_ether_addr *ether_addr = rte_zmalloc("",
1251                 sizeof(struct rte_ether_addr), 0);
1252         struct rte_eth_dev *eth_dev;
1253
1254         rte_eth_random_addr(ether_addr->addr_bytes);
1255
1256         MIF_LOG(INFO, "Initialize MEMIF: %s.", name);
1257
1258         if (rte_eal_process_type() == RTE_PROC_SECONDARY) {
1259                 eth_dev = rte_eth_dev_attach_secondary(name);
1260                 if (!eth_dev) {
1261                         MIF_LOG(ERR, "Failed to probe %s", name);
1262                         return -1;
1263                 }
1264
1265                 eth_dev->dev_ops = &ops;
1266                 eth_dev->device = &vdev->device;
1267                 eth_dev->rx_pkt_burst = eth_memif_rx;
1268                 eth_dev->tx_pkt_burst = eth_memif_tx;
1269
1270                 if (!rte_eal_primary_proc_alive(NULL)) {
1271                         MIF_LOG(ERR, "Primary process is missing");
1272                         return -1;
1273                 }
1274
1275                 eth_dev->process_private = (struct pmd_process_private *)
1276                         rte_zmalloc(name,
1277                                 sizeof(struct pmd_process_private),
1278                                 RTE_CACHE_LINE_SIZE);
1279                 if (eth_dev->process_private == NULL) {
1280                         MIF_LOG(ERR,
1281                                 "Failed to alloc memory for process private");
1282                         return -1;
1283                 }
1284
1285                 rte_eth_dev_probing_finish(eth_dev);
1286
1287                 return 0;
1288         }
1289
1290         ret = rte_mp_action_register(MEMIF_MP_SEND_REGION, memif_mp_send_region);
1291         /*
1292          * Primary process can continue probing, but secondary process won't
1293          * be able to get memory regions information
1294          */
1295         if (ret < 0 && rte_errno != EEXIST)
1296                 MIF_LOG(WARNING, "Failed to register mp action callback: %s",
1297                         strerror(rte_errno));
1298
1299         kvlist = rte_kvargs_parse(rte_vdev_device_args(vdev), valid_arguments);
1300
1301         /* parse parameters */
1302         if (kvlist != NULL) {
1303                 ret = rte_kvargs_process(kvlist, ETH_MEMIF_ROLE_ARG,
1304                                          &memif_set_role, &role);
1305                 if (ret < 0)
1306                         goto exit;
1307                 ret = rte_kvargs_process(kvlist, ETH_MEMIF_ID_ARG,
1308                                          &memif_set_id, &id);
1309                 if (ret < 0)
1310                         goto exit;
1311                 ret = rte_kvargs_process(kvlist, ETH_MEMIF_PKT_BUFFER_SIZE_ARG,
1312                                          &memif_set_bs, &pkt_buffer_size);
1313                 if (ret < 0)
1314                         goto exit;
1315                 ret = rte_kvargs_process(kvlist, ETH_MEMIF_RING_SIZE_ARG,
1316                                          &memif_set_rs, &log2_ring_size);
1317                 if (ret < 0)
1318                         goto exit;
1319                 ret = rte_kvargs_process(kvlist, ETH_MEMIF_SOCKET_ARG,
1320                                          &memif_set_socket_filename,
1321                                          (void *)(&socket_filename));
1322                 if (ret < 0)
1323                         goto exit;
1324                 ret = rte_kvargs_process(kvlist, ETH_MEMIF_MAC_ARG,
1325                                          &memif_set_mac, ether_addr);
1326                 if (ret < 0)
1327                         goto exit;
1328                 ret = rte_kvargs_process(kvlist, ETH_MEMIF_ZC_ARG,
1329                                          &memif_set_zc, &flags);
1330                 if (ret < 0)
1331                         goto exit;
1332                 ret = rte_kvargs_process(kvlist, ETH_MEMIF_SECRET_ARG,
1333                                          &memif_set_secret, (void *)(&secret));
1334                 if (ret < 0)
1335                         goto exit;
1336         }
1337
1338         /* create interface */
1339         ret = memif_create(vdev, role, id, flags, socket_filename,
1340                            log2_ring_size, pkt_buffer_size, secret, ether_addr);
1341
1342 exit:
1343         if (kvlist != NULL)
1344                 rte_kvargs_free(kvlist);
1345         return ret;
1346 }
1347
1348 static int
1349 rte_pmd_memif_remove(struct rte_vdev_device *vdev)
1350 {
1351         struct rte_eth_dev *eth_dev;
1352
1353         eth_dev = rte_eth_dev_allocated(rte_vdev_device_name(vdev));
1354         if (eth_dev == NULL)
1355                 return 0;
1356
1357         rte_eth_dev_close(eth_dev->data->port_id);
1358
1359         return 0;
1360 }
1361
1362 static struct rte_vdev_driver pmd_memif_drv = {
1363         .probe = rte_pmd_memif_probe,
1364         .remove = rte_pmd_memif_remove,
1365 };
1366
1367 RTE_PMD_REGISTER_VDEV(net_memif, pmd_memif_drv);
1368
1369 RTE_PMD_REGISTER_PARAM_STRING(net_memif,
1370                               ETH_MEMIF_ID_ARG "=<int>"
1371                               ETH_MEMIF_ROLE_ARG "=master|slave"
1372                               ETH_MEMIF_PKT_BUFFER_SIZE_ARG "=<int>"
1373                               ETH_MEMIF_RING_SIZE_ARG "=<int>"
1374                               ETH_MEMIF_SOCKET_ARG "=<string>"
1375                               ETH_MEMIF_MAC_ARG "=xx:xx:xx:xx:xx:xx"
1376                               ETH_MEMIF_ZC_ARG "=yes|no"
1377                               ETH_MEMIF_SECRET_ARG "=<string>");
1378
1379 int memif_logtype;
1380
1381 RTE_INIT(memif_init_log)
1382 {
1383         memif_logtype = rte_log_register("pmd.net.memif");
1384         if (memif_logtype >= 0)
1385                 rte_log_set_level(memif_logtype, RTE_LOG_NOTICE);
1386 }