blob: 980ef7e174fbac056f68df931a6ed31d0dd8cebe [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
Bill Pemberton454f18a2009-07-27 16:47:24 -040036/* Internal routines */
Haiyang Zhangfff41b22010-10-07 11:40:08 -070037static int create_gpadl_header(
Haiyang Zhang39d70a42010-09-30 10:52:13 -070038 void *kbuffer, /* must be phys and virt contiguous */
39 u32 size, /* page-size multiple */
40 struct vmbus_channel_msginfo **msginfo,
41 u32 *messagecount);
Haiyang Zhangfff41b22010-10-07 11:40:08 -070042static void vmbus_setevent(struct vmbus_channel *channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -070043
Hank Janssen3e189512010-03-04 22:11:00 +000044/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -070045 * vmbus_setevent- Trigger an event notification on the specified
Hank Janssen3e189512010-03-04 22:11:00 +000046 * channel.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070047 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -070048static void vmbus_setevent(struct vmbus_channel *channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -070049{
Haiyang Zhang39d70a42010-09-30 10:52:13 -070050 struct hv_monitor_page *monitorpage;
Hank Janssen3e7ee492009-07-13 16:02:34 -070051
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080052 if (channel->offermsg.monitor_allocated) {
Bill Pemberton454f18a2009-07-27 16:47:24 -040053 /* Each u32 represents 32 channels */
Olaf Hering22356582011-03-21 14:41:37 +010054 sync_set_bit(channel->offermsg.child_relid & 31,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -080055 (unsigned long *) vmbus_connection.send_int_page +
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080056 (channel->offermsg.child_relid >> 5));
Hank Janssen3e7ee492009-07-13 16:02:34 -070057
Haiyang Zhangda9fcb72011-01-26 12:12:14 -080058 monitorpage = vmbus_connection.monitor_pages;
Haiyang Zhang39d70a42010-09-30 10:52:13 -070059 monitorpage++; /* Get the child to parent monitor page */
Hank Janssen3e7ee492009-07-13 16:02:34 -070060
Olaf Hering22356582011-03-21 14:41:37 +010061 sync_set_bit(channel->monitor_bit,
Haiyang Zhangf6feebe2010-11-08 14:04:39 -080062 (unsigned long *)&monitorpage->trigger_group
63 [channel->monitor_grp].pending);
Bill Pemberton7c369f42009-07-29 17:00:11 -040064
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070065 } else {
Haiyang Zhangc6977672011-01-26 12:12:08 -080066 vmbus_set_event(channel->offermsg.child_relid);
Hank Janssen3e7ee492009-07-13 16:02:34 -070067 }
Hank Janssen3e7ee492009-07-13 16:02:34 -070068}
69
Hank Janssen3e189512010-03-04 22:11:00 +000070/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -070071 * vmbus_get_debug_info -Retrieve various channel debug info
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -070072 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -070073void vmbus_get_debug_info(struct vmbus_channel *channel,
Haiyang Zhang39d70a42010-09-30 10:52:13 -070074 struct vmbus_channel_debug_info *debuginfo)
Hank Janssen3e7ee492009-07-13 16:02:34 -070075{
Haiyang Zhang39d70a42010-09-30 10:52:13 -070076 struct hv_monitor_page *monitorpage;
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080077 u8 monitor_group = (u8)channel->offermsg.monitorid / 32;
78 u8 monitor_offset = (u8)channel->offermsg.monitorid % 32;
Hank Janssen3e7ee492009-07-13 16:02:34 -070079
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080080 debuginfo->relid = channel->offermsg.child_relid;
81 debuginfo->state = channel->state;
82 memcpy(&debuginfo->interfacetype,
K. Y. Srinivasan358d2ee2011-08-25 09:48:28 -070083 &channel->offermsg.offer.if_type, sizeof(uuid_le));
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080084 memcpy(&debuginfo->interface_instance,
Haiyang Zhang767dff62011-01-26 12:12:12 -080085 &channel->offermsg.offer.if_instance,
K. Y. Srinivasan358d2ee2011-08-25 09:48:28 -070086 sizeof(uuid_le));
Hank Janssen3e7ee492009-07-13 16:02:34 -070087
Haiyang Zhangda9fcb72011-01-26 12:12:14 -080088 monitorpage = (struct hv_monitor_page *)vmbus_connection.monitor_pages;
Hank Janssen3e7ee492009-07-13 16:02:34 -070089
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080090 debuginfo->monitorid = channel->offermsg.monitorid;
Hank Janssen3e7ee492009-07-13 16:02:34 -070091
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080092 debuginfo->servermonitor_pending =
Haiyang Zhangf6feebe2010-11-08 14:04:39 -080093 monitorpage->trigger_group[monitor_group].pending;
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080094 debuginfo->servermonitor_latency =
Haiyang Zhangf6feebe2010-11-08 14:04:39 -080095 monitorpage->latency[monitor_group][monitor_offset];
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -080096 debuginfo->servermonitor_connectionid =
Haiyang Zhangf6feebe2010-11-08 14:04:39 -080097 monitorpage->parameter[monitor_group]
98 [monitor_offset].connectionid.u.id;
Hank Janssen3e7ee492009-07-13 16:02:34 -070099
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700100 monitorpage++;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700101
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800102 debuginfo->clientmonitor_pending =
Haiyang Zhangf6feebe2010-11-08 14:04:39 -0800103 monitorpage->trigger_group[monitor_group].pending;
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800104 debuginfo->clientmonitor_latency =
Haiyang Zhangf6feebe2010-11-08 14:04:39 -0800105 monitorpage->latency[monitor_group][monitor_offset];
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800106 debuginfo->clientmonitor_connectionid =
Haiyang Zhangf6feebe2010-11-08 14:04:39 -0800107 monitorpage->parameter[monitor_group]
108 [monitor_offset].connectionid.u.id;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700109
K. Y. Srinivasana75b61d2011-05-10 07:55:28 -0700110 hv_ringbuffer_get_debuginfo(&channel->inbound, &debuginfo->inbound);
111 hv_ringbuffer_get_debuginfo(&channel->outbound, &debuginfo->outbound);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700112}
113
Hank Janssen3e189512010-03-04 22:11:00 +0000114/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700115 * vmbus_open - Open the specified channel.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700116 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700117int vmbus_open(struct vmbus_channel *newchannel, u32 send_ringbuffer_size,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700118 u32 recv_ringbuffer_size, void *userdata, u32 userdatalen,
119 void (*onchannelcallback)(void *context), void *context)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700120{
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700121 struct vmbus_channel_open_channel *open_msg;
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700122 struct vmbus_channel_msginfo *open_info = NULL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700123 void *in, *out;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700124 unsigned long flags;
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700125 int ret, t, err = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700126
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800127 newchannel->onchannel_callback = onchannelcallback;
128 newchannel->channel_callback_context = context;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700129
Bill Pemberton454f18a2009-07-27 16:47:24 -0400130 /* Allocate the ring buffer */
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -0800131 out = (void *)__get_free_pages(GFP_KERNEL|__GFP_ZERO,
132 get_order(send_ringbuffer_size + recv_ringbuffer_size));
133
Bill Pemberton7e052d92010-05-05 15:27:30 -0400134 if (!out)
135 return -ENOMEM;
136
Hank Janssen3e7ee492009-07-13 16:02:34 -0700137
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700138 in = (void *)((unsigned long)out + send_ringbuffer_size);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700139
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800140 newchannel->ringbuffer_pages = out;
141 newchannel->ringbuffer_pagecount = (send_ringbuffer_size +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700142 recv_ringbuffer_size) >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700143
K. Y. Srinivasan72a95cb2011-05-10 07:55:21 -0700144 ret = hv_ringbuffer_init(
145 &newchannel->outbound, out, send_ringbuffer_size);
146
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000147 if (ret != 0) {
Bill Pemberton3324fb42010-05-05 15:27:49 -0400148 err = ret;
K. Y. Srinivasanc87b93b2012-10-12 13:22:42 -0700149 goto error0;
Bill Pemberton3324fb42010-05-05 15:27:49 -0400150 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700151
K. Y. Srinivasan72a95cb2011-05-10 07:55:21 -0700152 ret = hv_ringbuffer_init(
153 &newchannel->inbound, in, recv_ringbuffer_size);
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000154 if (ret != 0) {
Bill Pemberton3324fb42010-05-05 15:27:49 -0400155 err = ret;
K. Y. Srinivasanc87b93b2012-10-12 13:22:42 -0700156 goto error0;
Bill Pemberton3324fb42010-05-05 15:27:49 -0400157 }
158
Hank Janssen3e7ee492009-07-13 16:02:34 -0700159
Bill Pemberton454f18a2009-07-27 16:47:24 -0400160 /* Establish the gpadl for the ring buffer */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800161 newchannel->ringbuffer_gpadlhandle = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700162
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700163 ret = vmbus_establish_gpadl(newchannel,
Haiyang Zhang82f8bd42010-11-08 14:04:45 -0800164 newchannel->outbound.ring_buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700165 send_ringbuffer_size +
166 recv_ringbuffer_size,
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800167 &newchannel->ringbuffer_gpadlhandle);
Bill Pembertonb94ef342010-05-05 15:27:37 -0400168
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000169 if (ret != 0) {
Bill Pembertonb94ef342010-05-05 15:27:37 -0400170 err = ret;
K. Y. Srinivasanc87b93b2012-10-12 13:22:42 -0700171 goto error0;
Bill Pembertonb94ef342010-05-05 15:27:37 -0400172 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700173
Bill Pemberton454f18a2009-07-27 16:47:24 -0400174 /* Create and init the channel open message */
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700175 open_info = kmalloc(sizeof(*open_info) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700176 sizeof(struct vmbus_channel_open_channel),
177 GFP_KERNEL);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700178 if (!open_info) {
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400179 err = -ENOMEM;
K. Y. Srinivasana5eecb72015-02-27 11:26:04 -0800180 goto error_gpadl;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400181 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700182
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700183 init_completion(&open_info->waitevent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700184
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700185 open_msg = (struct vmbus_channel_open_channel *)open_info->msg;
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700186 open_msg->header.msgtype = CHANNELMSG_OPENCHANNEL;
187 open_msg->openid = newchannel->offermsg.child_relid;
188 open_msg->child_relid = newchannel->offermsg.child_relid;
189 open_msg->ringbuffer_gpadlhandle = newchannel->ringbuffer_gpadlhandle;
190 open_msg->downstream_ringbuffer_pageoffset = send_ringbuffer_size >>
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700191 PAGE_SHIFT;
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700192 open_msg->server_contextarea_gpadlhandle = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700193
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700194 if (userdatalen > MAX_USER_DEFINED_BYTES) {
Bill Pembertonc827f942010-05-05 15:27:38 -0400195 err = -EINVAL;
K. Y. Srinivasana5eecb72015-02-27 11:26:04 -0800196 goto error_gpadl;
Bill Pembertonc827f942010-05-05 15:27:38 -0400197 }
198
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700199 if (userdatalen)
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700200 memcpy(open_msg->userdata, userdata, userdatalen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700201
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800202 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700203 list_add_tail(&open_info->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800204 &vmbus_connection.chn_msg_list);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800205 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700206
K. Y. Srinivasan0987ff62011-08-25 09:48:55 -0700207 ret = vmbus_post_msg(open_msg,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700208 sizeof(struct vmbus_channel_open_channel));
Hank Janssen98e08702011-03-29 13:58:44 -0700209
K. Y. Srinivasan0d45da72014-08-27 16:25:35 -0700210 if (ret != 0) {
211 err = ret;
K. Y. Srinivasanc87b93b2012-10-12 13:22:42 -0700212 goto error1;
K. Y. Srinivasan0d45da72014-08-27 16:25:35 -0700213 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700214
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700215 t = wait_for_completion_timeout(&open_info->waitevent, 5*HZ);
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700216 if (t == 0) {
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800217 err = -ETIMEDOUT;
K. Y. Srinivasanc87b93b2012-10-12 13:22:42 -0700218 goto error1;
K. Y. Srinivasan0c3b7b22011-02-11 09:59:43 -0800219 }
220
Hank Janssen3e7ee492009-07-13 16:02:34 -0700221
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700222 if (open_info->response.open_result.status)
223 err = open_info->response.open_result.status;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700224
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800225 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700226 list_del(&open_info->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800227 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700228
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700229 kfree(open_info);
Hank Janssen98e08702011-03-29 13:58:44 -0700230 return err;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400231
K. Y. Srinivasanc87b93b2012-10-12 13:22:42 -0700232error1:
233 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
234 list_del(&open_info->msglistentry);
235 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
236
K. Y. Srinivasana5eecb72015-02-27 11:26:04 -0800237error_gpadl:
238 vmbus_teardown_gpadl(newchannel, newchannel->ringbuffer_gpadlhandle);
239
K. Y. Srinivasanc87b93b2012-10-12 13:22:42 -0700240error0:
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -0800241 free_pages((unsigned long)out,
242 get_order(send_ringbuffer_size + recv_ringbuffer_size));
K. Y. Srinivasan176fb9e2011-08-25 09:48:57 -0700243 kfree(open_info);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400244 return err;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700245}
Greg Kroah-Hartman36ceadf2010-10-21 09:58:21 -0700246EXPORT_SYMBOL_GPL(vmbus_open);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700247
Hank Janssen3e189512010-03-04 22:11:00 +0000248/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700249 * create_gpadl_header - Creates a gpadl for the specified buffer
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700250 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700251static int create_gpadl_header(void *kbuffer, u32 size,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700252 struct vmbus_channel_msginfo **msginfo,
253 u32 *messagecount)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700254{
255 int i;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700256 int pagecount;
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700257 unsigned long long pfn;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700258 struct vmbus_channel_gpadl_header *gpadl_header;
259 struct vmbus_channel_gpadl_body *gpadl_body;
260 struct vmbus_channel_msginfo *msgheader;
261 struct vmbus_channel_msginfo *msgbody = NULL;
262 u32 msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700263
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700264 int pfnsum, pfncount, pfnleft, pfncurr, pfnsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700265
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700266 pagecount = size >> PAGE_SHIFT;
267 pfn = virt_to_phys(kbuffer) >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700268
Bill Pemberton454f18a2009-07-27 16:47:24 -0400269 /* do we need a gpadl body msg */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700270 pfnsize = MAX_SIZE_CHANNEL_MESSAGE -
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700271 sizeof(struct vmbus_channel_gpadl_header) -
272 sizeof(struct gpa_range);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700273 pfncount = pfnsize / sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700274
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700275 if (pagecount > pfncount) {
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700276 /* we need a gpadl body */
Bill Pemberton454f18a2009-07-27 16:47:24 -0400277 /* fill in the header */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700278 msgsize = sizeof(struct vmbus_channel_msginfo) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700279 sizeof(struct vmbus_channel_gpadl_header) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700280 sizeof(struct gpa_range) + pfncount * sizeof(u64);
281 msgheader = kzalloc(msgsize, GFP_KERNEL);
282 if (!msgheader)
Bill Pembertond1c250b2010-05-05 15:27:35 -0400283 goto nomem;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700284
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800285 INIT_LIST_HEAD(&msgheader->submsglist);
286 msgheader->msgsize = msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700287
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700288 gpadl_header = (struct vmbus_channel_gpadl_header *)
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800289 msgheader->msg;
290 gpadl_header->rangecount = 1;
291 gpadl_header->range_buflen = sizeof(struct gpa_range) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700292 pagecount * sizeof(u64);
Haiyang Zhang415f2282011-01-26 12:12:13 -0800293 gpadl_header->range[0].byte_offset = 0;
294 gpadl_header->range[0].byte_count = size;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700295 for (i = 0; i < pfncount; i++)
Haiyang Zhang415f2282011-01-26 12:12:13 -0800296 gpadl_header->range[0].pfn_array[i] = pfn+i;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700297 *msginfo = msgheader;
298 *messagecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700299
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700300 pfnsum = pfncount;
301 pfnleft = pagecount - pfncount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700302
Bill Pemberton454f18a2009-07-27 16:47:24 -0400303 /* how many pfns can we fit */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700304 pfnsize = MAX_SIZE_CHANNEL_MESSAGE -
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700305 sizeof(struct vmbus_channel_gpadl_body);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700306 pfncount = pfnsize / sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700307
Bill Pemberton454f18a2009-07-27 16:47:24 -0400308 /* fill in the body */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700309 while (pfnleft) {
310 if (pfnleft > pfncount)
311 pfncurr = pfncount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700312 else
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700313 pfncurr = pfnleft;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700314
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_body) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700317 pfncurr * sizeof(u64);
318 msgbody = kzalloc(msgsize, GFP_KERNEL);
K. Y. Srinivasanf38cf9c2011-06-06 15:50:06 -0700319
320 if (!msgbody) {
321 struct vmbus_channel_msginfo *pos = NULL;
322 struct vmbus_channel_msginfo *tmp = NULL;
323 /*
324 * Free up all the allocated messages.
325 */
326 list_for_each_entry_safe(pos, tmp,
327 &msgheader->submsglist,
328 msglistentry) {
329
330 list_del(&pos->msglistentry);
331 kfree(pos);
332 }
333
Bill Pembertond1c250b2010-05-05 15:27:35 -0400334 goto nomem;
K. Y. Srinivasanf38cf9c2011-06-06 15:50:06 -0700335 }
336
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800337 msgbody->msgsize = msgsize;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700338 (*messagecount)++;
339 gpadl_body =
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800340 (struct vmbus_channel_gpadl_body *)msgbody->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700341
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700342 /*
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700343 * Gpadl is u32 and we are using a pointer which could
344 * be 64-bit
K. Y. Srinivasanf27df642011-06-06 15:49:56 -0700345 * This is governed by the guest/host protocol and
346 * so the hypervisor gurantees that this is ok.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700347 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700348 for (i = 0; i < pfncurr; i++)
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800349 gpadl_body->pfn[i] = pfn + pfnsum + i;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700350
Bill Pemberton454f18a2009-07-27 16:47:24 -0400351 /* add to msg header */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800352 list_add_tail(&msgbody->msglistentry,
353 &msgheader->submsglist);
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700354 pfnsum += pfncurr;
355 pfnleft -= pfncurr;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700356 }
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700357 } else {
Bill Pemberton454f18a2009-07-27 16:47:24 -0400358 /* everything fits in a header */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700359 msgsize = sizeof(struct vmbus_channel_msginfo) +
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700360 sizeof(struct vmbus_channel_gpadl_header) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700361 sizeof(struct gpa_range) + pagecount * sizeof(u64);
362 msgheader = kzalloc(msgsize, GFP_KERNEL);
363 if (msgheader == NULL)
Kulikov Vasiliye3eb7cd2010-07-16 20:13:51 +0400364 goto nomem;
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800365 msgheader->msgsize = msgsize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700366
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700367 gpadl_header = (struct vmbus_channel_gpadl_header *)
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800368 msgheader->msg;
369 gpadl_header->rangecount = 1;
370 gpadl_header->range_buflen = sizeof(struct gpa_range) +
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700371 pagecount * sizeof(u64);
Haiyang Zhang415f2282011-01-26 12:12:13 -0800372 gpadl_header->range[0].byte_offset = 0;
373 gpadl_header->range[0].byte_count = size;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700374 for (i = 0; i < pagecount; i++)
Haiyang Zhang415f2282011-01-26 12:12:13 -0800375 gpadl_header->range[0].pfn_array[i] = pfn+i;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700376
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700377 *msginfo = msgheader;
378 *messagecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700379 }
380
381 return 0;
Bill Pembertond1c250b2010-05-05 15:27:35 -0400382nomem:
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700383 kfree(msgheader);
384 kfree(msgbody);
Bill Pembertond1c250b2010-05-05 15:27:35 -0400385 return -ENOMEM;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700386}
387
Hank Janssen3e189512010-03-04 22:11:00 +0000388/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700389 * vmbus_establish_gpadl - Estabish a GPADL for the specified buffer
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700390 *
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700391 * @channel: a channel
392 * @kbuffer: from kmalloc
393 * @size: page-size multiple
394 * @gpadl_handle: some funky thing
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700395 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700396int vmbus_establish_gpadl(struct vmbus_channel *channel, void *kbuffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700397 u32 size, u32 *gpadl_handle)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700398{
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700399 struct vmbus_channel_gpadl_header *gpadlmsg;
400 struct vmbus_channel_gpadl_body *gpadl_body;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700401 struct vmbus_channel_msginfo *msginfo = NULL;
402 struct vmbus_channel_msginfo *submsginfo;
403 u32 msgcount;
Bill Pemberton53af5452009-09-11 21:46:44 -0400404 struct list_head *curr;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700405 u32 next_gpadl_handle;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700406 unsigned long flags;
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400407 int ret = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700408
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800409 next_gpadl_handle = atomic_read(&vmbus_connection.next_gpadl_handle);
410 atomic_inc(&vmbus_connection.next_gpadl_handle);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700411
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700412 ret = create_gpadl_header(kbuffer, size, &msginfo, &msgcount);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400413 if (ret)
414 return ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700415
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700416 init_completion(&msginfo->waitevent);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400417
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800418 gpadlmsg = (struct vmbus_channel_gpadl_header *)msginfo->msg;
419 gpadlmsg->header.msgtype = CHANNELMSG_GPADL_HEADER;
420 gpadlmsg->child_relid = channel->offermsg.child_relid;
421 gpadlmsg->gpadl = next_gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700422
Hank Janssen3e7ee492009-07-13 16:02:34 -0700423
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800424 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800425 list_add_tail(&msginfo->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800426 &vmbus_connection.chn_msg_list);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700427
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800428 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700429
Haiyang Zhangc6977672011-01-26 12:12:08 -0800430 ret = vmbus_post_msg(gpadlmsg, msginfo->msgsize -
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700431 sizeof(*msginfo));
Hank Janssen98e08702011-03-29 13:58:44 -0700432 if (ret != 0)
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700433 goto cleanup;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700434
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700435 if (msgcount > 1) {
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800436 list_for_each(curr, &msginfo->submsglist) {
Bill Pemberton53af5452009-09-11 21:46:44 -0400437
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700438 submsginfo = (struct vmbus_channel_msginfo *)curr;
439 gpadl_body =
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800440 (struct vmbus_channel_gpadl_body *)submsginfo->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700441
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800442 gpadl_body->header.msgtype =
443 CHANNELMSG_GPADL_BODY;
444 gpadl_body->gpadl = next_gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700445
Haiyang Zhangc6977672011-01-26 12:12:08 -0800446 ret = vmbus_post_msg(gpadl_body,
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800447 submsginfo->msgsize -
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700448 sizeof(*submsginfo));
Haiyang Zhangfd4dc882010-05-13 15:56:30 +0000449 if (ret != 0)
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700450 goto cleanup;
Bill Pemberton99259152010-05-05 15:27:36 -0400451
Hank Janssen3e7ee492009-07-13 16:02:34 -0700452 }
453 }
K. Y. Srinivasan7dd7c9f2014-08-27 16:25:34 -0700454 wait_for_completion(&msginfo->waitevent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700455
Bill Pemberton454f18a2009-07-27 16:47:24 -0400456 /* At this point, we received the gpadl created msg */
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800457 *gpadl_handle = gpadlmsg->gpadl;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700458
K. Y. Srinivasan00d760b2011-06-06 15:50:12 -0700459cleanup:
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800460 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800461 list_del(&msginfo->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800462 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700463
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700464 kfree(msginfo);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700465 return ret;
466}
Greg Kroah-Hartman98873722010-10-21 08:47:43 -0700467EXPORT_SYMBOL_GPL(vmbus_establish_gpadl);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700468
Hank Janssen3e189512010-03-04 22:11:00 +0000469/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700470 * vmbus_teardown_gpadl -Teardown the specified GPADL handle
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700471 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700472int vmbus_teardown_gpadl(struct vmbus_channel *channel, u32 gpadl_handle)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700473{
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700474 struct vmbus_channel_gpadl_teardown *msg;
Greg Kroah-Hartmanaded7162009-08-18 15:21:19 -0700475 struct vmbus_channel_msginfo *info;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700476 unsigned long flags;
K. Y. Srinivasan7c53cc62014-08-27 16:25:32 -0700477 int ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700478
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700479 info = kmalloc(sizeof(*info) +
480 sizeof(struct vmbus_channel_gpadl_teardown), GFP_KERNEL);
Bill Pembertonc3bf2e22010-05-05 15:27:34 -0400481 if (!info)
482 return -ENOMEM;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700483
K. Y. Srinivasan9568a192011-05-10 07:55:39 -0700484 init_completion(&info->waitevent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700485
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800486 msg = (struct vmbus_channel_gpadl_teardown *)info->msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700487
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800488 msg->header.msgtype = CHANNELMSG_GPADL_TEARDOWN;
489 msg->child_relid = channel->offermsg.child_relid;
490 msg->gpadl = gpadl_handle;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700491
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800492 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800493 list_add_tail(&info->msglistentry,
Haiyang Zhangda9fcb72011-01-26 12:12:14 -0800494 &vmbus_connection.chn_msg_list);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800495 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc6977672011-01-26 12:12:08 -0800496 ret = vmbus_post_msg(msg,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700497 sizeof(struct vmbus_channel_gpadl_teardown));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700498
K. Y. Srinivasan7c53cc62014-08-27 16:25:32 -0700499 if (ret)
500 goto post_msg_err;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700501
K. Y. Srinivasan7c53cc62014-08-27 16:25:32 -0700502 wait_for_completion(&info->waitevent);
503
504post_msg_err:
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800505 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800506 list_del(&info->msglistentry);
Haiyang Zhang15b2f642011-01-26 12:12:07 -0800507 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700508
Greg Kroah-Hartman8c69f522009-07-15 12:48:29 -0700509 kfree(info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700510 return ret;
511}
Greg Kroah-Hartman18726d72010-10-21 08:39:59 -0700512EXPORT_SYMBOL_GPL(vmbus_teardown_gpadl);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700513
Hank Janssen3e189512010-03-04 22:11:00 +0000514/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700515 * vmbus_close - Close the specified channel
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700516 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700517void vmbus_close(struct vmbus_channel *channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700518{
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700519 struct vmbus_channel_close_channel *msg;
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700520 int ret;
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700521 unsigned long flags;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700522
Bill Pemberton454f18a2009-07-27 16:47:24 -0400523 /* Stop callback and cancel the timer asap */
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700524 spin_lock_irqsave(&channel->inbound_lock, flags);
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800525 channel->onchannel_callback = NULL;
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700526 spin_unlock_irqrestore(&channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700527
Bill Pemberton454f18a2009-07-27 16:47:24 -0400528 /* Send a closing message */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700529
K. Y. Srinivasane9a27a92011-06-06 15:49:59 -0700530 msg = &channel->close_msg.msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700531
Haiyang Zhangc50f7fb2010-11-08 14:04:38 -0800532 msg->header.msgtype = CHANNELMSG_CLOSECHANNEL;
533 msg->child_relid = channel->offermsg.child_relid;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700534
Haiyang Zhangc6977672011-01-26 12:12:08 -0800535 ret = vmbus_post_msg(msg, sizeof(struct vmbus_channel_close_channel));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700536
K. Y. Srinivasane728a122014-08-27 16:25:33 -0700537 if (ret) {
538 pr_err("Close failed: close post msg return is %d\n", ret);
539 /*
540 * If we failed to post the close msg,
541 * it is perhaps better to leak memory.
542 */
543 return;
544 }
545
Bill Pemberton454f18a2009-07-27 16:47:24 -0400546 /* Tear down the gpadl for the channel's ring buffer */
K. Y. Srinivasane728a122014-08-27 16:25:33 -0700547 if (channel->ringbuffer_gpadlhandle) {
548 ret = vmbus_teardown_gpadl(channel,
549 channel->ringbuffer_gpadlhandle);
550 if (ret) {
551 pr_err("Close failed: teardown gpadl return %d\n", ret);
552 /*
553 * If we failed to teardown gpadl,
554 * it is perhaps better to leak memory.
555 */
556 return;
557 }
558 }
Hank Janssen3e7ee492009-07-13 16:02:34 -0700559
Bill Pemberton454f18a2009-07-27 16:47:24 -0400560 /* Cleanup the ring buffers for this channel */
K. Y. Srinivasan2dba6882011-05-10 07:55:22 -0700561 hv_ringbuffer_cleanup(&channel->outbound);
562 hv_ringbuffer_cleanup(&channel->inbound);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700563
K. Y. Srinivasandf3493e2011-02-11 09:59:00 -0800564 free_pages((unsigned long)channel->ringbuffer_pages,
565 get_order(channel->ringbuffer_pagecount * PAGE_SIZE));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700566}
Greg Kroah-Hartman70bfa302010-10-21 09:52:22 -0700567EXPORT_SYMBOL_GPL(vmbus_close);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700568
Hank Janssenc88c4e42010-05-04 15:55:05 -0700569/**
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700570 * vmbus_sendpacket() - Send the specified buffer on the given channel
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700571 * @channel: Pointer to vmbus_channel structure.
572 * @buffer: Pointer to the buffer you want to receive the data into.
573 * @bufferlen: Maximum size of what the the buffer will hold
574 * @requestid: Identifier of the request
575 * @type: Type of packet that is being send e.g. negotiate, time
Hank Janssenc88c4e42010-05-04 15:55:05 -0700576 * packet etc.
577 *
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700578 * Sends data in @buffer directly to hyper-v via the vmbus
Hank Janssenc88c4e42010-05-04 15:55:05 -0700579 * This will send the data unparsed to hyper-v.
580 *
581 * Mainly used by Hyper-V drivers.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700582 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700583int vmbus_sendpacket(struct vmbus_channel *channel, const void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700584 u32 bufferlen, u64 requestid,
585 enum vmbus_packet_type type, u32 flags)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700586{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700587 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700588 u32 packetlen = sizeof(struct vmpacket_descriptor) + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100589 u32 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700590 struct scatterlist bufferlist[3];
591 u64 aligned_data = 0;
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700592 int ret;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700593
Hank Janssen3e7ee492009-07-13 16:02:34 -0700594
Bill Pemberton454f18a2009-07-27 16:47:24 -0400595 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800596 desc.type = type; /* VmbusPacketTypeDataInBand; */
597 desc.flags = flags; /* VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED; */
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700598 /* in 8-bytes granularity */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800599 desc.offset8 = sizeof(struct vmpacket_descriptor) >> 3;
600 desc.len8 = (u16)(packetlen_aligned >> 3);
601 desc.trans_id = requestid;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700602
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700603 sg_init_table(bufferlist, 3);
604 sg_set_buf(&bufferlist[0], &desc, sizeof(struct vmpacket_descriptor));
605 sg_set_buf(&bufferlist[1], buffer, bufferlen);
606 sg_set_buf(&bufferlist[2], &aligned_data,
607 packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700608
K. Y. Srinivasan633c4dc2011-05-10 07:55:23 -0700609 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700610
K. Y. Srinivasandecc49d2011-05-10 07:55:26 -0700611 if (ret == 0 && !hv_get_ringbuffer_interrupt_mask(&channel->outbound))
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700612 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700613
Hank Janssen3e7ee492009-07-13 16:02:34 -0700614 return ret;
615}
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700616EXPORT_SYMBOL(vmbus_sendpacket);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700617
Hank Janssen3e189512010-03-04 22:11:00 +0000618/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700619 * vmbus_sendpacket_pagebuffer - Send a range of single-page buffer
Hank Janssen3e189512010-03-04 22:11:00 +0000620 * packets using a GPADL Direct packet type.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700621 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700622int vmbus_sendpacket_pagebuffer(struct vmbus_channel *channel,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700623 struct hv_page_buffer pagebuffers[],
624 u32 pagecount, void *buffer, u32 bufferlen,
625 u64 requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700626{
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700627 int ret;
628 int i;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000629 struct vmbus_channel_packet_page_buffer desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700630 u32 descsize;
631 u32 packetlen;
632 u32 packetlen_aligned;
633 struct scatterlist bufferlist[3];
634 u64 aligned_data = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700635
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700636 if (pagecount > MAX_PAGE_BUFFER_COUNT)
Bill Pemberton002b53e2010-05-05 15:27:39 -0400637 return -EINVAL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700638
Hank Janssen3e7ee492009-07-13 16:02:34 -0700639
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700640 /*
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000641 * Adjust the size down since vmbus_channel_packet_page_buffer is the
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700642 * largest size we support
643 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700644 descsize = sizeof(struct vmbus_channel_packet_page_buffer) -
645 ((MAX_PAGE_BUFFER_COUNT - pagecount) *
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700646 sizeof(struct hv_page_buffer));
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700647 packetlen = descsize + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100648 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700649
Bill Pemberton454f18a2009-07-27 16:47:24 -0400650 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800651 desc.type = VM_PKT_DATA_USING_GPA_DIRECT;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000652 desc.flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700653 desc.dataoffset8 = descsize >> 3; /* in 8-bytes grandularity */
654 desc.length8 = (u16)(packetlen_aligned >> 3);
655 desc.transactionid = requestid;
656 desc.rangecount = pagecount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700657
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700658 for (i = 0; i < pagecount; i++) {
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800659 desc.range[i].len = pagebuffers[i].len;
660 desc.range[i].offset = pagebuffers[i].offset;
661 desc.range[i].pfn = pagebuffers[i].pfn;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700662 }
663
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700664 sg_init_table(bufferlist, 3);
665 sg_set_buf(&bufferlist[0], &desc, descsize);
666 sg_set_buf(&bufferlist[1], buffer, bufferlen);
667 sg_set_buf(&bufferlist[2], &aligned_data,
668 packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700669
K. Y. Srinivasan633c4dc2011-05-10 07:55:23 -0700670 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700671
K. Y. Srinivasandecc49d2011-05-10 07:55:26 -0700672 if (ret == 0 && !hv_get_ringbuffer_interrupt_mask(&channel->outbound))
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700673 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700674
Hank Janssen3e7ee492009-07-13 16:02:34 -0700675 return ret;
676}
Greg Kroah-Hartman713efeb2010-10-21 09:29:54 -0700677EXPORT_SYMBOL_GPL(vmbus_sendpacket_pagebuffer);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700678
Hank Janssen3e189512010-03-04 22:11:00 +0000679/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700680 * vmbus_sendpacket_multipagebuffer - Send a multi-page buffer packet
Hank Janssen3e189512010-03-04 22:11:00 +0000681 * using a GPADL Direct packet type.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700682 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700683int vmbus_sendpacket_multipagebuffer(struct vmbus_channel *channel,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700684 struct hv_multipage_buffer *multi_pagebuffer,
685 void *buffer, u32 bufferlen, u64 requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700686{
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700687 int ret;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000688 struct vmbus_channel_packet_multipage_buffer desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700689 u32 descsize;
690 u32 packetlen;
691 u32 packetlen_aligned;
692 struct scatterlist bufferlist[3];
693 u64 aligned_data = 0;
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800694 u32 pfncount = NUM_PAGES_SPANNED(multi_pagebuffer->offset,
695 multi_pagebuffer->len);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700696
Hank Janssen3e7ee492009-07-13 16:02:34 -0700697
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700698 if ((pfncount < 0) || (pfncount > MAX_MULTIPAGE_BUFFER_COUNT))
Bill Pemberton002b53e2010-05-05 15:27:39 -0400699 return -EINVAL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700700
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700701 /*
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000702 * Adjust the size down since vmbus_channel_packet_multipage_buffer is
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700703 * the largest size we support
704 */
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700705 descsize = sizeof(struct vmbus_channel_packet_multipage_buffer) -
706 ((MAX_MULTIPAGE_BUFFER_COUNT - pfncount) *
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700707 sizeof(u64));
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700708 packetlen = descsize + bufferlen;
Uwe Kleine-König73509682011-01-20 09:32:01 +0100709 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700710
Hank Janssen3e7ee492009-07-13 16:02:34 -0700711
Bill Pemberton454f18a2009-07-27 16:47:24 -0400712 /* Setup the descriptor */
Haiyang Zhang415f2282011-01-26 12:12:13 -0800713 desc.type = VM_PKT_DATA_USING_GPA_DIRECT;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000714 desc.flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700715 desc.dataoffset8 = descsize >> 3; /* in 8-bytes grandularity */
716 desc.length8 = (u16)(packetlen_aligned >> 3);
717 desc.transactionid = requestid;
Haiyang Zhang430a8e92010-09-20 21:07:51 +0000718 desc.rangecount = 1;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700719
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800720 desc.range.len = multi_pagebuffer->len;
721 desc.range.offset = multi_pagebuffer->offset;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700722
Haiyang Zhangca623ad2011-01-26 12:12:11 -0800723 memcpy(desc.range.pfn_array, multi_pagebuffer->pfn_array,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700724 pfncount * sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700725
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700726 sg_init_table(bufferlist, 3);
727 sg_set_buf(&bufferlist[0], &desc, descsize);
728 sg_set_buf(&bufferlist[1], buffer, bufferlen);
729 sg_set_buf(&bufferlist[2], &aligned_data,
730 packetlen_aligned - packetlen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700731
K. Y. Srinivasan633c4dc2011-05-10 07:55:23 -0700732 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700733
K. Y. Srinivasandecc49d2011-05-10 07:55:26 -0700734 if (ret == 0 && !hv_get_ringbuffer_interrupt_mask(&channel->outbound))
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700735 vmbus_setevent(channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700736
Hank Janssen3e7ee492009-07-13 16:02:34 -0700737 return ret;
738}
Greg Kroah-Hartman4cb106f2010-10-21 09:23:59 -0700739EXPORT_SYMBOL_GPL(vmbus_sendpacket_multipagebuffer);
Hank Janssenc88c4e42010-05-04 15:55:05 -0700740
741/**
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700742 * vmbus_recvpacket() - Retrieve the user packet on the specified channel
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700743 * @channel: Pointer to vmbus_channel structure.
744 * @buffer: Pointer to the buffer you want to receive the data into.
745 * @bufferlen: Maximum size of what the the buffer will hold
746 * @buffer_actual_len: The actual size of the data after it was received
747 * @requestid: Identifier of the request
Hank Janssenc88c4e42010-05-04 15:55:05 -0700748 *
749 * Receives directly from the hyper-v vmbus and puts the data it received
750 * into Buffer. This will receive the data unparsed from hyper-v.
751 *
752 * Mainly used by Hyper-V drivers.
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700753 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700754int vmbus_recvpacket(struct vmbus_channel *channel, void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700755 u32 bufferlen, u32 *buffer_actual_len, u64 *requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700756{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700757 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700758 u32 packetlen;
759 u32 userlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700760 int ret;
761
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700762 *buffer_actual_len = 0;
763 *requestid = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700764
Hank Janssen3e7ee492009-07-13 16:02:34 -0700765
K. Y. Srinivasana89186c2011-05-10 07:55:24 -0700766 ret = hv_ringbuffer_peek(&channel->inbound, &desc,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700767 sizeof(struct vmpacket_descriptor));
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700768 if (ret != 0)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700769 return 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700770
Haiyang Zhang415f2282011-01-26 12:12:13 -0800771 packetlen = desc.len8 << 3;
772 userlen = packetlen - (desc.offset8 << 3);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700773
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700774 *buffer_actual_len = userlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700775
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700776 if (userlen > bufferlen) {
Hank Janssen3e7ee492009-07-13 16:02:34 -0700777
Hank Janssen0a466182011-03-29 13:58:47 -0700778 pr_err("Buffer too small - got %d needs %d\n",
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700779 bufferlen, userlen);
K. Y. Srinivasan926ae522011-06-06 15:50:11 -0700780 return -ETOOSMALL;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700781 }
782
Haiyang Zhang415f2282011-01-26 12:12:13 -0800783 *requestid = desc.trans_id;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700784
Bill Pemberton454f18a2009-07-27 16:47:24 -0400785 /* Copy over the packet to the user buffer */
K. Y. Srinivasan38397c82011-05-10 07:55:25 -0700786 ret = hv_ringbuffer_read(&channel->inbound, buffer, userlen,
Haiyang Zhang415f2282011-01-26 12:12:13 -0800787 (desc.offset8 << 3));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700788
Hank Janssen3e7ee492009-07-13 16:02:34 -0700789
Hank Janssen3e7ee492009-07-13 16:02:34 -0700790 return 0;
791}
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700792EXPORT_SYMBOL(vmbus_recvpacket);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700793
Hank Janssen3e189512010-03-04 22:11:00 +0000794/*
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700795 * vmbus_recvpacket_raw - Retrieve the raw packet on the specified channel
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700796 */
Haiyang Zhangfff41b22010-10-07 11:40:08 -0700797int vmbus_recvpacket_raw(struct vmbus_channel *channel, void *buffer,
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700798 u32 bufferlen, u32 *buffer_actual_len,
799 u64 *requestid)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700800{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700801 struct vmpacket_descriptor desc;
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700802 u32 packetlen;
803 u32 userlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700804 int ret;
805
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700806 *buffer_actual_len = 0;
807 *requestid = 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700808
Hank Janssen3e7ee492009-07-13 16:02:34 -0700809
K. Y. Srinivasana89186c2011-05-10 07:55:24 -0700810 ret = hv_ringbuffer_peek(&channel->inbound, &desc,
Greg Kroah-Hartmanf4266e32009-09-01 17:24:57 -0700811 sizeof(struct vmpacket_descriptor));
K. Y. Srinivasandad76bf2011-08-27 11:31:33 -0700812 if (ret != 0)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700813 return 0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700814
Hank Janssen3e7ee492009-07-13 16:02:34 -0700815
Haiyang Zhang415f2282011-01-26 12:12:13 -0800816 packetlen = desc.len8 << 3;
817 userlen = packetlen - (desc.offset8 << 3);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700818
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700819 *buffer_actual_len = packetlen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700820
Haiyang Zhang39d70a42010-09-30 10:52:13 -0700821 if (packetlen > bufferlen) {
Hank Janssen0a466182011-03-29 13:58:47 -0700822 pr_err("Buffer too small - needed %d bytes but "
823 "got space for only %d bytes\n",
824 packetlen, bufferlen);
K. Y. Srinivasan3d5cad92011-08-25 09:48:59 -0700825 return -ENOBUFS;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700826 }
827
Haiyang Zhang415f2282011-01-26 12:12:13 -0800828 *requestid = desc.trans_id;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700829
Bill Pemberton454f18a2009-07-27 16:47:24 -0400830 /* Copy over the entire packet to the user buffer */
K. Y. Srinivasan38397c82011-05-10 07:55:25 -0700831 ret = hv_ringbuffer_read(&channel->inbound, buffer, packetlen, 0);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700832
Hank Janssen3e7ee492009-07-13 16:02:34 -0700833 return 0;
834}
Greg Kroah-Hartmanadaee6b2010-10-21 09:09:23 -0700835EXPORT_SYMBOL_GPL(vmbus_recvpacket_raw);