Staging: rtl8192su: led update
[linux-2.6-block.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 */
5654e932 21#include <linux/kernel.h>
a0086dc5 22#include <linux/mm.h>
5a0e3ad6 23#include <linux/slab.h>
c88c4e4c 24#include <linux/module.h>
4983b39a 25#include "osd.h"
645954c5 26#include "logging.h"
72daf320 27#include "vmbus_private.h"
3e7ee490 28
454f18a9 29/* Internal routines */
aded7165 30static int VmbusChannelCreateGpadlHeader(
f4266e34
GKH
31 void *Kbuffer, /* must be phys and virt contiguous */
32 u32 Size, /* page-size multiple */
aded7165 33 struct vmbus_channel_msginfo **msgInfo,
f4266e34 34 u32 *MessageCount);
aded7165
GKH
35static void DumpVmbusChannel(struct vmbus_channel *channel);
36static void VmbusChannelSetEvent(struct vmbus_channel *channel);
3e7ee490
HJ
37
38
39#if 0
f4266e34 40static void DumpMonitorPage(struct hv_monitor_page *MonitorPage)
3e7ee490 41{
f4266e34
GKH
42 int i = 0;
43 int j = 0;
3e7ee490 44
f4266e34
GKH
45 DPRINT_DBG(VMBUS, "monitorPage - %p, trigger state - %d",
46 MonitorPage, MonitorPage->TriggerState);
3e7ee490 47
f4266e34
GKH
48 for (i = 0; i < 4; i++)
49 DPRINT_DBG(VMBUS, "trigger group (%d) - %llx", i,
50 MonitorPage->TriggerGroup[i].AsUINT64);
3e7ee490 51
f4266e34
GKH
52 for (i = 0; i < 4; i++) {
53 for (j = 0; j < 32; j++) {
54 DPRINT_DBG(VMBUS, "latency (%d)(%d) - %llx", i, j,
55 MonitorPage->Latency[i][j]);
3e7ee490
HJ
56 }
57 }
f4266e34
GKH
58 for (i = 0; i < 4; i++) {
59 for (j = 0; j < 32; j++) {
60 DPRINT_DBG(VMBUS, "param-conn id (%d)(%d) - %d", i, j,
61 MonitorPage->Parameter[i][j].ConnectionId.Asu32);
62 DPRINT_DBG(VMBUS, "param-flag (%d)(%d) - %d", i, j,
63 MonitorPage->Parameter[i][j].FlagNumber);
3e7ee490
HJ
64 }
65 }
66}
67#endif
68
3e189519
HJ
69/*
70 * VmbusChannelSetEvent - Trigger an event notification on the specified
71 * channel.
f4266e34 72 */
aded7165 73static void VmbusChannelSetEvent(struct vmbus_channel *Channel)
3e7ee490 74{
eacb1b4d 75 struct hv_monitor_page *monitorPage;
3e7ee490
HJ
76
77 DPRINT_ENTER(VMBUS);
78
f4266e34 79 if (Channel->OfferMsg.MonitorAllocated) {
454f18a9 80 /* Each u32 represents 32 channels */
7c369f40
BP
81 set_bit(Channel->OfferMsg.ChildRelId & 31,
82 (unsigned long *) gVmbusConnection.SendInterruptPage +
f4266e34 83 (Channel->OfferMsg.ChildRelId >> 5));
3e7ee490 84
f4266e34 85 monitorPage = gVmbusConnection.MonitorPages;
454f18a9 86 monitorPage++; /* Get the child to parent monitor page */
3e7ee490 87
7c369f40 88 set_bit(Channel->MonitorBit,
f4266e34
GKH
89 (unsigned long *)&monitorPage->TriggerGroup
90 [Channel->MonitorGroup].Pending);
7c369f40 91
f4266e34 92 } else {
3e7ee490
HJ
93 VmbusSetEvent(Channel->OfferMsg.ChildRelId);
94 }
95
96 DPRINT_EXIT(VMBUS);
97}
98
99#if 0
aded7165 100static void VmbusChannelClearEvent(struct vmbus_channel *channel)
3e7ee490 101{
eacb1b4d 102 struct hv_monitor_page *monitorPage;
3e7ee490
HJ
103
104 DPRINT_ENTER(VMBUS);
105
f4266e34 106 if (Channel->OfferMsg.MonitorAllocated) {
454f18a9 107 /* Each u32 represents 32 channels */
7c369f40 108 clear_bit(Channel->OfferMsg.ChildRelId & 31,
f4266e34
GKH
109 (unsigned long *)gVmbusConnection.SendInterruptPage +
110 (Channel->OfferMsg.ChildRelId >> 5));
3e7ee490 111
f4266e34
GKH
112 monitorPage =
113 (struct hv_monitor_page *)gVmbusConnection.MonitorPages;
454f18a9 114 monitorPage++; /* Get the child to parent monitor page */
3e7ee490 115
7c369f40 116 clear_bit(Channel->MonitorBit,
f4266e34
GKH
117 (unsigned long *)&monitorPage->TriggerGroup
118 [Channel->MonitorGroup].Pending);
3e7ee490
HJ
119 }
120
121 DPRINT_EXIT(VMBUS);
122}
123
124#endif
3e189519 125/*
f4266e34
GKH
126 * VmbusChannelGetDebugInfo -Retrieve various channel debug info
127 */
aded7165
GKH
128void VmbusChannelGetDebugInfo(struct vmbus_channel *Channel,
129 struct vmbus_channel_debug_info *DebugInfo)
3e7ee490 130{
eacb1b4d 131 struct hv_monitor_page *monitorPage;
f4266e34
GKH
132 u8 monitorGroup = (u8)Channel->OfferMsg.MonitorId / 32;
133 u8 monitorOffset = (u8)Channel->OfferMsg.MonitorId % 32;
454f18a9 134 /* u32 monitorBit = 1 << monitorOffset; */
3e7ee490
HJ
135
136 DebugInfo->RelId = Channel->OfferMsg.ChildRelId;
137 DebugInfo->State = Channel->State;
f4266e34
GKH
138 memcpy(&DebugInfo->InterfaceType,
139 &Channel->OfferMsg.Offer.InterfaceType, sizeof(struct hv_guid));
140 memcpy(&DebugInfo->InterfaceInstance,
141 &Channel->OfferMsg.Offer.InterfaceInstance,
142 sizeof(struct hv_guid));
3e7ee490 143
eacb1b4d 144 monitorPage = (struct hv_monitor_page *)gVmbusConnection.MonitorPages;
3e7ee490
HJ
145
146 DebugInfo->MonitorId = Channel->OfferMsg.MonitorId;
147
f4266e34
GKH
148 DebugInfo->ServerMonitorPending =
149 monitorPage->TriggerGroup[monitorGroup].Pending;
150 DebugInfo->ServerMonitorLatency =
151 monitorPage->Latency[monitorGroup][monitorOffset];
152 DebugInfo->ServerMonitorConnectionId =
153 monitorPage->Parameter[monitorGroup]
154 [monitorOffset].ConnectionId.u.Id;
3e7ee490
HJ
155
156 monitorPage++;
157
f4266e34
GKH
158 DebugInfo->ClientMonitorPending =
159 monitorPage->TriggerGroup[monitorGroup].Pending;
160 DebugInfo->ClientMonitorLatency =
161 monitorPage->Latency[monitorGroup][monitorOffset];
162 DebugInfo->ClientMonitorConnectionId =
163 monitorPage->Parameter[monitorGroup]
164 [monitorOffset].ConnectionId.u.Id;
3e7ee490
HJ
165
166 RingBufferGetDebugInfo(&Channel->Inbound, &DebugInfo->Inbound);
167 RingBufferGetDebugInfo(&Channel->Outbound, &DebugInfo->Outbound);
168}
169
3e189519 170/*
f4266e34
GKH
171 * VmbusChannelOpen - Open the specified channel.
172 */
173int VmbusChannelOpen(struct vmbus_channel *NewChannel, u32 SendRingBufferSize,
174 u32 RecvRingBufferSize, void *UserData, u32 UserDataLen,
79035069 175 void (*OnChannelCallback)(void *context), void *Context)
3e7ee490 176{
82250213 177 struct vmbus_channel_open_channel *openMsg;
b94ef345 178 struct vmbus_channel_msginfo *openInfo = NULL;
3e7ee490 179 void *in, *out;
dd0813b6 180 unsigned long flags;
c3bf2e26 181 int ret, err = 0;
3e7ee490
HJ
182
183 DPRINT_ENTER(VMBUS);
184
454f18a9 185 /* Aligned to page size */
0ace247e
BP
186 /* ASSERT(!(SendRingBufferSize & (PAGE_SIZE - 1))); */
187 /* ASSERT(!(RecvRingBufferSize & (PAGE_SIZE - 1))); */
3e7ee490 188
79035069 189 NewChannel->OnChannelCallback = OnChannelCallback;
3e7ee490
HJ
190 NewChannel->ChannelCallbackContext = Context;
191
454f18a9 192 /* Allocate the ring buffer */
f4266e34
GKH
193 out = osd_PageAlloc((SendRingBufferSize + RecvRingBufferSize)
194 >> PAGE_SHIFT);
7e052d98
BP
195 if (!out)
196 return -ENOMEM;
197
0ace247e 198 /* ASSERT(((unsigned long)out & (PAGE_SIZE-1)) == 0); */
3e7ee490 199
f4266e34 200 in = (void *)((unsigned long)out + SendRingBufferSize);
3e7ee490
HJ
201
202 NewChannel->RingBufferPages = out;
f4266e34
GKH
203 NewChannel->RingBufferPageCount = (SendRingBufferSize +
204 RecvRingBufferSize) >> PAGE_SHIFT;
3e7ee490 205
3324fb40
BP
206 ret = RingBufferInit(&NewChannel->Outbound, out, SendRingBufferSize);
207 if (!ret) {
208 err = ret;
209 goto errorout;
210 }
211
212 ret = RingBufferInit(&NewChannel->Inbound, in, RecvRingBufferSize);
213 if (!ret) {
214 err = ret;
215 goto errorout;
216 }
3e7ee490 217
3e7ee490 218
454f18a9 219 /* Establish the gpadl for the ring buffer */
f4266e34
GKH
220 DPRINT_DBG(VMBUS, "Establishing ring buffer's gpadl for channel %p...",
221 NewChannel);
3e7ee490
HJ
222
223 NewChannel->RingBufferGpadlHandle = 0;
224
225 ret = VmbusChannelEstablishGpadl(NewChannel,
f4266e34
GKH
226 NewChannel->Outbound.RingBuffer,
227 SendRingBufferSize +
228 RecvRingBufferSize,
229 &NewChannel->RingBufferGpadlHandle);
b94ef345
BP
230
231 if (!ret) {
232 err = ret;
233 goto errorout;
234 }
f4266e34
GKH
235
236 DPRINT_DBG(VMBUS, "channel %p <relid %d gpadl 0x%x send ring %p "
237 "size %d recv ring %p size %d, downstreamoffset %d>",
238 NewChannel, NewChannel->OfferMsg.ChildRelId,
239 NewChannel->RingBufferGpadlHandle,
240 NewChannel->Outbound.RingBuffer,
241 NewChannel->Outbound.RingSize,
242 NewChannel->Inbound.RingBuffer,
243 NewChannel->Inbound.RingSize,
244 SendRingBufferSize);
3e7ee490 245
454f18a9 246 /* Create and init the channel open message */
f4266e34
GKH
247 openInfo = kmalloc(sizeof(*openInfo) +
248 sizeof(struct vmbus_channel_open_channel),
249 GFP_KERNEL);
c3bf2e26
BP
250 if (!openInfo) {
251 err = -ENOMEM;
252 goto errorout;
253 }
3e7ee490 254
bfc30aae 255 openInfo->WaitEvent = osd_WaitEventCreate();
c3bf2e26
BP
256 if (!openInfo->WaitEvent) {
257 err = -ENOMEM;
258 goto errorout;
259 }
3e7ee490 260
82250213 261 openMsg = (struct vmbus_channel_open_channel *)openInfo->Msg;
f4266e34
GKH
262 openMsg->Header.MessageType = ChannelMessageOpenChannel;
263 openMsg->OpenId = NewChannel->OfferMsg.ChildRelId; /* FIXME */
264 openMsg->ChildRelId = NewChannel->OfferMsg.ChildRelId;
265 openMsg->RingBufferGpadlHandle = NewChannel->RingBufferGpadlHandle;
f4266e34
GKH
266 openMsg->DownstreamRingBufferPageOffset = SendRingBufferSize >>
267 PAGE_SHIFT;
268 openMsg->ServerContextAreaGpadlHandle = 0; /* TODO */
3e7ee490 269
c827f944
BP
270 if (UserDataLen > MAX_USER_DEFINED_BYTES) {
271 err = -EINVAL;
272 goto errorout;
273 }
274
3e7ee490 275 if (UserDataLen)
3e7ee490 276 memcpy(openMsg->UserData, UserData, UserDataLen);
3e7ee490 277
dd0813b6 278 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
53af545b
BP
279 list_add_tail(&openInfo->MsgListEntry,
280 &gVmbusConnection.ChannelMsgList);
dd0813b6 281 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490
HJ
282
283 DPRINT_DBG(VMBUS, "Sending channel open msg...");
284
f4266e34
GKH
285 ret = VmbusPostMessage(openMsg,
286 sizeof(struct vmbus_channel_open_channel));
287 if (ret != 0) {
3e7ee490
HJ
288 DPRINT_ERR(VMBUS, "unable to open channel - %d", ret);
289 goto Cleanup;
290 }
291
454f18a9 292 /* FIXME: Need to time-out here */
bfc30aae 293 osd_WaitEventWait(openInfo->WaitEvent);
3e7ee490
HJ
294
295 if (openInfo->Response.OpenResult.Status == 0)
3e7ee490 296 DPRINT_INFO(VMBUS, "channel <%p> open success!!", NewChannel);
3e7ee490 297 else
f4266e34
GKH
298 DPRINT_INFO(VMBUS, "channel <%p> open failed - %d!!",
299 NewChannel, openInfo->Response.OpenResult.Status);
3e7ee490
HJ
300
301Cleanup:
dd0813b6 302 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
53af545b 303 list_del(&openInfo->MsgListEntry);
dd0813b6 304 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490 305
420beac4 306 kfree(openInfo->WaitEvent);
8c69f52a 307 kfree(openInfo);
3e7ee490
HJ
308
309 DPRINT_EXIT(VMBUS);
310
311 return 0;
c3bf2e26
BP
312
313errorout:
b94ef345
BP
314 RingBufferCleanup(&NewChannel->Outbound);
315 RingBufferCleanup(&NewChannel->Inbound);
c3bf2e26
BP
316 osd_PageFree(out, (SendRingBufferSize + RecvRingBufferSize)
317 >> PAGE_SHIFT);
318 kfree(openInfo);
319 return err;
3e7ee490
HJ
320}
321
3e189519
HJ
322/*
323 * DumpGpadlBody - Dump the gpadl body message to the console for
324 * debugging purposes.
f4266e34 325 */
82250213 326static void DumpGpadlBody(struct vmbus_channel_gpadl_body *Gpadl, u32 Len)
3e7ee490 327{
f4266e34
GKH
328 int i;
329 int pfnCount;
3e7ee490 330
f4266e34
GKH
331 pfnCount = (Len - sizeof(struct vmbus_channel_gpadl_body)) /
332 sizeof(u64);
3e7ee490
HJ
333 DPRINT_DBG(VMBUS, "gpadl body - len %d pfn count %d", Len, pfnCount);
334
f4266e34
GKH
335 for (i = 0; i < pfnCount; i++)
336 DPRINT_DBG(VMBUS, "gpadl body - %d) pfn %llu",
337 i, Gpadl->Pfn[i]);
3e7ee490
HJ
338}
339
3e189519
HJ
340/*
341 * DumpGpadlHeader - Dump the gpadl header message to the console for
342 * debugging purposes.
f4266e34 343 */
82250213 344static void DumpGpadlHeader(struct vmbus_channel_gpadl_header *Gpadl)
3e7ee490 345{
f4266e34
GKH
346 int i, j;
347 int pageCount;
3e7ee490 348
f4266e34
GKH
349 DPRINT_DBG(VMBUS,
350 "gpadl header - relid %d, range count %d, range buflen %d",
351 Gpadl->ChildRelId, Gpadl->RangeCount, Gpadl->RangeBufLen);
352 for (i = 0; i < Gpadl->RangeCount; i++) {
3e7ee490 353 pageCount = Gpadl->Range[i].ByteCount >> PAGE_SHIFT;
f4266e34 354 pageCount = (pageCount > 26) ? 26 : pageCount;
3e7ee490 355
f4266e34
GKH
356 DPRINT_DBG(VMBUS, "gpadl range %d - len %d offset %d "
357 "page count %d", i, Gpadl->Range[i].ByteCount,
358 Gpadl->Range[i].ByteOffset, pageCount);
3e7ee490 359
f4266e34
GKH
360 for (j = 0; j < pageCount; j++)
361 DPRINT_DBG(VMBUS, "%d) pfn %llu", j,
362 Gpadl->Range[i].PfnArray[j]);
3e7ee490
HJ
363 }
364}
365
3e189519 366/*
f4266e34
GKH
367 * VmbusChannelCreateGpadlHeader - Creates a gpadl for the specified buffer
368 */
369static int VmbusChannelCreateGpadlHeader(void *Kbuffer, u32 Size,
370 struct vmbus_channel_msginfo **MsgInfo,
371 u32 *MessageCount)
3e7ee490
HJ
372{
373 int i;
374 int pageCount;
f4266e34 375 unsigned long long pfn;
82250213
GKH
376 struct vmbus_channel_gpadl_header *gpaHeader;
377 struct vmbus_channel_gpadl_body *gpadlBody;
aded7165 378 struct vmbus_channel_msginfo *msgHeader;
e61fbe66 379 struct vmbus_channel_msginfo *msgBody = NULL;
f4266e34 380 u32 msgSize;
3e7ee490
HJ
381
382 int pfnSum, pfnCount, pfnLeft, pfnCurr, pfnSize;
383
f4266e34 384 /* ASSERT((kbuffer & (PAGE_SIZE-1)) == 0); */
0ace247e 385 /* ASSERT((Size & (PAGE_SIZE-1)) == 0); */
3e7ee490
HJ
386
387 pageCount = Size >> PAGE_SHIFT;
fa56d361 388 pfn = virt_to_phys(Kbuffer) >> PAGE_SHIFT;
3e7ee490 389
454f18a9 390 /* do we need a gpadl body msg */
f4266e34
GKH
391 pfnSize = MAX_SIZE_CHANNEL_MESSAGE -
392 sizeof(struct vmbus_channel_gpadl_header) -
393 sizeof(struct gpa_range);
59471438 394 pfnCount = pfnSize / sizeof(u64);
3e7ee490 395
f4266e34
GKH
396 if (pageCount > pfnCount) {
397 /* we need a gpadl body */
454f18a9 398 /* fill in the header */
f4266e34
GKH
399 msgSize = sizeof(struct vmbus_channel_msginfo) +
400 sizeof(struct vmbus_channel_gpadl_header) +
401 sizeof(struct gpa_range) + pfnCount * sizeof(u64);
e276a3a5 402 msgHeader = kzalloc(msgSize, GFP_KERNEL);
d1c250bb
BP
403 if (!msgHeader)
404 goto nomem;
3e7ee490 405
53af545b 406 INIT_LIST_HEAD(&msgHeader->SubMsgList);
f4266e34 407 msgHeader->MessageSize = msgSize;
3e7ee490 408
82250213 409 gpaHeader = (struct vmbus_channel_gpadl_header *)msgHeader->Msg;
3e7ee490 410 gpaHeader->RangeCount = 1;
f4266e34
GKH
411 gpaHeader->RangeBufLen = sizeof(struct gpa_range) +
412 pageCount * sizeof(u64);
3e7ee490
HJ
413 gpaHeader->Range[0].ByteOffset = 0;
414 gpaHeader->Range[0].ByteCount = Size;
f4266e34 415 for (i = 0; i < pfnCount; i++)
3e7ee490 416 gpaHeader->Range[0].PfnArray[i] = pfn+i;
3e7ee490
HJ
417 *MsgInfo = msgHeader;
418 *MessageCount = 1;
419
420 pfnSum = pfnCount;
421 pfnLeft = pageCount - pfnCount;
422
454f18a9 423 /* how many pfns can we fit */
f4266e34
GKH
424 pfnSize = MAX_SIZE_CHANNEL_MESSAGE -
425 sizeof(struct vmbus_channel_gpadl_body);
59471438 426 pfnCount = pfnSize / sizeof(u64);
3e7ee490 427
454f18a9 428 /* fill in the body */
f4266e34 429 while (pfnLeft) {
3e7ee490 430 if (pfnLeft > pfnCount)
3e7ee490 431 pfnCurr = pfnCount;
3e7ee490 432 else
3e7ee490 433 pfnCurr = pfnLeft;
3e7ee490 434
f4266e34
GKH
435 msgSize = sizeof(struct vmbus_channel_msginfo) +
436 sizeof(struct vmbus_channel_gpadl_body) +
437 pfnCurr * sizeof(u64);
e276a3a5 438 msgBody = kzalloc(msgSize, GFP_KERNEL);
d1c250bb
BP
439 /* FIXME: we probably need to more if this fails */
440 if (!msgBody)
441 goto nomem;
3e7ee490
HJ
442 msgBody->MessageSize = msgSize;
443 (*MessageCount)++;
f4266e34
GKH
444 gpadlBody =
445 (struct vmbus_channel_gpadl_body *)msgBody->Msg;
446
447 /*
448 * FIXME:
449 * Gpadl is u32 and we are using a pointer which could
450 * be 64-bit
451 */
454f18a9 452 /* gpadlBody->Gpadl = kbuffer; */
f4266e34 453 for (i = 0; i < pfnCurr; i++)
3e7ee490 454 gpadlBody->Pfn[i] = pfn + pfnSum + i;
3e7ee490 455
454f18a9 456 /* add to msg header */
53af545b
BP
457 list_add_tail(&msgBody->MsgListEntry,
458 &msgHeader->SubMsgList);
3e7ee490
HJ
459 pfnSum += pfnCurr;
460 pfnLeft -= pfnCurr;
461 }
f4266e34 462 } else {
454f18a9 463 /* everything fits in a header */
f4266e34
GKH
464 msgSize = sizeof(struct vmbus_channel_msginfo) +
465 sizeof(struct vmbus_channel_gpadl_header) +
466 sizeof(struct gpa_range) + pageCount * sizeof(u64);
e276a3a5 467 msgHeader = kzalloc(msgSize, GFP_KERNEL);
f4266e34 468 msgHeader->MessageSize = msgSize;
3e7ee490 469
82250213 470 gpaHeader = (struct vmbus_channel_gpadl_header *)msgHeader->Msg;
3e7ee490 471 gpaHeader->RangeCount = 1;
f4266e34
GKH
472 gpaHeader->RangeBufLen = sizeof(struct gpa_range) +
473 pageCount * sizeof(u64);
3e7ee490
HJ
474 gpaHeader->Range[0].ByteOffset = 0;
475 gpaHeader->Range[0].ByteCount = Size;
f4266e34 476 for (i = 0; i < pageCount; i++)
3e7ee490 477 gpaHeader->Range[0].PfnArray[i] = pfn+i;
3e7ee490
HJ
478
479 *MsgInfo = msgHeader;
480 *MessageCount = 1;
481 }
482
483 return 0;
d1c250bb
BP
484nomem:
485 kfree(msgHeader);
486 kfree(msgBody);
487 return -ENOMEM;
3e7ee490
HJ
488}
489
3e189519 490/*
f4266e34
GKH
491 * VmbusChannelEstablishGpadl - Estabish a GPADL for the specified buffer
492 *
493 * @Channel: a channel
494 * @Kbuffer: from kmalloc
495 * @Size: page-size multiple
496 * @GpadlHandle: some funky thing
497 */
498int VmbusChannelEstablishGpadl(struct vmbus_channel *Channel, void *Kbuffer,
499 u32 Size, u32 *GpadlHandle)
3e7ee490 500{
82250213
GKH
501 struct vmbus_channel_gpadl_header *gpadlMsg;
502 struct vmbus_channel_gpadl_body *gpadlBody;
503 /* struct vmbus_channel_gpadl_created *gpadlCreated; */
c3bf2e26 504 struct vmbus_channel_msginfo *msgInfo = NULL;
aded7165 505 struct vmbus_channel_msginfo *subMsgInfo;
4d643114 506 u32 msgCount;
53af545b 507 struct list_head *curr;
4d643114 508 u32 nextGpadlHandle;
dd0813b6 509 unsigned long flags;
c3bf2e26 510 int ret = 0;
3e7ee490
HJ
511
512 DPRINT_ENTER(VMBUS);
513
f4888417
BP
514 nextGpadlHandle = atomic_read(&gVmbusConnection.NextGpadlHandle);
515 atomic_inc(&gVmbusConnection.NextGpadlHandle);
3e7ee490 516
c3bf2e26
BP
517 ret = VmbusChannelCreateGpadlHeader(Kbuffer, Size, &msgInfo, &msgCount);
518 if (ret)
519 return ret;
3e7ee490 520
bfc30aae 521 msgInfo->WaitEvent = osd_WaitEventCreate();
c3bf2e26
BP
522 if (!msgInfo->WaitEvent) {
523 ret = -ENOMEM;
524 goto Cleanup;
525 }
526
82250213 527 gpadlMsg = (struct vmbus_channel_gpadl_header *)msgInfo->Msg;
3e7ee490
HJ
528 gpadlMsg->Header.MessageType = ChannelMessageGpadlHeader;
529 gpadlMsg->ChildRelId = Channel->OfferMsg.ChildRelId;
530 gpadlMsg->Gpadl = nextGpadlHandle;
531
532 DumpGpadlHeader(gpadlMsg);
533
dd0813b6 534 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
53af545b
BP
535 list_add_tail(&msgInfo->MsgListEntry,
536 &gVmbusConnection.ChannelMsgList);
3e7ee490 537
53af545b 538 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
f4266e34
GKH
539 DPRINT_DBG(VMBUS, "buffer %p, size %d msg cnt %d",
540 Kbuffer, Size, msgCount);
3e7ee490 541
f4266e34
GKH
542 DPRINT_DBG(VMBUS, "Sending GPADL Header - len %zd",
543 msgInfo->MessageSize - sizeof(*msgInfo));
3e7ee490 544
f4266e34
GKH
545 ret = VmbusPostMessage(gpadlMsg, msgInfo->MessageSize -
546 sizeof(*msgInfo));
547 if (ret != 0) {
3e7ee490
HJ
548 DPRINT_ERR(VMBUS, "Unable to open channel - %d", ret);
549 goto Cleanup;
550 }
551
f4266e34 552 if (msgCount > 1) {
53af545b
BP
553 list_for_each(curr, &msgInfo->SubMsgList) {
554
555 /* FIXME: should this use list_entry() instead ? */
82250213 556 subMsgInfo = (struct vmbus_channel_msginfo *)curr;
f4266e34
GKH
557 gpadlBody =
558 (struct vmbus_channel_gpadl_body *)subMsgInfo->Msg;
3e7ee490
HJ
559
560 gpadlBody->Header.MessageType = ChannelMessageGpadlBody;
561 gpadlBody->Gpadl = nextGpadlHandle;
562
f4266e34
GKH
563 DPRINT_DBG(VMBUS, "Sending GPADL Body - len %zd",
564 subMsgInfo->MessageSize -
565 sizeof(*subMsgInfo));
3e7ee490 566
f4266e34
GKH
567 DumpGpadlBody(gpadlBody, subMsgInfo->MessageSize -
568 sizeof(*subMsgInfo));
569 ret = VmbusPostMessage(gpadlBody,
570 subMsgInfo->MessageSize -
571 sizeof(*subMsgInfo));
99259159
BP
572 if (!ret)
573 goto Cleanup;
574
3e7ee490
HJ
575 }
576 }
bfc30aae 577 osd_WaitEventWait(msgInfo->WaitEvent);
3e7ee490 578
454f18a9 579 /* At this point, we received the gpadl created msg */
f4266e34
GKH
580 DPRINT_DBG(VMBUS, "Received GPADL created "
581 "(relid %d, status %d handle %x)",
582 Channel->OfferMsg.ChildRelId,
583 msgInfo->Response.GpadlCreated.CreationStatus,
584 gpadlMsg->Gpadl);
3e7ee490
HJ
585
586 *GpadlHandle = gpadlMsg->Gpadl;
587
588Cleanup:
dd0813b6 589 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
53af545b 590 list_del(&msgInfo->MsgListEntry);
dd0813b6 591 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490 592
420beac4 593 kfree(msgInfo->WaitEvent);
8c69f52a 594 kfree(msgInfo);
3e7ee490
HJ
595
596 DPRINT_EXIT(VMBUS);
597
598 return ret;
599}
600
3e189519 601/*
f4266e34
GKH
602 * VmbusChannelTeardownGpadl -Teardown the specified GPADL handle
603 */
aded7165 604int VmbusChannelTeardownGpadl(struct vmbus_channel *Channel, u32 GpadlHandle)
3e7ee490 605{
82250213 606 struct vmbus_channel_gpadl_teardown *msg;
aded7165 607 struct vmbus_channel_msginfo *info;
dd0813b6 608 unsigned long flags;
f4266e34 609 int ret;
3e7ee490
HJ
610
611 DPRINT_ENTER(VMBUS);
612
0ace247e 613 /* ASSERT(GpadlHandle != 0); */
3e7ee490 614
f4266e34
GKH
615 info = kmalloc(sizeof(*info) +
616 sizeof(struct vmbus_channel_gpadl_teardown), GFP_KERNEL);
c3bf2e26
BP
617 if (!info)
618 return -ENOMEM;
3e7ee490 619
bfc30aae 620 info->WaitEvent = osd_WaitEventCreate();
c3bf2e26
BP
621 if (!info->WaitEvent) {
622 kfree(info);
623 return -ENOMEM;
624 }
3e7ee490 625
82250213 626 msg = (struct vmbus_channel_gpadl_teardown *)info->Msg;
3e7ee490
HJ
627
628 msg->Header.MessageType = ChannelMessageGpadlTeardown;
f4266e34
GKH
629 msg->ChildRelId = Channel->OfferMsg.ChildRelId;
630 msg->Gpadl = GpadlHandle;
3e7ee490 631
dd0813b6 632 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
53af545b
BP
633 list_add_tail(&info->MsgListEntry,
634 &gVmbusConnection.ChannelMsgList);
dd0813b6 635 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490 636
f4266e34
GKH
637 ret = VmbusPostMessage(msg,
638 sizeof(struct vmbus_channel_gpadl_teardown));
639 if (ret != 0) {
454f18a9 640 /* TODO: */
f4266e34 641 /* something... */
3e7ee490
HJ
642 }
643
bfc30aae 644 osd_WaitEventWait(info->WaitEvent);
3e7ee490 645
454f18a9 646 /* Received a torndown response */
dd0813b6 647 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
53af545b 648 list_del(&info->MsgListEntry);
dd0813b6 649 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490 650
420beac4 651 kfree(info->WaitEvent);
8c69f52a 652 kfree(info);
3e7ee490
HJ
653
654 DPRINT_EXIT(VMBUS);
655
656 return ret;
657}
658
3e189519 659/*
f4266e34
GKH
660 * VmbusChannelClose - Close the specified channel
661 */
aded7165 662void VmbusChannelClose(struct vmbus_channel *Channel)
3e7ee490 663{
82250213 664 struct vmbus_channel_close_channel *msg;
aded7165 665 struct vmbus_channel_msginfo *info;
0f5e44ca 666 unsigned long flags;
f4266e34 667 int ret;
3e7ee490
HJ
668
669 DPRINT_ENTER(VMBUS);
670
454f18a9 671 /* Stop callback and cancel the timer asap */
3e7ee490 672 Channel->OnChannelCallback = NULL;
5996b3dd 673 del_timer_sync(&Channel->poll_timer);
3e7ee490 674
454f18a9 675 /* Send a closing message */
f4266e34
GKH
676 info = kmalloc(sizeof(*info) +
677 sizeof(struct vmbus_channel_close_channel), GFP_KERNEL);
c3bf2e26
BP
678 /* FIXME: can't do anything other than return here because the
679 * function is void */
680 if (!info)
681 return;
3e7ee490 682
bfc30aae 683 /* info->waitEvent = osd_WaitEventCreate(); */
3e7ee490 684
82250213 685 msg = (struct vmbus_channel_close_channel *)info->Msg;
f4266e34
GKH
686 msg->Header.MessageType = ChannelMessageCloseChannel;
687 msg->ChildRelId = Channel->OfferMsg.ChildRelId;
3e7ee490 688
82250213 689 ret = VmbusPostMessage(msg, sizeof(struct vmbus_channel_close_channel));
f4266e34 690 if (ret != 0) {
454f18a9 691 /* TODO: */
f4266e34 692 /* something... */
3e7ee490
HJ
693 }
694
454f18a9 695 /* Tear down the gpadl for the channel's ring buffer */
3e7ee490 696 if (Channel->RingBufferGpadlHandle)
f4266e34
GKH
697 VmbusChannelTeardownGpadl(Channel,
698 Channel->RingBufferGpadlHandle);
3e7ee490 699
454f18a9 700 /* TODO: Send a msg to release the childRelId */
3e7ee490 701
454f18a9 702 /* Cleanup the ring buffers for this channel */
3e7ee490
HJ
703 RingBufferCleanup(&Channel->Outbound);
704 RingBufferCleanup(&Channel->Inbound);
705
bfc30aae 706 osd_PageFree(Channel->RingBufferPages, Channel->RingBufferPageCount);
3e7ee490 707
8c69f52a 708 kfree(info);
3e7ee490 709
454f18a9
BP
710 /*
711 * If we are closing the channel during an error path in
712 * opening the channel, don't free the channel since the
713 * caller will free the channel
714 */
715
f4266e34 716 if (Channel->State == CHANNEL_OPEN_STATE) {
0f5e44ca 717 spin_lock_irqsave(&gVmbusConnection.channel_lock, flags);
53af545b 718 list_del(&Channel->ListEntry);
0f5e44ca 719 spin_unlock_irqrestore(&gVmbusConnection.channel_lock, flags);
3e7ee490
HJ
720
721 FreeVmbusChannel(Channel);
722 }
723
724 DPRINT_EXIT(VMBUS);
725}
726
c88c4e4c
HJ
727/**
728 * VmbusChannelSendPacket() - Send the specified buffer on the given channel
729 * @Channel: Pointer to vmbus_channel structure.
730 * @Buffer: Pointer to the buffer you want to receive the data into.
731 * @BufferLen: Maximum size of what the the buffer will hold
732 * @RequestId: Identifier of the request
733 * @vmbus_packet_type: Type of packet that is being send e.g. negotiate, time
734 * packet etc.
735 *
736 * Sends data in @Buffer directly to hyper-v via the vmbus
737 * This will send the data unparsed to hyper-v.
738 *
739 * Mainly used by Hyper-V drivers.
f4266e34
GKH
740 */
741int VmbusChannelSendPacket(struct vmbus_channel *Channel, const void *Buffer,
742 u32 BufferLen, u64 RequestId,
743 enum vmbus_packet_type Type, u32 Flags)
3e7ee490 744{
8dc0a06a
GKH
745 struct vmpacket_descriptor desc;
746 u32 packetLen = sizeof(struct vmpacket_descriptor) + BufferLen;
59471438 747 u32 packetLenAligned = ALIGN_UP(packetLen, sizeof(u64));
b219b3f7 748 struct scatterlist bufferList[3];
f4266e34
GKH
749 u64 alignedData = 0;
750 int ret;
3e7ee490
HJ
751
752 DPRINT_ENTER(VMBUS);
f4266e34
GKH
753 DPRINT_DBG(VMBUS, "channel %p buffer %p len %d",
754 Channel, Buffer, BufferLen);
3e7ee490
HJ
755
756 DumpVmbusChannel(Channel);
757
0ace247e 758 /* ASSERT((packetLenAligned - packetLen) < sizeof(u64)); */
3e7ee490 759
454f18a9
BP
760 /* Setup the descriptor */
761 desc.Type = Type; /* VmbusPacketTypeDataInBand; */
762 desc.Flags = Flags; /* VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED; */
f4266e34
GKH
763 /* in 8-bytes granularity */
764 desc.DataOffset8 = sizeof(struct vmpacket_descriptor) >> 3;
454f18a9
BP
765 desc.Length8 = (u16)(packetLenAligned >> 3);
766 desc.TransactionId = RequestId;
3e7ee490 767
f4266e34 768 sg_init_table(bufferList, 3);
8dc0a06a 769 sg_set_buf(&bufferList[0], &desc, sizeof(struct vmpacket_descriptor));
b219b3f7
NP
770 sg_set_buf(&bufferList[1], Buffer, BufferLen);
771 sg_set_buf(&bufferList[2], &alignedData, packetLenAligned - packetLen);
3e7ee490 772
f4266e34 773 ret = RingBufferWrite(&Channel->Outbound, bufferList, 3);
3e7ee490 774
454f18a9 775 /* TODO: We should determine if this is optional */
3e7ee490 776 if (ret == 0 && !GetRingBufferInterruptMask(&Channel->Outbound))
3e7ee490 777 VmbusChannelSetEvent(Channel);
3e7ee490
HJ
778
779 DPRINT_EXIT(VMBUS);
780
781 return ret;
782}
c88c4e4c 783EXPORT_SYMBOL(VmbusChannelSendPacket);
3e7ee490 784
3e189519
HJ
785/*
786 * VmbusChannelSendPacketPageBuffer - Send a range of single-page buffer
787 * packets using a GPADL Direct packet type.
f4266e34 788 */
aded7165 789int VmbusChannelSendPacketPageBuffer(struct vmbus_channel *Channel,
f4266e34
GKH
790 struct hv_page_buffer PageBuffers[],
791 u32 PageCount, void *Buffer, u32 BufferLen,
792 u64 RequestId)
3e7ee490 793{
f4266e34
GKH
794 int ret;
795 int i;
0cf4fa80 796 struct VMBUS_CHANNEL_PACKET_PAGE_BUFFER desc;
4d643114
GKH
797 u32 descSize;
798 u32 packetLen;
799 u32 packetLenAligned;
b219b3f7 800 struct scatterlist bufferList[3];
f4266e34 801 u64 alignedData = 0;
3e7ee490
HJ
802
803 DPRINT_ENTER(VMBUS);
804
002b53ea
BP
805 if (PageCount > MAX_PAGE_BUFFER_COUNT)
806 return -EINVAL;
3e7ee490
HJ
807
808 DumpVmbusChannel(Channel);
809
f4266e34
GKH
810 /*
811 * Adjust the size down since VMBUS_CHANNEL_PACKET_PAGE_BUFFER is the
812 * largest size we support
813 */
814 descSize = sizeof(struct VMBUS_CHANNEL_PACKET_PAGE_BUFFER) -
815 ((MAX_PAGE_BUFFER_COUNT - PageCount) *
816 sizeof(struct hv_page_buffer));
3e7ee490 817 packetLen = descSize + BufferLen;
59471438 818 packetLenAligned = ALIGN_UP(packetLen, sizeof(u64));
3e7ee490 819
0ace247e 820 /* ASSERT((packetLenAligned - packetLen) < sizeof(u64)); */
3e7ee490 821
454f18a9 822 /* Setup the descriptor */
3e7ee490
HJ
823 desc.Type = VmbusPacketTypeDataUsingGpaDirect;
824 desc.Flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
454f18a9
BP
825 desc.DataOffset8 = descSize >> 3; /* in 8-bytes grandularity */
826 desc.Length8 = (u16)(packetLenAligned >> 3);
827 desc.TransactionId = RequestId;
3e7ee490
HJ
828 desc.RangeCount = PageCount;
829
f4266e34 830 for (i = 0; i < PageCount; i++) {
3e7ee490
HJ
831 desc.Range[i].Length = PageBuffers[i].Length;
832 desc.Range[i].Offset = PageBuffers[i].Offset;
833 desc.Range[i].Pfn = PageBuffers[i].Pfn;
834 }
835
f4266e34 836 sg_init_table(bufferList, 3);
b219b3f7
NP
837 sg_set_buf(&bufferList[0], &desc, descSize);
838 sg_set_buf(&bufferList[1], Buffer, BufferLen);
839 sg_set_buf(&bufferList[2], &alignedData, packetLenAligned - packetLen);
3e7ee490 840
f4266e34 841 ret = RingBufferWrite(&Channel->Outbound, bufferList, 3);
3e7ee490 842
454f18a9 843 /* TODO: We should determine if this is optional */
3e7ee490 844 if (ret == 0 && !GetRingBufferInterruptMask(&Channel->Outbound))
3e7ee490 845 VmbusChannelSetEvent(Channel);
3e7ee490
HJ
846
847 DPRINT_EXIT(VMBUS);
848
849 return ret;
850}
851
3e189519
HJ
852/*
853 * VmbusChannelSendPacketMultiPageBuffer - Send a multi-page buffer packet
854 * using a GPADL Direct packet type.
f4266e34 855 */
aded7165 856int VmbusChannelSendPacketMultiPageBuffer(struct vmbus_channel *Channel,
f4266e34
GKH
857 struct hv_multipage_buffer *MultiPageBuffer,
858 void *Buffer, u32 BufferLen, u64 RequestId)
3e7ee490 859{
f4266e34 860 int ret;
3fcc523a 861 struct VMBUS_CHANNEL_PACKET_MULITPAGE_BUFFER desc;
4d643114
GKH
862 u32 descSize;
863 u32 packetLen;
864 u32 packetLenAligned;
b219b3f7 865 struct scatterlist bufferList[3];
f4266e34
GKH
866 u64 alignedData = 0;
867 u32 PfnCount = NUM_PAGES_SPANNED(MultiPageBuffer->Offset,
868 MultiPageBuffer->Length);
3e7ee490
HJ
869
870 DPRINT_ENTER(VMBUS);
871
872 DumpVmbusChannel(Channel);
873
f4266e34
GKH
874 DPRINT_DBG(VMBUS, "data buffer - offset %u len %u pfn count %u",
875 MultiPageBuffer->Offset, MultiPageBuffer->Length, PfnCount);
3e7ee490 876
002b53ea
BP
877 if ((PfnCount < 0) || (PfnCount > MAX_MULTIPAGE_BUFFER_COUNT))
878 return -EINVAL;
3e7ee490 879
f4266e34
GKH
880 /*
881 * Adjust the size down since VMBUS_CHANNEL_PACKET_MULITPAGE_BUFFER is
882 * the largest size we support
883 */
884 descSize = sizeof(struct VMBUS_CHANNEL_PACKET_MULITPAGE_BUFFER) -
885 ((MAX_MULTIPAGE_BUFFER_COUNT - PfnCount) *
886 sizeof(u64));
3e7ee490 887 packetLen = descSize + BufferLen;
59471438 888 packetLenAligned = ALIGN_UP(packetLen, sizeof(u64));
3e7ee490 889
0ace247e 890 /* ASSERT((packetLenAligned - packetLen) < sizeof(u64)); */
3e7ee490 891
454f18a9 892 /* Setup the descriptor */
3e7ee490
HJ
893 desc.Type = VmbusPacketTypeDataUsingGpaDirect;
894 desc.Flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
454f18a9
BP
895 desc.DataOffset8 = descSize >> 3; /* in 8-bytes grandularity */
896 desc.Length8 = (u16)(packetLenAligned >> 3);
897 desc.TransactionId = RequestId;
3e7ee490
HJ
898 desc.RangeCount = 1;
899
900 desc.Range.Length = MultiPageBuffer->Length;
901 desc.Range.Offset = MultiPageBuffer->Offset;
902
f4266e34
GKH
903 memcpy(desc.Range.PfnArray, MultiPageBuffer->PfnArray,
904 PfnCount * sizeof(u64));
3e7ee490 905
f4266e34 906 sg_init_table(bufferList, 3);
b219b3f7
NP
907 sg_set_buf(&bufferList[0], &desc, descSize);
908 sg_set_buf(&bufferList[1], Buffer, BufferLen);
909 sg_set_buf(&bufferList[2], &alignedData, packetLenAligned - packetLen);
3e7ee490 910
f4266e34 911 ret = RingBufferWrite(&Channel->Outbound, bufferList, 3);
3e7ee490 912
454f18a9 913 /* TODO: We should determine if this is optional */
3e7ee490 914 if (ret == 0 && !GetRingBufferInterruptMask(&Channel->Outbound))
3e7ee490 915 VmbusChannelSetEvent(Channel);
3e7ee490
HJ
916
917 DPRINT_EXIT(VMBUS);
918
919 return ret;
920}
921
c88c4e4c
HJ
922
923/**
924 * VmbusChannelRecvPacket() - Retrieve the user packet on the specified channel
925 * @Channel: Pointer to vmbus_channel structure.
926 * @Buffer: Pointer to the buffer you want to receive the data into.
927 * @BufferLen: Maximum size of what the the buffer will hold
928 * @BufferActualLen: The actual size of the data after it was received
929 * @RequestId: Identifier of the request
930 *
931 * Receives directly from the hyper-v vmbus and puts the data it received
932 * into Buffer. This will receive the data unparsed from hyper-v.
933 *
934 * Mainly used by Hyper-V drivers.
f4266e34 935 */
f4266e34
GKH
936int VmbusChannelRecvPacket(struct vmbus_channel *Channel, void *Buffer,
937 u32 BufferLen, u32 *BufferActualLen, u64 *RequestId)
3e7ee490 938{
8dc0a06a 939 struct vmpacket_descriptor desc;
4d643114
GKH
940 u32 packetLen;
941 u32 userLen;
3e7ee490 942 int ret;
54411c42 943 unsigned long flags;
3e7ee490
HJ
944
945 DPRINT_ENTER(VMBUS);
946
947 *BufferActualLen = 0;
948 *RequestId = 0;
949
54411c42 950 spin_lock_irqsave(&Channel->inbound_lock, flags);
3e7ee490 951
f4266e34
GKH
952 ret = RingBufferPeek(&Channel->Inbound, &desc,
953 sizeof(struct vmpacket_descriptor));
954 if (ret != 0) {
54411c42 955 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
3e7ee490 956
454f18a9 957 /* DPRINT_DBG(VMBUS, "nothing to read!!"); */
3e7ee490
HJ
958 DPRINT_EXIT(VMBUS);
959 return 0;
960 }
961
454f18a9 962 /* VmbusChannelClearEvent(Channel); */
3e7ee490
HJ
963
964 packetLen = desc.Length8 << 3;
965 userLen = packetLen - (desc.DataOffset8 << 3);
454f18a9 966 /* ASSERT(userLen > 0); */
3e7ee490 967
f4266e34
GKH
968 DPRINT_DBG(VMBUS, "packet received on channel %p relid %d <type %d "
969 "flag %d tid %llx pktlen %d datalen %d> ",
970 Channel, Channel->OfferMsg.ChildRelId, desc.Type,
971 desc.Flags, desc.TransactionId, packetLen, userLen);
3e7ee490
HJ
972
973 *BufferActualLen = userLen;
974
f4266e34 975 if (userLen > BufferLen) {
54411c42 976 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
3e7ee490 977
f4266e34
GKH
978 DPRINT_ERR(VMBUS, "buffer too small - got %d needs %d",
979 BufferLen, userLen);
3e7ee490
HJ
980 DPRINT_EXIT(VMBUS);
981
982 return -1;
983 }
984
985 *RequestId = desc.TransactionId;
986
454f18a9 987 /* Copy over the packet to the user buffer */
f4266e34
GKH
988 ret = RingBufferRead(&Channel->Inbound, Buffer, userLen,
989 (desc.DataOffset8 << 3));
3e7ee490 990
54411c42 991 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
3e7ee490
HJ
992
993 DPRINT_EXIT(VMBUS);
994
995 return 0;
996}
c88c4e4c 997EXPORT_SYMBOL(VmbusChannelRecvPacket);
3e7ee490 998
3e189519 999/*
f4266e34
GKH
1000 * VmbusChannelRecvPacketRaw - Retrieve the raw packet on the specified channel
1001 */
1002int VmbusChannelRecvPacketRaw(struct vmbus_channel *Channel, void *Buffer,
1003 u32 BufferLen, u32 *BufferActualLen,
1004 u64 *RequestId)
3e7ee490 1005{
8dc0a06a 1006 struct vmpacket_descriptor desc;
4d643114
GKH
1007 u32 packetLen;
1008 u32 userLen;
3e7ee490 1009 int ret;
54411c42 1010 unsigned long flags;
3e7ee490
HJ
1011
1012 DPRINT_ENTER(VMBUS);
1013
1014 *BufferActualLen = 0;
1015 *RequestId = 0;
1016
54411c42 1017 spin_lock_irqsave(&Channel->inbound_lock, flags);
3e7ee490 1018
f4266e34
GKH
1019 ret = RingBufferPeek(&Channel->Inbound, &desc,
1020 sizeof(struct vmpacket_descriptor));
1021 if (ret != 0) {
54411c42 1022 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
3e7ee490 1023
454f18a9 1024 /* DPRINT_DBG(VMBUS, "nothing to read!!"); */
3e7ee490
HJ
1025 DPRINT_EXIT(VMBUS);
1026 return 0;
1027 }
1028
454f18a9 1029 /* VmbusChannelClearEvent(Channel); */
3e7ee490
HJ
1030
1031 packetLen = desc.Length8 << 3;
1032 userLen = packetLen - (desc.DataOffset8 << 3);
1033
f4266e34
GKH
1034 DPRINT_DBG(VMBUS, "packet received on channel %p relid %d <type %d "
1035 "flag %d tid %llx pktlen %d datalen %d> ",
1036 Channel, Channel->OfferMsg.ChildRelId, desc.Type,
1037 desc.Flags, desc.TransactionId, packetLen, userLen);
3e7ee490
HJ
1038
1039 *BufferActualLen = packetLen;
1040
f4266e34 1041 if (packetLen > BufferLen) {
54411c42 1042 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
3e7ee490 1043
f4266e34
GKH
1044 DPRINT_ERR(VMBUS, "buffer too small - needed %d bytes but "
1045 "got space for only %d bytes", packetLen, BufferLen);
3e7ee490
HJ
1046 DPRINT_EXIT(VMBUS);
1047 return -2;
1048 }
1049
1050 *RequestId = desc.TransactionId;
1051
454f18a9 1052 /* Copy over the entire packet to the user buffer */
3e7ee490
HJ
1053 ret = RingBufferRead(&Channel->Inbound, Buffer, packetLen, 0);
1054
54411c42 1055 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
3e7ee490
HJ
1056
1057 DPRINT_EXIT(VMBUS);
1058
1059 return 0;
1060}
1061
3e189519 1062/*
f4266e34
GKH
1063 * VmbusChannelOnChannelEvent - Channel event callback
1064 */
aded7165 1065void VmbusChannelOnChannelEvent(struct vmbus_channel *Channel)
3e7ee490
HJ
1066{
1067 DumpVmbusChannel(Channel);
0ace247e 1068 /* ASSERT(Channel->OnChannelCallback); */
5996b3dd 1069
3e7ee490 1070 Channel->OnChannelCallback(Channel->ChannelCallbackContext);
5996b3dd
HZ
1071
1072 mod_timer(&Channel->poll_timer, jiffies + usecs_to_jiffies(100));
3e7ee490
HJ
1073}
1074
3e189519 1075/*
f4266e34
GKH
1076 * VmbusChannelOnTimer - Timer event callback
1077 */
46a05253 1078void VmbusChannelOnTimer(unsigned long data)
3e7ee490 1079{
aded7165 1080 struct vmbus_channel *channel = (struct vmbus_channel *)data;
3e7ee490 1081
0fa37b1e 1082 if (channel->OnChannelCallback)
3e7ee490 1083 channel->OnChannelCallback(channel->ChannelCallbackContext);
3e7ee490
HJ
1084}
1085
3e189519 1086/*
f4266e34
GKH
1087 * DumpVmbusChannel - Dump vmbus channel info to the console
1088 */
aded7165 1089static void DumpVmbusChannel(struct vmbus_channel *Channel)
3e7ee490
HJ
1090{
1091 DPRINT_DBG(VMBUS, "Channel (%d)", Channel->OfferMsg.ChildRelId);
1092 DumpRingInfo(&Channel->Outbound, "Outbound ");
1093 DumpRingInfo(&Channel->Inbound, "Inbound ");
1094}