]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/staging/hv/channel.c
Staging: hv: fix up driver registering mess
[mirror_ubuntu-bionic-kernel.git] / drivers / staging / hv / channel.c
CommitLineData
3e7ee490 1/*
3e7ee490
HJ
2 * 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>
3e7ee490 20 */
0a46618d
HJ
21#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
22
5654e932 23#include <linux/kernel.h>
0c3b7b2f
S
24#include <linux/sched.h>
25#include <linux/wait.h>
a0086dc5 26#include <linux/mm.h>
5a0e3ad6 27#include <linux/slab.h>
c88c4e4c 28#include <linux/module.h>
3f335ea2
S
29
30#include "hyperv.h"
0f2a6619 31#include "hyperv_vmbus.h"
3e7ee490 32
e3fe0bb6
S
33#define NUM_PAGES_SPANNED(addr, len) \
34((PAGE_ALIGN(addr + len) >> PAGE_SHIFT) - (addr >> PAGE_SHIFT))
35
454f18a9 36/* Internal routines */
fff41b2e 37static int create_gpadl_header(
39d70a4a
HZ
38 void *kbuffer, /* must be phys and virt contiguous */
39 u32 size, /* page-size multiple */
40 struct vmbus_channel_msginfo **msginfo,
41 u32 *messagecount);
fff41b2e 42static void vmbus_setevent(struct vmbus_channel *channel);
3e7ee490 43
3e189519 44/*
fff41b2e 45 * vmbus_setevent- Trigger an event notification on the specified
3e189519 46 * channel.
f4266e34 47 */
fff41b2e 48static void vmbus_setevent(struct vmbus_channel *channel)
3e7ee490 49{
39d70a4a 50 struct hv_monitor_page *monitorpage;
3e7ee490 51
c50f7fb2 52 if (channel->offermsg.monitor_allocated) {
454f18a9 53 /* Each u32 represents 32 channels */
22356585 54 sync_set_bit(channel->offermsg.child_relid & 31,
da9fcb72 55 (unsigned long *) vmbus_connection.send_int_page +
c50f7fb2 56 (channel->offermsg.child_relid >> 5));
3e7ee490 57
da9fcb72 58 monitorpage = vmbus_connection.monitor_pages;
39d70a4a 59 monitorpage++; /* Get the child to parent monitor page */
3e7ee490 60
22356585 61 sync_set_bit(channel->monitor_bit,
f6feebe0
HZ
62 (unsigned long *)&monitorpage->trigger_group
63 [channel->monitor_grp].pending);
7c369f40 64
f4266e34 65 } else {
c6977677 66 vmbus_set_event(channel->offermsg.child_relid);
3e7ee490 67 }
3e7ee490
HJ
68}
69
3e189519 70/*
fff41b2e 71 * vmbus_get_debug_info -Retrieve various channel debug info
f4266e34 72 */
fff41b2e 73void vmbus_get_debug_info(struct vmbus_channel *channel,
39d70a4a 74 struct vmbus_channel_debug_info *debuginfo)
3e7ee490 75{
39d70a4a 76 struct hv_monitor_page *monitorpage;
c50f7fb2
HZ
77 u8 monitor_group = (u8)channel->offermsg.monitorid / 32;
78 u8 monitor_offset = (u8)channel->offermsg.monitorid % 32;
454f18a9 79 /* u32 monitorBit = 1 << monitorOffset; */
3e7ee490 80
c50f7fb2
HZ
81 debuginfo->relid = channel->offermsg.child_relid;
82 debuginfo->state = channel->state;
83 memcpy(&debuginfo->interfacetype,
358d2ee2 84 &channel->offermsg.offer.if_type, sizeof(uuid_le));
c50f7fb2 85 memcpy(&debuginfo->interface_instance,
767dff68 86 &channel->offermsg.offer.if_instance,
358d2ee2 87 sizeof(uuid_le));
3e7ee490 88
da9fcb72 89 monitorpage = (struct hv_monitor_page *)vmbus_connection.monitor_pages;
3e7ee490 90
c50f7fb2 91 debuginfo->monitorid = channel->offermsg.monitorid;
3e7ee490 92
c50f7fb2 93 debuginfo->servermonitor_pending =
f6feebe0 94 monitorpage->trigger_group[monitor_group].pending;
c50f7fb2 95 debuginfo->servermonitor_latency =
f6feebe0 96 monitorpage->latency[monitor_group][monitor_offset];
c50f7fb2 97 debuginfo->servermonitor_connectionid =
f6feebe0
HZ
98 monitorpage->parameter[monitor_group]
99 [monitor_offset].connectionid.u.id;
3e7ee490 100
39d70a4a 101 monitorpage++;
3e7ee490 102
c50f7fb2 103 debuginfo->clientmonitor_pending =
f6feebe0 104 monitorpage->trigger_group[monitor_group].pending;
c50f7fb2 105 debuginfo->clientmonitor_latency =
f6feebe0 106 monitorpage->latency[monitor_group][monitor_offset];
c50f7fb2 107 debuginfo->clientmonitor_connectionid =
f6feebe0
HZ
108 monitorpage->parameter[monitor_group]
109 [monitor_offset].connectionid.u.id;
3e7ee490 110
a75b61d5
S
111 hv_ringbuffer_get_debuginfo(&channel->inbound, &debuginfo->inbound);
112 hv_ringbuffer_get_debuginfo(&channel->outbound, &debuginfo->outbound);
3e7ee490
HJ
113}
114
3e189519 115/*
fff41b2e 116 * vmbus_open - Open the specified channel.
f4266e34 117 */
fff41b2e 118int vmbus_open(struct vmbus_channel *newchannel, u32 send_ringbuffer_size,
39d70a4a
HZ
119 u32 recv_ringbuffer_size, void *userdata, u32 userdatalen,
120 void (*onchannelcallback)(void *context), void *context)
3e7ee490 121{
82250213 122 struct vmbus_channel_open_channel *openMsg;
b94ef345 123 struct vmbus_channel_msginfo *openInfo = NULL;
3e7ee490 124 void *in, *out;
dd0813b6 125 unsigned long flags;
9568a193 126 int ret, t, err = 0;
3e7ee490 127
c50f7fb2
HZ
128 newchannel->onchannel_callback = onchannelcallback;
129 newchannel->channel_callback_context = context;
3e7ee490 130
454f18a9 131 /* Allocate the ring buffer */
df3493e0
S
132 out = (void *)__get_free_pages(GFP_KERNEL|__GFP_ZERO,
133 get_order(send_ringbuffer_size + recv_ringbuffer_size));
134
7e052d98
BP
135 if (!out)
136 return -ENOMEM;
137
3e7ee490 138
39d70a4a 139 in = (void *)((unsigned long)out + send_ringbuffer_size);
3e7ee490 140
c50f7fb2
HZ
141 newchannel->ringbuffer_pages = out;
142 newchannel->ringbuffer_pagecount = (send_ringbuffer_size +
39d70a4a 143 recv_ringbuffer_size) >> PAGE_SHIFT;
3e7ee490 144
72a95cbc
S
145 ret = hv_ringbuffer_init(
146 &newchannel->outbound, out, send_ringbuffer_size);
147
fd4dc88e 148 if (ret != 0) {
3324fb40
BP
149 err = ret;
150 goto errorout;
151 }
152
72a95cbc
S
153 ret = hv_ringbuffer_init(
154 &newchannel->inbound, in, recv_ringbuffer_size);
fd4dc88e 155 if (ret != 0) {
3324fb40
BP
156 err = ret;
157 goto errorout;
158 }
3e7ee490 159
3e7ee490 160
454f18a9 161 /* Establish the gpadl for the ring buffer */
c50f7fb2 162 newchannel->ringbuffer_gpadlhandle = 0;
3e7ee490 163
fff41b2e 164 ret = vmbus_establish_gpadl(newchannel,
82f8bd40 165 newchannel->outbound.ring_buffer,
39d70a4a
HZ
166 send_ringbuffer_size +
167 recv_ringbuffer_size,
c50f7fb2 168 &newchannel->ringbuffer_gpadlhandle);
b94ef345 169
fd4dc88e 170 if (ret != 0) {
b94ef345
BP
171 err = ret;
172 goto errorout;
173 }
f4266e34 174
454f18a9 175 /* Create and init the channel open message */
f4266e34
GKH
176 openInfo = kmalloc(sizeof(*openInfo) +
177 sizeof(struct vmbus_channel_open_channel),
178 GFP_KERNEL);
c3bf2e26
BP
179 if (!openInfo) {
180 err = -ENOMEM;
181 goto errorout;
182 }
3e7ee490 183
9568a193 184 init_completion(&openInfo->waitevent);
3e7ee490 185
c50f7fb2
HZ
186 openMsg = (struct vmbus_channel_open_channel *)openInfo->msg;
187 openMsg->header.msgtype = CHANNELMSG_OPENCHANNEL;
f27df643 188 openMsg->openid = newchannel->offermsg.child_relid;
c50f7fb2
HZ
189 openMsg->child_relid = newchannel->offermsg.child_relid;
190 openMsg->ringbuffer_gpadlhandle = newchannel->ringbuffer_gpadlhandle;
191 openMsg->downstream_ringbuffer_pageoffset = send_ringbuffer_size >>
f4266e34 192 PAGE_SHIFT;
f27df643 193 openMsg->server_contextarea_gpadlhandle = 0;
3e7ee490 194
39d70a4a 195 if (userdatalen > MAX_USER_DEFINED_BYTES) {
c827f944
BP
196 err = -EINVAL;
197 goto errorout;
198 }
199
39d70a4a 200 if (userdatalen)
c50f7fb2 201 memcpy(openMsg->userdata, userdata, userdatalen);
3e7ee490 202
15b2f647 203 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
c50f7fb2 204 list_add_tail(&openInfo->msglistentry,
da9fcb72 205 &vmbus_connection.chn_msg_list);
15b2f647 206 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 207
c6977677 208 ret = vmbus_post_msg(openMsg,
f4266e34 209 sizeof(struct vmbus_channel_open_channel));
98e08702
HJ
210
211 if (ret != 0)
00d760b0 212 goto cleanup;
3e7ee490 213
2dfde964 214 t = wait_for_completion_timeout(&openInfo->waitevent, 5*HZ);
9568a193 215 if (t == 0) {
0c3b7b2f
S
216 err = -ETIMEDOUT;
217 goto errorout;
218 }
219
3e7ee490 220
98e08702
HJ
221 if (openInfo->response.open_result.status)
222 err = openInfo->response.open_result.status;
3e7ee490 223
00d760b0 224cleanup:
15b2f647 225 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
c50f7fb2 226 list_del(&openInfo->msglistentry);
15b2f647 227 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 228
8c69f52a 229 kfree(openInfo);
98e08702 230 return err;
c3bf2e26
BP
231
232errorout:
2dba688b
S
233 hv_ringbuffer_cleanup(&newchannel->outbound);
234 hv_ringbuffer_cleanup(&newchannel->inbound);
df3493e0
S
235 free_pages((unsigned long)out,
236 get_order(send_ringbuffer_size + recv_ringbuffer_size));
c3bf2e26
BP
237 kfree(openInfo);
238 return err;
3e7ee490 239}
36ceadfc 240EXPORT_SYMBOL_GPL(vmbus_open);
3e7ee490 241
3e189519 242/*
fff41b2e 243 * dump_gpadl_body - Dump the gpadl body message to the console for
3e189519 244 * debugging purposes.
f4266e34 245 */
fff41b2e 246static void dump_gpadl_body(struct vmbus_channel_gpadl_body *gpadl, u32 len)
3e7ee490 247{
f4266e34 248 int i;
39d70a4a 249 int pfncount;
3e7ee490 250
39d70a4a 251 pfncount = (len - sizeof(struct vmbus_channel_gpadl_body)) /
f4266e34 252 sizeof(u64);
98e08702 253
39d70a4a 254 DPRINT_DBG(VMBUS, "gpadl body - len %d pfn count %d", len, pfncount);
3e7ee490 255
39d70a4a 256 for (i = 0; i < pfncount; i++)
f4266e34 257 DPRINT_DBG(VMBUS, "gpadl body - %d) pfn %llu",
c50f7fb2 258 i, gpadl->pfn[i]);
3e7ee490
HJ
259}
260
3e189519 261/*
fff41b2e 262 * dump_gpadl_header - Dump the gpadl header message to the console for
3e189519 263 * debugging purposes.
f4266e34 264 */
fff41b2e 265static void dump_gpadl_header(struct vmbus_channel_gpadl_header *gpadl)
3e7ee490 266{
f4266e34 267 int i, j;
39d70a4a 268 int pagecount;
3e7ee490 269
f4266e34
GKH
270 DPRINT_DBG(VMBUS,
271 "gpadl header - relid %d, range count %d, range buflen %d",
c50f7fb2
HZ
272 gpadl->child_relid, gpadl->rangecount, gpadl->range_buflen);
273 for (i = 0; i < gpadl->rangecount; i++) {
415f2287 274 pagecount = gpadl->range[i].byte_count >> PAGE_SHIFT;
39d70a4a 275 pagecount = (pagecount > 26) ? 26 : pagecount;
3e7ee490 276
f4266e34 277 DPRINT_DBG(VMBUS, "gpadl range %d - len %d offset %d "
415f2287
HZ
278 "page count %d", i, gpadl->range[i].byte_count,
279 gpadl->range[i].byte_offset, pagecount);
3e7ee490 280
39d70a4a 281 for (j = 0; j < pagecount; j++)
f4266e34 282 DPRINT_DBG(VMBUS, "%d) pfn %llu", j,
415f2287 283 gpadl->range[i].pfn_array[j]);
3e7ee490
HJ
284 }
285}
286
3e189519 287/*
fff41b2e 288 * create_gpadl_header - Creates a gpadl for the specified buffer
f4266e34 289 */
fff41b2e 290static int create_gpadl_header(void *kbuffer, u32 size,
39d70a4a
HZ
291 struct vmbus_channel_msginfo **msginfo,
292 u32 *messagecount)
3e7ee490
HJ
293{
294 int i;
39d70a4a 295 int pagecount;
f4266e34 296 unsigned long long pfn;
39d70a4a
HZ
297 struct vmbus_channel_gpadl_header *gpadl_header;
298 struct vmbus_channel_gpadl_body *gpadl_body;
299 struct vmbus_channel_msginfo *msgheader;
300 struct vmbus_channel_msginfo *msgbody = NULL;
301 u32 msgsize;
3e7ee490 302
39d70a4a 303 int pfnsum, pfncount, pfnleft, pfncurr, pfnsize;
3e7ee490 304
39d70a4a
HZ
305 pagecount = size >> PAGE_SHIFT;
306 pfn = virt_to_phys(kbuffer) >> PAGE_SHIFT;
3e7ee490 307
454f18a9 308 /* do we need a gpadl body msg */
39d70a4a 309 pfnsize = MAX_SIZE_CHANNEL_MESSAGE -
f4266e34
GKH
310 sizeof(struct vmbus_channel_gpadl_header) -
311 sizeof(struct gpa_range);
39d70a4a 312 pfncount = pfnsize / sizeof(u64);
3e7ee490 313
39d70a4a 314 if (pagecount > pfncount) {
f4266e34 315 /* we need a gpadl body */
454f18a9 316 /* fill in the header */
39d70a4a 317 msgsize = sizeof(struct vmbus_channel_msginfo) +
f4266e34 318 sizeof(struct vmbus_channel_gpadl_header) +
39d70a4a
HZ
319 sizeof(struct gpa_range) + pfncount * sizeof(u64);
320 msgheader = kzalloc(msgsize, GFP_KERNEL);
321 if (!msgheader)
d1c250bb 322 goto nomem;
3e7ee490 323
c50f7fb2
HZ
324 INIT_LIST_HEAD(&msgheader->submsglist);
325 msgheader->msgsize = msgsize;
3e7ee490 326
39d70a4a 327 gpadl_header = (struct vmbus_channel_gpadl_header *)
c50f7fb2
HZ
328 msgheader->msg;
329 gpadl_header->rangecount = 1;
330 gpadl_header->range_buflen = sizeof(struct gpa_range) +
39d70a4a 331 pagecount * sizeof(u64);
415f2287
HZ
332 gpadl_header->range[0].byte_offset = 0;
333 gpadl_header->range[0].byte_count = size;
39d70a4a 334 for (i = 0; i < pfncount; i++)
415f2287 335 gpadl_header->range[0].pfn_array[i] = pfn+i;
39d70a4a
HZ
336 *msginfo = msgheader;
337 *messagecount = 1;
3e7ee490 338
39d70a4a
HZ
339 pfnsum = pfncount;
340 pfnleft = pagecount - pfncount;
3e7ee490 341
454f18a9 342 /* how many pfns can we fit */
39d70a4a 343 pfnsize = MAX_SIZE_CHANNEL_MESSAGE -
f4266e34 344 sizeof(struct vmbus_channel_gpadl_body);
39d70a4a 345 pfncount = pfnsize / sizeof(u64);
3e7ee490 346
454f18a9 347 /* fill in the body */
39d70a4a
HZ
348 while (pfnleft) {
349 if (pfnleft > pfncount)
350 pfncurr = pfncount;
3e7ee490 351 else
39d70a4a 352 pfncurr = pfnleft;
3e7ee490 353
39d70a4a 354 msgsize = sizeof(struct vmbus_channel_msginfo) +
f4266e34 355 sizeof(struct vmbus_channel_gpadl_body) +
39d70a4a
HZ
356 pfncurr * sizeof(u64);
357 msgbody = kzalloc(msgsize, GFP_KERNEL);
f38cf9cc
S
358
359 if (!msgbody) {
360 struct vmbus_channel_msginfo *pos = NULL;
361 struct vmbus_channel_msginfo *tmp = NULL;
362 /*
363 * Free up all the allocated messages.
364 */
365 list_for_each_entry_safe(pos, tmp,
366 &msgheader->submsglist,
367 msglistentry) {
368
369 list_del(&pos->msglistentry);
370 kfree(pos);
371 }
372
d1c250bb 373 goto nomem;
f38cf9cc
S
374 }
375
c50f7fb2 376 msgbody->msgsize = msgsize;
39d70a4a
HZ
377 (*messagecount)++;
378 gpadl_body =
c50f7fb2 379 (struct vmbus_channel_gpadl_body *)msgbody->msg;
f4266e34
GKH
380
381 /*
f4266e34
GKH
382 * Gpadl is u32 and we are using a pointer which could
383 * be 64-bit
f27df643
S
384 * This is governed by the guest/host protocol and
385 * so the hypervisor gurantees that this is ok.
f4266e34 386 */
39d70a4a 387 for (i = 0; i < pfncurr; i++)
c50f7fb2 388 gpadl_body->pfn[i] = pfn + pfnsum + i;
3e7ee490 389
454f18a9 390 /* add to msg header */
c50f7fb2
HZ
391 list_add_tail(&msgbody->msglistentry,
392 &msgheader->submsglist);
39d70a4a
HZ
393 pfnsum += pfncurr;
394 pfnleft -= pfncurr;
3e7ee490 395 }
f4266e34 396 } else {
454f18a9 397 /* everything fits in a header */
39d70a4a 398 msgsize = sizeof(struct vmbus_channel_msginfo) +
f4266e34 399 sizeof(struct vmbus_channel_gpadl_header) +
39d70a4a
HZ
400 sizeof(struct gpa_range) + pagecount * sizeof(u64);
401 msgheader = kzalloc(msgsize, GFP_KERNEL);
402 if (msgheader == NULL)
e3eb7cdd 403 goto nomem;
c50f7fb2 404 msgheader->msgsize = msgsize;
39d70a4a
HZ
405
406 gpadl_header = (struct vmbus_channel_gpadl_header *)
c50f7fb2
HZ
407 msgheader->msg;
408 gpadl_header->rangecount = 1;
409 gpadl_header->range_buflen = sizeof(struct gpa_range) +
39d70a4a 410 pagecount * sizeof(u64);
415f2287
HZ
411 gpadl_header->range[0].byte_offset = 0;
412 gpadl_header->range[0].byte_count = size;
39d70a4a 413 for (i = 0; i < pagecount; i++)
415f2287 414 gpadl_header->range[0].pfn_array[i] = pfn+i;
39d70a4a
HZ
415
416 *msginfo = msgheader;
417 *messagecount = 1;
3e7ee490
HJ
418 }
419
420 return 0;
d1c250bb 421nomem:
39d70a4a
HZ
422 kfree(msgheader);
423 kfree(msgbody);
d1c250bb 424 return -ENOMEM;
3e7ee490
HJ
425}
426
3e189519 427/*
fff41b2e 428 * vmbus_establish_gpadl - Estabish a GPADL for the specified buffer
f4266e34 429 *
39d70a4a
HZ
430 * @channel: a channel
431 * @kbuffer: from kmalloc
432 * @size: page-size multiple
433 * @gpadl_handle: some funky thing
f4266e34 434 */
fff41b2e 435int vmbus_establish_gpadl(struct vmbus_channel *channel, void *kbuffer,
39d70a4a 436 u32 size, u32 *gpadl_handle)
3e7ee490 437{
39d70a4a
HZ
438 struct vmbus_channel_gpadl_header *gpadlmsg;
439 struct vmbus_channel_gpadl_body *gpadl_body;
82250213 440 /* struct vmbus_channel_gpadl_created *gpadlCreated; */
39d70a4a
HZ
441 struct vmbus_channel_msginfo *msginfo = NULL;
442 struct vmbus_channel_msginfo *submsginfo;
443 u32 msgcount;
53af545b 444 struct list_head *curr;
39d70a4a 445 u32 next_gpadl_handle;
dd0813b6 446 unsigned long flags;
c3bf2e26 447 int ret = 0;
9568a193 448 int t;
3e7ee490 449
da9fcb72
HZ
450 next_gpadl_handle = atomic_read(&vmbus_connection.next_gpadl_handle);
451 atomic_inc(&vmbus_connection.next_gpadl_handle);
3e7ee490 452
fff41b2e 453 ret = create_gpadl_header(kbuffer, size, &msginfo, &msgcount);
c3bf2e26
BP
454 if (ret)
455 return ret;
3e7ee490 456
9568a193 457 init_completion(&msginfo->waitevent);
c3bf2e26 458
c50f7fb2
HZ
459 gpadlmsg = (struct vmbus_channel_gpadl_header *)msginfo->msg;
460 gpadlmsg->header.msgtype = CHANNELMSG_GPADL_HEADER;
461 gpadlmsg->child_relid = channel->offermsg.child_relid;
462 gpadlmsg->gpadl = next_gpadl_handle;
3e7ee490 463
fff41b2e 464 dump_gpadl_header(gpadlmsg);
3e7ee490 465
15b2f647 466 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
c50f7fb2 467 list_add_tail(&msginfo->msglistentry,
da9fcb72 468 &vmbus_connection.chn_msg_list);
3e7ee490 469
15b2f647 470 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 471
c6977677 472 ret = vmbus_post_msg(gpadlmsg, msginfo->msgsize -
39d70a4a 473 sizeof(*msginfo));
98e08702 474 if (ret != 0)
00d760b0 475 goto cleanup;
3e7ee490 476
39d70a4a 477 if (msgcount > 1) {
c50f7fb2 478 list_for_each(curr, &msginfo->submsglist) {
53af545b 479
39d70a4a
HZ
480 submsginfo = (struct vmbus_channel_msginfo *)curr;
481 gpadl_body =
c50f7fb2 482 (struct vmbus_channel_gpadl_body *)submsginfo->msg;
3e7ee490 483
c50f7fb2
HZ
484 gpadl_body->header.msgtype =
485 CHANNELMSG_GPADL_BODY;
486 gpadl_body->gpadl = next_gpadl_handle;
3e7ee490 487
c50f7fb2 488 dump_gpadl_body(gpadl_body, submsginfo->msgsize -
39d70a4a 489 sizeof(*submsginfo));
c6977677 490 ret = vmbus_post_msg(gpadl_body,
c50f7fb2 491 submsginfo->msgsize -
39d70a4a 492 sizeof(*submsginfo));
fd4dc88e 493 if (ret != 0)
00d760b0 494 goto cleanup;
99259159 495
3e7ee490
HJ
496 }
497 }
40961de3 498 t = wait_for_completion_timeout(&msginfo->waitevent, 5*HZ);
9568a193 499 BUG_ON(t == 0);
0c3b7b2f 500
3e7ee490 501
454f18a9 502 /* At this point, we received the gpadl created msg */
c50f7fb2 503 *gpadl_handle = gpadlmsg->gpadl;
3e7ee490 504
00d760b0 505cleanup:
15b2f647 506 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
c50f7fb2 507 list_del(&msginfo->msglistentry);
15b2f647 508 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 509
39d70a4a 510 kfree(msginfo);
3e7ee490
HJ
511 return ret;
512}
98873724 513EXPORT_SYMBOL_GPL(vmbus_establish_gpadl);
3e7ee490 514
3e189519 515/*
fff41b2e 516 * vmbus_teardown_gpadl -Teardown the specified GPADL handle
f4266e34 517 */
fff41b2e 518int vmbus_teardown_gpadl(struct vmbus_channel *channel, u32 gpadl_handle)
3e7ee490 519{
82250213 520 struct vmbus_channel_gpadl_teardown *msg;
aded7165 521 struct vmbus_channel_msginfo *info;
dd0813b6 522 unsigned long flags;
9568a193 523 int ret, t;
3e7ee490 524
39d70a4a 525 /* ASSERT(gpadl_handle != 0); */
3e7ee490 526
f4266e34
GKH
527 info = kmalloc(sizeof(*info) +
528 sizeof(struct vmbus_channel_gpadl_teardown), GFP_KERNEL);
c3bf2e26
BP
529 if (!info)
530 return -ENOMEM;
3e7ee490 531
9568a193 532 init_completion(&info->waitevent);
3e7ee490 533
c50f7fb2 534 msg = (struct vmbus_channel_gpadl_teardown *)info->msg;
3e7ee490 535
c50f7fb2
HZ
536 msg->header.msgtype = CHANNELMSG_GPADL_TEARDOWN;
537 msg->child_relid = channel->offermsg.child_relid;
538 msg->gpadl = gpadl_handle;
3e7ee490 539
15b2f647 540 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
c50f7fb2 541 list_add_tail(&info->msglistentry,
da9fcb72 542 &vmbus_connection.chn_msg_list);
15b2f647 543 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
c6977677 544 ret = vmbus_post_msg(msg,
f4266e34 545 sizeof(struct vmbus_channel_gpadl_teardown));
3e7ee490 546
0c3b7b2f 547 BUG_ON(ret != 0);
40961de3 548 t = wait_for_completion_timeout(&info->waitevent, 5*HZ);
9568a193 549 BUG_ON(t == 0);
3e7ee490 550
454f18a9 551 /* Received a torndown response */
15b2f647 552 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
c50f7fb2 553 list_del(&info->msglistentry);
15b2f647 554 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 555
8c69f52a 556 kfree(info);
3e7ee490
HJ
557 return ret;
558}
18726d7a 559EXPORT_SYMBOL_GPL(vmbus_teardown_gpadl);
3e7ee490 560
3e189519 561/*
fff41b2e 562 * vmbus_close - Close the specified channel
f4266e34 563 */
fff41b2e 564void vmbus_close(struct vmbus_channel *channel)
3e7ee490 565{
82250213 566 struct vmbus_channel_close_channel *msg;
f4266e34 567 int ret;
3e7ee490 568
454f18a9 569 /* Stop callback and cancel the timer asap */
c50f7fb2 570 channel->onchannel_callback = NULL;
3e7ee490 571
454f18a9 572 /* Send a closing message */
3e7ee490 573
e9a27a9f 574 msg = &channel->close_msg.msg;
3e7ee490 575
c50f7fb2
HZ
576 msg->header.msgtype = CHANNELMSG_CLOSECHANNEL;
577 msg->child_relid = channel->offermsg.child_relid;
3e7ee490 578
c6977677 579 ret = vmbus_post_msg(msg, sizeof(struct vmbus_channel_close_channel));
3e7ee490 580
0c3b7b2f 581 BUG_ON(ret != 0);
454f18a9 582 /* Tear down the gpadl for the channel's ring buffer */
c50f7fb2 583 if (channel->ringbuffer_gpadlhandle)
fff41b2e 584 vmbus_teardown_gpadl(channel,
c50f7fb2 585 channel->ringbuffer_gpadlhandle);
3e7ee490 586
454f18a9 587 /* Cleanup the ring buffers for this channel */
2dba688b
S
588 hv_ringbuffer_cleanup(&channel->outbound);
589 hv_ringbuffer_cleanup(&channel->inbound);
3e7ee490 590
df3493e0
S
591 free_pages((unsigned long)channel->ringbuffer_pages,
592 get_order(channel->ringbuffer_pagecount * PAGE_SIZE));
3e7ee490 593
3e7ee490 594
3e7ee490 595}
70bfa307 596EXPORT_SYMBOL_GPL(vmbus_close);
3e7ee490 597
c88c4e4c 598/**
fff41b2e 599 * vmbus_sendpacket() - Send the specified buffer on the given channel
39d70a4a
HZ
600 * @channel: Pointer to vmbus_channel structure.
601 * @buffer: Pointer to the buffer you want to receive the data into.
602 * @bufferlen: Maximum size of what the the buffer will hold
603 * @requestid: Identifier of the request
604 * @type: Type of packet that is being send e.g. negotiate, time
c88c4e4c
HJ
605 * packet etc.
606 *
39d70a4a 607 * Sends data in @buffer directly to hyper-v via the vmbus
c88c4e4c
HJ
608 * This will send the data unparsed to hyper-v.
609 *
610 * Mainly used by Hyper-V drivers.
f4266e34 611 */
fff41b2e 612int vmbus_sendpacket(struct vmbus_channel *channel, const void *buffer,
39d70a4a
HZ
613 u32 bufferlen, u64 requestid,
614 enum vmbus_packet_type type, u32 flags)
3e7ee490 615{
8dc0a06a 616 struct vmpacket_descriptor desc;
39d70a4a 617 u32 packetlen = sizeof(struct vmpacket_descriptor) + bufferlen;
73509681 618 u32 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
39d70a4a
HZ
619 struct scatterlist bufferlist[3];
620 u64 aligned_data = 0;
f4266e34 621 int ret;
3e7ee490 622
3e7ee490 623
454f18a9 624 /* Setup the descriptor */
415f2287
HZ
625 desc.type = type; /* VmbusPacketTypeDataInBand; */
626 desc.flags = flags; /* VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED; */
f4266e34 627 /* in 8-bytes granularity */
415f2287
HZ
628 desc.offset8 = sizeof(struct vmpacket_descriptor) >> 3;
629 desc.len8 = (u16)(packetlen_aligned >> 3);
630 desc.trans_id = requestid;
3e7ee490 631
39d70a4a
HZ
632 sg_init_table(bufferlist, 3);
633 sg_set_buf(&bufferlist[0], &desc, sizeof(struct vmpacket_descriptor));
634 sg_set_buf(&bufferlist[1], buffer, bufferlen);
635 sg_set_buf(&bufferlist[2], &aligned_data,
636 packetlen_aligned - packetlen);
3e7ee490 637
633c4dce 638 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3);
3e7ee490 639
decc49da 640 if (ret == 0 && !hv_get_ringbuffer_interrupt_mask(&channel->outbound))
fff41b2e 641 vmbus_setevent(channel);
3e7ee490 642
3e7ee490
HJ
643 return ret;
644}
fff41b2e 645EXPORT_SYMBOL(vmbus_sendpacket);
3e7ee490 646
3e189519 647/*
fff41b2e 648 * vmbus_sendpacket_pagebuffer - Send a range of single-page buffer
3e189519 649 * packets using a GPADL Direct packet type.
f4266e34 650 */
fff41b2e 651int vmbus_sendpacket_pagebuffer(struct vmbus_channel *channel,
39d70a4a
HZ
652 struct hv_page_buffer pagebuffers[],
653 u32 pagecount, void *buffer, u32 bufferlen,
654 u64 requestid)
3e7ee490 655{
f4266e34
GKH
656 int ret;
657 int i;
430a8e9a 658 struct vmbus_channel_packet_page_buffer desc;
39d70a4a
HZ
659 u32 descsize;
660 u32 packetlen;
661 u32 packetlen_aligned;
662 struct scatterlist bufferlist[3];
663 u64 aligned_data = 0;
3e7ee490 664
39d70a4a 665 if (pagecount > MAX_PAGE_BUFFER_COUNT)
002b53ea 666 return -EINVAL;
3e7ee490 667
3e7ee490 668
f4266e34 669 /*
430a8e9a 670 * Adjust the size down since vmbus_channel_packet_page_buffer is the
f4266e34
GKH
671 * largest size we support
672 */
39d70a4a
HZ
673 descsize = sizeof(struct vmbus_channel_packet_page_buffer) -
674 ((MAX_PAGE_BUFFER_COUNT - pagecount) *
f4266e34 675 sizeof(struct hv_page_buffer));
39d70a4a 676 packetlen = descsize + bufferlen;
73509681 677 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
3e7ee490 678
454f18a9 679 /* Setup the descriptor */
415f2287 680 desc.type = VM_PKT_DATA_USING_GPA_DIRECT;
430a8e9a 681 desc.flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
39d70a4a
HZ
682 desc.dataoffset8 = descsize >> 3; /* in 8-bytes grandularity */
683 desc.length8 = (u16)(packetlen_aligned >> 3);
684 desc.transactionid = requestid;
685 desc.rangecount = pagecount;
686
687 for (i = 0; i < pagecount; i++) {
ca623ad3
HZ
688 desc.range[i].len = pagebuffers[i].len;
689 desc.range[i].offset = pagebuffers[i].offset;
690 desc.range[i].pfn = pagebuffers[i].pfn;
3e7ee490
HJ
691 }
692
39d70a4a
HZ
693 sg_init_table(bufferlist, 3);
694 sg_set_buf(&bufferlist[0], &desc, descsize);
695 sg_set_buf(&bufferlist[1], buffer, bufferlen);
696 sg_set_buf(&bufferlist[2], &aligned_data,
697 packetlen_aligned - packetlen);
3e7ee490 698
633c4dce 699 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3);
3e7ee490 700
decc49da 701 if (ret == 0 && !hv_get_ringbuffer_interrupt_mask(&channel->outbound))
fff41b2e 702 vmbus_setevent(channel);
3e7ee490 703
3e7ee490
HJ
704 return ret;
705}
713efeb4 706EXPORT_SYMBOL_GPL(vmbus_sendpacket_pagebuffer);
3e7ee490 707
3e189519 708/*
fff41b2e 709 * vmbus_sendpacket_multipagebuffer - Send a multi-page buffer packet
3e189519 710 * using a GPADL Direct packet type.
f4266e34 711 */
fff41b2e 712int vmbus_sendpacket_multipagebuffer(struct vmbus_channel *channel,
39d70a4a
HZ
713 struct hv_multipage_buffer *multi_pagebuffer,
714 void *buffer, u32 bufferlen, u64 requestid)
3e7ee490 715{
f4266e34 716 int ret;
430a8e9a 717 struct vmbus_channel_packet_multipage_buffer desc;
39d70a4a
HZ
718 u32 descsize;
719 u32 packetlen;
720 u32 packetlen_aligned;
721 struct scatterlist bufferlist[3];
722 u64 aligned_data = 0;
ca623ad3
HZ
723 u32 pfncount = NUM_PAGES_SPANNED(multi_pagebuffer->offset,
724 multi_pagebuffer->len);
3e7ee490 725
3e7ee490 726
39d70a4a 727 if ((pfncount < 0) || (pfncount > MAX_MULTIPAGE_BUFFER_COUNT))
002b53ea 728 return -EINVAL;
3e7ee490 729
f4266e34 730 /*
430a8e9a 731 * Adjust the size down since vmbus_channel_packet_multipage_buffer is
f4266e34
GKH
732 * the largest size we support
733 */
39d70a4a
HZ
734 descsize = sizeof(struct vmbus_channel_packet_multipage_buffer) -
735 ((MAX_MULTIPAGE_BUFFER_COUNT - pfncount) *
f4266e34 736 sizeof(u64));
39d70a4a 737 packetlen = descsize + bufferlen;
73509681 738 packetlen_aligned = ALIGN(packetlen, sizeof(u64));
3e7ee490 739
3e7ee490 740
454f18a9 741 /* Setup the descriptor */
415f2287 742 desc.type = VM_PKT_DATA_USING_GPA_DIRECT;
430a8e9a 743 desc.flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
39d70a4a
HZ
744 desc.dataoffset8 = descsize >> 3; /* in 8-bytes grandularity */
745 desc.length8 = (u16)(packetlen_aligned >> 3);
746 desc.transactionid = requestid;
430a8e9a 747 desc.rangecount = 1;
3e7ee490 748
ca623ad3
HZ
749 desc.range.len = multi_pagebuffer->len;
750 desc.range.offset = multi_pagebuffer->offset;
3e7ee490 751
ca623ad3 752 memcpy(desc.range.pfn_array, multi_pagebuffer->pfn_array,
39d70a4a 753 pfncount * sizeof(u64));
3e7ee490 754
39d70a4a
HZ
755 sg_init_table(bufferlist, 3);
756 sg_set_buf(&bufferlist[0], &desc, descsize);
757 sg_set_buf(&bufferlist[1], buffer, bufferlen);
758 sg_set_buf(&bufferlist[2], &aligned_data,
759 packetlen_aligned - packetlen);
3e7ee490 760
633c4dce 761 ret = hv_ringbuffer_write(&channel->outbound, bufferlist, 3);
3e7ee490 762
decc49da 763 if (ret == 0 && !hv_get_ringbuffer_interrupt_mask(&channel->outbound))
fff41b2e 764 vmbus_setevent(channel);
3e7ee490 765
3e7ee490
HJ
766 return ret;
767}
4cb106fa 768EXPORT_SYMBOL_GPL(vmbus_sendpacket_multipagebuffer);
c88c4e4c
HJ
769
770/**
fff41b2e 771 * vmbus_recvpacket() - Retrieve the user packet on the specified channel
39d70a4a
HZ
772 * @channel: Pointer to vmbus_channel structure.
773 * @buffer: Pointer to the buffer you want to receive the data into.
774 * @bufferlen: Maximum size of what the the buffer will hold
775 * @buffer_actual_len: The actual size of the data after it was received
776 * @requestid: Identifier of the request
c88c4e4c
HJ
777 *
778 * Receives directly from the hyper-v vmbus and puts the data it received
779 * into Buffer. This will receive the data unparsed from hyper-v.
780 *
781 * Mainly used by Hyper-V drivers.
f4266e34 782 */
fff41b2e 783int vmbus_recvpacket(struct vmbus_channel *channel, void *buffer,
39d70a4a 784 u32 bufferlen, u32 *buffer_actual_len, u64 *requestid)
3e7ee490 785{
8dc0a06a 786 struct vmpacket_descriptor desc;
39d70a4a
HZ
787 u32 packetlen;
788 u32 userlen;
3e7ee490 789 int ret;
54411c42 790 unsigned long flags;
3e7ee490 791
39d70a4a
HZ
792 *buffer_actual_len = 0;
793 *requestid = 0;
3e7ee490 794
39d70a4a 795 spin_lock_irqsave(&channel->inbound_lock, flags);
3e7ee490 796
a89186c2 797 ret = hv_ringbuffer_peek(&channel->inbound, &desc,
f4266e34
GKH
798 sizeof(struct vmpacket_descriptor));
799 if (ret != 0) {
39d70a4a 800 spin_unlock_irqrestore(&channel->inbound_lock, flags);
3e7ee490
HJ
801 return 0;
802 }
803
415f2287
HZ
804 packetlen = desc.len8 << 3;
805 userlen = packetlen - (desc.offset8 << 3);
3e7ee490 806
39d70a4a 807 *buffer_actual_len = userlen;
3e7ee490 808
39d70a4a
HZ
809 if (userlen > bufferlen) {
810 spin_unlock_irqrestore(&channel->inbound_lock, flags);
3e7ee490 811
0a46618d 812 pr_err("Buffer too small - got %d needs %d\n",
39d70a4a 813 bufferlen, userlen);
926ae526 814 return -ETOOSMALL;
3e7ee490
HJ
815 }
816
415f2287 817 *requestid = desc.trans_id;
3e7ee490 818
454f18a9 819 /* Copy over the packet to the user buffer */
38397c8a 820 ret = hv_ringbuffer_read(&channel->inbound, buffer, userlen,
415f2287 821 (desc.offset8 << 3));
3e7ee490 822
39d70a4a 823 spin_unlock_irqrestore(&channel->inbound_lock, flags);
3e7ee490 824
3e7ee490
HJ
825 return 0;
826}
fff41b2e 827EXPORT_SYMBOL(vmbus_recvpacket);
3e7ee490 828
3e189519 829/*
fff41b2e 830 * vmbus_recvpacket_raw - Retrieve the raw packet on the specified channel
f4266e34 831 */
fff41b2e 832int vmbus_recvpacket_raw(struct vmbus_channel *channel, void *buffer,
39d70a4a
HZ
833 u32 bufferlen, u32 *buffer_actual_len,
834 u64 *requestid)
3e7ee490 835{
8dc0a06a 836 struct vmpacket_descriptor desc;
39d70a4a
HZ
837 u32 packetlen;
838 u32 userlen;
3e7ee490 839 int ret;
54411c42 840 unsigned long flags;
3e7ee490 841
39d70a4a
HZ
842 *buffer_actual_len = 0;
843 *requestid = 0;
3e7ee490 844
39d70a4a 845 spin_lock_irqsave(&channel->inbound_lock, flags);
3e7ee490 846
a89186c2 847 ret = hv_ringbuffer_peek(&channel->inbound, &desc,
f4266e34
GKH
848 sizeof(struct vmpacket_descriptor));
849 if (ret != 0) {
39d70a4a 850 spin_unlock_irqrestore(&channel->inbound_lock, flags);
3e7ee490
HJ
851 return 0;
852 }
853
3e7ee490 854
415f2287
HZ
855 packetlen = desc.len8 << 3;
856 userlen = packetlen - (desc.offset8 << 3);
3e7ee490 857
39d70a4a 858 *buffer_actual_len = packetlen;
3e7ee490 859
39d70a4a
HZ
860 if (packetlen > bufferlen) {
861 spin_unlock_irqrestore(&channel->inbound_lock, flags);
3e7ee490 862
0a46618d
HJ
863 pr_err("Buffer too small - needed %d bytes but "
864 "got space for only %d bytes\n",
865 packetlen, bufferlen);
3e7ee490
HJ
866 return -2;
867 }
868
415f2287 869 *requestid = desc.trans_id;
3e7ee490 870
454f18a9 871 /* Copy over the entire packet to the user buffer */
38397c8a 872 ret = hv_ringbuffer_read(&channel->inbound, buffer, packetlen, 0);
3e7ee490 873
39d70a4a 874 spin_unlock_irqrestore(&channel->inbound_lock, flags);
3e7ee490
HJ
875 return 0;
876}
adaee6bd 877EXPORT_SYMBOL_GPL(vmbus_recvpacket_raw);