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