1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2018, Bin Meng <bmeng.cn@gmail.com>
5 * VirtIO Sandbox transport driver, for testing purpose only
10 #include <virtio_types.h>
12 #include <virtio_ring.h>
13 #include <linux/bug.h>
14 #include <linux/compat.h>
15 #include <linux/err.h>
18 struct virtio_sandbox_priv {
24 ulong queue_available;
28 static int virtio_sandbox_get_config(struct udevice *udev, unsigned int offset,
29 void *buf, unsigned int len)
34 static int virtio_sandbox_set_config(struct udevice *udev, unsigned int offset,
35 const void *buf, unsigned int len)
40 static int virtio_sandbox_get_status(struct udevice *udev, u8 *status)
42 struct virtio_sandbox_priv *priv = dev_get_priv(udev);
44 *status = priv->status;
49 static int virtio_sandbox_set_status(struct udevice *udev, u8 status)
51 struct virtio_sandbox_priv *priv = dev_get_priv(udev);
53 /* We should never be setting status to 0 */
56 priv->status = status;
61 static int virtio_sandbox_reset(struct udevice *udev)
63 struct virtio_sandbox_priv *priv = dev_get_priv(udev);
65 /* 0 status means a reset */
71 static int virtio_sandbox_get_features(struct udevice *udev, u64 *features)
73 struct virtio_sandbox_priv *priv = dev_get_priv(udev);
75 *features = priv->device_features;
80 static int virtio_sandbox_set_features(struct udevice *udev)
82 struct virtio_sandbox_priv *priv = dev_get_priv(udev);
83 struct virtio_dev_priv *uc_priv = dev_get_uclass_priv(udev);
85 priv->driver_features = uc_priv->features;
90 static struct virtqueue *virtio_sandbox_setup_vq(struct udevice *udev,
93 struct virtio_sandbox_priv *priv = dev_get_priv(udev);
98 /* Create the vring */
99 vq = vring_create_virtqueue(index, 4, 4096, udev);
102 goto error_new_virtqueue;
105 addr = virtqueue_get_desc_addr(vq);
106 priv->queue_desc = addr;
108 addr = virtqueue_get_avail_addr(vq);
109 priv->queue_available = addr;
111 addr = virtqueue_get_used_addr(vq);
112 priv->queue_used = addr;
120 static void virtio_sandbox_del_vq(struct virtqueue *vq)
122 vring_del_virtqueue(vq);
125 static int virtio_sandbox_del_vqs(struct udevice *udev)
127 struct virtio_dev_priv *uc_priv = dev_get_uclass_priv(udev);
128 struct virtqueue *vq, *n;
130 list_for_each_entry_safe(vq, n, &uc_priv->vqs, list)
131 virtio_sandbox_del_vq(vq);
136 static int virtio_sandbox_find_vqs(struct udevice *udev, unsigned int nvqs,
137 struct virtqueue *vqs[])
141 for (i = 0; i < nvqs; ++i) {
142 vqs[i] = virtio_sandbox_setup_vq(udev, i);
143 if (IS_ERR(vqs[i])) {
144 virtio_sandbox_del_vqs(udev);
145 return PTR_ERR(vqs[i]);
152 static int virtio_sandbox_notify(struct udevice *udev, struct virtqueue *vq)
157 static int virtio_sandbox_probe(struct udevice *udev)
159 struct virtio_sandbox_priv *priv = dev_get_priv(udev);
160 struct virtio_dev_priv *uc_priv = dev_get_uclass_priv(udev);
162 /* fake some information for testing */
163 priv->device_features = BIT_ULL(VIRTIO_F_VERSION_1);
164 uc_priv->device = dev_read_u32_default(udev, "virtio-type",
166 uc_priv->vendor = ('u' << 24) | ('b' << 16) | ('o' << 8) | 't';
171 static const struct dm_virtio_ops virtio_sandbox1_ops = {
172 .get_config = virtio_sandbox_get_config,
173 .set_config = virtio_sandbox_set_config,
174 .get_status = virtio_sandbox_get_status,
175 .set_status = virtio_sandbox_set_status,
176 .reset = virtio_sandbox_reset,
177 .get_features = virtio_sandbox_get_features,
178 .set_features = virtio_sandbox_set_features,
179 .find_vqs = virtio_sandbox_find_vqs,
180 .del_vqs = virtio_sandbox_del_vqs,
181 .notify = virtio_sandbox_notify,
184 static const struct udevice_id virtio_sandbox1_ids[] = {
185 { .compatible = "sandbox,virtio1" },
189 U_BOOT_DRIVER(virtio_sandbox1) = {
190 .name = "virtio-sandbox1",
192 .of_match = virtio_sandbox1_ids,
193 .ops = &virtio_sandbox1_ops,
194 .probe = virtio_sandbox_probe,
195 .priv_auto = sizeof(struct virtio_sandbox_priv),
198 /* this one without notify op */
199 static const struct dm_virtio_ops virtio_sandbox2_ops = {
200 .get_config = virtio_sandbox_get_config,
201 .set_config = virtio_sandbox_set_config,
202 .get_status = virtio_sandbox_get_status,
203 .set_status = virtio_sandbox_set_status,
204 .reset = virtio_sandbox_reset,
205 .get_features = virtio_sandbox_get_features,
206 .set_features = virtio_sandbox_set_features,
207 .find_vqs = virtio_sandbox_find_vqs,
208 .del_vqs = virtio_sandbox_del_vqs,
211 static const struct udevice_id virtio_sandbox2_ids[] = {
212 { .compatible = "sandbox,virtio2" },
216 U_BOOT_DRIVER(virtio_sandbox2) = {
217 .name = "virtio-sandbox2",
219 .of_match = virtio_sandbox2_ids,
220 .ops = &virtio_sandbox2_ops,
221 .probe = virtio_sandbox_probe,
222 .priv_auto = sizeof(struct virtio_sandbox_priv),