1#ifndef _LINUX_VIRTIO_CONFIG_H
2#define _LINUX_VIRTIO_CONFIG_H
3
4#include <linux/err.h>
5#include <linux/bug.h>
6#include <linux/virtio.h>
7#include <linux/virtio_byteorder.h>
8#include <uapi/linux/virtio_config.h>
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60typedef void vq_callback_t(struct virtqueue *);
61struct virtio_config_ops {
62 void (*get)(struct virtio_device *vdev, unsigned offset,
63 void *buf, unsigned len);
64 void (*set)(struct virtio_device *vdev, unsigned offset,
65 const void *buf, unsigned len);
66 u32 (*generation)(struct virtio_device *vdev);
67 u8 (*get_status)(struct virtio_device *vdev);
68 void (*set_status)(struct virtio_device *vdev, u8 status);
69 void (*reset)(struct virtio_device *vdev);
70 int (*find_vqs)(struct virtio_device *, unsigned nvqs,
71 struct virtqueue *vqs[],
72 vq_callback_t *callbacks[],
73 const char *names[]);
74 void (*del_vqs)(struct virtio_device *);
75 u64 (*get_features)(struct virtio_device *vdev);
76 int (*finalize_features)(struct virtio_device *vdev);
77 const char *(*bus_name)(struct virtio_device *vdev);
78 int (*set_vq_affinity)(struct virtqueue *vq, int cpu);
79};
80
81
82void virtio_check_driver_offered_feature(const struct virtio_device *vdev,
83 unsigned int fbit);
84
85
86
87
88
89
90
91
92static inline bool __virtio_test_bit(const struct virtio_device *vdev,
93 unsigned int fbit)
94{
95
96 if (__builtin_constant_p(fbit))
97 BUILD_BUG_ON(fbit >= 64);
98 else
99 BUG_ON(fbit >= 64);
100
101 return vdev->features & BIT_ULL(fbit);
102}
103
104
105
106
107
108
109static inline void __virtio_set_bit(struct virtio_device *vdev,
110 unsigned int fbit)
111{
112
113 if (__builtin_constant_p(fbit))
114 BUILD_BUG_ON(fbit >= 64);
115 else
116 BUG_ON(fbit >= 64);
117
118 vdev->features |= BIT_ULL(fbit);
119}
120
121
122
123
124
125
126static inline void __virtio_clear_bit(struct virtio_device *vdev,
127 unsigned int fbit)
128{
129
130 if (__builtin_constant_p(fbit))
131 BUILD_BUG_ON(fbit >= 64);
132 else
133 BUG_ON(fbit >= 64);
134
135 vdev->features &= ~BIT_ULL(fbit);
136}
137
138
139
140
141
142
143static inline bool virtio_has_feature(const struct virtio_device *vdev,
144 unsigned int fbit)
145{
146 if (fbit < VIRTIO_TRANSPORT_F_START)
147 virtio_check_driver_offered_feature(vdev, fbit);
148
149 return __virtio_test_bit(vdev, fbit);
150}
151
152static inline
153struct virtqueue *virtio_find_single_vq(struct virtio_device *vdev,
154 vq_callback_t *c, const char *n)
155{
156 vq_callback_t *callbacks[] = { c };
157 const char *names[] = { n };
158 struct virtqueue *vq;
159 int err = vdev->config->find_vqs(vdev, 1, &vq, callbacks, names);
160 if (err < 0)
161 return ERR_PTR(err);
162 return vq;
163}
164
165
166
167
168
169
170
171
172
173static inline
174void virtio_device_ready(struct virtio_device *dev)
175{
176 unsigned status = dev->config->get_status(dev);
177
178 BUG_ON(status & VIRTIO_CONFIG_S_DRIVER_OK);
179 dev->config->set_status(dev, status | VIRTIO_CONFIG_S_DRIVER_OK);
180}
181
182static inline
183const char *virtio_bus_name(struct virtio_device *vdev)
184{
185 if (!vdev->config->bus_name)
186 return "virtio";
187 return vdev->config->bus_name(vdev);
188}
189
190
191
192
193
194
195
196
197
198
199static inline
200int virtqueue_set_affinity(struct virtqueue *vq, int cpu)
201{
202 struct virtio_device *vdev = vq->vdev;
203 if (vdev->config->set_vq_affinity)
204 return vdev->config->set_vq_affinity(vq, cpu);
205 return 0;
206}
207
208
209static inline u16 virtio16_to_cpu(struct virtio_device *vdev, __virtio16 val)
210{
211 return __virtio16_to_cpu(virtio_has_feature(vdev, VIRTIO_F_VERSION_1), val);
212}
213
214static inline __virtio16 cpu_to_virtio16(struct virtio_device *vdev, u16 val)
215{
216 return __cpu_to_virtio16(virtio_has_feature(vdev, VIRTIO_F_VERSION_1), val);
217}
218
219static inline u32 virtio32_to_cpu(struct virtio_device *vdev, __virtio32 val)
220{
221 return __virtio32_to_cpu(virtio_has_feature(vdev, VIRTIO_F_VERSION_1), val);
222}
223
224static inline __virtio32 cpu_to_virtio32(struct virtio_device *vdev, u32 val)
225{
226 return __cpu_to_virtio32(virtio_has_feature(vdev, VIRTIO_F_VERSION_1), val);
227}
228
229static inline u64 virtio64_to_cpu(struct virtio_device *vdev, __virtio64 val)
230{
231 return __virtio64_to_cpu(virtio_has_feature(vdev, VIRTIO_F_VERSION_1), val);
232}
233
234static inline __virtio64 cpu_to_virtio64(struct virtio_device *vdev, u64 val)
235{
236 return __cpu_to_virtio64(virtio_has_feature(vdev, VIRTIO_F_VERSION_1), val);
237}
238
239
240#define virtio_cread(vdev, structname, member, ptr) \
241 do { \
242 \
243 if (!typecheck(typeof((((structname*)0)->member)), *(ptr))) \
244 (*ptr) = 1; \
245 \
246 switch (sizeof(*ptr)) { \
247 case 1: \
248 *(ptr) = virtio_cread8(vdev, \
249 offsetof(structname, member)); \
250 break; \
251 case 2: \
252 *(ptr) = virtio_cread16(vdev, \
253 offsetof(structname, member)); \
254 break; \
255 case 4: \
256 *(ptr) = virtio_cread32(vdev, \
257 offsetof(structname, member)); \
258 break; \
259 case 8: \
260 *(ptr) = virtio_cread64(vdev, \
261 offsetof(structname, member)); \
262 break; \
263 default: \
264 BUG(); \
265 } \
266 } while(0)
267
268
269#define virtio_cwrite(vdev, structname, member, ptr) \
270 do { \
271 \
272 if (!typecheck(typeof((((structname*)0)->member)), *(ptr))) \
273 BUG_ON((*ptr) == 1); \
274 \
275 switch (sizeof(*ptr)) { \
276 case 1: \
277 virtio_cwrite8(vdev, \
278 offsetof(structname, member), \
279 *(ptr)); \
280 break; \
281 case 2: \
282 virtio_cwrite16(vdev, \
283 offsetof(structname, member), \
284 *(ptr)); \
285 break; \
286 case 4: \
287 virtio_cwrite32(vdev, \
288 offsetof(structname, member), \
289 *(ptr)); \
290 break; \
291 case 8: \
292 virtio_cwrite64(vdev, \
293 offsetof(structname, member), \
294 *(ptr)); \
295 break; \
296 default: \
297 BUG(); \
298 } \
299 } while(0)
300
301static inline u8 virtio_cread8(struct virtio_device *vdev, unsigned int offset)
302{
303 u8 ret;
304 vdev->config->get(vdev, offset, &ret, sizeof(ret));
305 return ret;
306}
307
308
309static inline void __virtio_cread_many(struct virtio_device *vdev,
310 unsigned int offset,
311 void *buf, size_t count, size_t bytes)
312{
313 u32 old, gen = vdev->config->generation ?
314 vdev->config->generation(vdev) : 0;
315 int i;
316
317 do {
318 old = gen;
319
320 for (i = 0; i < count; i++)
321 vdev->config->get(vdev, offset + bytes * i,
322 buf + i * bytes, bytes);
323
324 gen = vdev->config->generation ?
325 vdev->config->generation(vdev) : 0;
326 } while (gen != old);
327}
328
329
330static inline void virtio_cread_bytes(struct virtio_device *vdev,
331 unsigned int offset,
332 void *buf, size_t len)
333{
334 __virtio_cread_many(vdev, offset, buf, len, 1);
335}
336
337static inline void virtio_cwrite8(struct virtio_device *vdev,
338 unsigned int offset, u8 val)
339{
340 vdev->config->set(vdev, offset, &val, sizeof(val));
341}
342
343static inline u16 virtio_cread16(struct virtio_device *vdev,
344 unsigned int offset)
345{
346 u16 ret;
347 vdev->config->get(vdev, offset, &ret, sizeof(ret));
348 return virtio16_to_cpu(vdev, (__force __virtio16)ret);
349}
350
351static inline void virtio_cwrite16(struct virtio_device *vdev,
352 unsigned int offset, u16 val)
353{
354 val = (__force u16)cpu_to_virtio16(vdev, val);
355 vdev->config->set(vdev, offset, &val, sizeof(val));
356}
357
358static inline u32 virtio_cread32(struct virtio_device *vdev,
359 unsigned int offset)
360{
361 u32 ret;
362 vdev->config->get(vdev, offset, &ret, sizeof(ret));
363 return virtio32_to_cpu(vdev, (__force __virtio32)ret);
364}
365
366static inline void virtio_cwrite32(struct virtio_device *vdev,
367 unsigned int offset, u32 val)
368{
369 val = (__force u32)cpu_to_virtio32(vdev, val);
370 vdev->config->set(vdev, offset, &val, sizeof(val));
371}
372
373static inline u64 virtio_cread64(struct virtio_device *vdev,
374 unsigned int offset)
375{
376 u64 ret;
377 vdev->config->get(vdev, offset, &ret, sizeof(ret));
378 __virtio_cread_many(vdev, offset, &ret, 1, sizeof(ret));
379 return virtio64_to_cpu(vdev, (__force __virtio64)ret);
380}
381
382static inline void virtio_cwrite64(struct virtio_device *vdev,
383 unsigned int offset, u64 val)
384{
385 val = (__force u64)cpu_to_virtio64(vdev, val);
386 vdev->config->set(vdev, offset, &val, sizeof(val));
387}
388
389
390#define virtio_cread_feature(vdev, fbit, structname, member, ptr) \
391 ({ \
392 int _r = 0; \
393 if (!virtio_has_feature(vdev, fbit)) \
394 _r = -ENOENT; \
395 else \
396 virtio_cread((vdev), structname, member, ptr); \
397 _r; \
398 })
399
400#endif
401