1 /* SPDX-License-Identifier: BSD-3-Clause
2 * Copyright 2018-2019 Cisco Systems, Inc. All rights reserved.
9 #include <sys/socket.h>
11 #include <sys/ioctl.h>
14 #include <rte_version.h>
16 #include <rte_ether.h>
17 #include <rte_ethdev_driver.h>
18 #include <rte_ethdev_vdev.h>
19 #include <rte_malloc.h>
20 #include <rte_kvargs.h>
21 #include <rte_bus_vdev.h>
23 #include <rte_jhash.h>
24 #include <rte_string_fns.h>
26 #include "rte_eth_memif.h"
27 #include "memif_socket.h"
29 static void memif_intr_handler(void *arg);
32 memif_msg_send(int fd, memif_msg_t *msg, int afd)
34 struct msghdr mh = { 0 };
37 char ctl[CMSG_SPACE(sizeof(int))];
39 iov[0].iov_base = msg;
40 iov[0].iov_len = sizeof(memif_msg_t);
45 memset(&ctl, 0, sizeof(ctl));
47 mh.msg_controllen = sizeof(ctl);
48 cmsg = CMSG_FIRSTHDR(&mh);
49 cmsg->cmsg_len = CMSG_LEN(sizeof(int));
50 cmsg->cmsg_level = SOL_SOCKET;
51 cmsg->cmsg_type = SCM_RIGHTS;
52 rte_memcpy(CMSG_DATA(cmsg), &afd, sizeof(int));
55 return sendmsg(fd, &mh, 0);
59 memif_msg_send_from_queue(struct memif_control_channel *cc)
63 struct memif_msg_queue_elt *e;
65 e = TAILQ_FIRST(&cc->msg_queue);
69 size = memif_msg_send(cc->intr_handle.fd, &e->msg, e->fd);
70 if (size != sizeof(memif_msg_t)) {
71 MIF_LOG(ERR, "sendmsg fail: %s.", strerror(errno));
74 MIF_LOG(DEBUG, "Sent msg type %u.", e->msg.type);
76 TAILQ_REMOVE(&cc->msg_queue, e, next);
82 static struct memif_msg_queue_elt *
83 memif_msg_enq(struct memif_control_channel *cc)
85 struct memif_msg_queue_elt *e;
87 e = rte_zmalloc("memif_msg", sizeof(struct memif_msg_queue_elt), 0);
89 MIF_LOG(ERR, "Failed to allocate control message.");
94 TAILQ_INSERT_TAIL(&cc->msg_queue, e, next);
100 memif_msg_enq_disconnect(struct memif_control_channel *cc, const char *reason,
103 struct memif_msg_queue_elt *e;
104 struct pmd_internals *pmd;
105 memif_msg_disconnect_t *d;
108 MIF_LOG(DEBUG, "Missing control channel.");
112 e = memif_msg_enq(cc);
114 MIF_LOG(WARNING, "Failed to enqueue disconnect message.");
118 d = &e->msg.disconnect;
120 e->msg.type = MEMIF_MSG_TYPE_DISCONNECT;
123 if (reason != NULL) {
124 strlcpy((char *)d->string, reason, sizeof(d->string));
125 if (cc->dev != NULL) {
126 pmd = cc->dev->data->dev_private;
127 strlcpy(pmd->local_disc_string, reason,
128 sizeof(pmd->local_disc_string));
134 memif_msg_enq_hello(struct memif_control_channel *cc)
136 struct memif_msg_queue_elt *e = memif_msg_enq(cc);
137 memif_msg_hello_t *h;
144 e->msg.type = MEMIF_MSG_TYPE_HELLO;
145 h->min_version = MEMIF_VERSION;
146 h->max_version = MEMIF_VERSION;
147 h->max_s2m_ring = ETH_MEMIF_MAX_NUM_Q_PAIRS;
148 h->max_m2s_ring = ETH_MEMIF_MAX_NUM_Q_PAIRS;
149 h->max_region = ETH_MEMIF_MAX_REGION_NUM - 1;
150 h->max_log2_ring_size = ETH_MEMIF_MAX_LOG2_RING_SIZE;
152 strlcpy((char *)h->name, rte_version(), sizeof(h->name));
158 memif_msg_receive_hello(struct rte_eth_dev *dev, memif_msg_t *msg)
160 struct pmd_internals *pmd = dev->data->dev_private;
161 memif_msg_hello_t *h = &msg->hello;
163 if (h->min_version > MEMIF_VERSION || h->max_version < MEMIF_VERSION) {
164 memif_msg_enq_disconnect(pmd->cc, "Incompatible memif version", 0);
168 /* Set parameters for active connection */
169 pmd->run.num_s2m_rings = RTE_MIN(h->max_s2m_ring + 1,
170 pmd->cfg.num_s2m_rings);
171 pmd->run.num_m2s_rings = RTE_MIN(h->max_m2s_ring + 1,
172 pmd->cfg.num_m2s_rings);
173 pmd->run.log2_ring_size = RTE_MIN(h->max_log2_ring_size,
174 pmd->cfg.log2_ring_size);
175 pmd->run.pkt_buffer_size = pmd->cfg.pkt_buffer_size;
177 strlcpy(pmd->remote_name, (char *)h->name, sizeof(pmd->remote_name));
179 MIF_LOG(DEBUG, "%s: Connecting to %s.",
180 rte_vdev_device_name(pmd->vdev), pmd->remote_name);
186 memif_msg_receive_init(struct memif_control_channel *cc, memif_msg_t *msg)
188 memif_msg_init_t *i = &msg->init;
189 struct memif_socket_dev_list_elt *elt;
190 struct pmd_internals *pmd;
191 struct rte_eth_dev *dev;
193 if (i->version != MEMIF_VERSION) {
194 memif_msg_enq_disconnect(cc, "Incompatible memif version", 0);
198 if (cc->socket == NULL) {
199 memif_msg_enq_disconnect(cc, "Device error", 0);
203 /* Find device with requested ID */
204 TAILQ_FOREACH(elt, &cc->socket->dev_queue, next) {
206 pmd = dev->data->dev_private;
207 if (((pmd->flags & ETH_MEMIF_FLAG_DISABLED) == 0) &&
209 /* assign control channel to device */
213 if (i->mode != MEMIF_INTERFACE_MODE_ETHERNET) {
214 memif_msg_enq_disconnect(pmd->cc,
215 "Only ethernet mode supported",
220 if (pmd->flags & (ETH_MEMIF_FLAG_CONNECTING |
221 ETH_MEMIF_FLAG_CONNECTED)) {
222 memif_msg_enq_disconnect(pmd->cc,
223 "Already connected", 0);
226 strlcpy(pmd->remote_name, (char *)i->name,
227 sizeof(pmd->remote_name));
229 if (*pmd->secret != '\0') {
230 if (*i->secret == '\0') {
231 memif_msg_enq_disconnect(pmd->cc,
232 "Secret required", 0);
235 if (strncmp(pmd->secret, (char *)i->secret,
236 ETH_MEMIF_SECRET_SIZE) != 0) {
237 memif_msg_enq_disconnect(pmd->cc,
238 "Incorrect secret", 0);
243 pmd->flags |= ETH_MEMIF_FLAG_CONNECTING;
248 /* ID not found on this socket */
249 MIF_LOG(DEBUG, "ID %u not found.", i->id);
250 memif_msg_enq_disconnect(cc, "ID not found", 0);
255 memif_msg_receive_add_region(struct rte_eth_dev *dev, memif_msg_t *msg,
258 struct pmd_internals *pmd = dev->data->dev_private;
259 memif_msg_add_region_t *ar = &msg->add_region;
260 struct memif_region *r;
263 memif_msg_enq_disconnect(pmd->cc, "Missing region fd", 0);
267 if (ar->index >= ETH_MEMIF_MAX_REGION_NUM || ar->index != pmd->regions_num ||
268 pmd->regions[ar->index] != NULL) {
269 memif_msg_enq_disconnect(pmd->cc, "Invalid region index", 0);
273 r = rte_zmalloc("region", sizeof(struct memif_region), 0);
275 MIF_LOG(ERR, "%s: Failed to alloc memif region.",
276 rte_vdev_device_name(pmd->vdev));
281 r->region_size = ar->size;
284 pmd->regions[ar->index] = r;
291 memif_msg_receive_add_ring(struct rte_eth_dev *dev, memif_msg_t *msg, int fd)
293 struct pmd_internals *pmd = dev->data->dev_private;
294 memif_msg_add_ring_t *ar = &msg->add_ring;
295 struct memif_queue *mq;
298 memif_msg_enq_disconnect(pmd->cc, "Missing interrupt fd", 0);
302 /* check if we have enough queues */
303 if (ar->flags & MEMIF_MSG_ADD_RING_FLAG_S2M) {
304 if (ar->index >= pmd->cfg.num_s2m_rings) {
305 memif_msg_enq_disconnect(pmd->cc, "Invalid ring index", 0);
308 pmd->run.num_s2m_rings++;
310 if (ar->index >= pmd->cfg.num_m2s_rings) {
311 memif_msg_enq_disconnect(pmd->cc, "Invalid ring index", 0);
314 pmd->run.num_m2s_rings++;
317 mq = (ar->flags & MEMIF_MSG_ADD_RING_FLAG_S2M) ?
318 dev->data->rx_queues[ar->index] : dev->data->tx_queues[ar->index];
320 mq->intr_handle.fd = fd;
321 mq->log2_ring_size = ar->log2_ring_size;
322 mq->region = ar->region;
323 mq->ring_offset = ar->offset;
329 memif_msg_receive_connect(struct rte_eth_dev *dev, memif_msg_t *msg)
331 struct pmd_internals *pmd = dev->data->dev_private;
332 memif_msg_connect_t *c = &msg->connect;
335 ret = memif_connect(dev);
339 strlcpy(pmd->remote_if_name, (char *)c->if_name,
340 sizeof(pmd->remote_if_name));
341 MIF_LOG(INFO, "%s: Remote interface %s connected.",
342 rte_vdev_device_name(pmd->vdev), pmd->remote_if_name);
348 memif_msg_receive_connected(struct rte_eth_dev *dev, memif_msg_t *msg)
350 struct pmd_internals *pmd = dev->data->dev_private;
351 memif_msg_connected_t *c = &msg->connected;
354 ret = memif_connect(dev);
358 strlcpy(pmd->remote_if_name, (char *)c->if_name,
359 sizeof(pmd->remote_if_name));
360 MIF_LOG(INFO, "%s: Remote interface %s connected.",
361 rte_vdev_device_name(pmd->vdev), pmd->remote_if_name);
367 memif_msg_receive_disconnect(struct rte_eth_dev *dev, memif_msg_t *msg)
369 struct pmd_internals *pmd = dev->data->dev_private;
370 memif_msg_disconnect_t *d = &msg->disconnect;
372 memset(pmd->remote_disc_string, 0, ETH_MEMIF_DISC_STRING_SIZE);
373 strlcpy(pmd->remote_disc_string, (char *)d->string,
374 sizeof(pmd->remote_disc_string));
376 MIF_LOG(INFO, "%s: Disconnect received: %s",
377 rte_vdev_device_name(pmd->vdev), pmd->remote_disc_string);
379 memset(pmd->local_disc_string, 0, ETH_MEMIF_DISC_STRING_SIZE);
380 memif_disconnect(rte_eth_dev_allocated
381 (rte_vdev_device_name(pmd->vdev)));
386 memif_msg_enq_ack(struct rte_eth_dev *dev)
388 struct pmd_internals *pmd = dev->data->dev_private;
389 struct memif_msg_queue_elt *e = memif_msg_enq(pmd->cc);
393 e->msg.type = MEMIF_MSG_TYPE_ACK;
399 memif_msg_enq_init(struct rte_eth_dev *dev)
401 struct pmd_internals *pmd = dev->data->dev_private;
402 struct memif_msg_queue_elt *e = memif_msg_enq(pmd->cc);
403 memif_msg_init_t *i = &e->msg.init;
409 e->msg.type = MEMIF_MSG_TYPE_INIT;
410 i->version = MEMIF_VERSION;
412 i->mode = MEMIF_INTERFACE_MODE_ETHERNET;
414 strlcpy((char *)i->name, rte_version(), sizeof(i->name));
416 if (*pmd->secret != '\0')
417 strlcpy((char *)i->secret, pmd->secret, sizeof(i->secret));
423 memif_msg_enq_add_region(struct rte_eth_dev *dev, uint8_t idx)
425 struct pmd_internals *pmd = dev->data->dev_private;
426 struct memif_msg_queue_elt *e = memif_msg_enq(pmd->cc);
427 memif_msg_add_region_t *ar;
428 struct memif_region *mr = pmd->regions[idx];
433 ar = &e->msg.add_region;
434 e->msg.type = MEMIF_MSG_TYPE_ADD_REGION;
437 ar->size = mr->region_size;
443 memif_msg_enq_add_ring(struct rte_eth_dev *dev, uint8_t idx,
444 memif_ring_type_t type)
446 struct pmd_internals *pmd = dev->data->dev_private;
447 struct memif_msg_queue_elt *e = memif_msg_enq(pmd->cc);
448 struct memif_queue *mq;
449 memif_msg_add_ring_t *ar;
454 ar = &e->msg.add_ring;
455 mq = (type == MEMIF_RING_S2M) ? dev->data->tx_queues[idx] :
456 dev->data->rx_queues[idx];
458 e->msg.type = MEMIF_MSG_TYPE_ADD_RING;
459 e->fd = mq->intr_handle.fd;
461 ar->offset = mq->ring_offset;
462 ar->region = mq->region;
463 ar->log2_ring_size = mq->log2_ring_size;
464 ar->flags = (type == MEMIF_RING_S2M) ? MEMIF_MSG_ADD_RING_FLAG_S2M : 0;
465 ar->private_hdr_size = 0;
471 memif_msg_enq_connect(struct rte_eth_dev *dev)
473 struct pmd_internals *pmd = dev->data->dev_private;
474 struct memif_msg_queue_elt *e = memif_msg_enq(pmd->cc);
475 const char *name = rte_vdev_device_name(pmd->vdev);
476 memif_msg_connect_t *c;
482 e->msg.type = MEMIF_MSG_TYPE_CONNECT;
483 strlcpy((char *)c->if_name, name, sizeof(c->if_name));
489 memif_msg_enq_connected(struct rte_eth_dev *dev)
491 struct pmd_internals *pmd = dev->data->dev_private;
492 struct memif_msg_queue_elt *e = memif_msg_enq(pmd->cc);
493 const char *name = rte_vdev_device_name(pmd->vdev);
494 memif_msg_connected_t *c;
499 c = &e->msg.connected;
500 e->msg.type = MEMIF_MSG_TYPE_CONNECTED;
501 strlcpy((char *)c->if_name, name, sizeof(c->if_name));
507 memif_intr_unregister_handler(struct rte_intr_handle *intr_handle, void *arg)
509 struct memif_msg_queue_elt *elt;
510 struct memif_control_channel *cc = arg;
512 /* close control channel fd */
513 close(intr_handle->fd);
514 /* clear message queue */
515 while ((elt = TAILQ_FIRST(&cc->msg_queue)) != NULL) {
516 TAILQ_REMOVE(&cc->msg_queue, elt, next);
519 /* free control channel */
524 memif_disconnect(struct rte_eth_dev *dev)
526 struct pmd_internals *pmd = dev->data->dev_private;
527 struct memif_msg_queue_elt *elt, *next;
528 struct memif_queue *mq;
529 struct rte_intr_handle *ih;
533 if (pmd->cc != NULL) {
534 /* Clear control message queue (except disconnect message if any). */
535 for (elt = TAILQ_FIRST(&pmd->cc->msg_queue); elt != NULL; elt = next) {
536 next = TAILQ_NEXT(elt, next);
537 if (elt->msg.type != MEMIF_MSG_TYPE_DISCONNECT) {
538 TAILQ_REMOVE(&pmd->cc->msg_queue, elt, next);
542 /* send disconnect message (if there is any in queue) */
543 memif_msg_send_from_queue(pmd->cc);
545 /* at this point, there should be no more messages in queue */
546 if (TAILQ_FIRST(&pmd->cc->msg_queue) != NULL) {
548 "%s: Unexpected message(s) in message queue.",
549 rte_vdev_device_name(pmd->vdev));
552 ih = &pmd->cc->intr_handle;
554 ret = rte_intr_callback_unregister(ih,
558 * If callback is active (disconnecting based on
559 * received control message).
561 if (ret == -EAGAIN) {
562 ret = rte_intr_callback_unregister_pending(ih,
565 memif_intr_unregister_handler);
566 } else if (ret > 0) {
572 MIF_LOG(WARNING, "%s: Failed to unregister "
573 "control channel callback.",
574 rte_vdev_device_name(pmd->vdev));
578 /* unconfig interrupts */
579 for (i = 0; i < pmd->cfg.num_s2m_rings; i++) {
580 if (pmd->role == MEMIF_ROLE_SLAVE) {
581 if (dev->data->tx_queues != NULL)
582 mq = dev->data->tx_queues[i];
586 if (dev->data->rx_queues != NULL)
587 mq = dev->data->rx_queues[i];
591 if (mq->intr_handle.fd > 0) {
592 close(mq->intr_handle.fd);
593 mq->intr_handle.fd = -1;
597 for (i = 0; i < pmd->cfg.num_m2s_rings; i++) {
598 if (pmd->role == MEMIF_ROLE_MASTER) {
599 if (dev->data->tx_queues != NULL)
600 mq = dev->data->tx_queues[i];
604 if (dev->data->rx_queues != NULL)
605 mq = dev->data->rx_queues[i];
609 if (mq->intr_handle.fd > 0) {
610 close(mq->intr_handle.fd);
611 mq->intr_handle.fd = -1;
616 memif_free_regions(pmd);
618 /* reset connection configuration */
619 memset(&pmd->run, 0, sizeof(pmd->run));
621 dev->data->dev_link.link_status = ETH_LINK_DOWN;
622 pmd->flags &= ~ETH_MEMIF_FLAG_CONNECTING;
623 pmd->flags &= ~ETH_MEMIF_FLAG_CONNECTED;
624 MIF_LOG(DEBUG, "%s: Disconnected.", rte_vdev_device_name(pmd->vdev));
628 memif_msg_receive(struct memif_control_channel *cc)
630 char ctl[CMSG_SPACE(sizeof(int)) +
631 CMSG_SPACE(sizeof(struct ucred))] = { 0 };
632 struct msghdr mh = { 0 };
634 memif_msg_t msg = { 0 };
637 struct ucred *cr __rte_unused;
639 struct cmsghdr *cmsg;
642 struct pmd_internals *pmd;
644 iov[0].iov_base = (void *)&msg;
645 iov[0].iov_len = sizeof(memif_msg_t);
648 mh.msg_control = ctl;
649 mh.msg_controllen = sizeof(ctl);
651 size = recvmsg(cc->intr_handle.fd, &mh, 0);
652 if (size != sizeof(memif_msg_t)) {
653 MIF_LOG(DEBUG, "Invalid message size.");
654 memif_msg_enq_disconnect(cc, "Invalid message size", 0);
657 MIF_LOG(DEBUG, "Received msg type: %u.", msg.type);
659 cmsg = CMSG_FIRSTHDR(&mh);
661 if (cmsg->cmsg_level == SOL_SOCKET) {
662 if (cmsg->cmsg_type == SCM_CREDENTIALS)
663 cr = (struct ucred *)CMSG_DATA(cmsg);
664 else if (cmsg->cmsg_type == SCM_RIGHTS)
665 memcpy(&afd, CMSG_DATA(cmsg), sizeof(int));
667 cmsg = CMSG_NXTHDR(&mh, cmsg);
670 if (cc->dev == NULL && msg.type != MEMIF_MSG_TYPE_INIT) {
671 MIF_LOG(DEBUG, "Unexpected message.");
672 memif_msg_enq_disconnect(cc, "Unexpected message", 0);
676 /* get device from hash data */
678 case MEMIF_MSG_TYPE_ACK:
680 case MEMIF_MSG_TYPE_HELLO:
681 ret = memif_msg_receive_hello(cc->dev, &msg);
684 ret = memif_init_regions_and_queues(cc->dev);
687 ret = memif_msg_enq_init(cc->dev);
690 pmd = cc->dev->data->dev_private;
691 for (i = 0; i < pmd->regions_num; i++) {
692 ret = memif_msg_enq_add_region(cc->dev, i);
696 for (i = 0; i < pmd->run.num_s2m_rings; i++) {
697 ret = memif_msg_enq_add_ring(cc->dev, i,
702 for (i = 0; i < pmd->run.num_m2s_rings; i++) {
703 ret = memif_msg_enq_add_ring(cc->dev, i,
708 ret = memif_msg_enq_connect(cc->dev);
712 case MEMIF_MSG_TYPE_INIT:
714 * This cc does not have an interface asociated with it.
715 * If suitable interface is found it will be assigned here.
717 ret = memif_msg_receive_init(cc, &msg);
720 ret = memif_msg_enq_ack(cc->dev);
724 case MEMIF_MSG_TYPE_ADD_REGION:
725 ret = memif_msg_receive_add_region(cc->dev, &msg, afd);
728 ret = memif_msg_enq_ack(cc->dev);
732 case MEMIF_MSG_TYPE_ADD_RING:
733 ret = memif_msg_receive_add_ring(cc->dev, &msg, afd);
736 ret = memif_msg_enq_ack(cc->dev);
740 case MEMIF_MSG_TYPE_CONNECT:
741 ret = memif_msg_receive_connect(cc->dev, &msg);
744 ret = memif_msg_enq_connected(cc->dev);
748 case MEMIF_MSG_TYPE_CONNECTED:
749 ret = memif_msg_receive_connected(cc->dev, &msg);
751 case MEMIF_MSG_TYPE_DISCONNECT:
752 ret = memif_msg_receive_disconnect(cc->dev, &msg);
757 memif_msg_enq_disconnect(cc, "Unknown message type", 0);
767 memif_intr_handler(void *arg)
769 struct memif_control_channel *cc = arg;
772 ret = memif_msg_receive(cc);
773 /* if driver failed to assign device */
774 if (cc->dev == NULL) {
775 ret = rte_intr_callback_unregister_pending(&cc->intr_handle,
778 memif_intr_unregister_handler);
781 "Failed to unregister control channel callback.");
784 /* if memif_msg_receive failed */
788 ret = memif_msg_send_from_queue(cc);
795 if (cc->dev == NULL) {
796 MIF_LOG(WARNING, "eth dev not allocated");
799 memif_disconnect(cc->dev);
803 memif_listener_handler(void *arg)
805 struct memif_socket *socket = arg;
808 struct sockaddr_un client;
809 struct memif_control_channel *cc;
812 addr_len = sizeof(client);
813 sockfd = accept(socket->intr_handle.fd, (struct sockaddr *)&client,
814 (socklen_t *)&addr_len);
817 "Failed to accept connection request on socket fd %d",
818 socket->intr_handle.fd);
822 MIF_LOG(DEBUG, "%s: Connection request accepted.", socket->filename);
824 cc = rte_zmalloc("memif-cc", sizeof(struct memif_control_channel), 0);
826 MIF_LOG(ERR, "Failed to allocate control channel.");
830 cc->intr_handle.fd = sockfd;
831 cc->intr_handle.type = RTE_INTR_HANDLE_EXT;
834 TAILQ_INIT(&cc->msg_queue);
836 ret = rte_intr_callback_register(&cc->intr_handle, memif_intr_handler, cc);
838 MIF_LOG(ERR, "Failed to register control channel callback.");
842 ret = memif_msg_enq_hello(cc);
844 MIF_LOG(ERR, "Failed to enqueue hello message.");
847 ret = memif_msg_send_from_queue(cc);
862 static struct memif_socket *
863 memif_socket_create(struct pmd_internals *pmd, char *key, uint8_t listener)
865 struct memif_socket *sock;
866 struct sockaddr_un un;
871 sock = rte_zmalloc("memif-socket", sizeof(struct memif_socket), 0);
873 MIF_LOG(ERR, "Failed to allocate memory for memif socket");
877 sock->listener = listener;
878 rte_memcpy(sock->filename, key, 256);
879 TAILQ_INIT(&sock->dev_queue);
882 sockfd = socket(AF_UNIX, SOCK_SEQPACKET, 0);
886 un.sun_family = AF_UNIX;
887 memcpy(un.sun_path, sock->filename,
888 sizeof(un.sun_path) - 1);
890 ret = setsockopt(sockfd, SOL_SOCKET, SO_PASSCRED, &on,
894 ret = bind(sockfd, (struct sockaddr *)&un, sizeof(un));
897 ret = listen(sockfd, 1);
901 MIF_LOG(DEBUG, "%s: Memif listener socket %s created.",
902 rte_vdev_device_name(pmd->vdev), sock->filename);
904 sock->intr_handle.fd = sockfd;
905 sock->intr_handle.type = RTE_INTR_HANDLE_EXT;
906 ret = rte_intr_callback_register(&sock->intr_handle,
907 memif_listener_handler, sock);
909 MIF_LOG(ERR, "%s: Failed to register interrupt "
910 "callback for listener socket",
911 rte_vdev_device_name(pmd->vdev));
919 MIF_LOG(ERR, "%s: Failed to setup socket %s: %s",
920 rte_vdev_device_name(pmd->vdev), key, strerror(errno));
926 static struct rte_hash *
927 memif_create_socket_hash(void)
929 struct rte_hash_parameters params = { 0 };
930 params.name = MEMIF_SOCKET_HASH_NAME;
931 params.entries = 256;
932 params.key_len = 256;
933 params.hash_func = rte_jhash;
934 params.hash_func_init_val = 0;
935 return rte_hash_create(¶ms);
939 memif_socket_init(struct rte_eth_dev *dev, const char *socket_filename)
941 struct pmd_internals *pmd = dev->data->dev_private;
942 struct memif_socket *socket = NULL;
943 struct memif_socket_dev_list_elt *elt;
944 struct pmd_internals *tmp_pmd;
945 struct rte_hash *hash;
949 hash = rte_hash_find_existing(MEMIF_SOCKET_HASH_NAME);
951 hash = memif_create_socket_hash();
953 MIF_LOG(ERR, "Failed to create memif socket hash.");
959 rte_memcpy(key, socket_filename, strlen(socket_filename));
960 ret = rte_hash_lookup_data(hash, key, (void **)&socket);
962 socket = memif_socket_create(pmd, key,
964 MEMIF_ROLE_SLAVE) ? 0 : 1);
967 ret = rte_hash_add_key_data(hash, key, socket);
969 MIF_LOG(ERR, "Failed to add socket to socket hash.");
973 pmd->socket_filename = socket->filename;
975 if (socket->listener != 0 && pmd->role == MEMIF_ROLE_SLAVE) {
976 MIF_LOG(ERR, "Socket is a listener.");
978 } else if ((socket->listener == 0) && (pmd->role == MEMIF_ROLE_MASTER)) {
979 MIF_LOG(ERR, "Socket is not a listener.");
983 TAILQ_FOREACH(elt, &socket->dev_queue, next) {
984 tmp_pmd = elt->dev->data->dev_private;
985 if (tmp_pmd->id == pmd->id) {
986 MIF_LOG(ERR, "Memif device with id %d already "
987 "exists on socket %s",
988 pmd->id, socket->filename);
993 elt = rte_malloc("pmd-queue", sizeof(struct memif_socket_dev_list_elt), 0);
995 MIF_LOG(ERR, "%s: Failed to add device to socket device list.",
996 rte_vdev_device_name(pmd->vdev));
1000 TAILQ_INSERT_TAIL(&socket->dev_queue, elt, next);
1006 memif_socket_remove_device(struct rte_eth_dev *dev)
1008 struct pmd_internals *pmd = dev->data->dev_private;
1009 struct memif_socket *socket = NULL;
1010 struct memif_socket_dev_list_elt *elt, *next;
1011 struct rte_hash *hash;
1013 hash = rte_hash_find_existing(MEMIF_SOCKET_HASH_NAME);
1017 if (pmd->socket_filename == NULL)
1020 if (rte_hash_lookup_data(hash, pmd->socket_filename, (void **)&socket) < 0)
1023 for (elt = TAILQ_FIRST(&socket->dev_queue); elt != NULL; elt = next) {
1024 next = TAILQ_NEXT(elt, next);
1025 if (elt->dev == dev) {
1026 TAILQ_REMOVE(&socket->dev_queue, elt, next);
1028 pmd->socket_filename = NULL;
1032 /* remove socket, if this was the last device using it */
1033 if (TAILQ_EMPTY(&socket->dev_queue)) {
1034 rte_hash_del_key(hash, socket->filename);
1035 if (socket->listener) {
1036 /* remove listener socket file,
1037 * so we can create new one later.
1039 remove(socket->filename);
1046 memif_connect_master(struct rte_eth_dev *dev)
1048 struct pmd_internals *pmd = dev->data->dev_private;
1050 memset(pmd->local_disc_string, 0, ETH_MEMIF_DISC_STRING_SIZE);
1051 memset(pmd->remote_disc_string, 0, ETH_MEMIF_DISC_STRING_SIZE);
1052 pmd->flags &= ~ETH_MEMIF_FLAG_DISABLED;
1057 memif_connect_slave(struct rte_eth_dev *dev)
1061 struct sockaddr_un sun;
1062 struct pmd_internals *pmd = dev->data->dev_private;
1064 memset(pmd->local_disc_string, 0, ETH_MEMIF_DISC_STRING_SIZE);
1065 memset(pmd->remote_disc_string, 0, ETH_MEMIF_DISC_STRING_SIZE);
1066 pmd->flags &= ~ETH_MEMIF_FLAG_DISABLED;
1068 sockfd = socket(AF_UNIX, SOCK_SEQPACKET, 0);
1070 MIF_LOG(ERR, "%s: Failed to open socket.",
1071 rte_vdev_device_name(pmd->vdev));
1075 sun.sun_family = AF_UNIX;
1077 memcpy(sun.sun_path, pmd->socket_filename, sizeof(sun.sun_path) - 1);
1079 ret = connect(sockfd, (struct sockaddr *)&sun,
1080 sizeof(struct sockaddr_un));
1082 MIF_LOG(ERR, "%s: Failed to connect socket: %s.",
1083 rte_vdev_device_name(pmd->vdev), pmd->socket_filename);
1087 MIF_LOG(DEBUG, "%s: Memif socket: %s connected.",
1088 rte_vdev_device_name(pmd->vdev), pmd->socket_filename);
1090 pmd->cc = rte_zmalloc("memif-cc",
1091 sizeof(struct memif_control_channel), 0);
1092 if (pmd->cc == NULL) {
1093 MIF_LOG(ERR, "%s: Failed to allocate control channel.",
1094 rte_vdev_device_name(pmd->vdev));
1098 pmd->cc->intr_handle.fd = sockfd;
1099 pmd->cc->intr_handle.type = RTE_INTR_HANDLE_EXT;
1100 pmd->cc->socket = NULL;
1102 TAILQ_INIT(&pmd->cc->msg_queue);
1104 ret = rte_intr_callback_register(&pmd->cc->intr_handle,
1105 memif_intr_handler, pmd->cc);
1107 MIF_LOG(ERR, "%s: Failed to register interrupt callback "
1108 "for control fd", rte_vdev_device_name(pmd->vdev));
1119 if (pmd->cc != NULL) {