1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
25
26#include <linux/kernel.h>
27#include <linux/mm.h>
28#include <linux/hyperv.h>
29#include <linux/uio.h>
30#include <linux/vmalloc.h>
31#include <linux/slab.h>
32#include <linux/prefetch.h>
33
34#include "hyperv_vmbus.h"
35
36#define VMBUS_PKT_TRAILER 8
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63static void hv_signal_on_write(u32 old_write, struct vmbus_channel *channel)
64{
65 struct hv_ring_buffer_info *rbi = &channel->outbound;
66
67 virt_mb();
68 if (READ_ONCE(rbi->ring_buffer->interrupt_mask))
69 return;
70
71
72 virt_rmb();
73
74
75
76
77 if (old_write == READ_ONCE(rbi->ring_buffer->read_index)) {
78 ++channel->intr_out_empty;
79 vmbus_setevent(channel);
80 }
81}
82
83
84static inline u32
85hv_get_next_write_location(struct hv_ring_buffer_info *ring_info)
86{
87 u32 next = ring_info->ring_buffer->write_index;
88
89 return next;
90}
91
92
93static inline void
94hv_set_next_write_location(struct hv_ring_buffer_info *ring_info,
95 u32 next_write_location)
96{
97 ring_info->ring_buffer->write_index = next_write_location;
98}
99
100
101static inline u32
102hv_get_ring_buffersize(const struct hv_ring_buffer_info *ring_info)
103{
104 return ring_info->ring_datasize;
105}
106
107
108static inline u64
109hv_get_ring_bufferindices(struct hv_ring_buffer_info *ring_info)
110{
111 return (u64)ring_info->ring_buffer->write_index << 32;
112}
113
114
115
116
117
118static u32 hv_copyto_ringbuffer(
119 struct hv_ring_buffer_info *ring_info,
120 u32 start_write_offset,
121 const void *src,
122 u32 srclen)
123{
124 void *ring_buffer = hv_get_ring_buffer(ring_info);
125 u32 ring_buffer_size = hv_get_ring_buffersize(ring_info);
126
127 memcpy(ring_buffer + start_write_offset, src, srclen);
128
129 start_write_offset += srclen;
130 if (start_write_offset >= ring_buffer_size)
131 start_write_offset -= ring_buffer_size;
132
133 return start_write_offset;
134}
135
136
137
138
139
140
141
142
143static void
144hv_get_ringbuffer_availbytes(const struct hv_ring_buffer_info *rbi,
145 u32 *read, u32 *write)
146{
147 u32 read_loc, write_loc, dsize;
148
149
150 read_loc = READ_ONCE(rbi->ring_buffer->read_index);
151 write_loc = READ_ONCE(rbi->ring_buffer->write_index);
152 dsize = rbi->ring_datasize;
153
154 *write = write_loc >= read_loc ? dsize - (write_loc - read_loc) :
155 read_loc - write_loc;
156 *read = dsize - *write;
157}
158
159
160int hv_ringbuffer_get_debuginfo(struct hv_ring_buffer_info *ring_info,
161 struct hv_ring_buffer_debug_info *debug_info)
162{
163 u32 bytes_avail_towrite;
164 u32 bytes_avail_toread;
165
166 mutex_lock(&ring_info->ring_buffer_mutex);
167
168 if (!ring_info->ring_buffer) {
169 mutex_unlock(&ring_info->ring_buffer_mutex);
170 return -EINVAL;
171 }
172
173 hv_get_ringbuffer_availbytes(ring_info,
174 &bytes_avail_toread,
175 &bytes_avail_towrite);
176 debug_info->bytes_avail_toread = bytes_avail_toread;
177 debug_info->bytes_avail_towrite = bytes_avail_towrite;
178 debug_info->current_read_index = ring_info->ring_buffer->read_index;
179 debug_info->current_write_index = ring_info->ring_buffer->write_index;
180 debug_info->current_interrupt_mask
181 = ring_info->ring_buffer->interrupt_mask;
182 mutex_unlock(&ring_info->ring_buffer_mutex);
183
184 return 0;
185}
186EXPORT_SYMBOL_GPL(hv_ringbuffer_get_debuginfo);
187
188
189void hv_ringbuffer_pre_init(struct vmbus_channel *channel)
190{
191 mutex_init(&channel->inbound.ring_buffer_mutex);
192 mutex_init(&channel->outbound.ring_buffer_mutex);
193}
194
195
196int hv_ringbuffer_init(struct hv_ring_buffer_info *ring_info,
197 struct page *pages, u32 page_cnt, u32 max_pkt_size)
198{
199 int i;
200 struct page **pages_wraparound;
201
202 BUILD_BUG_ON((sizeof(struct hv_ring_buffer) != PAGE_SIZE));
203
204
205
206
207
208 pages_wraparound = kcalloc(page_cnt * 2 - 1, sizeof(struct page *),
209 GFP_KERNEL);
210 if (!pages_wraparound)
211 return -ENOMEM;
212
213 pages_wraparound[0] = pages;
214 for (i = 0; i < 2 * (page_cnt - 1); i++)
215 pages_wraparound[i + 1] = &pages[i % (page_cnt - 1) + 1];
216
217 ring_info->ring_buffer = (struct hv_ring_buffer *)
218 vmap(pages_wraparound, page_cnt * 2 - 1, VM_MAP, PAGE_KERNEL);
219
220 kfree(pages_wraparound);
221
222
223 if (!ring_info->ring_buffer)
224 return -ENOMEM;
225
226 ring_info->ring_buffer->read_index =
227 ring_info->ring_buffer->write_index = 0;
228
229
230 ring_info->ring_buffer->feature_bits.value = 1;
231
232 ring_info->ring_size = page_cnt << PAGE_SHIFT;
233 ring_info->ring_size_div10_reciprocal =
234 reciprocal_value(ring_info->ring_size / 10);
235 ring_info->ring_datasize = ring_info->ring_size -
236 sizeof(struct hv_ring_buffer);
237 ring_info->priv_read_index = 0;
238
239
240 if (max_pkt_size) {
241 ring_info->pkt_buffer = kzalloc(max_pkt_size, GFP_KERNEL);
242 if (!ring_info->pkt_buffer)
243 return -ENOMEM;
244 ring_info->pkt_buffer_size = max_pkt_size;
245 }
246
247 spin_lock_init(&ring_info->ring_lock);
248
249 return 0;
250}
251
252
253void hv_ringbuffer_cleanup(struct hv_ring_buffer_info *ring_info)
254{
255 mutex_lock(&ring_info->ring_buffer_mutex);
256 vunmap(ring_info->ring_buffer);
257 ring_info->ring_buffer = NULL;
258 mutex_unlock(&ring_info->ring_buffer_mutex);
259
260 kfree(ring_info->pkt_buffer);
261 ring_info->pkt_buffer = NULL;
262 ring_info->pkt_buffer_size = 0;
263}
264
265
266int hv_ringbuffer_write(struct vmbus_channel *channel,
267 const struct kvec *kv_list, u32 kv_count,
268 u64 requestid)
269{
270 int i;
271 u32 bytes_avail_towrite;
272 u32 totalbytes_towrite = sizeof(u64);
273 u32 next_write_location;
274 u32 old_write;
275 u64 prev_indices;
276 unsigned long flags;
277 struct hv_ring_buffer_info *outring_info = &channel->outbound;
278 struct vmpacket_descriptor *desc = kv_list[0].iov_base;
279 u64 rqst_id = VMBUS_NO_RQSTOR;
280
281 if (channel->rescind)
282 return -ENODEV;
283
284 for (i = 0; i < kv_count; i++)
285 totalbytes_towrite += kv_list[i].iov_len;
286
287 spin_lock_irqsave(&outring_info->ring_lock, flags);
288
289 bytes_avail_towrite = hv_get_bytes_to_write(outring_info);
290
291
292
293
294
295
296 if (bytes_avail_towrite <= totalbytes_towrite) {
297 ++channel->out_full_total;
298
299 if (!channel->out_full_flag) {
300 ++channel->out_full_first;
301 channel->out_full_flag = true;
302 }
303
304 spin_unlock_irqrestore(&outring_info->ring_lock, flags);
305 return -EAGAIN;
306 }
307
308 channel->out_full_flag = false;
309
310
311 next_write_location = hv_get_next_write_location(outring_info);
312
313 old_write = next_write_location;
314
315 for (i = 0; i < kv_count; i++) {
316 next_write_location = hv_copyto_ringbuffer(outring_info,
317 next_write_location,
318 kv_list[i].iov_base,
319 kv_list[i].iov_len);
320 }
321
322
323
324
325
326
327
328 if (desc->flags == VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED) {
329 if (channel->next_request_id_callback != NULL) {
330 rqst_id = channel->next_request_id_callback(channel, requestid);
331 if (rqst_id == VMBUS_RQST_ERROR) {
332 spin_unlock_irqrestore(&outring_info->ring_lock, flags);
333 return -EAGAIN;
334 }
335 }
336 }
337 desc = hv_get_ring_buffer(outring_info) + old_write;
338 desc->trans_id = (rqst_id == VMBUS_NO_RQSTOR) ? requestid : rqst_id;
339
340
341 prev_indices = hv_get_ring_bufferindices(outring_info);
342
343 next_write_location = hv_copyto_ringbuffer(outring_info,
344 next_write_location,
345 &prev_indices,
346 sizeof(u64));
347
348
349 virt_mb();
350
351
352 hv_set_next_write_location(outring_info, next_write_location);
353
354
355 spin_unlock_irqrestore(&outring_info->ring_lock, flags);
356
357 hv_signal_on_write(old_write, channel);
358
359 if (channel->rescind) {
360 if (rqst_id != VMBUS_NO_RQSTOR) {
361
362 if (channel->request_addr_callback != NULL)
363 channel->request_addr_callback(channel, rqst_id);
364 }
365 return -ENODEV;
366 }
367
368 return 0;
369}
370
371int hv_ringbuffer_read(struct vmbus_channel *channel,
372 void *buffer, u32 buflen, u32 *buffer_actual_len,
373 u64 *requestid, bool raw)
374{
375 struct vmpacket_descriptor *desc;
376 u32 packetlen, offset;
377
378 if (unlikely(buflen == 0))
379 return -EINVAL;
380
381 *buffer_actual_len = 0;
382 *requestid = 0;
383
384
385 desc = hv_pkt_iter_first(channel);
386 if (desc == NULL) {
387
388
389
390
391 return 0;
392 }
393
394 offset = raw ? 0 : (desc->offset8 << 3);
395 packetlen = (desc->len8 << 3) - offset;
396 *buffer_actual_len = packetlen;
397 *requestid = desc->trans_id;
398
399 if (unlikely(packetlen > buflen))
400 return -ENOBUFS;
401
402
403 memcpy(buffer, (const char *)desc + offset, packetlen);
404
405
406 __hv_pkt_iter_next(channel, desc, true);
407
408
409 hv_pkt_iter_close(channel);
410
411 return 0;
412}
413
414
415
416
417
418
419
420
421static u32 hv_pkt_iter_avail(const struct hv_ring_buffer_info *rbi)
422{
423 u32 priv_read_loc = rbi->priv_read_index;
424 u32 write_loc = READ_ONCE(rbi->ring_buffer->write_index);
425
426 if (write_loc >= priv_read_loc)
427 return write_loc - priv_read_loc;
428 else
429 return (rbi->ring_datasize - priv_read_loc) + write_loc;
430}
431
432
433
434
435struct vmpacket_descriptor *hv_pkt_iter_first_raw(struct vmbus_channel *channel)
436{
437 struct hv_ring_buffer_info *rbi = &channel->inbound;
438
439 hv_debug_delay_test(channel, MESSAGE_DELAY);
440
441 if (hv_pkt_iter_avail(rbi) < sizeof(struct vmpacket_descriptor))
442 return NULL;
443
444 return (struct vmpacket_descriptor *)(hv_get_ring_buffer(rbi) + rbi->priv_read_index);
445}
446EXPORT_SYMBOL_GPL(hv_pkt_iter_first_raw);
447
448
449
450
451
452
453struct vmpacket_descriptor *hv_pkt_iter_first(struct vmbus_channel *channel)
454{
455 struct hv_ring_buffer_info *rbi = &channel->inbound;
456 struct vmpacket_descriptor *desc, *desc_copy;
457 u32 bytes_avail, pkt_len, pkt_offset;
458
459 desc = hv_pkt_iter_first_raw(channel);
460 if (!desc)
461 return NULL;
462
463 bytes_avail = min(rbi->pkt_buffer_size, hv_pkt_iter_avail(rbi));
464
465
466
467
468
469 pkt_len = READ_ONCE(desc->len8) << 3;
470 pkt_offset = READ_ONCE(desc->offset8) << 3;
471
472
473
474
475
476 if (pkt_len < sizeof(struct vmpacket_descriptor) || pkt_len > bytes_avail)
477 pkt_len = bytes_avail;
478
479
480
481
482
483 if (pkt_offset < sizeof(struct vmpacket_descriptor) || pkt_offset > pkt_len)
484 pkt_offset = sizeof(struct vmpacket_descriptor);
485
486
487 desc_copy = (struct vmpacket_descriptor *)rbi->pkt_buffer;
488 memcpy(desc_copy, desc, pkt_len);
489
490
491
492
493
494
495 desc_copy->len8 = pkt_len >> 3;
496 desc_copy->offset8 = pkt_offset >> 3;
497
498 return desc_copy;
499}
500EXPORT_SYMBOL_GPL(hv_pkt_iter_first);
501
502
503
504
505
506
507
508struct vmpacket_descriptor *
509__hv_pkt_iter_next(struct vmbus_channel *channel,
510 const struct vmpacket_descriptor *desc,
511 bool copy)
512{
513 struct hv_ring_buffer_info *rbi = &channel->inbound;
514 u32 packetlen = desc->len8 << 3;
515 u32 dsize = rbi->ring_datasize;
516
517 hv_debug_delay_test(channel, MESSAGE_DELAY);
518
519 rbi->priv_read_index += packetlen + VMBUS_PKT_TRAILER;
520 if (rbi->priv_read_index >= dsize)
521 rbi->priv_read_index -= dsize;
522
523
524 return copy ? hv_pkt_iter_first(channel) : hv_pkt_iter_first_raw(channel);
525}
526EXPORT_SYMBOL_GPL(__hv_pkt_iter_next);
527
528
529static u32 hv_pkt_iter_bytes_read(const struct hv_ring_buffer_info *rbi,
530 u32 start_read_index)
531{
532 if (rbi->priv_read_index >= start_read_index)
533 return rbi->priv_read_index - start_read_index;
534 else
535 return rbi->ring_datasize - start_read_index +
536 rbi->priv_read_index;
537}
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559void hv_pkt_iter_close(struct vmbus_channel *channel)
560{
561 struct hv_ring_buffer_info *rbi = &channel->inbound;
562 u32 curr_write_sz, pending_sz, bytes_read, start_read_index;
563
564
565
566
567
568
569 virt_rmb();
570 start_read_index = rbi->ring_buffer->read_index;
571 rbi->ring_buffer->read_index = rbi->priv_read_index;
572
573
574
575
576
577
578 if (!rbi->ring_buffer->feature_bits.feat_pending_send_sz)
579 return;
580
581
582
583
584
585
586
587
588
589
590 virt_mb();
591
592
593
594
595
596
597 pending_sz = READ_ONCE(rbi->ring_buffer->pending_send_sz);
598 if (!pending_sz)
599 return;
600
601
602
603
604
605 virt_rmb();
606 curr_write_sz = hv_get_bytes_to_write(rbi);
607 bytes_read = hv_pkt_iter_bytes_read(rbi, start_read_index);
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629 if (curr_write_sz - bytes_read > pending_sz)
630 return;
631
632
633
634
635
636 if (curr_write_sz <= pending_sz)
637 return;
638
639 ++channel->intr_in_full;
640 vmbus_setevent(channel);
641}
642EXPORT_SYMBOL_GPL(hv_pkt_iter_close);
643