blob: a9021f13379f05ba8f48162711f0fcd2533610c7 [file] [log] [blame]
Hank Janssen3e7ee492009-07-13 16:02:34 -07001/*
2 *
3 * Copyright (c) 2009, Microsoft Corporation.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
16 * Place - Suite 330, Boston, MA 02111-1307 USA.
17 *
18 * Authors:
19 * Haiyang Zhang <haiyangz@microsoft.com>
20 * Hank Janssen <hjanssen@microsoft.com>
K. Y. Srinivasanb2a5a582011-05-10 07:55:30 -070021 * K. Y. Srinivasan <kys@microsoft.com>
Hank Janssen3e7ee492009-07-13 16:02:34 -070022 *
23 */
Hank Janssen0a466182011-03-29 13:58:47 -070024#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
Hank Janssen3e7ee492009-07-13 16:02:34 -070025
Greg Kroah-Hartmana0086dc2009-08-17 17:22:08 -070026#include <linux/kernel.h>
27#include <linux/mm.h>
Greg Kroah-Hartman46a97192011-10-04 12:29:52 -070028#include <linux/hyperv.h>
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -080029#include <linux/uio.h>
Vitaly Kuznetsov9988ce62016-09-02 05:58:20 -070030#include <linux/vmalloc.h>
31#include <linux/slab.h>
Stephen Hemminger8dd45f22017-06-25 12:30:26 -070032#include <linux/prefetch.h>
K. Y. Srinivasan3f335ea2011-05-12 19:34:15 -070033
K. Y. Srinivasan0f2a6612011-05-12 19:34:28 -070034#include "hyperv_vmbus.h"
Hank Janssen3e7ee492009-07-13 16:02:34 -070035
stephen hemmingerf3dd3f42017-02-27 10:26:48 -080036#define VMBUS_PKT_TRAILER 8
37
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -080038/*
39 * When we write to the ring buffer, check if the host needs to
40 * be signaled. Here is the details of this protocol:
41 *
42 * 1. The host guarantees that while it is draining the
43 * ring buffer, it will set the interrupt_mask to
44 * indicate it does not need to be interrupted when
45 * new data is placed.
46 *
47 * 2. The host guarantees that it will completely drain
48 * the ring buffer before exiting the read loop. Further,
49 * once the ring buffer is empty, it will clear the
50 * interrupt_mask and re-check to see if new data has
51 * arrived.
K. Y. Srinivasan1f6ee4e2016-11-06 13:14:17 -080052 *
53 * KYS: Oct. 30, 2016:
54 * It looks like Windows hosts have logic to deal with DOS attacks that
55 * can be triggered if it receives interrupts when it is not expecting
56 * the interrupt. The host expects interrupts only when the ring
57 * transitions from empty to non-empty (or full to non full on the guest
58 * to host ring).
59 * So, base the signaling decision solely on the ring state until the
60 * host logic is fixed.
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -080061 */
62
Stephen Hemmingerb103a562017-02-05 17:20:32 -070063static void hv_signal_on_write(u32 old_write, struct vmbus_channel *channel)
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -080064{
K. Y. Srinivasan1f6ee4e2016-11-06 13:14:17 -080065 struct hv_ring_buffer_info *rbi = &channel->outbound;
66
K. Y. Srinivasandcd0eec2016-04-02 17:59:48 -070067 virt_mb();
K. Y. Srinivasand45faae2016-04-02 17:59:47 -070068 if (READ_ONCE(rbi->ring_buffer->interrupt_mask))
K. Y. Srinivasan1f6ee4e2016-11-06 13:14:17 -080069 return;
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -080070
Jason Wange91e84f2013-06-20 12:58:57 +080071 /* check interrupt_mask before read_index */
K. Y. Srinivasandcd0eec2016-04-02 17:59:48 -070072 virt_rmb();
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -080073 /*
74 * This is the only case we need to signal when the
75 * ring transitions from being empty to non-empty.
76 */
K. Y. Srinivasand45faae2016-04-02 17:59:47 -070077 if (old_write == READ_ONCE(rbi->ring_buffer->read_index))
K. Y. Srinivasan1f6ee4e2016-11-06 13:14:17 -080078 vmbus_setevent(channel);
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -080079}
80
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -080081/* Get the next write location for the specified ring buffer. */
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -070082static inline u32
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -070083hv_get_next_write_location(struct hv_ring_buffer_info *ring_info)
Hank Janssen3e7ee492009-07-13 16:02:34 -070084{
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -080085 u32 next = ring_info->ring_buffer->write_index;
Hank Janssen3e7ee492009-07-13 16:02:34 -070086
Hank Janssen3e7ee492009-07-13 16:02:34 -070087 return next;
88}
89
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -080090/* Set the next write location for the specified ring buffer. */
Hank Janssen3e7ee492009-07-13 16:02:34 -070091static inline void
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -070092hv_set_next_write_location(struct hv_ring_buffer_info *ring_info,
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -080093 u32 next_write_location)
Hank Janssen3e7ee492009-07-13 16:02:34 -070094{
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -080095 ring_info->ring_buffer->write_index = next_write_location;
Hank Janssen3e7ee492009-07-13 16:02:34 -070096}
97
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -080098/* Set the next read location for the specified ring buffer. */
Hank Janssen3e7ee492009-07-13 16:02:34 -070099static inline void
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -0700100hv_set_next_read_location(struct hv_ring_buffer_info *ring_info,
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800101 u32 next_read_location)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700102{
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800103 ring_info->ring_buffer->read_index = next_read_location;
K. Y. Srinivasanab028db2016-04-02 17:59:51 -0700104 ring_info->priv_read_index = next_read_location;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700105}
106
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -0800107/* Get the size of the ring buffer. */
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700108static inline u32
Stephen Hemmingere4165a02017-02-11 23:02:24 -0700109hv_get_ring_buffersize(const struct hv_ring_buffer_info *ring_info)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700110{
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800111 return ring_info->ring_datasize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700112}
113
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -0800114/* Get the read and write indices as u64 of the specified ring buffer. */
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700115static inline u64
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -0700116hv_get_ring_bufferindices(struct hv_ring_buffer_info *ring_info)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700117{
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800118 return (u64)ring_info->ring_buffer->write_index << 32;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700119}
120
K. Y. Srinivasan8f1136a2011-05-10 07:55:31 -0700121/*
K. Y. Srinivasan75815782011-05-10 07:55:32 -0700122 * Helper routine to copy from source to ring buffer.
123 * Assume there is enough room. Handles wrap-around in dest case only!!
K. Y. Srinivasan75815782011-05-10 07:55:32 -0700124 */
125static u32 hv_copyto_ringbuffer(
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800126 struct hv_ring_buffer_info *ring_info,
127 u32 start_write_offset,
Stephen Hemmingere4165a02017-02-11 23:02:24 -0700128 const void *src,
K. Y. Srinivasan75815782011-05-10 07:55:32 -0700129 u32 srclen)
130{
131 void *ring_buffer = hv_get_ring_buffer(ring_info);
132 u32 ring_buffer_size = hv_get_ring_buffersize(ring_info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700133
Vitaly Kuznetsovf24f0b42016-09-02 05:58:21 -0700134 memcpy(ring_buffer + start_write_offset, src, srclen);
K. Y. Srinivasan75815782011-05-10 07:55:32 -0700135
136 start_write_offset += srclen;
Stephen Hemminger8d12f882017-02-11 23:02:25 -0700137 if (start_write_offset >= ring_buffer_size)
138 start_write_offset -= ring_buffer_size;
K. Y. Srinivasan75815782011-05-10 07:55:32 -0700139
140 return start_write_offset;
141}
Hank Janssen3e7ee492009-07-13 16:02:34 -0700142
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -0800143/* Get various debug metrics for the specified ring buffer. */
Stephen Hemmingere4165a02017-02-11 23:02:24 -0700144void hv_ringbuffer_get_debuginfo(const struct hv_ring_buffer_info *ring_info,
145 struct hv_ring_buffer_debug_info *debug_info)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700146{
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800147 u32 bytes_avail_towrite;
148 u32 bytes_avail_toread;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700149
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800150 if (ring_info->ring_buffer) {
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -0700151 hv_get_ringbuffer_availbytes(ring_info,
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800152 &bytes_avail_toread,
153 &bytes_avail_towrite);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700154
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800155 debug_info->bytes_avail_toread = bytes_avail_toread;
156 debug_info->bytes_avail_towrite = bytes_avail_towrite;
Haiyang Zhang82f8bd42010-11-08 14:04:45 -0800157 debug_info->current_read_index =
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800158 ring_info->ring_buffer->read_index;
Haiyang Zhang82f8bd42010-11-08 14:04:45 -0800159 debug_info->current_write_index =
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800160 ring_info->ring_buffer->write_index;
Haiyang Zhang82f8bd42010-11-08 14:04:45 -0800161 debug_info->current_interrupt_mask =
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800162 ring_info->ring_buffer->interrupt_mask;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700163 }
164}
Stephen Hemminger4827ee12017-03-04 18:27:18 -0700165EXPORT_SYMBOL_GPL(hv_ringbuffer_get_debuginfo);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700166
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -0800167/* Initialize the ring buffer. */
K. Y. Srinivasan72a95cb2011-05-10 07:55:21 -0700168int hv_ringbuffer_init(struct hv_ring_buffer_info *ring_info,
Vitaly Kuznetsov9988ce62016-09-02 05:58:20 -0700169 struct page *pages, u32 page_cnt)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700170{
Vitaly Kuznetsov9988ce62016-09-02 05:58:20 -0700171 int i;
172 struct page **pages_wraparound;
173
174 BUILD_BUG_ON((sizeof(struct hv_ring_buffer) != PAGE_SIZE));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700175
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800176 memset(ring_info, 0, sizeof(struct hv_ring_buffer_info));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700177
Vitaly Kuznetsov9988ce62016-09-02 05:58:20 -0700178 /*
179 * First page holds struct hv_ring_buffer, do wraparound mapping for
180 * the rest.
181 */
182 pages_wraparound = kzalloc(sizeof(struct page *) * (page_cnt * 2 - 1),
183 GFP_KERNEL);
184 if (!pages_wraparound)
185 return -ENOMEM;
186
187 pages_wraparound[0] = pages;
188 for (i = 0; i < 2 * (page_cnt - 1); i++)
189 pages_wraparound[i + 1] = &pages[i % (page_cnt - 1) + 1];
190
191 ring_info->ring_buffer = (struct hv_ring_buffer *)
192 vmap(pages_wraparound, page_cnt * 2 - 1, VM_MAP, PAGE_KERNEL);
193
194 kfree(pages_wraparound);
195
196
197 if (!ring_info->ring_buffer)
198 return -ENOMEM;
199
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800200 ring_info->ring_buffer->read_index =
201 ring_info->ring_buffer->write_index = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700202
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -0800203 /* Set the feature bit for enabling flow control. */
K. Y. Srinivasan046c7912014-09-05 17:29:12 -0700204 ring_info->ring_buffer->feature_bits.value = 1;
205
Vitaly Kuznetsov9988ce62016-09-02 05:58:20 -0700206 ring_info->ring_size = page_cnt << PAGE_SHIFT;
207 ring_info->ring_datasize = ring_info->ring_size -
208 sizeof(struct hv_ring_buffer);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700209
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800210 spin_lock_init(&ring_info->ring_lock);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700211
212 return 0;
213}
214
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -0800215/* Cleanup the ring buffer. */
K. Y. Srinivasan2dba6882011-05-10 07:55:22 -0700216void hv_ringbuffer_cleanup(struct hv_ring_buffer_info *ring_info)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700217{
Vitaly Kuznetsov9988ce62016-09-02 05:58:20 -0700218 vunmap(ring_info->ring_buffer);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700219}
220
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -0800221/* Write to the ring buffer. */
K. Y. Srinivasan1f6ee4e2016-11-06 13:14:17 -0800222int hv_ringbuffer_write(struct vmbus_channel *channel,
Stephen Hemmingere4165a02017-02-11 23:02:24 -0700223 const struct kvec *kv_list, u32 kv_count)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700224{
Stephen Hemminger2c616a82017-03-04 18:27:13 -0700225 int i;
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800226 u32 bytes_avail_towrite;
Stephen Hemminger2c616a82017-03-04 18:27:13 -0700227 u32 totalbytes_towrite = sizeof(u64);
K. Y. Srinivasan66a60542011-05-10 07:55:33 -0700228 u32 next_write_location;
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800229 u32 old_write;
Stephen Hemminger2c616a82017-03-04 18:27:13 -0700230 u64 prev_indices;
231 unsigned long flags;
K. Y. Srinivasan1f6ee4e2016-11-06 13:14:17 -0800232 struct hv_ring_buffer_info *outring_info = &channel->outbound;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700233
K. Y. Srinivasane7e97dd2016-12-07 01:16:28 -0800234 if (channel->rescind)
235 return -ENODEV;
236
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800237 for (i = 0; i < kv_count; i++)
238 totalbytes_towrite += kv_list[i].iov_len;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700239
Stephen Hemminger5529eaf2017-02-11 23:02:22 -0700240 spin_lock_irqsave(&outring_info->ring_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700241
K. Y. Srinivasana6341f02016-04-02 17:59:46 -0700242 bytes_avail_towrite = hv_get_bytes_to_write(outring_info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700243
Vitaly Kuznetsov822f18d2015-12-14 19:01:57 -0800244 /*
245 * If there is only room for the packet, assume it is full.
246 * Otherwise, the next time around, we think the ring buffer
247 * is empty since the read index == write index.
248 */
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800249 if (bytes_avail_towrite <= totalbytes_towrite) {
Stephen Hemminger5529eaf2017-02-11 23:02:22 -0700250 spin_unlock_irqrestore(&outring_info->ring_lock, flags);
K. Y. Srinivasand2598f02011-08-25 09:48:58 -0700251 return -EAGAIN;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700252 }
253
Bill Pemberton454f18a2009-07-27 16:47:24 -0400254 /* Write to the ring buffer */
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -0700255 next_write_location = hv_get_next_write_location(outring_info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700256
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800257 old_write = next_write_location;
258
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800259 for (i = 0; i < kv_count; i++) {
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -0700260 next_write_location = hv_copyto_ringbuffer(outring_info,
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800261 next_write_location,
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800262 kv_list[i].iov_base,
263 kv_list[i].iov_len);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700264 }
265
Bill Pemberton454f18a2009-07-27 16:47:24 -0400266 /* Set previous packet start */
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -0700267 prev_indices = hv_get_ring_bufferindices(outring_info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700268
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -0700269 next_write_location = hv_copyto_ringbuffer(outring_info,
Haiyang Zhangfc8c72e2010-11-08 14:04:46 -0800270 next_write_location,
271 &prev_indices,
Nicolas Palixb219b3f2009-07-30 17:37:23 +0200272 sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700273
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800274 /* Issue a full memory barrier before updating the write index */
K. Y. Srinivasandcd0eec2016-04-02 17:59:48 -0700275 virt_mb();
Hank Janssen3e7ee492009-07-13 16:02:34 -0700276
Bill Pemberton454f18a2009-07-27 16:47:24 -0400277 /* Now, update the write location */
K. Y. Srinivasan2b8a9122011-05-10 07:55:29 -0700278 hv_set_next_write_location(outring_info, next_write_location);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700279
Hank Janssen3e7ee492009-07-13 16:02:34 -0700280
Stephen Hemminger5529eaf2017-02-11 23:02:22 -0700281 spin_unlock_irqrestore(&outring_info->ring_lock, flags);
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800282
Stephen Hemmingerb103a562017-02-05 17:20:32 -0700283 hv_signal_on_write(old_write, channel);
K. Y. Srinivasane7e97dd2016-12-07 01:16:28 -0800284
285 if (channel->rescind)
286 return -ENODEV;
287
Hank Janssen3e7ee492009-07-13 16:02:34 -0700288 return 0;
289}
290
K. Y. Srinivasan33725922016-11-06 13:14:18 -0800291int hv_ringbuffer_read(struct vmbus_channel *channel,
Vitaly Kuznetsov940b68e2015-12-14 19:02:01 -0800292 void *buffer, u32 buflen, u32 *buffer_actual_len,
K. Y. Srinivasan33725922016-11-06 13:14:18 -0800293 u64 *requestid, bool raw)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700294{
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700295 struct vmpacket_descriptor *desc;
296 u32 packetlen, offset;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700297
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700298 if (unlikely(buflen == 0))
Bill Pembertona16e1482010-05-05 15:27:50 -0400299 return -EINVAL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700300
Vitaly Kuznetsov940b68e2015-12-14 19:02:01 -0800301 *buffer_actual_len = 0;
302 *requestid = 0;
303
Bill Pemberton454f18a2009-07-27 16:47:24 -0400304 /* Make sure there is something to read */
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700305 desc = hv_pkt_iter_first(channel);
306 if (desc == NULL) {
Vitaly Kuznetsov940b68e2015-12-14 19:02:01 -0800307 /*
308 * No error is set when there is even no header, drivers are
309 * supposed to analyze buffer_actual_len.
310 */
Stephen Hemminger42dd2712017-03-04 18:27:15 -0700311 return 0;
Vitaly Kuznetsov940b68e2015-12-14 19:02:01 -0800312 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700313
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700314 offset = raw ? 0 : (desc->offset8 << 3);
315 packetlen = (desc->len8 << 3) - offset;
Vitaly Kuznetsov940b68e2015-12-14 19:02:01 -0800316 *buffer_actual_len = packetlen;
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700317 *requestid = desc->trans_id;
Vitaly Kuznetsov940b68e2015-12-14 19:02:01 -0800318
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700319 if (unlikely(packetlen > buflen))
K. Y. Srinivasan3eba9a72016-01-27 22:29:44 -0800320 return -ENOBUFS;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700321
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700322 /* since ring is double mapped, only one copy is necessary */
323 memcpy(buffer, (const char *)desc + offset, packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700324
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700325 /* Advance ring index to next packet descriptor */
326 __hv_pkt_iter_next(channel, desc);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700327
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700328 /* Notify host of update */
329 hv_pkt_iter_close(channel);
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800330
Stephen Hemminger42dd2712017-03-04 18:27:15 -0700331 return 0;
Vitaly Kuznetsovb5f53dd2015-12-14 19:01:59 -0800332}
stephen hemmingerf3dd3f42017-02-27 10:26:48 -0800333
334/*
335 * Determine number of bytes available in ring buffer after
336 * the current iterator (priv_read_index) location.
337 *
338 * This is similar to hv_get_bytes_to_read but with private
339 * read index instead.
340 */
341static u32 hv_pkt_iter_avail(const struct hv_ring_buffer_info *rbi)
342{
343 u32 priv_read_loc = rbi->priv_read_index;
344 u32 write_loc = READ_ONCE(rbi->ring_buffer->write_index);
345
346 if (write_loc >= priv_read_loc)
347 return write_loc - priv_read_loc;
348 else
349 return (rbi->ring_datasize - priv_read_loc) + write_loc;
350}
351
352/*
353 * Get first vmbus packet from ring buffer after read_index
354 *
355 * If ring buffer is empty, returns NULL and no other action needed.
356 */
357struct vmpacket_descriptor *hv_pkt_iter_first(struct vmbus_channel *channel)
358{
359 struct hv_ring_buffer_info *rbi = &channel->inbound;
360
Stephen Hemminger8dd45f22017-06-25 12:30:26 -0700361 /* set state for later hv_pkt_iter_close */
Stephen Hemminger4226ff62017-06-25 12:30:24 -0700362 rbi->cached_read_index = rbi->ring_buffer->read_index;
stephen hemmingerf3dd3f42017-02-27 10:26:48 -0800363
364 if (hv_pkt_iter_avail(rbi) < sizeof(struct vmpacket_descriptor))
365 return NULL;
366
367 return hv_get_ring_buffer(rbi) + rbi->priv_read_index;
368}
369EXPORT_SYMBOL_GPL(hv_pkt_iter_first);
370
371/*
372 * Get next vmbus packet from ring buffer.
373 *
374 * Advances the current location (priv_read_index) and checks for more
375 * data. If the end of the ring buffer is reached, then return NULL.
376 */
377struct vmpacket_descriptor *
378__hv_pkt_iter_next(struct vmbus_channel *channel,
379 const struct vmpacket_descriptor *desc)
380{
381 struct hv_ring_buffer_info *rbi = &channel->inbound;
382 u32 packetlen = desc->len8 << 3;
383 u32 dsize = rbi->ring_datasize;
384
385 /* bump offset to next potential packet */
386 rbi->priv_read_index += packetlen + VMBUS_PKT_TRAILER;
387 if (rbi->priv_read_index >= dsize)
388 rbi->priv_read_index -= dsize;
389
390 /* more data? */
391 if (hv_pkt_iter_avail(rbi) < sizeof(struct vmpacket_descriptor))
392 return NULL;
393 else
394 return hv_get_ring_buffer(rbi) + rbi->priv_read_index;
395}
396EXPORT_SYMBOL_GPL(__hv_pkt_iter_next);
397
398/*
399 * Update host ring buffer after iterating over packets.
400 */
401void hv_pkt_iter_close(struct vmbus_channel *channel)
402{
403 struct hv_ring_buffer_info *rbi = &channel->inbound;
Stephen Hemminger8dd45f22017-06-25 12:30:26 -0700404 u32 cur_write_sz, cached_write_sz;
405 u32 pending_sz;
stephen hemmingerf3dd3f42017-02-27 10:26:48 -0800406
407 /*
408 * Make sure all reads are done before we update the read index since
409 * the writer may start writing to the read area once the read index
410 * is updated.
411 */
412 virt_rmb();
413 rbi->ring_buffer->read_index = rbi->priv_read_index;
414
Stephen Hemminger8dd45f22017-06-25 12:30:26 -0700415 /*
416 * Issue a full memory barrier before making the signaling decision.
417 * Here is the reason for having this barrier:
418 * If the reading of the pend_sz (in this function)
419 * were to be reordered and read before we commit the new read
420 * index (in the calling function) we could
421 * have a problem. If the host were to set the pending_sz after we
422 * have sampled pending_sz and go to sleep before we commit the
423 * read index, we could miss sending the interrupt. Issue a full
424 * memory barrier to address this.
425 */
426 virt_mb();
427
428 pending_sz = READ_ONCE(rbi->ring_buffer->pending_send_sz);
429 /* If the other end is not blocked on write don't bother. */
430 if (pending_sz == 0)
431 return;
432
433 cur_write_sz = hv_get_bytes_to_write(rbi);
434
435 if (cur_write_sz < pending_sz)
436 return;
437
438 cached_write_sz = hv_get_cached_bytes_to_write(rbi);
439 if (cached_write_sz < pending_sz)
440 vmbus_setevent(channel);
stephen hemmingerf3dd3f42017-02-27 10:26:48 -0800441}
442EXPORT_SYMBOL_GPL(hv_pkt_iter_close);