1 /* SPDX-License-Identifier: BSD-3-Clause
2 * Copyright 2019 Mellanox Technologies, Ltd
6 #include <sys/socket.h>
9 #include <netinet/in.h>
11 #include <rte_malloc.h>
13 #include <rte_errno.h>
14 #include <rte_string_fns.h>
15 #include <rte_bus_pci.h>
17 #include <mlx5_glue.h>
18 #include <mlx5_common.h>
19 #include <mlx5_common_defs.h>
20 #include <mlx5_devx_cmds.h>
24 #include "mlx5_vdpa_utils.h"
25 #include "mlx5_vdpa.h"
27 #define MLX5_VDPA_DRIVER_NAME vdpa_mlx5
29 #define MLX5_VDPA_DEFAULT_FEATURES ((1ULL << VHOST_USER_F_PROTOCOL_FEATURES) | \
30 (1ULL << VIRTIO_F_ANY_LAYOUT) | \
31 (1ULL << VIRTIO_NET_F_MQ) | \
32 (1ULL << VIRTIO_NET_F_GUEST_ANNOUNCE) | \
33 (1ULL << VIRTIO_F_ORDER_PLATFORM) | \
34 (1ULL << VHOST_F_LOG_ALL) | \
35 (1ULL << VIRTIO_NET_F_MTU))
37 #define MLX5_VDPA_PROTOCOL_FEATURES \
38 ((1ULL << VHOST_USER_PROTOCOL_F_SLAVE_REQ) | \
39 (1ULL << VHOST_USER_PROTOCOL_F_SLAVE_SEND_FD) | \
40 (1ULL << VHOST_USER_PROTOCOL_F_HOST_NOTIFIER) | \
41 (1ULL << VHOST_USER_PROTOCOL_F_LOG_SHMFD) | \
42 (1ULL << VHOST_USER_PROTOCOL_F_MQ) | \
43 (1ULL << VHOST_USER_PROTOCOL_F_NET_MTU) | \
44 (1ULL << VHOST_USER_PROTOCOL_F_STATUS))
46 #define MLX5_VDPA_DEFAULT_NO_TRAFFIC_MAX 16LLU
48 TAILQ_HEAD(mlx5_vdpa_privs, mlx5_vdpa_priv) priv_list =
49 TAILQ_HEAD_INITIALIZER(priv_list);
50 static pthread_mutex_t priv_list_lock = PTHREAD_MUTEX_INITIALIZER;
52 static struct mlx5_vdpa_priv *
53 mlx5_vdpa_find_priv_resource_by_vdev(struct rte_vdpa_device *vdev)
55 struct mlx5_vdpa_priv *priv;
58 pthread_mutex_lock(&priv_list_lock);
59 TAILQ_FOREACH(priv, &priv_list, next) {
60 if (vdev == priv->vdev) {
65 pthread_mutex_unlock(&priv_list_lock);
67 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
75 mlx5_vdpa_get_queue_num(struct rte_vdpa_device *vdev, uint32_t *queue_num)
77 struct mlx5_vdpa_priv *priv =
78 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
81 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
84 *queue_num = priv->caps.max_num_virtio_queues;
89 mlx5_vdpa_get_vdpa_features(struct rte_vdpa_device *vdev, uint64_t *features)
91 struct mlx5_vdpa_priv *priv =
92 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
95 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
98 *features = MLX5_VDPA_DEFAULT_FEATURES;
99 if (priv->caps.virtio_queue_type & (1 << MLX5_VIRTQ_TYPE_PACKED))
100 *features |= (1ULL << VIRTIO_F_RING_PACKED);
101 if (priv->caps.tso_ipv4)
102 *features |= (1ULL << VIRTIO_NET_F_HOST_TSO4);
103 if (priv->caps.tso_ipv6)
104 *features |= (1ULL << VIRTIO_NET_F_HOST_TSO6);
105 if (priv->caps.tx_csum)
106 *features |= (1ULL << VIRTIO_NET_F_CSUM);
107 if (priv->caps.rx_csum)
108 *features |= (1ULL << VIRTIO_NET_F_GUEST_CSUM);
109 if (priv->caps.virtio_version_1_0)
110 *features |= (1ULL << VIRTIO_F_VERSION_1);
115 mlx5_vdpa_get_protocol_features(struct rte_vdpa_device *vdev,
118 struct mlx5_vdpa_priv *priv =
119 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
122 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
125 *features = MLX5_VDPA_PROTOCOL_FEATURES;
130 mlx5_vdpa_set_vring_state(int vid, int vring, int state)
132 struct rte_vdpa_device *vdev = rte_vhost_get_vdpa_device(vid);
133 struct mlx5_vdpa_priv *priv =
134 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
138 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
141 if (vring >= (int)priv->caps.max_num_virtio_queues * 2) {
142 DRV_LOG(ERR, "Too big vring id: %d.", vring);
145 pthread_mutex_lock(&priv->vq_config_lock);
146 ret = mlx5_vdpa_virtq_enable(priv, vring, state);
147 pthread_mutex_unlock(&priv->vq_config_lock);
152 mlx5_vdpa_features_set(int vid)
154 struct rte_vdpa_device *vdev = rte_vhost_get_vdpa_device(vid);
155 struct mlx5_vdpa_priv *priv =
156 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
157 uint64_t log_base, log_size;
162 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
165 ret = rte_vhost_get_negotiated_features(vid, &features);
167 DRV_LOG(ERR, "Failed to get negotiated features.");
170 if (RTE_VHOST_NEED_LOG(features)) {
171 ret = rte_vhost_get_log_base(vid, &log_base, &log_size);
173 DRV_LOG(ERR, "Failed to get log base.");
176 ret = mlx5_vdpa_dirty_bitmap_set(priv, log_base, log_size);
178 DRV_LOG(ERR, "Failed to set dirty bitmap.");
181 DRV_LOG(INFO, "mlx5 vdpa: enabling dirty logging...");
182 ret = mlx5_vdpa_logging_enable(priv, 1);
184 DRV_LOG(ERR, "Failed t enable dirty logging.");
192 mlx5_vdpa_mtu_set(struct mlx5_vdpa_priv *priv)
194 struct ifreq request;
195 uint16_t vhost_mtu = 0;
196 uint16_t kern_mtu = 0;
197 int ret = rte_vhost_get_mtu(priv->vid, &vhost_mtu);
199 int retries = MLX5_VDPA_MAX_RETRIES;
202 DRV_LOG(DEBUG, "Cannot get vhost MTU - %d.", ret);
206 DRV_LOG(DEBUG, "Vhost MTU is 0.");
209 ret = mlx5_get_ifname_sysfs
210 (mlx5_os_get_ctx_device_name(priv->cdev->ctx),
213 DRV_LOG(DEBUG, "Cannot get kernel IF name - %d.", ret);
216 sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_IP);
218 DRV_LOG(DEBUG, "Cannot open IF socket.");
222 ret = ioctl(sock, SIOCGIFMTU, &request);
225 kern_mtu = request.ifr_mtu;
226 DRV_LOG(DEBUG, "MTU: current %d requested %d.", (int)kern_mtu,
228 if (kern_mtu == vhost_mtu)
230 request.ifr_mtu = vhost_mtu;
231 ret = ioctl(sock, SIOCSIFMTU, &request);
235 usleep(MLX5_VDPA_USEC);
238 return kern_mtu == vhost_mtu ? 0 : -1;
242 mlx5_vdpa_dev_close(int vid)
244 struct rte_vdpa_device *vdev = rte_vhost_get_vdpa_device(vid);
245 struct mlx5_vdpa_priv *priv =
246 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
250 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
253 if (priv->configured)
254 ret |= mlx5_vdpa_lm_log(priv);
255 mlx5_vdpa_err_event_unset(priv);
256 mlx5_vdpa_cqe_event_unset(priv);
257 mlx5_vdpa_steer_unset(priv);
258 mlx5_vdpa_virtqs_release(priv);
259 mlx5_vdpa_event_qp_global_release(priv);
260 mlx5_vdpa_mem_dereg(priv);
261 priv->configured = 0;
263 /* The mutex may stay locked after event thread cancel - initiate it. */
264 pthread_mutex_init(&priv->vq_config_lock, NULL);
265 DRV_LOG(INFO, "vDPA device %d was closed.", vid);
270 mlx5_vdpa_dev_config(int vid)
272 struct rte_vdpa_device *vdev = rte_vhost_get_vdpa_device(vid);
273 struct mlx5_vdpa_priv *priv =
274 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
277 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
280 if (priv->configured && mlx5_vdpa_dev_close(vid)) {
281 DRV_LOG(ERR, "Failed to reconfigure vid %d.", vid);
285 if (mlx5_vdpa_mtu_set(priv))
286 DRV_LOG(WARNING, "MTU cannot be set on device %s.",
288 if (mlx5_vdpa_mem_register(priv) || mlx5_vdpa_err_event_setup(priv) ||
289 mlx5_vdpa_virtqs_prepare(priv) || mlx5_vdpa_steer_setup(priv) ||
290 mlx5_vdpa_cqe_event_setup(priv)) {
291 mlx5_vdpa_dev_close(vid);
294 priv->configured = 1;
295 DRV_LOG(INFO, "vDPA device %d was configured.", vid);
300 mlx5_vdpa_get_device_fd(int vid)
302 struct rte_vdpa_device *vdev = rte_vhost_get_vdpa_device(vid);
303 struct mlx5_vdpa_priv *priv =
304 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
307 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
310 return ((struct ibv_context *)priv->cdev->ctx)->cmd_fd;
314 mlx5_vdpa_get_notify_area(int vid, int qid, uint64_t *offset, uint64_t *size)
316 struct rte_vdpa_device *vdev = rte_vhost_get_vdpa_device(vid);
317 struct mlx5_vdpa_priv *priv =
318 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
322 DRV_LOG(ERR, "Invalid vDPA device: %s.", vdev->device->name);
326 DRV_LOG(ERR, "VAR was not created for device %s, is the device"
327 " configured?.", vdev->device->name);
330 *offset = priv->var->mmap_off;
331 *size = priv->var->length;
336 mlx5_vdpa_get_stats_names(struct rte_vdpa_device *vdev,
337 struct rte_vdpa_stat_name *stats_names,
340 static const char *mlx5_vdpa_stats_names[MLX5_VDPA_STATS_MAX] = {
341 "received_descriptors",
342 "completed_descriptors",
343 "bad descriptor errors",
348 struct mlx5_vdpa_priv *priv =
349 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
353 DRV_LOG(ERR, "Invalid device: %s.", vdev->device->name);
357 return MLX5_VDPA_STATS_MAX;
358 size = RTE_MIN(size, (unsigned int)MLX5_VDPA_STATS_MAX);
359 for (i = 0; i < size; ++i)
360 strlcpy(stats_names[i].name, mlx5_vdpa_stats_names[i],
361 RTE_VDPA_STATS_NAME_SIZE);
366 mlx5_vdpa_get_stats(struct rte_vdpa_device *vdev, int qid,
367 struct rte_vdpa_stat *stats, unsigned int n)
369 struct mlx5_vdpa_priv *priv =
370 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
373 DRV_LOG(ERR, "Invalid device: %s.", vdev->device->name);
376 if (!priv->configured) {
377 DRV_LOG(ERR, "Device %s was not configured.",
381 if (qid >= (int)priv->nr_virtqs) {
382 DRV_LOG(ERR, "Too big vring id: %d for device %s.", qid,
386 if (!priv->caps.queue_counters_valid) {
387 DRV_LOG(ERR, "Virtq statistics is not supported for device %s.",
391 return mlx5_vdpa_virtq_stats_get(priv, qid, stats, n);
395 mlx5_vdpa_reset_stats(struct rte_vdpa_device *vdev, int qid)
397 struct mlx5_vdpa_priv *priv =
398 mlx5_vdpa_find_priv_resource_by_vdev(vdev);
401 DRV_LOG(ERR, "Invalid device: %s.", vdev->device->name);
404 if (!priv->configured) {
405 DRV_LOG(ERR, "Device %s was not configured.",
409 if (qid >= (int)priv->nr_virtqs) {
410 DRV_LOG(ERR, "Too big vring id: %d for device %s.", qid,
414 if (!priv->caps.queue_counters_valid) {
415 DRV_LOG(ERR, "Virtq statistics is not supported for device %s.",
419 return mlx5_vdpa_virtq_stats_reset(priv, qid);
422 static struct rte_vdpa_dev_ops mlx5_vdpa_ops = {
423 .get_queue_num = mlx5_vdpa_get_queue_num,
424 .get_features = mlx5_vdpa_get_vdpa_features,
425 .get_protocol_features = mlx5_vdpa_get_protocol_features,
426 .dev_conf = mlx5_vdpa_dev_config,
427 .dev_close = mlx5_vdpa_dev_close,
428 .set_vring_state = mlx5_vdpa_set_vring_state,
429 .set_features = mlx5_vdpa_features_set,
430 .migration_done = NULL,
431 .get_vfio_group_fd = NULL,
432 .get_vfio_device_fd = mlx5_vdpa_get_device_fd,
433 .get_notify_area = mlx5_vdpa_get_notify_area,
434 .get_stats_names = mlx5_vdpa_get_stats_names,
435 .get_stats = mlx5_vdpa_get_stats,
436 .reset_stats = mlx5_vdpa_reset_stats,
440 mlx5_vdpa_args_check_handler(const char *key, const char *val, void *opaque)
442 struct mlx5_vdpa_priv *priv = opaque;
444 int n_cores = sysconf(_SC_NPROCESSORS_ONLN);
446 if (strcmp(key, RTE_DEVARGS_KEY_CLASS) == 0)
449 tmp = strtoul(val, NULL, 0);
451 DRV_LOG(WARNING, "%s: \"%s\" is an invalid integer.", key, val);
454 if (strcmp(key, "event_mode") == 0) {
455 if (tmp <= MLX5_VDPA_EVENT_MODE_ONLY_INTERRUPT)
456 priv->event_mode = (int)tmp;
458 DRV_LOG(WARNING, "Invalid event_mode %s.", val);
459 } else if (strcmp(key, "event_us") == 0) {
460 priv->event_us = (uint32_t)tmp;
461 } else if (strcmp(key, "no_traffic_time") == 0) {
462 priv->no_traffic_max = (uint32_t)tmp;
463 } else if (strcmp(key, "event_core") == 0) {
464 if (tmp >= (unsigned long)n_cores)
465 DRV_LOG(WARNING, "Invalid event_core %s.", val);
467 priv->event_core = tmp;
468 } else if (strcmp(key, "hw_latency_mode") == 0) {
469 priv->hw_latency_mode = (uint32_t)tmp;
470 } else if (strcmp(key, "hw_max_latency_us") == 0) {
471 priv->hw_max_latency_us = (uint32_t)tmp;
472 } else if (strcmp(key, "hw_max_pending_comp") == 0) {
473 priv->hw_max_pending_comp = (uint32_t)tmp;
475 DRV_LOG(WARNING, "Invalid key %s.", key);
481 mlx5_vdpa_config_get(struct rte_devargs *devargs, struct mlx5_vdpa_priv *priv)
483 struct rte_kvargs *kvlist;
485 priv->event_mode = MLX5_VDPA_EVENT_MODE_FIXED_TIMER;
487 priv->event_core = -1;
488 priv->no_traffic_max = MLX5_VDPA_DEFAULT_NO_TRAFFIC_MAX;
491 kvlist = rte_kvargs_parse(devargs->args, NULL);
494 rte_kvargs_process(kvlist, NULL, mlx5_vdpa_args_check_handler, priv);
495 rte_kvargs_free(kvlist);
496 if (!priv->event_us &&
497 priv->event_mode == MLX5_VDPA_EVENT_MODE_DYNAMIC_TIMER)
498 priv->event_us = MLX5_VDPA_DEFAULT_TIMER_STEP_US;
499 DRV_LOG(DEBUG, "event mode is %d.", priv->event_mode);
500 DRV_LOG(DEBUG, "event_us is %u us.", priv->event_us);
501 DRV_LOG(DEBUG, "no traffic max is %u.", priv->no_traffic_max);
505 mlx5_vdpa_dev_probe(struct mlx5_common_device *cdev)
507 struct mlx5_vdpa_priv *priv = NULL;
508 struct mlx5_hca_attr *attr = &cdev->config.hca_attr;
511 if (!attr->vdpa.valid || !attr->vdpa.max_num_virtio_queues) {
512 DRV_LOG(ERR, "Not enough capabilities to support vdpa, maybe "
513 "old FW/OFED version?");
517 if (!attr->vdpa.queue_counters_valid)
518 DRV_LOG(DEBUG, "No capability to support virtq statistics.");
519 priv = rte_zmalloc("mlx5 vDPA device private", sizeof(*priv) +
520 sizeof(struct mlx5_vdpa_virtq) *
521 attr->vdpa.max_num_virtio_queues * 2,
522 RTE_CACHE_LINE_SIZE);
524 DRV_LOG(ERR, "Failed to allocate private memory.");
528 priv->caps = attr->vdpa;
529 priv->log_max_rqt_size = attr->log_max_rqt_size;
530 priv->num_lag_ports = attr->num_lag_ports;
531 if (attr->num_lag_ports == 0)
532 priv->num_lag_ports = 1;
534 for (retry = 0; retry < 7; retry++) {
535 priv->var = mlx5_glue->dv_alloc_var(priv->cdev->ctx, 0);
536 if (priv->var != NULL)
538 DRV_LOG(WARNING, "Failed to allocate VAR, retry %d.\n", retry);
539 /* Wait Qemu release VAR during vdpa restart, 0.1 sec based. */
540 usleep(100000U << retry);
543 DRV_LOG(ERR, "Failed to allocate VAR %u.", errno);
546 priv->err_intr_handle =
547 rte_intr_instance_alloc(RTE_INTR_INSTANCE_F_SHARED);
548 if (priv->err_intr_handle == NULL) {
549 DRV_LOG(ERR, "Fail to allocate intr_handle");
552 priv->vdev = rte_vdpa_register_device(cdev->dev, &mlx5_vdpa_ops);
553 if (priv->vdev == NULL) {
554 DRV_LOG(ERR, "Failed to register vDPA device.");
555 rte_errno = rte_errno ? rte_errno : EINVAL;
558 mlx5_vdpa_config_get(cdev->dev->devargs, priv);
559 SLIST_INIT(&priv->mr_list);
560 pthread_mutex_init(&priv->vq_config_lock, NULL);
561 pthread_mutex_lock(&priv_list_lock);
562 TAILQ_INSERT_TAIL(&priv_list, priv, next);
563 pthread_mutex_unlock(&priv_list_lock);
569 mlx5_glue->dv_free_var(priv->var);
570 rte_intr_instance_free(priv->err_intr_handle);
577 mlx5_vdpa_dev_remove(struct mlx5_common_device *cdev)
579 struct mlx5_vdpa_priv *priv = NULL;
582 pthread_mutex_lock(&priv_list_lock);
583 TAILQ_FOREACH(priv, &priv_list, next) {
584 if (priv->vdev->device == cdev->dev) {
590 TAILQ_REMOVE(&priv_list, priv, next);
591 pthread_mutex_unlock(&priv_list_lock);
593 if (priv->configured)
594 mlx5_vdpa_dev_close(priv->vid);
596 mlx5_glue->dv_free_var(priv->var);
600 rte_vdpa_unregister_device(priv->vdev);
601 pthread_mutex_destroy(&priv->vq_config_lock);
602 rte_intr_instance_free(priv->err_intr_handle);
608 static const struct rte_pci_id mlx5_vdpa_pci_id_map[] = {
610 RTE_PCI_DEVICE(PCI_VENDOR_ID_MELLANOX,
611 PCI_DEVICE_ID_MELLANOX_CONNECTX6)
614 RTE_PCI_DEVICE(PCI_VENDOR_ID_MELLANOX,
615 PCI_DEVICE_ID_MELLANOX_CONNECTX6VF)
618 RTE_PCI_DEVICE(PCI_VENDOR_ID_MELLANOX,
619 PCI_DEVICE_ID_MELLANOX_CONNECTX6DX)
622 RTE_PCI_DEVICE(PCI_VENDOR_ID_MELLANOX,
623 PCI_DEVICE_ID_MELLANOX_CONNECTXVF)
626 RTE_PCI_DEVICE(PCI_VENDOR_ID_MELLANOX,
627 PCI_DEVICE_ID_MELLANOX_CONNECTX6DXBF)
630 RTE_PCI_DEVICE(PCI_VENDOR_ID_MELLANOX,
631 PCI_DEVICE_ID_MELLANOX_CONNECTX7)
634 RTE_PCI_DEVICE(PCI_VENDOR_ID_MELLANOX,
635 PCI_DEVICE_ID_MELLANOX_CONNECTX7BF)
642 static struct mlx5_class_driver mlx5_vdpa_driver = {
643 .drv_class = MLX5_CLASS_VDPA,
644 .name = RTE_STR(MLX5_VDPA_DRIVER_NAME),
645 .id_table = mlx5_vdpa_pci_id_map,
646 .probe = mlx5_vdpa_dev_probe,
647 .remove = mlx5_vdpa_dev_remove,
650 RTE_LOG_REGISTER_DEFAULT(mlx5_vdpa_logtype, NOTICE)
653 * Driver initialization routine.
655 RTE_INIT(rte_mlx5_vdpa_init)
659 mlx5_class_driver_register(&mlx5_vdpa_driver);
662 RTE_PMD_EXPORT_NAME(MLX5_VDPA_DRIVER_NAME, __COUNTER__);
663 RTE_PMD_REGISTER_PCI_TABLE(MLX5_VDPA_DRIVER_NAME, mlx5_vdpa_pci_id_map);
664 RTE_PMD_REGISTER_KMOD_DEP(MLX5_VDPA_DRIVER_NAME, "* ib_uverbs & mlx5_core & mlx5_ib");