blob: 26dcf268b09343aa498e7b04957607a20de53f61 [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. Srinivasan011a7c32014-02-01 19:02:20 -080030#include <linux/uio.h>
K. Y. Srinivasan3f335ea2011-05-12 19:34:15 -070031
K. Y. Srinivasan0f2a6612011-05-12 19:34:28 -070032#include "hyperv_vmbus.h"
Hank Janssen3e7ee492009-07-13 16:02:34 -070033
K. Y. Srinivasane3fe0bb2011-02-11 10:00:12 -080034#define NUM_PAGES_SPANNED(addr, len) \
35((PAGE_ALIGN(addr + len) >> PAGE_SHIFT) - (addr >> PAGE_SHIFT))
36
Hank Janssen3e189512010-03-04 22:11:00 +000037/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -070038 * vmbus_setevent- Trigger an event notification on the specified
Hank Janssen3e189512010-03-04 22:11:00 +000039 * channel.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070040 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -070041static void vmbus_setevent(struct vmbus_channel *channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -070042{
Haiyang Zhang39d70a42010-09-30 10:52:13 -070043 struct hv_monitor_page *monitorpage;
Hank Janssen3e7ee492009-07-13 16:02:34 -070044
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080045 if (channel->offermsg.monitor_allocated) {
Bill Pemberton454f18a2009-07-27 16:47:24 -040046 /* Each u32 represents 32 channels */
Olaf Hering223565852011-03-21 14:41:37 +010047 sync_set_bit(channel->offermsg.child_relid & 31,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -080048 (unsigned long *) vmbus_connection.send_int_page +
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080049 (channel->offermsg.child_relid >> 5));
Hank Janssen3e7ee492009-07-13 16:02:34 -070050
Greg Kroah-Hartman8681db42013-09-13 11:32:55 -070051 /* Get the child to parent monitor page */
52 monitorpage = vmbus_connection.monitor_pages[1];
Hank Janssen3e7ee492009-07-13 16:02:34 -070053
Olaf Hering223565852011-03-21 14:41:37 +010054 sync_set_bit(channel->monitor_bit,
Haiyang Zhangf6feebe2010-11-08 14:04:39 -080055 (unsigned long *)&monitorpage->trigger_group
56 [channel->monitor_grp].pending);
Bill Pemberton7c369f42009-07-29 17:00:11 -040057
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070058 } else {
K. Y. Srinivasan21c3bef2012-12-01 06:46:43 -080059 vmbus_set_event(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -070060 }
Hank Janssen3e7ee492009-07-13 16:02:34 -070061}
62
Hank Janssen3e189512010-03-04 22:11:00 +000063/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -070064 * vmbus_open - Open the specified channel.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070065 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -070066int vmbus_open(struct vmbus_channel *newchannel, u32 send_ringbuffer_size,
Haiyang Zhang39d70a42010-09-30 10:52:13 -070067 u32 recv_ringbuffer_size, void *userdata, u32 userdatalen,
68 void (*onchannelcallback)(void *context), void *context)
Hank Janssen3e7ee492009-07-13 16:02:34 -070069{
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -070070 struct vmbus_channel_open_channel *open_msg;
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -070071 struct vmbus_channel_msginfo *open_info = NULL;
Hank Janssen3e7ee492009-07-13 16:02:34 -070072 void *in, *out;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -070073 unsigned long flags;
K. Y. Srinivasan9568a192011-05-10 07:55:39 -070074 int ret, t, err = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -070075
Vitaly Kuznetsov67fae052015-01-20 16:45:05 +010076 spin_lock_irqsave(&newchannel->lock, flags);
K. Y. Srinivasane68d2972013-05-23 12:02:32 -070077 if (newchannel->state == CHANNEL_OPEN_STATE) {
78 newchannel->state = CHANNEL_OPENING_STATE;
79 } else {
Vitaly Kuznetsov67fae052015-01-20 16:45:05 +010080 spin_unlock_irqrestore(&newchannel->lock, flags);
K. Y. Srinivasane68d2972013-05-23 12:02:32 -070081 return -EINVAL;
82 }
Vitaly Kuznetsov67fae052015-01-20 16:45:05 +010083 spin_unlock_irqrestore(&newchannel->lock, flags);
K. Y. Srinivasane68d2972013-05-23 12:02:32 -070084
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080085 newchannel->onchannel_callback = onchannelcallback;
86 newchannel->channel_callback_context = context;
Hank Janssen3e7ee492009-07-13 16:02:34 -070087
Bill Pemberton454f18a2009-07-27 16:47:24 -040088 /* Allocate the ring buffer */
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -080089 out = (void *)__get_free_pages(GFP_KERNEL|__GFP_ZERO,
90 get_order(send_ringbuffer_size + recv_ringbuffer_size));
91
Dexuan Cuiac0d12b2015-02-27 11:26:00 -080092 if (!out) {
93 err = -ENOMEM;
94 goto error0;
95 }
Hank Janssen3e7ee492009-07-13 16:02:34 -070096
Haiyang Zhang39d70a42010-09-30 10:52:13 -070097 in = (void *)((unsigned long)out + send_ringbuffer_size);
Hank Janssen3e7ee492009-07-13 16:02:34 -070098
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080099 newchannel->ringbuffer_pages = out;
100 newchannel->ringbuffer_pagecount = (send_ringbuffer_size +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700101 recv_ringbuffer_size) >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700102
K. Y. Srinivasan72a95cb2011-05-10 07:55:21 -0700103 ret = hv_ringbuffer_init(
104 &newchannel->outbound, out, send_ringbuffer_size);
105
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000106 if (ret != 0) {
Bill Pemberton3324fb42010-05-05 15:27:49 -0400107 err = ret;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700108 goto error0;
Bill Pemberton3324fb42010-05-05 15:27:49 -0400109 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700110
K. Y. Srinivasan72a95cb2011-05-10 07:55:21 -0700111 ret = hv_ringbuffer_init(
112 &newchannel->inbound, in, recv_ringbuffer_size);
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000113 if (ret != 0) {
Bill Pemberton3324fb42010-05-05 15:27:49 -0400114 err = ret;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700115 goto error0;
Bill Pemberton3324fb42010-05-05 15:27:49 -0400116 }
117
Hank Janssen3e7ee492009-07-13 16:02:34 -0700118
Bill Pemberton454f18a2009-07-27 16:47:24 -0400119 /* Establish the gpadl for the ring buffer */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800120 newchannel->ringbuffer_gpadlhandle = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700121
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700122 ret = vmbus_establish_gpadl(newchannel,
Haiyang Zhang82f8bd42010-11-08 14:04:45 -0800123 newchannel->outbound.ring_buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700124 send_ringbuffer_size +
125 recv_ringbuffer_size,
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800126 &newchannel->ringbuffer_gpadlhandle);
Bill Pembertonb94ef342010-05-05 15:27:37 -0400127
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000128 if (ret != 0) {
Bill Pembertonb94ef342010-05-05 15:27:37 -0400129 err = ret;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700130 goto error0;
Bill Pembertonb94ef342010-05-05 15:27:37 -0400131 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700132
Bill Pemberton454f18a2009-07-27 16:47:24 -0400133 /* Create and init the channel open message */
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700134 open_info = kmalloc(sizeof(*open_info) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700135 sizeof(struct vmbus_channel_open_channel),
136 GFP_KERNEL);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700137 if (!open_info) {
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400138 err = -ENOMEM;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700139 goto error0;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400140 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700141
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700142 init_completion(&open_info->waitevent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700143
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700144 open_msg = (struct vmbus_channel_open_channel *)open_info->msg;
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700145 open_msg->header.msgtype = CHANNELMSG_OPENCHANNEL;
146 open_msg->openid = newchannel->offermsg.child_relid;
147 open_msg->child_relid = newchannel->offermsg.child_relid;
148 open_msg->ringbuffer_gpadlhandle = newchannel->ringbuffer_gpadlhandle;
149 open_msg->downstream_ringbuffer_pageoffset = send_ringbuffer_size >>
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700150 PAGE_SHIFT;
K. Y. Srinivasanabbf3b22012-12-01 06:46:48 -0800151 open_msg->target_vp = newchannel->target_vp;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700152
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700153 if (userdatalen > MAX_USER_DEFINED_BYTES) {
Bill Pembertonc827f942010-05-05 15:27:38 -0400154 err = -EINVAL;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700155 goto error0;
Bill Pembertonc827f942010-05-05 15:27:38 -0400156 }
157
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700158 if (userdatalen)
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700159 memcpy(open_msg->userdata, userdata, userdatalen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700160
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800161 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700162 list_add_tail(&open_info->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800163 &vmbus_connection.chn_msg_list);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800164 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700165
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700166 ret = vmbus_post_msg(open_msg,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700167 sizeof(struct vmbus_channel_open_channel));
Hank Janssen98e08702011-03-29 13:58:44 -0700168
K. Y. Srinivasan45d727c2014-08-27 16:25:35 -0700169 if (ret != 0) {
170 err = ret;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700171 goto error1;
K. Y. Srinivasan45d727c2014-08-27 16:25:35 -0700172 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700173
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700174 t = wait_for_completion_timeout(&open_info->waitevent, 5*HZ);
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700175 if (t == 0) {
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800176 err = -ETIMEDOUT;
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700177 goto error1;
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800178 }
179
Hank Janssen3e7ee492009-07-13 16:02:34 -0700180
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700181 if (open_info->response.open_result.status)
182 err = open_info->response.open_result.status;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700183
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800184 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700185 list_del(&open_info->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800186 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700187
K. Y. Srinivasane68d2972013-05-23 12:02:32 -0700188 if (err == 0)
189 newchannel->state = CHANNEL_OPENED_STATE;
190
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700191 kfree(open_info);
Hank Janssen98e08702011-03-29 13:58:44 -0700192 return err;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400193
K. Y. Srinivasan13925502012-10-12 13:22:42 -0700194error1:
195 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
196 list_del(&open_info->msglistentry);
197 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
198
199error0:
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -0800200 free_pages((unsigned long)out,
201 get_order(send_ringbuffer_size + recv_ringbuffer_size));
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700202 kfree(open_info);
Dexuan Cuiac0d12b2015-02-27 11:26:00 -0800203 newchannel->state = CHANNEL_OPEN_STATE;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400204 return err;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700205}
Greg Kroah-Hartman36ceadf2010-10-21 09:58:21 -0700206EXPORT_SYMBOL_GPL(vmbus_open);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700207
Hank Janssen3e189512010-03-04 22:11:00 +0000208/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700209 * create_gpadl_header - Creates a gpadl for the specified buffer
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700210 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700211static int create_gpadl_header(void *kbuffer, u32 size,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700212 struct vmbus_channel_msginfo **msginfo,
213 u32 *messagecount)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700214{
215 int i;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700216 int pagecount;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700217 struct vmbus_channel_gpadl_header *gpadl_header;
218 struct vmbus_channel_gpadl_body *gpadl_body;
219 struct vmbus_channel_msginfo *msgheader;
220 struct vmbus_channel_msginfo *msgbody = NULL;
221 u32 msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700222
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700223 int pfnsum, pfncount, pfnleft, pfncurr, pfnsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700224
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700225 pagecount = size >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700226
Bill Pemberton454f18a2009-07-27 16:47:24 -0400227 /* do we need a gpadl body msg */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700228 pfnsize = MAX_SIZE_CHANNEL_MESSAGE -
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700229 sizeof(struct vmbus_channel_gpadl_header) -
230 sizeof(struct gpa_range);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700231 pfncount = pfnsize / sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700232
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700233 if (pagecount > pfncount) {
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700234 /* we need a gpadl body */
Bill Pemberton454f18a2009-07-27 16:47:24 -0400235 /* fill in the header */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700236 msgsize = sizeof(struct vmbus_channel_msginfo) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700237 sizeof(struct vmbus_channel_gpadl_header) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700238 sizeof(struct gpa_range) + pfncount * sizeof(u64);
239 msgheader = kzalloc(msgsize, GFP_KERNEL);
240 if (!msgheader)
Bill Pembertond1c250b2010-05-05 15:27:35 -0400241 goto nomem;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700242
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800243 INIT_LIST_HEAD(&msgheader->submsglist);
244 msgheader->msgsize = msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700245
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700246 gpadl_header = (struct vmbus_channel_gpadl_header *)
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800247 msgheader->msg;
248 gpadl_header->rangecount = 1;
249 gpadl_header->range_buflen = sizeof(struct gpa_range) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700250 pagecount * sizeof(u64);
Haiyang Zhang415f2282011-01-26 12:12:13 -0800251 gpadl_header->range[0].byte_offset = 0;
252 gpadl_header->range[0].byte_count = size;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700253 for (i = 0; i < pfncount; i++)
Haiyang Zhangb679ef72014-01-27 15:03:42 -0800254 gpadl_header->range[0].pfn_array[i] = slow_virt_to_phys(
255 kbuffer + PAGE_SIZE * i) >> PAGE_SHIFT;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700256 *msginfo = msgheader;
257 *messagecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700258
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700259 pfnsum = pfncount;
260 pfnleft = pagecount - pfncount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700261
Bill Pemberton454f18a2009-07-27 16:47:24 -0400262 /* how many pfns can we fit */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700263 pfnsize = MAX_SIZE_CHANNEL_MESSAGE -
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700264 sizeof(struct vmbus_channel_gpadl_body);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700265 pfncount = pfnsize / sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700266
Bill Pemberton454f18a2009-07-27 16:47:24 -0400267 /* fill in the body */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700268 while (pfnleft) {
269 if (pfnleft > pfncount)
270 pfncurr = pfncount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700271 else
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700272 pfncurr = pfnleft;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700273
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700274 msgsize = sizeof(struct vmbus_channel_msginfo) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700275 sizeof(struct vmbus_channel_gpadl_body) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700276 pfncurr * sizeof(u64);
277 msgbody = kzalloc(msgsize, GFP_KERNEL);
K. Y. Srinivasanf38cf9c2011-06-06 15:50:06 -0700278
279 if (!msgbody) {
280 struct vmbus_channel_msginfo *pos = NULL;
281 struct vmbus_channel_msginfo *tmp = NULL;
282 /*
283 * Free up all the allocated messages.
284 */
285 list_for_each_entry_safe(pos, tmp,
286 &msgheader->submsglist,
287 msglistentry) {
288
289 list_del(&pos->msglistentry);
290 kfree(pos);
291 }
292
Bill Pembertond1c250b2010-05-05 15:27:35 -0400293 goto nomem;
K. Y. Srinivasanf38cf9c2011-06-06 15:50:06 -0700294 }
295
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800296 msgbody->msgsize = msgsize;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700297 (*messagecount)++;
298 gpadl_body =
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800299 (struct vmbus_channel_gpadl_body *)msgbody->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700300
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700301 /*
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700302 * Gpadl is u32 and we are using a pointer which could
303 * be 64-bit
K. Y. Srinivasanf27df642011-06-06 15:49:56 -0700304 * This is governed by the guest/host protocol and
305 * so the hypervisor gurantees that this is ok.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700306 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700307 for (i = 0; i < pfncurr; i++)
Haiyang Zhangb679ef72014-01-27 15:03:42 -0800308 gpadl_body->pfn[i] = slow_virt_to_phys(
309 kbuffer + PAGE_SIZE * (pfnsum + i)) >>
310 PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700311
Bill Pemberton454f18a2009-07-27 16:47:24 -0400312 /* add to msg header */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800313 list_add_tail(&msgbody->msglistentry,
314 &msgheader->submsglist);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700315 pfnsum += pfncurr;
316 pfnleft -= pfncurr;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700317 }
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700318 } else {
Bill Pemberton454f18a2009-07-27 16:47:24 -0400319 /* everything fits in a header */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700320 msgsize = sizeof(struct vmbus_channel_msginfo) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700321 sizeof(struct vmbus_channel_gpadl_header) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700322 sizeof(struct gpa_range) + pagecount * sizeof(u64);
323 msgheader = kzalloc(msgsize, GFP_KERNEL);
324 if (msgheader == NULL)
Kulikov Vasiliye3eb7cd2010-07-16 20:13:51 +0400325 goto nomem;
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800326 msgheader->msgsize = msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700327
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700328 gpadl_header = (struct vmbus_channel_gpadl_header *)
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800329 msgheader->msg;
330 gpadl_header->rangecount = 1;
331 gpadl_header->range_buflen = sizeof(struct gpa_range) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700332 pagecount * sizeof(u64);
Haiyang Zhang415f2282011-01-26 12:12:13 -0800333 gpadl_header->range[0].byte_offset = 0;
334 gpadl_header->range[0].byte_count = size;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700335 for (i = 0; i < pagecount; i++)
Haiyang Zhangb679ef72014-01-27 15:03:42 -0800336 gpadl_header->range[0].pfn_array[i] = slow_virt_to_phys(
337 kbuffer + PAGE_SIZE * i) >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700338
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700339 *msginfo = msgheader;
340 *messagecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700341 }
342
343 return 0;
Bill Pembertond1c250b2010-05-05 15:27:35 -0400344nomem:
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700345 kfree(msgheader);
346 kfree(msgbody);
Bill Pembertond1c250b2010-05-05 15:27:35 -0400347 return -ENOMEM;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700348}
349
Hank Janssen3e189512010-03-04 22:11:00 +0000350/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700351 * vmbus_establish_gpadl - Estabish a GPADL for the specified buffer
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700352 *
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700353 * @channel: a channel
Haiyang Zhangb679ef72014-01-27 15:03:42 -0800354 * @kbuffer: from kmalloc or vmalloc
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700355 * @size: page-size multiple
356 * @gpadl_handle: some funky thing
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700357 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700358int vmbus_establish_gpadl(struct vmbus_channel *channel, void *kbuffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700359 u32 size, u32 *gpadl_handle)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700360{
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700361 struct vmbus_channel_gpadl_header *gpadlmsg;
362 struct vmbus_channel_gpadl_body *gpadl_body;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700363 struct vmbus_channel_msginfo *msginfo = NULL;
364 struct vmbus_channel_msginfo *submsginfo;
365 u32 msgcount;
Bill Pemberton53af5452009-09-11 21:46:44 -0400366 struct list_head *curr;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700367 u32 next_gpadl_handle;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700368 unsigned long flags;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400369 int ret = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700370
K. Y. Srinivasan9f52a162015-01-09 23:54:33 -0800371 next_gpadl_handle =
372 (atomic_inc_return(&vmbus_connection.next_gpadl_handle) - 1);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700373
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700374 ret = create_gpadl_header(kbuffer, size, &msginfo, &msgcount);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400375 if (ret)
376 return ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700377
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700378 init_completion(&msginfo->waitevent);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400379
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800380 gpadlmsg = (struct vmbus_channel_gpadl_header *)msginfo->msg;
381 gpadlmsg->header.msgtype = CHANNELMSG_GPADL_HEADER;
382 gpadlmsg->child_relid = channel->offermsg.child_relid;
383 gpadlmsg->gpadl = next_gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700384
Hank Janssen3e7ee492009-07-13 16:02:34 -0700385
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800386 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800387 list_add_tail(&msginfo->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800388 &vmbus_connection.chn_msg_list);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700389
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800390 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700391
Haiyang Zhangc6977672011-01-26 12:12:08 -0800392 ret = vmbus_post_msg(gpadlmsg, msginfo->msgsize -
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700393 sizeof(*msginfo));
Hank Janssen98e08702011-03-29 13:58:44 -0700394 if (ret != 0)
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700395 goto cleanup;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700396
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700397 if (msgcount > 1) {
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800398 list_for_each(curr, &msginfo->submsglist) {
Bill Pemberton53af5452009-09-11 21:46:44 -0400399
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700400 submsginfo = (struct vmbus_channel_msginfo *)curr;
401 gpadl_body =
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800402 (struct vmbus_channel_gpadl_body *)submsginfo->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700403
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800404 gpadl_body->header.msgtype =
405 CHANNELMSG_GPADL_BODY;
406 gpadl_body->gpadl = next_gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700407
Haiyang Zhangc6977672011-01-26 12:12:08 -0800408 ret = vmbus_post_msg(gpadl_body,
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800409 submsginfo->msgsize -
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700410 sizeof(*submsginfo));
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000411 if (ret != 0)
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700412 goto cleanup;
Bill Pemberton99259152010-05-05 15:27:36 -0400413
Hank Janssen3e7ee492009-07-13 16:02:34 -0700414 }
415 }
K. Y. Srinivasan72c6b712014-08-27 16:25:34 -0700416 wait_for_completion(&msginfo->waitevent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700417
Bill Pemberton454f18a2009-07-27 16:47:24 -0400418 /* At this point, we received the gpadl created msg */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800419 *gpadl_handle = gpadlmsg->gpadl;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700420
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700421cleanup:
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800422 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800423 list_del(&msginfo->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800424 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700425
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700426 kfree(msginfo);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700427 return ret;
428}
Greg Kroah-Hartman98873722010-10-21 08:47:43 -0700429EXPORT_SYMBOL_GPL(vmbus_establish_gpadl);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700430
Hank Janssen3e189512010-03-04 22:11:00 +0000431/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700432 * vmbus_teardown_gpadl -Teardown the specified GPADL handle
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700433 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700434int vmbus_teardown_gpadl(struct vmbus_channel *channel, u32 gpadl_handle)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700435{
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700436 struct vmbus_channel_gpadl_teardown *msg;
Greg Kroah-Hartmanaded7162009-08-18 15:21:19 -0700437 struct vmbus_channel_msginfo *info;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700438 unsigned long flags;
K. Y. Srinivasan66be6532014-08-27 16:25:32 -0700439 int ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700440
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700441 info = kmalloc(sizeof(*info) +
442 sizeof(struct vmbus_channel_gpadl_teardown), GFP_KERNEL);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400443 if (!info)
444 return -ENOMEM;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700445
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700446 init_completion(&info->waitevent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700447
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800448 msg = (struct vmbus_channel_gpadl_teardown *)info->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700449
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800450 msg->header.msgtype = CHANNELMSG_GPADL_TEARDOWN;
451 msg->child_relid = channel->offermsg.child_relid;
452 msg->gpadl = gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700453
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800454 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800455 list_add_tail(&info->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800456 &vmbus_connection.chn_msg_list);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800457 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc6977672011-01-26 12:12:08 -0800458 ret = vmbus_post_msg(msg,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700459 sizeof(struct vmbus_channel_gpadl_teardown));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700460
K. Y. Srinivasan66be6532014-08-27 16:25:32 -0700461 if (ret)
462 goto post_msg_err;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700463
K. Y. Srinivasan66be6532014-08-27 16:25:32 -0700464 wait_for_completion(&info->waitevent);
465
466post_msg_err:
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800467 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800468 list_del(&info->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800469 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700470
Greg Kroah-Hartman8c69f522009-07-15 12:48:29 -0700471 kfree(info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700472 return ret;
473}
Greg Kroah-Hartman18726d72010-10-21 08:39:59 -0700474EXPORT_SYMBOL_GPL(vmbus_teardown_gpadl);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700475
K. Y. Srinivasand3ba7202014-04-08 18:45:53 -0700476static void reset_channel_cb(void *arg)
477{
478 struct vmbus_channel *channel = arg;
479
480 channel->onchannel_callback = NULL;
481}
482
K. Y. Srinivasan98d731b2014-08-27 16:25:33 -0700483static int vmbus_close_internal(struct vmbus_channel *channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700484{
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700485 struct vmbus_channel_close_channel *msg;
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700486 int ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700487
K. Y. Srinivasane68d2972013-05-23 12:02:32 -0700488 channel->state = CHANNEL_OPEN_STATE;
489 channel->sc_creation_callback = NULL;
Bill Pemberton454f18a2009-07-27 16:47:24 -0400490 /* Stop callback and cancel the timer asap */
K. Y. Srinivasan2115b562014-08-28 18:29:53 -0700491 if (channel->target_cpu != get_cpu()) {
492 put_cpu();
K. Y. Srinivasand3ba7202014-04-08 18:45:53 -0700493 smp_call_function_single(channel->target_cpu, reset_channel_cb,
494 channel, true);
K. Y. Srinivasan2115b562014-08-28 18:29:53 -0700495 } else {
K. Y. Srinivasand3ba7202014-04-08 18:45:53 -0700496 reset_channel_cb(channel);
K. Y. Srinivasan2115b562014-08-28 18:29:53 -0700497 put_cpu();
498 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700499
Bill Pemberton454f18a2009-07-27 16:47:24 -0400500 /* Send a closing message */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700501
K. Y. Srinivasane9a27a92011-06-06 15:49:59 -0700502 msg = &channel->close_msg.msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700503
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800504 msg->header.msgtype = CHANNELMSG_CLOSECHANNEL;
505 msg->child_relid = channel->offermsg.child_relid;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700506
Haiyang Zhangc6977672011-01-26 12:12:08 -0800507 ret = vmbus_post_msg(msg, sizeof(struct vmbus_channel_close_channel));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700508
K. Y. Srinivasan98d731b2014-08-27 16:25:33 -0700509 if (ret) {
510 pr_err("Close failed: close post msg return is %d\n", ret);
511 /*
512 * If we failed to post the close msg,
513 * it is perhaps better to leak memory.
514 */
515 return ret;
516 }
517
Bill Pemberton454f18a2009-07-27 16:47:24 -0400518 /* Tear down the gpadl for the channel's ring buffer */
K. Y. Srinivasan98d731b2014-08-27 16:25:33 -0700519 if (channel->ringbuffer_gpadlhandle) {
520 ret = vmbus_teardown_gpadl(channel,
521 channel->ringbuffer_gpadlhandle);
522 if (ret) {
523 pr_err("Close failed: teardown gpadl return %d\n", ret);
524 /*
525 * If we failed to teardown gpadl,
526 * it is perhaps better to leak memory.
527 */
528 return ret;
529 }
530 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700531
Bill Pemberton454f18a2009-07-27 16:47:24 -0400532 /* Cleanup the ring buffers for this channel */
K. Y. Srinivasan2dba6882011-05-10 07:55:22 -0700533 hv_ringbuffer_cleanup(&channel->outbound);
534 hv_ringbuffer_cleanup(&channel->inbound);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700535
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -0800536 free_pages((unsigned long)channel->ringbuffer_pages,
537 get_order(channel->ringbuffer_pagecount * PAGE_SIZE));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700538
K. Y. Srinivasan98d731b2014-08-27 16:25:33 -0700539 return ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700540}
K. Y. Srinivasane68d2972013-05-23 12:02:32 -0700541
542/*
543 * vmbus_close - Close the specified channel
544 */
545void vmbus_close(struct vmbus_channel *channel)
546{
547 struct list_head *cur, *tmp;
548 struct vmbus_channel *cur_channel;
549
550 if (channel->primary_channel != NULL) {
551 /*
552 * We will only close sub-channels when
553 * the primary is closed.
554 */
555 return;
556 }
557 /*
558 * Close all the sub-channels first and then close the
559 * primary channel.
560 */
561 list_for_each_safe(cur, tmp, &channel->sc_list) {
562 cur_channel = list_entry(cur, struct vmbus_channel, sc_list);
563 if (cur_channel->state != CHANNEL_OPENED_STATE)
564 continue;
565 vmbus_close_internal(cur_channel);
566 }
567 /*
568 * Now close the primary.
569 */
570 vmbus_close_internal(channel);
571}
Greg Kroah-Hartman70bfa302010-10-21 09:52:22 -0700572EXPORT_SYMBOL_GPL(vmbus_close);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700573
Hank Janssenc88c4e42010-05-04 15:55:05 -0700574/**
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700575 * vmbus_sendpacket() - Send the specified buffer on the given channel
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700576 * @channel: Pointer to vmbus_channel structure.
577 * @buffer: Pointer to the buffer you want to receive the data into.
578 * @bufferlen: Maximum size of what the the buffer will hold
579 * @requestid: Identifier of the request
580 * @type: Type of packet that is being send e.g. negotiate, time
Hank Janssenc88c4e42010-05-04 15:55:05 -0700581 * packet etc.
582 *
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700583 * Sends data in @buffer directly to hyper-v via the vmbus
Hank Janssenc88c4e42010-05-04 15:55:05 -0700584 * This will send the data unparsed to hyper-v.
585 *
586 * Mainly used by Hyper-V drivers.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700587 */
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800588int vmbus_sendpacket(struct vmbus_channel *channel, void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700589 u32 bufferlen, u64 requestid,
590 enum vmbus_packet_type type, u32 flags)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700591{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700592 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700593 u32 packetlen = sizeof(struct vmpacket_descriptor) + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100594 u32 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800595 struct kvec bufferlist[3];
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700596 u64 aligned_data = 0;
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700597 int ret;
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800598 bool signal = false;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700599
Hank Janssen3e7ee492009-07-13 16:02:34 -0700600
Bill Pemberton454f18a2009-07-27 16:47:24 -0400601 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800602 desc.type = type; /* VmbusPacketTypeDataInBand; */
603 desc.flags = flags; /* VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED; */
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700604 /* in 8-bytes granularity */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800605 desc.offset8 = sizeof(struct vmpacket_descriptor) >> 3;
606 desc.len8 = (u16)(packetlen_aligned >> 3);
607 desc.trans_id = requestid;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700608
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800609 bufferlist[0].iov_base = &desc;
610 bufferlist[0].iov_len = sizeof(struct vmpacket_descriptor);
611 bufferlist[1].iov_base = buffer;
612 bufferlist[1].iov_len = bufferlen;
613 bufferlist[2].iov_base = &aligned_data;
614 bufferlist[2].iov_len = (packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700615
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800616 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3, &signal);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700617
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800618 if (ret == 0 && signal)
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700619 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700620
Hank Janssen3e7ee492009-07-13 16:02:34 -0700621 return ret;
622}
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700623EXPORT_SYMBOL(vmbus_sendpacket);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700624
Hank Janssen3e189512010-03-04 22:11:00 +0000625/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700626 * vmbus_sendpacket_pagebuffer - Send a range of single-page buffer
Hank Janssen3e189512010-03-04 22:11:00 +0000627 * packets using a GPADL Direct packet type.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700628 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700629int vmbus_sendpacket_pagebuffer(struct vmbus_channel *channel,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700630 struct hv_page_buffer pagebuffers[],
631 u32 pagecount, void *buffer, u32 bufferlen,
632 u64 requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700633{
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700634 int ret;
635 int i;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000636 struct vmbus_channel_packet_page_buffer desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700637 u32 descsize;
638 u32 packetlen;
639 u32 packetlen_aligned;
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800640 struct kvec bufferlist[3];
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700641 u64 aligned_data = 0;
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800642 bool signal = false;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700643
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700644 if (pagecount > MAX_PAGE_BUFFER_COUNT)
Bill Pemberton002b53e2010-05-05 15:27:39 -0400645 return -EINVAL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700646
Hank Janssen3e7ee492009-07-13 16:02:34 -0700647
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700648 /*
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000649 * Adjust the size down since vmbus_channel_packet_page_buffer is the
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700650 * largest size we support
651 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700652 descsize = sizeof(struct vmbus_channel_packet_page_buffer) -
653 ((MAX_PAGE_BUFFER_COUNT - pagecount) *
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700654 sizeof(struct hv_page_buffer));
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700655 packetlen = descsize + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100656 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700657
Bill Pemberton454f18a2009-07-27 16:47:24 -0400658 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800659 desc.type = VM_PKT_DATA_USING_GPA_DIRECT;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000660 desc.flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700661 desc.dataoffset8 = descsize >> 3; /* in 8-bytes grandularity */
662 desc.length8 = (u16)(packetlen_aligned >> 3);
663 desc.transactionid = requestid;
664 desc.rangecount = pagecount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700665
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700666 for (i = 0; i < pagecount; i++) {
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800667 desc.range[i].len = pagebuffers[i].len;
668 desc.range[i].offset = pagebuffers[i].offset;
669 desc.range[i].pfn = pagebuffers[i].pfn;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700670 }
671
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800672 bufferlist[0].iov_base = &desc;
673 bufferlist[0].iov_len = descsize;
674 bufferlist[1].iov_base = buffer;
675 bufferlist[1].iov_len = bufferlen;
676 bufferlist[2].iov_base = &aligned_data;
677 bufferlist[2].iov_len = (packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700678
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800679 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3, &signal);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700680
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800681 if (ret == 0 && signal)
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700682 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700683
Hank Janssen3e7ee492009-07-13 16:02:34 -0700684 return ret;
685}
Greg Kroah-Hartman713efeb2010-10-21 09:29:54 -0700686EXPORT_SYMBOL_GPL(vmbus_sendpacket_pagebuffer);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700687
Hank Janssen3e189512010-03-04 22:11:00 +0000688/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700689 * vmbus_sendpacket_multipagebuffer - Send a multi-page buffer packet
Hank Janssen3e189512010-03-04 22:11:00 +0000690 * using a GPADL Direct packet type.
K. Y. Srinivasand61031e2015-01-09 23:54:34 -0800691 * The buffer includes the vmbus descriptor.
692 */
693int vmbus_sendpacket_mpb_desc(struct vmbus_channel *channel,
694 struct vmbus_packet_mpb_array *desc,
695 u32 desc_size,
696 void *buffer, u32 bufferlen, u64 requestid)
697{
698 int ret;
699 u32 packetlen;
700 u32 packetlen_aligned;
701 struct kvec bufferlist[3];
702 u64 aligned_data = 0;
703 bool signal = false;
704
705 packetlen = desc_size + bufferlen;
706 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
707
708 /* Setup the descriptor */
709 desc->type = VM_PKT_DATA_USING_GPA_DIRECT;
710 desc->flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
711 desc->dataoffset8 = desc_size >> 3; /* in 8-bytes grandularity */
712 desc->length8 = (u16)(packetlen_aligned >> 3);
713 desc->transactionid = requestid;
714 desc->rangecount = 1;
715
716 bufferlist[0].iov_base = desc;
717 bufferlist[0].iov_len = desc_size;
718 bufferlist[1].iov_base = buffer;
719 bufferlist[1].iov_len = bufferlen;
720 bufferlist[2].iov_base = &aligned_data;
721 bufferlist[2].iov_len = (packetlen_aligned - packetlen);
722
723 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3, &signal);
724
725 if (ret == 0 && signal)
726 vmbus_setevent(channel);
727
728 return ret;
729}
730EXPORT_SYMBOL_GPL(vmbus_sendpacket_mpb_desc);
731
732/*
733 * vmbus_sendpacket_multipagebuffer - Send a multi-page buffer packet
734 * using a GPADL Direct packet type.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700735 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700736int vmbus_sendpacket_multipagebuffer(struct vmbus_channel *channel,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700737 struct hv_multipage_buffer *multi_pagebuffer,
738 void *buffer, u32 bufferlen, u64 requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700739{
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700740 int ret;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000741 struct vmbus_channel_packet_multipage_buffer desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700742 u32 descsize;
743 u32 packetlen;
744 u32 packetlen_aligned;
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800745 struct kvec bufferlist[3];
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700746 u64 aligned_data = 0;
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800747 bool signal = false;
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800748 u32 pfncount = NUM_PAGES_SPANNED(multi_pagebuffer->offset,
749 multi_pagebuffer->len);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700750
Tobias Klauser24b8a402014-04-25 17:03:50 +0200751 if (pfncount > MAX_MULTIPAGE_BUFFER_COUNT)
Bill Pemberton002b53e2010-05-05 15:27:39 -0400752 return -EINVAL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700753
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700754 /*
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000755 * Adjust the size down since vmbus_channel_packet_multipage_buffer is
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700756 * the largest size we support
757 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700758 descsize = sizeof(struct vmbus_channel_packet_multipage_buffer) -
759 ((MAX_MULTIPAGE_BUFFER_COUNT - pfncount) *
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700760 sizeof(u64));
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700761 packetlen = descsize + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100762 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700763
Hank Janssen3e7ee492009-07-13 16:02:34 -0700764
Bill Pemberton454f18a2009-07-27 16:47:24 -0400765 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800766 desc.type = VM_PKT_DATA_USING_GPA_DIRECT;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000767 desc.flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700768 desc.dataoffset8 = descsize >> 3; /* in 8-bytes grandularity */
769 desc.length8 = (u16)(packetlen_aligned >> 3);
770 desc.transactionid = requestid;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000771 desc.rangecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700772
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800773 desc.range.len = multi_pagebuffer->len;
774 desc.range.offset = multi_pagebuffer->offset;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700775
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800776 memcpy(desc.range.pfn_array, multi_pagebuffer->pfn_array,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700777 pfncount * sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700778
K. Y. Srinivasan011a7c32014-02-01 19:02:20 -0800779 bufferlist[0].iov_base = &desc;
780 bufferlist[0].iov_len = descsize;
781 bufferlist[1].iov_base = buffer;
782 bufferlist[1].iov_len = bufferlen;
783 bufferlist[2].iov_base = &aligned_data;
784 bufferlist[2].iov_len = (packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700785
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800786 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3, &signal);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700787
K. Y. Srinivasan98fa8cf2012-12-01 06:46:36 -0800788 if (ret == 0 && signal)
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700789 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700790
Hank Janssen3e7ee492009-07-13 16:02:34 -0700791 return ret;
792}
Greg Kroah-Hartman4cb106f2010-10-21 09:23:59 -0700793EXPORT_SYMBOL_GPL(vmbus_sendpacket_multipagebuffer);
Hank Janssenc88c4e42010-05-04 15:55:05 -0700794
795/**
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700796 * vmbus_recvpacket() - Retrieve the user packet on the specified channel
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700797 * @channel: Pointer to vmbus_channel structure.
798 * @buffer: Pointer to the buffer you want to receive the data into.
799 * @bufferlen: Maximum size of what the the buffer will hold
800 * @buffer_actual_len: The actual size of the data after it was received
801 * @requestid: Identifier of the request
Hank Janssenc88c4e42010-05-04 15:55:05 -0700802 *
803 * Receives directly from the hyper-v vmbus and puts the data it received
804 * into Buffer. This will receive the data unparsed from hyper-v.
805 *
806 * Mainly used by Hyper-V drivers.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700807 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700808int vmbus_recvpacket(struct vmbus_channel *channel, void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700809 u32 bufferlen, u32 *buffer_actual_len, u64 *requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700810{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700811 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700812 u32 packetlen;
813 u32 userlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700814 int ret;
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800815 bool signal = false;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700816
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700817 *buffer_actual_len = 0;
818 *requestid = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700819
Hank Janssen3e7ee492009-07-13 16:02:34 -0700820
K. Y. Srinivasana89186c2011-05-10 07:55:24 -0700821 ret = hv_ringbuffer_peek(&channel->inbound, &desc,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700822 sizeof(struct vmpacket_descriptor));
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700823 if (ret != 0)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700824 return 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700825
Haiyang Zhang415f2282011-01-26 12:12:13 -0800826 packetlen = desc.len8 << 3;
827 userlen = packetlen - (desc.offset8 << 3);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700828
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700829 *buffer_actual_len = userlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700830
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700831 if (userlen > bufferlen) {
Hank Janssen3e7ee492009-07-13 16:02:34 -0700832
Hank Janssen0a466182011-03-29 13:58:47 -0700833 pr_err("Buffer too small - got %d needs %d\n",
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700834 bufferlen, userlen);
K. Y. Srinivasan926ae5262011-06-06 15:50:11 -0700835 return -ETOOSMALL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700836 }
837
Haiyang Zhang415f2282011-01-26 12:12:13 -0800838 *requestid = desc.trans_id;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700839
Bill Pemberton454f18a2009-07-27 16:47:24 -0400840 /* Copy over the packet to the user buffer */
K. Y. Srinivasan38397c82011-05-10 07:55:25 -0700841 ret = hv_ringbuffer_read(&channel->inbound, buffer, userlen,
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800842 (desc.offset8 << 3), &signal);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700843
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800844 if (signal)
845 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700846
Hank Janssen3e7ee492009-07-13 16:02:34 -0700847 return 0;
848}
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700849EXPORT_SYMBOL(vmbus_recvpacket);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700850
Hank Janssen3e189512010-03-04 22:11:00 +0000851/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700852 * vmbus_recvpacket_raw - Retrieve the raw packet on the specified channel
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700853 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700854int vmbus_recvpacket_raw(struct vmbus_channel *channel, void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700855 u32 bufferlen, u32 *buffer_actual_len,
856 u64 *requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700857{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700858 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700859 u32 packetlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700860 int ret;
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800861 bool signal = false;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700862
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700863 *buffer_actual_len = 0;
864 *requestid = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700865
Hank Janssen3e7ee492009-07-13 16:02:34 -0700866
K. Y. Srinivasana89186c2011-05-10 07:55:24 -0700867 ret = hv_ringbuffer_peek(&channel->inbound, &desc,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700868 sizeof(struct vmpacket_descriptor));
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700869 if (ret != 0)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700870 return 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700871
Hank Janssen3e7ee492009-07-13 16:02:34 -0700872
Haiyang Zhang415f2282011-01-26 12:12:13 -0800873 packetlen = desc.len8 << 3;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700874
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700875 *buffer_actual_len = packetlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700876
Jason Wang7a446d62014-06-30 14:14:48 +0800877 if (packetlen > bufferlen)
K. Y. Srinivasan3d5cad92011-08-25 09:48:59 -0700878 return -ENOBUFS;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700879
Haiyang Zhang415f2282011-01-26 12:12:13 -0800880 *requestid = desc.trans_id;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700881
Bill Pemberton454f18a2009-07-27 16:47:24 -0400882 /* Copy over the entire packet to the user buffer */
K. Y. Srinivasanc2b8e522012-12-01 06:46:57 -0800883 ret = hv_ringbuffer_read(&channel->inbound, buffer, packetlen, 0,
884 &signal);
885
886 if (signal)
887 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700888
Dan Carpenter33b06932013-09-17 00:58:36 +0300889 return ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700890}
Greg Kroah-Hartmanadaee6b2010-10-21 09:09:23 -0700891EXPORT_SYMBOL_GPL(vmbus_recvpacket_raw);