net/virtio: check protocol feature in user backend
[dpdk.git] / drivers / net / virtio / virtio_user / virtio_user_dev.c
index 1c6b26f..d7cd6b0 100644 (file)
@@ -111,17 +111,6 @@ virtio_user_queue_setup(struct virtio_user_dev *dev,
        return 0;
 }
 
-int
-is_vhost_user_by_type(const char *path)
-{
-       struct stat sb;
-
-       if (stat(path, &sb) == -1)
-               return 0;
-
-       return S_ISSOCK(sb.st_mode);
-}
-
 int
 virtio_user_start_device(struct virtio_user_dev *dev)
 {
@@ -144,15 +133,18 @@ virtio_user_start_device(struct virtio_user_dev *dev)
        rte_mcfg_mem_read_lock();
        pthread_mutex_lock(&dev->mutex);
 
-       if (is_vhost_user_by_type(dev->path) && dev->vhostfd < 0)
+       if (dev->backend_type == VIRTIO_USER_BACKEND_VHOST_USER &&
+                       dev->vhostfd < 0)
                goto error;
 
        /* Step 0: tell vhost to create queues */
        if (virtio_user_queue_setup(dev, virtio_user_create_queue) < 0)
                goto error;
 
-       /* Step 1: set features */
+       /* Step 1: negotiate protocol features & set features */
        features = dev->features;
+
+
        /* Strip VIRTIO_NET_F_MAC, as MAC address is handled in vdev init */
        features &= ~(1ull << VIRTIO_NET_F_MAC);
        /* Strip VIRTIO_NET_F_CTRL_VQ, as devices do not really need to know */
@@ -358,16 +350,16 @@ virtio_user_dev_setup(struct virtio_user_dev *dev)
        dev->tapfds = NULL;
 
        if (dev->is_server) {
-               if (access(dev->path, F_OK) == 0 &&
-                   !is_vhost_user_by_type(dev->path)) {
-                       PMD_DRV_LOG(ERR, "Server mode doesn't support vhost-kernel!");
+               if (dev->backend_type != VIRTIO_USER_BACKEND_VHOST_USER) {
+                       PMD_DRV_LOG(ERR, "Server mode only supports vhost-user!");
                        return -1;
                }
                dev->ops = &virtio_ops_user;
        } else {
-               if (is_vhost_user_by_type(dev->path)) {
+               if (dev->backend_type == VIRTIO_USER_BACKEND_VHOST_USER) {
                        dev->ops = &virtio_ops_user;
-               } else {
+               } else if (dev->backend_type ==
+                                       VIRTIO_USER_BACKEND_VHOST_KERNEL) {
                        dev->ops = &virtio_ops_kernel;
 
                        dev->vhostfds = malloc(dev->max_queue_pairs *
@@ -417,13 +409,22 @@ virtio_user_dev_setup(struct virtio_user_dev *dev)
         1ULL << VIRTIO_NET_F_GUEST_TSO6        |       \
         1ULL << VIRTIO_F_IN_ORDER              |       \
         1ULL << VIRTIO_F_VERSION_1             |       \
-        1ULL << VIRTIO_F_RING_PACKED)
+        1ULL << VIRTIO_F_RING_PACKED           |       \
+        1ULL << VHOST_USER_F_PROTOCOL_FEATURES)
+
+#define VIRTIO_USER_SUPPORTED_PROTOCOL_FEATURES                \
+       (1ULL << VHOST_USER_PROTOCOL_F_MQ |             \
+        1ULL << VHOST_USER_PROTOCOL_F_REPLY_ACK |      \
+        1ULL << VHOST_USER_PROTOCOL_F_STATUS)
 
 int
 virtio_user_dev_init(struct virtio_user_dev *dev, char *path, int queues,
                     int cq, int queue_size, const char *mac, char **ifname,
-                    int server, int mrg_rxbuf, int in_order, int packed_vq)
+                    int server, int mrg_rxbuf, int in_order, int packed_vq,
+                    enum virtio_user_backend_type backend_type)
 {
+       uint64_t protocol_features = 0;
+
        pthread_mutex_init(&dev->mutex, NULL);
        strlcpy(dev->path, path, PATH_MAX);
        dev->started = 0;
@@ -434,6 +435,9 @@ virtio_user_dev_init(struct virtio_user_dev *dev, char *path, int queues,
        dev->mac_specified = 0;
        dev->frontend_features = 0;
        dev->unsupported_features = ~VIRTIO_USER_SUPPORTED_FEATURES;
+       dev->protocol_features = VIRTIO_USER_SUPPORTED_PROTOCOL_FEATURES;
+       dev->backend_type = backend_type;
+
        parse_mac(dev, mac);
 
        if (*ifname) {
@@ -446,6 +450,10 @@ virtio_user_dev_init(struct virtio_user_dev *dev, char *path, int queues,
                return -1;
        }
 
+       if (dev->backend_type != VIRTIO_USER_BACKEND_VHOST_USER)
+               dev->unsupported_features |=
+                       (1ULL << VHOST_USER_F_PROTOCOL_FEATURES);
+
        if (!dev->is_server) {
                if (dev->ops->send_request(dev, VHOST_USER_SET_OWNER,
                                           NULL) < 0) {
@@ -460,6 +468,27 @@ virtio_user_dev_init(struct virtio_user_dev *dev, char *path, int queues,
                                     strerror(errno));
                        return -1;
                }
+
+
+               if (dev->device_features &
+                               (1ULL << VHOST_USER_F_PROTOCOL_FEATURES)) {
+                       if (dev->ops->send_request(dev,
+                                       VHOST_USER_GET_PROTOCOL_FEATURES,
+                                       &protocol_features))
+                               return -1;
+
+                       dev->protocol_features &= protocol_features;
+
+                       if (dev->ops->send_request(dev,
+                                       VHOST_USER_SET_PROTOCOL_FEATURES,
+                                       &dev->protocol_features))
+                               return -1;
+
+                       if (!(dev->protocol_features &
+                                       (1ULL << VHOST_USER_PROTOCOL_F_MQ)))
+                               dev->unsupported_features |=
+                                       (1ull << VIRTIO_NET_F_MQ);
+               }
        } else {
                /* We just pretend vhost-user can support all these features.
                 * Note that this could be problematic that if some feature is
@@ -469,6 +498,8 @@ virtio_user_dev_init(struct virtio_user_dev *dev, char *path, int queues,
                dev->device_features = VIRTIO_USER_SUPPORTED_FEATURES;
        }
 
+
+
        if (!mrg_rxbuf)
                dev->unsupported_features |= (1ull << VIRTIO_NET_F_MRG_RXBUF);
 
@@ -501,7 +532,7 @@ virtio_user_dev_init(struct virtio_user_dev *dev, char *path, int queues,
        }
 
        /* The backend will not report this feature, we add it explicitly */
-       if (is_vhost_user_by_type(dev->path))
+       if (dev->backend_type == VIRTIO_USER_BACKEND_VHOST_USER)
                dev->frontend_features |= (1ull << VIRTIO_NET_F_STATUS);
 
        /*
@@ -730,8 +761,10 @@ virtio_user_handle_cq(struct virtio_user_dev *dev, uint16_t queue_idx)
        struct vring *vring = &dev->vrings[queue_idx];
 
        /* Consume avail ring, using used ring idx as first one */
-       while (vring->used->idx != vring->avail->idx) {
-               avail_idx = (vring->used->idx) & (vring->num - 1);
+       while (__atomic_load_n(&vring->used->idx, __ATOMIC_RELAXED)
+              != vring->avail->idx) {
+               avail_idx = __atomic_load_n(&vring->used->idx, __ATOMIC_RELAXED)
+                           & (vring->num - 1);
                desc_idx = vring->avail->ring[avail_idx];
 
                n_descs = virtio_user_handle_ctrl_msg(dev, vring, desc_idx);
@@ -741,6 +774,67 @@ virtio_user_handle_cq(struct virtio_user_dev *dev, uint16_t queue_idx)
                uep->id = desc_idx;
                uep->len = n_descs;
 
-               vring->used->idx++;
+               __atomic_add_fetch(&vring->used->idx, 1, __ATOMIC_RELAXED);
        }
 }
+
+int
+virtio_user_send_status_update(struct virtio_user_dev *dev, uint8_t status)
+{
+       int ret;
+       uint64_t arg = status;
+
+       /* Vhost-user only for now */
+       if (dev->backend_type != VIRTIO_USER_BACKEND_VHOST_USER)
+               return 0;
+
+       ret = dev->ops->send_request(dev, VHOST_USER_SET_STATUS, &arg);
+       if (ret) {
+               PMD_INIT_LOG(ERR, "VHOST_USER_SET_STATUS failed (%d): %s", ret,
+                            strerror(errno));
+               return -1;
+       }
+
+       return 0;
+}
+
+int
+virtio_user_update_status(struct virtio_user_dev *dev)
+{
+       uint64_t ret;
+       int err;
+
+       /* Vhost-user only for now */
+       if (dev->backend_type != VIRTIO_USER_BACKEND_VHOST_USER)
+               return 0;
+
+       err = dev->ops->send_request(dev, VHOST_USER_GET_STATUS, &ret);
+       if (err) {
+               PMD_INIT_LOG(ERR, "VHOST_USER_GET_STATUS failed (%d): %s", err,
+                            strerror(errno));
+               return -1;
+       }
+       if (ret > UINT8_MAX) {
+               PMD_INIT_LOG(ERR, "Invalid VHOST_USER_GET_STATUS response 0x%" PRIx64 "\n", ret);
+               return -1;
+       }
+
+       dev->status = ret;
+       PMD_INIT_LOG(DEBUG, "Updated Device Status(0x%08x):\n"
+                       "\t-RESET: %u\n"
+                       "\t-ACKNOWLEDGE: %u\n"
+                       "\t-DRIVER: %u\n"
+                       "\t-DRIVER_OK: %u\n"
+                       "\t-FEATURES_OK: %u\n"
+                       "\t-DEVICE_NEED_RESET: %u\n"
+                       "\t-FAILED: %u\n",
+                       dev->status,
+                       (dev->status == VIRTIO_CONFIG_STATUS_RESET),
+                       !!(dev->status & VIRTIO_CONFIG_STATUS_ACK),
+                       !!(dev->status & VIRTIO_CONFIG_STATUS_DRIVER),
+                       !!(dev->status & VIRTIO_CONFIG_STATUS_DRIVER_OK),
+                       !!(dev->status & VIRTIO_CONFIG_STATUS_FEATURES_OK),
+                       !!(dev->status & VIRTIO_CONFIG_STATUS_DEV_NEED_RESET),
+                       !!(dev->status & VIRTIO_CONFIG_STATUS_FAILED));
+       return 0;
+}