blob: 69ea36f07b4d6b47c2030fe9c82bb8bb3fe866d0 [file] [log] [blame]
Hank Janssen3e7ee492009-07-13 16:02:34 -07001/*
Hank Janssen3e7ee492009-07-13 16:02:34 -07002 * Copyright (c) 2009, Microsoft Corporation.
3 *
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms and conditions of the GNU General Public License,
6 * version 2, as published by the Free Software Foundation.
7 *
8 * This program is distributed in the hope it will be useful, but WITHOUT
9 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
10 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
11 * more details.
12 *
13 * You should have received a copy of the GNU General Public License along with
14 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
15 * Place - Suite 330, Boston, MA 02111-1307 USA.
16 *
17 * Authors:
18 * Haiyang Zhang <haiyangz@microsoft.com>
19 * Hank Janssen <hjanssen@microsoft.com>
Hank Janssen3e7ee492009-07-13 16:02:34 -070020 */
Hank Janssen0a466182011-03-29 13:58:47 -070021#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
22
Greg Kroah-Hartman5654e932009-07-14 15:08:20 -070023#include <linux/kernel.h>
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -080024#include <linux/sched.h>
25#include <linux/wait.h>
Greg Kroah-Hartmana0086dc2009-08-17 17:22:08 -070026#include <linux/mm.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090027#include <linux/slab.h>
Hank Janssenc88c4e42010-05-04 15:55:05 -070028#include <linux/module.h>
Greg Kroah-Hartman46a97192011-10-04 12:29:52 -070029#include <linux/hyperv.h>
K. Y. Srinivasan3f335ea2011-05-12 19:34:15 -070030
K. Y. Srinivasan0f2a6612011-05-12 19:34:28 -070031#include "hyperv_vmbus.h"
Hank Janssen3e7ee492009-07-13 16:02:34 -070032
K. Y. Srinivasane3fe0bb2011-02-11 10:00:12 -080033#define NUM_PAGES_SPANNED(addr, len) \
34((PAGE_ALIGN(addr + len) >> PAGE_SHIFT) - (addr >> PAGE_SHIFT))
35
Hank Janssen3e189512010-03-04 22:11:00 +000036/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -070037 * vmbus_setevent- Trigger an event notification on the specified
Hank Janssen3e189512010-03-04 22:11:00 +000038 * channel.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070039 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -070040static void vmbus_setevent(struct vmbus_channel *channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -070041{
Haiyang Zhang39d70a42010-09-30 10:52:13 -070042 struct hv_monitor_page *monitorpage;
Hank Janssen3e7ee492009-07-13 16:02:34 -070043
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080044 if (channel->offermsg.monitor_allocated) {
Bill Pemberton454f18a2009-07-27 16:47:24 -040045 /* Each u32 represents 32 channels */
Olaf Hering22356582011-03-21 14:41:37 +010046 sync_set_bit(channel->offermsg.child_relid & 31,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -080047 (unsigned long *) vmbus_connection.send_int_page +
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080048 (channel->offermsg.child_relid >> 5));
Hank Janssen3e7ee492009-07-13 16:02:34 -070049
Greg Kroah-Hartman8681db42013-09-13 11:32:55 -070050 /* Get the child to parent monitor page */
51 monitorpage = vmbus_connection.monitor_pages[1];
Hank Janssen3e7ee492009-07-13 16:02:34 -070052
Olaf Hering22356582011-03-21 14:41:37 +010053 sync_set_bit(channel->monitor_bit,
Haiyang Zhangf6feebe2010-11-08 14:04:39 -080054 (unsigned long *)&monitorpage->trigger_group
55 [channel->monitor_grp].pending);
Bill Pemberton7c369f42009-07-29 17:00:11 -040056
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070057 } else {
K. Y. Srinivasan21c3bef2012-12-01 06:46:43 -080058 vmbus_set_event(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -070059 }
Hank Janssen3e7ee492009-07-13 16:02:34 -070060}
61
Hank Janssen3e189512010-03-04 22:11:00 +000062/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -070063 * vmbus_open - Open the specified channel.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070064 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -070065int vmbus_open(struct vmbus_channel *newchannel, u32 send_ringbuffer_size,
Haiyang Zhang39d70a42010-09-30 10:52:13 -070066 u32 recv_ringbuffer_size, void *userdata, u32 userdatalen,
67 void (*onchannelcallback)(void *context), void *context)
Hank Janssen3e7ee492009-07-13 16:02:34 -070068{
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -070069 struct vmbus_channel_open_channel *open_msg;
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -070070 struct vmbus_channel_msginfo *open_info = NULL;
Hank Janssen3e7ee492009-07-13 16:02:34 -070071 void *in, *out;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -070072 unsigned long flags;
K. Y. Srinivasan9568a192011-05-10 07:55:39 -070073 int ret, t, err = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -070074
K. Y. Srinivasane68d2972013-05-23 12:02:32 -070075 spin_lock_irqsave(&newchannel->sc_lock, flags);
76 if (newchannel->state == CHANNEL_OPEN_STATE) {
77 newchannel->state = CHANNEL_OPENING_STATE;
78 } else {
79 spin_unlock_irqrestore(&newchannel->sc_lock, flags);
80 return -EINVAL;
81 }
82 spin_unlock_irqrestore(&newchannel->sc_lock, flags);
83
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080084 newchannel->onchannel_callback = onchannelcallback;
85 newchannel->channel_callback_context = context;
Hank Janssen3e7ee492009-07-13 16:02:34 -070086
Bill Pemberton454f18a2009-07-27 16:47:24 -040087 /* Allocate the ring buffer */
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -080088 out = (void *)__get_free_pages(GFP_KERNEL|__GFP_ZERO,
89 get_order(send_ringbuffer_size + recv_ringbuffer_size));
90
Bill Pemberton7e052d92010-05-05 15:27:30 -040091 if (!out)
92 return -ENOMEM;
93
Hank Janssen3e7ee492009-07-13 16:02:34 -070094
Haiyang Zhang39d70a42010-09-30 10:52:13 -070095 in = (void *)((unsigned long)out + send_ringbuffer_size);
Hank Janssen3e7ee492009-07-13 16:02:34 -070096
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080097 newchannel->ringbuffer_pages = out;
98 newchannel->ringbuffer_pagecount = (send_ringbuffer_size +
Haiyang Zhang39d70a42010-09-30 10:52:13 -070099 recv_ringbuffer_size) >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700100
K. Y. Srinivasan72a95cb2011-05-10 07:55:21 -0700101 ret = hv_ringbuffer_init(
102 &newchannel->outbound, out, send_ringbuffer_size);
103
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000104 if (ret != 0) {
Bill Pemberton3324fb42010-05-05 15:27:49 -0400105 err = ret;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700106 goto error0;
Bill Pemberton3324fb42010-05-05 15:27:49 -0400107 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700108
K. Y. Srinivasan72a95cb2011-05-10 07:55:21 -0700109 ret = hv_ringbuffer_init(
110 &newchannel->inbound, in, recv_ringbuffer_size);
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000111 if (ret != 0) {
Bill Pemberton3324fb42010-05-05 15:27:49 -0400112 err = ret;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700113 goto error0;
Bill Pemberton3324fb42010-05-05 15:27:49 -0400114 }
115
Hank Janssen3e7ee492009-07-13 16:02:34 -0700116
Bill Pemberton454f18a2009-07-27 16:47:24 -0400117 /* Establish the gpadl for the ring buffer */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800118 newchannel->ringbuffer_gpadlhandle = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700119
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700120 ret = vmbus_establish_gpadl(newchannel,
Haiyang Zhang82f8bd42010-11-08 14:04:45 -0800121 newchannel->outbound.ring_buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700122 send_ringbuffer_size +
123 recv_ringbuffer_size,
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800124 &newchannel->ringbuffer_gpadlhandle);
Bill Pembertonb94ef342010-05-05 15:27:37 -0400125
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000126 if (ret != 0) {
Bill Pembertonb94ef342010-05-05 15:27:37 -0400127 err = ret;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700128 goto error0;
Bill Pembertonb94ef342010-05-05 15:27:37 -0400129 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700130
Bill Pemberton454f18a2009-07-27 16:47:24 -0400131 /* Create and init the channel open message */
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700132 open_info = kmalloc(sizeof(*open_info) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700133 sizeof(struct vmbus_channel_open_channel),
134 GFP_KERNEL);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700135 if (!open_info) {
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400136 err = -ENOMEM;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700137 goto error0;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400138 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700139
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700140 init_completion(&open_info->waitevent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700141
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700142 open_msg = (struct vmbus_channel_open_channel *)open_info->msg;
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700143 open_msg->header.msgtype = CHANNELMSG_OPENCHANNEL;
144 open_msg->openid = newchannel->offermsg.child_relid;
145 open_msg->child_relid = newchannel->offermsg.child_relid;
146 open_msg->ringbuffer_gpadlhandle = newchannel->ringbuffer_gpadlhandle;
147 open_msg->downstream_ringbuffer_pageoffset = send_ringbuffer_size >>
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700148 PAGE_SHIFT;
K. Y. Srinivasanabbf3b22012-12-01 06:46:48 -0800149 open_msg->target_vp = newchannel->target_vp;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700150
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700151 if (userdatalen > MAX_USER_DEFINED_BYTES) {
Bill Pembertonc827f942010-05-05 15:27:38 -0400152 err = -EINVAL;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700153 goto error0;
Bill Pembertonc827f942010-05-05 15:27:38 -0400154 }
155
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700156 if (userdatalen)
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700157 memcpy(open_msg->userdata, userdata, userdatalen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700158
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800159 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700160 list_add_tail(&open_info->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800161 &vmbus_connection.chn_msg_list);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800162 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700163
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700164 ret = vmbus_post_msg(open_msg,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700165 sizeof(struct vmbus_channel_open_channel));
Hank Janssen98e08702011-03-29 13:58:44 -0700166
167 if (ret != 0)
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700168 goto error1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700169
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700170 t = wait_for_completion_timeout(&open_info->waitevent, 5*HZ);
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700171 if (t == 0) {
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800172 err = -ETIMEDOUT;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700173 goto error1;
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800174 }
175
Hank Janssen3e7ee492009-07-13 16:02:34 -0700176
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700177 if (open_info->response.open_result.status)
178 err = open_info->response.open_result.status;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700179
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800180 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700181 list_del(&open_info->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800182 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700183
K. Y. Srinivasane68d2972013-05-23 12:02:32 -0700184 if (err == 0)
185 newchannel->state = CHANNEL_OPENED_STATE;
186
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700187 kfree(open_info);
Hank Janssen98e08702011-03-29 13:58:44 -0700188 return err;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400189
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700190error1:
191 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
192 list_del(&open_info->msglistentry);
193 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
194
195error0:
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -0800196 free_pages((unsigned long)out,
197 get_order(send_ringbuffer_size + recv_ringbuffer_size));
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700198 kfree(open_info);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400199 return err;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700200}
Greg Kroah-Hartman36ceadf2010-10-21 09:58:21 -0700201EXPORT_SYMBOL_GPL(vmbus_open);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700202
Hank Janssen3e189512010-03-04 22:11:00 +0000203/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700204 * create_gpadl_header - Creates a gpadl for the specified buffer
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700205 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700206static int create_gpadl_header(void *kbuffer, u32 size,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700207 struct vmbus_channel_msginfo **msginfo,
208 u32 *messagecount)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700209{
210 int i;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700211 int pagecount;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700212 struct vmbus_channel_gpadl_header *gpadl_header;
213 struct vmbus_channel_gpadl_body *gpadl_body;
214 struct vmbus_channel_msginfo *msgheader;
215 struct vmbus_channel_msginfo *msgbody = NULL;
216 u32 msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700217
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700218 int pfnsum, pfncount, pfnleft, pfncurr, pfnsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700219
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700220 pagecount = size >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700221
Bill Pemberton454f18a2009-07-27 16:47:24 -0400222 /* do we need a gpadl body msg */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700223 pfnsize = MAX_SIZE_CHANNEL_MESSAGE -
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700224 sizeof(struct vmbus_channel_gpadl_header) -
225 sizeof(struct gpa_range);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700226 pfncount = pfnsize / sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700227
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700228 if (pagecount > pfncount) {
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700229 /* we need a gpadl body */
Bill Pemberton454f18a2009-07-27 16:47:24 -0400230 /* fill in the header */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700231 msgsize = sizeof(struct vmbus_channel_msginfo) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700232 sizeof(struct vmbus_channel_gpadl_header) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700233 sizeof(struct gpa_range) + pfncount * sizeof(u64);
234 msgheader = kzalloc(msgsize, GFP_KERNEL);
235 if (!msgheader)
Bill Pembertond1c250b2010-05-05 15:27:35 -0400236 goto nomem;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700237
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800238 INIT_LIST_HEAD(&msgheader->submsglist);
239 msgheader->msgsize = msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700240
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700241 gpadl_header = (struct vmbus_channel_gpadl_header *)
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800242 msgheader->msg;
243 gpadl_header->rangecount = 1;
244 gpadl_header->range_buflen = sizeof(struct gpa_range) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700245 pagecount * sizeof(u64);
Haiyang Zhang415f2282011-01-26 12:12:13 -0800246 gpadl_header->range[0].byte_offset = 0;
247 gpadl_header->range[0].byte_count = size;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700248 for (i = 0; i < pfncount; i++)
Haiyang Zhangb679ef72014-01-27 15:03:42 -0800249 gpadl_header->range[0].pfn_array[i] = slow_virt_to_phys(
250 kbuffer + PAGE_SIZE * i) >> PAGE_SHIFT;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700251 *msginfo = msgheader;
252 *messagecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700253
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700254 pfnsum = pfncount;
255 pfnleft = pagecount - pfncount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700256
Bill Pemberton454f18a2009-07-27 16:47:24 -0400257 /* how many pfns can we fit */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700258 pfnsize = MAX_SIZE_CHANNEL_MESSAGE -
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700259 sizeof(struct vmbus_channel_gpadl_body);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700260 pfncount = pfnsize / sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700261
Bill Pemberton454f18a2009-07-27 16:47:24 -0400262 /* fill in the body */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700263 while (pfnleft) {
264 if (pfnleft > pfncount)
265 pfncurr = pfncount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700266 else
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700267 pfncurr = pfnleft;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700268
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700269 msgsize = sizeof(struct vmbus_channel_msginfo) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700270 sizeof(struct vmbus_channel_gpadl_body) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700271 pfncurr * sizeof(u64);
272 msgbody = kzalloc(msgsize, GFP_KERNEL);
K. Y. Srinivasanf38cf9c2011-06-06 15:50:06 -0700273
274 if (!msgbody) {
275 struct vmbus_channel_msginfo *pos = NULL;
276 struct vmbus_channel_msginfo *tmp = NULL;
277 /*
278 * Free up all the allocated messages.
279 */
280 list_for_each_entry_safe(pos, tmp,
281 &msgheader->submsglist,
282 msglistentry) {
283
284 list_del(&pos->msglistentry);
285 kfree(pos);
286 }
287
Bill Pembertond1c250b2010-05-05 15:27:35 -0400288 goto nomem;
K. Y. Srinivasanf38cf9c2011-06-06 15:50:06 -0700289 }
290
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800291 msgbody->msgsize = msgsize;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700292 (*messagecount)++;
293 gpadl_body =
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800294 (struct vmbus_channel_gpadl_body *)msgbody->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700295
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700296 /*
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700297 * Gpadl is u32 and we are using a pointer which could
298 * be 64-bit
K. Y. Srinivasanf27df642011-06-06 15:49:56 -0700299 * This is governed by the guest/host protocol and
300 * so the hypervisor gurantees that this is ok.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700301 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700302 for (i = 0; i < pfncurr; i++)
Haiyang Zhangb679ef72014-01-27 15:03:42 -0800303 gpadl_body->pfn[i] = slow_virt_to_phys(
304 kbuffer + PAGE_SIZE * (pfnsum + i)) >>
305 PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700306
Bill Pemberton454f18a2009-07-27 16:47:24 -0400307 /* add to msg header */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800308 list_add_tail(&msgbody->msglistentry,
309 &msgheader->submsglist);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700310 pfnsum += pfncurr;
311 pfnleft -= pfncurr;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700312 }
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700313 } else {
Bill Pemberton454f18a2009-07-27 16:47:24 -0400314 /* everything fits in a header */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700315 msgsize = sizeof(struct vmbus_channel_msginfo) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700316 sizeof(struct vmbus_channel_gpadl_header) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700317 sizeof(struct gpa_range) + pagecount * sizeof(u64);
318 msgheader = kzalloc(msgsize, GFP_KERNEL);
319 if (msgheader == NULL)
Kulikov Vasiliye3eb7cd2010-07-16 20:13:51 +0400320 goto nomem;
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800321 msgheader->msgsize = msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700322
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700323 gpadl_header = (struct vmbus_channel_gpadl_header *)
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800324 msgheader->msg;
325 gpadl_header->rangecount = 1;
326 gpadl_header->range_buflen = sizeof(struct gpa_range) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700327 pagecount * sizeof(u64);
Haiyang Zhang415f2282011-01-26 12:12:13 -0800328 gpadl_header->range[0].byte_offset = 0;
329 gpadl_header->range[0].byte_count = size;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700330 for (i = 0; i < pagecount; i++)
Haiyang Zhangb679ef72014-01-27 15:03:42 -0800331 gpadl_header->range[0].pfn_array[i] = slow_virt_to_phys(
332 kbuffer + PAGE_SIZE * i) >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700333
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700334 *msginfo = msgheader;
335 *messagecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700336 }
337
338 return 0;
Bill Pembertond1c250b2010-05-05 15:27:35 -0400339nomem:
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700340 kfree(msgheader);
341 kfree(msgbody);
Bill Pembertond1c250b2010-05-05 15:27:35 -0400342 return -ENOMEM;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700343}
344
Hank Janssen3e189512010-03-04 22:11:00 +0000345/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700346 * vmbus_establish_gpadl - Estabish a GPADL for the specified buffer
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700347 *
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700348 * @channel: a channel
Haiyang Zhangb679ef72014-01-27 15:03:42 -0800349 * @kbuffer: from kmalloc or vmalloc
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700350 * @size: page-size multiple
351 * @gpadl_handle: some funky thing
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700352 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700353int vmbus_establish_gpadl(struct vmbus_channel *channel, void *kbuffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700354 u32 size, u32 *gpadl_handle)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700355{
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700356 struct vmbus_channel_gpadl_header *gpadlmsg;
357 struct vmbus_channel_gpadl_body *gpadl_body;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700358 struct vmbus_channel_msginfo *msginfo = NULL;
359 struct vmbus_channel_msginfo *submsginfo;
360 u32 msgcount;
Bill Pemberton53af5452009-09-11 21:46:44 -0400361 struct list_head *curr;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700362 u32 next_gpadl_handle;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700363 unsigned long flags;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400364 int ret = 0;
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700365 int t;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700366
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800367 next_gpadl_handle = atomic_read(&vmbus_connection.next_gpadl_handle);
368 atomic_inc(&vmbus_connection.next_gpadl_handle);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700369
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700370 ret = create_gpadl_header(kbuffer, size, &msginfo, &msgcount);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400371 if (ret)
372 return ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700373
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700374 init_completion(&msginfo->waitevent);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400375
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800376 gpadlmsg = (struct vmbus_channel_gpadl_header *)msginfo->msg;
377 gpadlmsg->header.msgtype = CHANNELMSG_GPADL_HEADER;
378 gpadlmsg->child_relid = channel->offermsg.child_relid;
379 gpadlmsg->gpadl = next_gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700380
Hank Janssen3e7ee492009-07-13 16:02:34 -0700381
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800382 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800383 list_add_tail(&msginfo->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800384 &vmbus_connection.chn_msg_list);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700385
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800386 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700387
Haiyang Zhangc6977672011-01-26 12:12:08 -0800388 ret = vmbus_post_msg(gpadlmsg, msginfo->msgsize -
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700389 sizeof(*msginfo));
Hank Janssen98e08702011-03-29 13:58:44 -0700390 if (ret != 0)
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700391 goto cleanup;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700392
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700393 if (msgcount > 1) {
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800394 list_for_each(curr, &msginfo->submsglist) {
Bill Pemberton53af5452009-09-11 21:46:44 -0400395
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700396 submsginfo = (struct vmbus_channel_msginfo *)curr;
397 gpadl_body =
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800398 (struct vmbus_channel_gpadl_body *)submsginfo->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700399
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800400 gpadl_body->header.msgtype =
401 CHANNELMSG_GPADL_BODY;
402 gpadl_body->gpadl = next_gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700403
Haiyang Zhangc6977672011-01-26 12:12:08 -0800404 ret = vmbus_post_msg(gpadl_body,
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800405 submsginfo->msgsize -
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700406 sizeof(*submsginfo));
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000407 if (ret != 0)
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700408 goto cleanup;
Bill Pemberton99259152010-05-05 15:27:36 -0400409
Hank Janssen3e7ee492009-07-13 16:02:34 -0700410 }
411 }
K. Y. Srinivasan40961de2011-06-06 15:50:05 -0700412 t = wait_for_completion_timeout(&msginfo->waitevent, 5*HZ);
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700413 BUG_ON(t == 0);
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800414
Hank Janssen3e7ee492009-07-13 16:02:34 -0700415
Bill Pemberton454f18a2009-07-27 16:47:24 -0400416 /* At this point, we received the gpadl created msg */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800417 *gpadl_handle = gpadlmsg->gpadl;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700418
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700419cleanup:
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800420 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800421 list_del(&msginfo->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800422 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700423
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700424 kfree(msginfo);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700425 return ret;
426}
Greg Kroah-Hartman98873722010-10-21 08:47:43 -0700427EXPORT_SYMBOL_GPL(vmbus_establish_gpadl);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700428
Hank Janssen3e189512010-03-04 22:11:00 +0000429/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700430 * vmbus_teardown_gpadl -Teardown the specified GPADL handle
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700431 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700432int vmbus_teardown_gpadl(struct vmbus_channel *channel, u32 gpadl_handle)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700433{
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700434 struct vmbus_channel_gpadl_teardown *msg;
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700435 struct vmbus_channel_msginfo *info;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700436 unsigned long flags;
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700437 int ret, t;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700438
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700439 info = kmalloc(sizeof(*info) +
440 sizeof(struct vmbus_channel_gpadl_teardown), GFP_KERNEL);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400441 if (!info)
442 return -ENOMEM;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700443
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700444 init_completion(&info->waitevent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700445
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800446 msg = (struct vmbus_channel_gpadl_teardown *)info->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700447
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800448 msg->header.msgtype = CHANNELMSG_GPADL_TEARDOWN;
449 msg->child_relid = channel->offermsg.child_relid;
450 msg->gpadl = gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700451
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800452 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800453 list_add_tail(&info->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800454 &vmbus_connection.chn_msg_list);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800455 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc6977672011-01-26 12:12:08 -0800456 ret = vmbus_post_msg(msg,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700457 sizeof(struct vmbus_channel_gpadl_teardown));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700458
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800459 BUG_ON(ret != 0);
K. Y. Srinivasan40961de2011-06-06 15:50:05 -0700460 t = wait_for_completion_timeout(&info->waitevent, 5*HZ);
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700461 BUG_ON(t == 0);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700462
Bill Pemberton454f18a2009-07-27 16:47:24 -0400463 /* Received a torndown response */
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800464 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800465 list_del(&info->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800466 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700467
Greg Kroah-Hartman8c69f522009-07-15 12:48:29 -0700468 kfree(info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700469 return ret;
470}
Greg Kroah-Hartman18726d72010-10-21 08:39:59 -0700471EXPORT_SYMBOL_GPL(vmbus_teardown_gpadl);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700472
K. Y. Srinivasane68d2972013-05-23 12:02:32 -0700473static void vmbus_close_internal(struct vmbus_channel *channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700474{
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700475 struct vmbus_channel_close_channel *msg;
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700476 int ret;
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700477 unsigned long flags;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700478
K. Y. Srinivasane68d2972013-05-23 12:02:32 -0700479 channel->state = CHANNEL_OPEN_STATE;
480 channel->sc_creation_callback = NULL;
Bill Pemberton454f18a2009-07-27 16:47:24 -0400481 /* Stop callback and cancel the timer asap */
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700482 spin_lock_irqsave(&channel->inbound_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800483 channel->onchannel_callback = NULL;
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700484 spin_unlock_irqrestore(&channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700485
Bill Pemberton454f18a2009-07-27 16:47:24 -0400486 /* Send a closing message */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700487
K. Y. Srinivasane9a27a92011-06-06 15:49:59 -0700488 msg = &channel->close_msg.msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700489
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800490 msg->header.msgtype = CHANNELMSG_CLOSECHANNEL;
491 msg->child_relid = channel->offermsg.child_relid;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700492
Haiyang Zhangc6977672011-01-26 12:12:08 -0800493 ret = vmbus_post_msg(msg, sizeof(struct vmbus_channel_close_channel));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700494
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800495 BUG_ON(ret != 0);
Bill Pemberton454f18a2009-07-27 16:47:24 -0400496 /* Tear down the gpadl for the channel's ring buffer */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800497 if (channel->ringbuffer_gpadlhandle)
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700498 vmbus_teardown_gpadl(channel,
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800499 channel->ringbuffer_gpadlhandle);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700500
Bill Pemberton454f18a2009-07-27 16:47:24 -0400501 /* Cleanup the ring buffers for this channel */
K. Y. Srinivasan2dba6882011-05-10 07:55:22 -0700502 hv_ringbuffer_cleanup(&channel->outbound);
503 hv_ringbuffer_cleanup(&channel->inbound);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700504
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -0800505 free_pages((unsigned long)channel->ringbuffer_pages,
506 get_order(channel->ringbuffer_pagecount * PAGE_SIZE));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700507
Hank Janssen3e7ee492009-07-13 16:02:34 -0700508
Hank Janssen3e7ee492009-07-13 16:02:34 -0700509}
K. Y. Srinivasane68d2972013-05-23 12:02:32 -0700510
511/*
512 * vmbus_close - Close the specified channel
513 */
514void vmbus_close(struct vmbus_channel *channel)
515{
516 struct list_head *cur, *tmp;
517 struct vmbus_channel *cur_channel;
518
519 if (channel->primary_channel != NULL) {
520 /*
521 * We will only close sub-channels when
522 * the primary is closed.
523 */
524 return;
525 }
526 /*
527 * Close all the sub-channels first and then close the
528 * primary channel.
529 */
530 list_for_each_safe(cur, tmp, &channel->sc_list) {
531 cur_channel = list_entry(cur, struct vmbus_channel, sc_list);
532 if (cur_channel->state != CHANNEL_OPENED_STATE)
533 continue;
534 vmbus_close_internal(cur_channel);
535 }
536 /*
537 * Now close the primary.
538 */
539 vmbus_close_internal(channel);
540}
Greg Kroah-Hartman70bfa302010-10-21 09:52:22 -0700541EXPORT_SYMBOL_GPL(vmbus_close);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700542
Hank Janssenc88c4e42010-05-04 15:55:05 -0700543/**
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700544 * vmbus_sendpacket() - Send the specified buffer on the given channel
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700545 * @channel: Pointer to vmbus_channel structure.
546 * @buffer: Pointer to the buffer you want to receive the data into.
547 * @bufferlen: Maximum size of what the the buffer will hold
548 * @requestid: Identifier of the request
549 * @type: Type of packet that is being send e.g. negotiate, time
Hank Janssenc88c4e42010-05-04 15:55:05 -0700550 * packet etc.
551 *
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700552 * Sends data in @buffer directly to hyper-v via the vmbus
Hank Janssenc88c4e42010-05-04 15:55:05 -0700553 * This will send the data unparsed to hyper-v.
554 *
555 * Mainly used by Hyper-V drivers.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700556 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700557int vmbus_sendpacket(struct vmbus_channel *channel, const void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700558 u32 bufferlen, u64 requestid,
559 enum vmbus_packet_type type, u32 flags)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700560{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700561 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700562 u32 packetlen = sizeof(struct vmpacket_descriptor) + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100563 u32 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700564 struct scatterlist bufferlist[3];
565 u64 aligned_data = 0;
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700566 int ret;
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800567 bool signal = false;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700568
Hank Janssen3e7ee492009-07-13 16:02:34 -0700569
Bill Pemberton454f18a2009-07-27 16:47:24 -0400570 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800571 desc.type = type; /* VmbusPacketTypeDataInBand; */
572 desc.flags = flags; /* VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED; */
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700573 /* in 8-bytes granularity */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800574 desc.offset8 = sizeof(struct vmpacket_descriptor) >> 3;
575 desc.len8 = (u16)(packetlen_aligned >> 3);
576 desc.trans_id = requestid;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700577
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700578 sg_init_table(bufferlist, 3);
579 sg_set_buf(&bufferlist[0], &desc, sizeof(struct vmpacket_descriptor));
580 sg_set_buf(&bufferlist[1], buffer, bufferlen);
581 sg_set_buf(&bufferlist[2], &aligned_data,
582 packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700583
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800584 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3, &signal);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700585
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800586 if (ret == 0 && signal)
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700587 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700588
Hank Janssen3e7ee492009-07-13 16:02:34 -0700589 return ret;
590}
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700591EXPORT_SYMBOL(vmbus_sendpacket);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700592
Hank Janssen3e189512010-03-04 22:11:00 +0000593/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700594 * vmbus_sendpacket_pagebuffer - Send a range of single-page buffer
Hank Janssen3e189512010-03-04 22:11:00 +0000595 * packets using a GPADL Direct packet type.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700596 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700597int vmbus_sendpacket_pagebuffer(struct vmbus_channel *channel,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700598 struct hv_page_buffer pagebuffers[],
599 u32 pagecount, void *buffer, u32 bufferlen,
600 u64 requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700601{
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700602 int ret;
603 int i;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000604 struct vmbus_channel_packet_page_buffer desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700605 u32 descsize;
606 u32 packetlen;
607 u32 packetlen_aligned;
608 struct scatterlist bufferlist[3];
609 u64 aligned_data = 0;
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800610 bool signal = false;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700611
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700612 if (pagecount > MAX_PAGE_BUFFER_COUNT)
Bill Pemberton002b53e2010-05-05 15:27:39 -0400613 return -EINVAL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700614
Hank Janssen3e7ee492009-07-13 16:02:34 -0700615
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700616 /*
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000617 * Adjust the size down since vmbus_channel_packet_page_buffer is the
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700618 * largest size we support
619 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700620 descsize = sizeof(struct vmbus_channel_packet_page_buffer) -
621 ((MAX_PAGE_BUFFER_COUNT - pagecount) *
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700622 sizeof(struct hv_page_buffer));
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700623 packetlen = descsize + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100624 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700625
Bill Pemberton454f18a2009-07-27 16:47:24 -0400626 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800627 desc.type = VM_PKT_DATA_USING_GPA_DIRECT;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000628 desc.flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700629 desc.dataoffset8 = descsize >> 3; /* in 8-bytes grandularity */
630 desc.length8 = (u16)(packetlen_aligned >> 3);
631 desc.transactionid = requestid;
632 desc.rangecount = pagecount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700633
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700634 for (i = 0; i < pagecount; i++) {
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800635 desc.range[i].len = pagebuffers[i].len;
636 desc.range[i].offset = pagebuffers[i].offset;
637 desc.range[i].pfn = pagebuffers[i].pfn;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700638 }
639
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700640 sg_init_table(bufferlist, 3);
641 sg_set_buf(&bufferlist[0], &desc, descsize);
642 sg_set_buf(&bufferlist[1], buffer, bufferlen);
643 sg_set_buf(&bufferlist[2], &aligned_data,
644 packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700645
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800646 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3, &signal);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700647
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800648 if (ret == 0 && signal)
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700649 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700650
Hank Janssen3e7ee492009-07-13 16:02:34 -0700651 return ret;
652}
Greg Kroah-Hartman713efeb2010-10-21 09:29:54 -0700653EXPORT_SYMBOL_GPL(vmbus_sendpacket_pagebuffer);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700654
Hank Janssen3e189512010-03-04 22:11:00 +0000655/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700656 * vmbus_sendpacket_multipagebuffer - Send a multi-page buffer packet
Hank Janssen3e189512010-03-04 22:11:00 +0000657 * using a GPADL Direct packet type.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700658 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700659int vmbus_sendpacket_multipagebuffer(struct vmbus_channel *channel,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700660 struct hv_multipage_buffer *multi_pagebuffer,
661 void *buffer, u32 bufferlen, u64 requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700662{
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700663 int ret;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000664 struct vmbus_channel_packet_multipage_buffer desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700665 u32 descsize;
666 u32 packetlen;
667 u32 packetlen_aligned;
668 struct scatterlist bufferlist[3];
669 u64 aligned_data = 0;
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800670 bool signal = false;
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800671 u32 pfncount = NUM_PAGES_SPANNED(multi_pagebuffer->offset,
672 multi_pagebuffer->len);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700673
Hank Janssen3e7ee492009-07-13 16:02:34 -0700674
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700675 if ((pfncount < 0) || (pfncount > MAX_MULTIPAGE_BUFFER_COUNT))
Bill Pemberton002b53e2010-05-05 15:27:39 -0400676 return -EINVAL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700677
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700678 /*
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000679 * Adjust the size down since vmbus_channel_packet_multipage_buffer is
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700680 * the largest size we support
681 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700682 descsize = sizeof(struct vmbus_channel_packet_multipage_buffer) -
683 ((MAX_MULTIPAGE_BUFFER_COUNT - pfncount) *
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700684 sizeof(u64));
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700685 packetlen = descsize + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100686 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700687
Hank Janssen3e7ee492009-07-13 16:02:34 -0700688
Bill Pemberton454f18a2009-07-27 16:47:24 -0400689 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800690 desc.type = VM_PKT_DATA_USING_GPA_DIRECT;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000691 desc.flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700692 desc.dataoffset8 = descsize >> 3; /* in 8-bytes grandularity */
693 desc.length8 = (u16)(packetlen_aligned >> 3);
694 desc.transactionid = requestid;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000695 desc.rangecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700696
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800697 desc.range.len = multi_pagebuffer->len;
698 desc.range.offset = multi_pagebuffer->offset;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700699
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800700 memcpy(desc.range.pfn_array, multi_pagebuffer->pfn_array,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700701 pfncount * sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700702
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700703 sg_init_table(bufferlist, 3);
704 sg_set_buf(&bufferlist[0], &desc, descsize);
705 sg_set_buf(&bufferlist[1], buffer, bufferlen);
706 sg_set_buf(&bufferlist[2], &aligned_data,
707 packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700708
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800709 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3, &signal);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700710
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800711 if (ret == 0 && signal)
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700712 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700713
Hank Janssen3e7ee492009-07-13 16:02:34 -0700714 return ret;
715}
Greg Kroah-Hartman4cb106f2010-10-21 09:23:59 -0700716EXPORT_SYMBOL_GPL(vmbus_sendpacket_multipagebuffer);
Hank Janssenc88c4e42010-05-04 15:55:05 -0700717
718/**
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700719 * vmbus_recvpacket() - Retrieve the user packet on the specified channel
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700720 * @channel: Pointer to vmbus_channel structure.
721 * @buffer: Pointer to the buffer you want to receive the data into.
722 * @bufferlen: Maximum size of what the the buffer will hold
723 * @buffer_actual_len: The actual size of the data after it was received
724 * @requestid: Identifier of the request
Hank Janssenc88c4e42010-05-04 15:55:05 -0700725 *
726 * Receives directly from the hyper-v vmbus and puts the data it received
727 * into Buffer. This will receive the data unparsed from hyper-v.
728 *
729 * Mainly used by Hyper-V drivers.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700730 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700731int vmbus_recvpacket(struct vmbus_channel *channel, void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700732 u32 bufferlen, u32 *buffer_actual_len, u64 *requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700733{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700734 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700735 u32 packetlen;
736 u32 userlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700737 int ret;
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800738 bool signal = false;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700739
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700740 *buffer_actual_len = 0;
741 *requestid = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700742
Hank Janssen3e7ee492009-07-13 16:02:34 -0700743
K. Y. Srinivasana89186c2011-05-10 07:55:24 -0700744 ret = hv_ringbuffer_peek(&channel->inbound, &desc,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700745 sizeof(struct vmpacket_descriptor));
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700746 if (ret != 0)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700747 return 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700748
Haiyang Zhang415f2282011-01-26 12:12:13 -0800749 packetlen = desc.len8 << 3;
750 userlen = packetlen - (desc.offset8 << 3);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700751
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700752 *buffer_actual_len = userlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700753
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700754 if (userlen > bufferlen) {
Hank Janssen3e7ee492009-07-13 16:02:34 -0700755
Hank Janssen0a466182011-03-29 13:58:47 -0700756 pr_err("Buffer too small - got %d needs %d\n",
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700757 bufferlen, userlen);
K. Y. Srinivasan926ae5262011-06-06 15:50:11 -0700758 return -ETOOSMALL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700759 }
760
Haiyang Zhang415f2282011-01-26 12:12:13 -0800761 *requestid = desc.trans_id;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700762
Bill Pemberton454f18a2009-07-27 16:47:24 -0400763 /* Copy over the packet to the user buffer */
K. Y. Srinivasan38397c82011-05-10 07:55:25 -0700764 ret = hv_ringbuffer_read(&channel->inbound, buffer, userlen,
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800765 (desc.offset8 << 3), &signal);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700766
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800767 if (signal)
768 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700769
Hank Janssen3e7ee492009-07-13 16:02:34 -0700770 return 0;
771}
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700772EXPORT_SYMBOL(vmbus_recvpacket);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700773
Hank Janssen3e189512010-03-04 22:11:00 +0000774/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700775 * vmbus_recvpacket_raw - Retrieve the raw packet on the specified channel
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700776 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700777int vmbus_recvpacket_raw(struct vmbus_channel *channel, void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700778 u32 bufferlen, u32 *buffer_actual_len,
779 u64 *requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700780{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700781 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700782 u32 packetlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700783 int ret;
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800784 bool signal = false;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700785
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700786 *buffer_actual_len = 0;
787 *requestid = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700788
Hank Janssen3e7ee492009-07-13 16:02:34 -0700789
K. Y. Srinivasana89186c2011-05-10 07:55:24 -0700790 ret = hv_ringbuffer_peek(&channel->inbound, &desc,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700791 sizeof(struct vmpacket_descriptor));
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700792 if (ret != 0)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700793 return 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700794
Hank Janssen3e7ee492009-07-13 16:02:34 -0700795
Haiyang Zhang415f2282011-01-26 12:12:13 -0800796 packetlen = desc.len8 << 3;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700797
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700798 *buffer_actual_len = packetlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700799
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700800 if (packetlen > bufferlen) {
Hank Janssen0a466182011-03-29 13:58:47 -0700801 pr_err("Buffer too small - needed %d bytes but "
802 "got space for only %d bytes\n",
803 packetlen, bufferlen);
K. Y. Srinivasan3d5cad92011-08-25 09:48:59 -0700804 return -ENOBUFS;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700805 }
806
Haiyang Zhang415f2282011-01-26 12:12:13 -0800807 *requestid = desc.trans_id;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700808
Bill Pemberton454f18a2009-07-27 16:47:24 -0400809 /* Copy over the entire packet to the user buffer */
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800810 ret = hv_ringbuffer_read(&channel->inbound, buffer, packetlen, 0,
811 &signal);
812
813 if (signal)
814 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700815
Dan Carpenter33b06932013-09-17 00:58:36 +0300816 return ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700817}
Greg Kroah-Hartmanadaee6b2010-10-21 09:09:23 -0700818EXPORT_SYMBOL_GPL(vmbus_recvpacket_raw);