blob: d303cbd4c5369479aa73ca2f40fed999565cc90c [file] [log] [blame]
Hank Janssen3e7ee492009-07-13 16:02:34 -07001/*
2 *
3 * Copyright (c) 2009, Microsoft Corporation.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
16 * Place - Suite 330, Boston, MA 02111-1307 USA.
17 *
18 * Authors:
19 * Haiyang Zhang <haiyangz@microsoft.com>
20 * Hank Janssen <hjanssen@microsoft.com>
21 *
22 */
23
Greg Kroah-Hartman5654e932009-07-14 15:08:20 -070024#include <linux/kernel.h>
Greg Kroah-Hartmana0086dc2009-08-17 17:22:08 -070025#include <linux/mm.h>
Greg Kroah-Hartman4983b392009-08-19 16:14:47 -070026#include "osd.h"
Greg Kroah-Hartman645954c2009-08-28 16:22:59 -070027#include "logging.h"
Hank Janssen3e7ee492009-07-13 16:02:34 -070028#include "VmbusPrivate.h"
29
Bill Pemberton454f18a2009-07-27 16:47:24 -040030/* Internal routines */
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -070031static int VmbusChannelCreateGpadlHeader(
Bill Pemberton454f18a2009-07-27 16:47:24 -040032 void * Kbuffer, /* must be phys and virt contiguous */
33 u32 Size, /* page-size multiple */
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -070034 struct vmbus_channel_msginfo **msgInfo,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -070035 u32 *MessageCount
Hank Janssen3e7ee492009-07-13 16:02:34 -070036 );
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -070037static void DumpVmbusChannel(struct vmbus_channel *channel);
38static void VmbusChannelSetEvent(struct vmbus_channel *channel);
Hank Janssen3e7ee492009-07-13 16:02:34 -070039
40
41#if 0
42static void
43DumpMonitorPage(
Greg Kroah-Hartmaneacb1b42009-08-20 12:11:26 -070044 struct hv_monitor_page *MonitorPage
Hank Janssen3e7ee492009-07-13 16:02:34 -070045 )
46{
47 int i=0;
48 int j=0;
49
50 DPRINT_DBG(VMBUS, "monitorPage - %p, trigger state - %d", MonitorPage, MonitorPage->TriggerState);
51
52 for (i=0; i<4; i++)
53 {
54 DPRINT_DBG(VMBUS, "trigger group (%d) - %llx", i, MonitorPage->TriggerGroup[i].AsUINT64);
55 }
56
57 for (i=0; i<4; i++)
58 {
59 for (j=0; j<32; j++)
60 {
61 DPRINT_DBG(VMBUS, "latency (%d)(%d) - %llx", i, j, MonitorPage->Latency[i][j]);
62 }
63 }
64 for (i=0; i<4; i++)
65 {
66 for (j=0; j<32; j++)
67 {
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -070068 DPRINT_DBG(VMBUS, "param-conn id (%d)(%d) - %d", i, j, MonitorPage->Parameter[i][j].ConnectionId.Asu32);
Hank Janssen3e7ee492009-07-13 16:02:34 -070069 DPRINT_DBG(VMBUS, "param-flag (%d)(%d) - %d", i, j, MonitorPage->Parameter[i][j].FlagNumber);
70
71 }
72 }
73}
74#endif
75
76/*++
77
78Name:
79 VmbusChannelSetEvent()
80
81Description:
82 Trigger an event notification on the specified channel.
83
84--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -070085static void VmbusChannelSetEvent(struct vmbus_channel *Channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -070086{
Greg Kroah-Hartmaneacb1b42009-08-20 12:11:26 -070087 struct hv_monitor_page *monitorPage;
Hank Janssen3e7ee492009-07-13 16:02:34 -070088
89 DPRINT_ENTER(VMBUS);
90
91 if (Channel->OfferMsg.MonitorAllocated)
92 {
Bill Pemberton454f18a2009-07-27 16:47:24 -040093 /* Each u32 represents 32 channels */
Bill Pemberton7c369f42009-07-29 17:00:11 -040094 set_bit(Channel->OfferMsg.ChildRelId & 31,
95 (unsigned long *) gVmbusConnection.SendInterruptPage +
96 (Channel->OfferMsg.ChildRelId >> 5) );
Hank Janssen3e7ee492009-07-13 16:02:34 -070097
Greg Kroah-Hartmaneacb1b42009-08-20 12:11:26 -070098 monitorPage = (struct hv_monitor_page *)gVmbusConnection.MonitorPages;
Bill Pemberton454f18a2009-07-27 16:47:24 -040099 monitorPage++; /* Get the child to parent monitor page */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700100
Bill Pemberton7c369f42009-07-29 17:00:11 -0400101 set_bit(Channel->MonitorBit,
102 (unsigned long *) &monitorPage->TriggerGroup[Channel->MonitorGroup].Pending);
103
Hank Janssen3e7ee492009-07-13 16:02:34 -0700104 }
105 else
106 {
107 VmbusSetEvent(Channel->OfferMsg.ChildRelId);
108 }
109
110 DPRINT_EXIT(VMBUS);
111}
112
113#if 0
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700114static void VmbusChannelClearEvent(struct vmbus_channel *channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700115{
Greg Kroah-Hartmaneacb1b42009-08-20 12:11:26 -0700116 struct hv_monitor_page *monitorPage;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700117
118 DPRINT_ENTER(VMBUS);
119
120 if (Channel->OfferMsg.MonitorAllocated)
121 {
Bill Pemberton454f18a2009-07-27 16:47:24 -0400122 /* Each u32 represents 32 channels */
Bill Pemberton7c369f42009-07-29 17:00:11 -0400123 clear_bit(Channel->OfferMsg.ChildRelId & 31,
124 (unsigned long *) gVmbusConnection.SendInterruptPage + (Channel->OfferMsg.ChildRelId >> 5));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700125
Greg Kroah-Hartmaneacb1b42009-08-20 12:11:26 -0700126 monitorPage = (struct hv_monitor_page *)gVmbusConnection.MonitorPages;
Bill Pemberton454f18a2009-07-27 16:47:24 -0400127 monitorPage++; /* Get the child to parent monitor page */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700128
Bill Pemberton7c369f42009-07-29 17:00:11 -0400129 clear_bit(Channel->MonitorBit,
130 (unsigned long *) &monitorPage->TriggerGroup[Channel->MonitorGroup].Pending);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700131 }
132
133 DPRINT_EXIT(VMBUS);
134}
135
136#endif
137/*++;
138
139Name:
140 VmbusChannelGetDebugInfo()
141
142Description:
143 Retrieve various channel debug info
144
145--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700146void VmbusChannelGetDebugInfo(struct vmbus_channel *Channel,
147 struct vmbus_channel_debug_info *DebugInfo)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700148{
Greg Kroah-Hartmaneacb1b42009-08-20 12:11:26 -0700149 struct hv_monitor_page *monitorPage;
Greg Kroah-Hartman5654e932009-07-14 15:08:20 -0700150 u8 monitorGroup = (u8)Channel->OfferMsg.MonitorId / 32;
151 u8 monitorOffset = (u8)Channel->OfferMsg.MonitorId % 32;
Bill Pemberton454f18a2009-07-27 16:47:24 -0400152 /* u32 monitorBit = 1 << monitorOffset; */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700153
154 DebugInfo->RelId = Channel->OfferMsg.ChildRelId;
155 DebugInfo->State = Channel->State;
Greg Kroah-Hartmancaf26a32009-08-19 16:17:03 -0700156 memcpy(&DebugInfo->InterfaceType, &Channel->OfferMsg.Offer.InterfaceType, sizeof(struct hv_guid));
157 memcpy(&DebugInfo->InterfaceInstance, &Channel->OfferMsg.Offer.InterfaceInstance, sizeof(struct hv_guid));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700158
Greg Kroah-Hartmaneacb1b42009-08-20 12:11:26 -0700159 monitorPage = (struct hv_monitor_page *)gVmbusConnection.MonitorPages;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700160
161 DebugInfo->MonitorId = Channel->OfferMsg.MonitorId;
162
163 DebugInfo->ServerMonitorPending = monitorPage->TriggerGroup[monitorGroup].Pending;
164 DebugInfo->ServerMonitorLatency = monitorPage->Latency[monitorGroup][ monitorOffset];
165 DebugInfo->ServerMonitorConnectionId = monitorPage->Parameter[monitorGroup][ monitorOffset].ConnectionId.u.Id;
166
167 monitorPage++;
168
169 DebugInfo->ClientMonitorPending = monitorPage->TriggerGroup[monitorGroup].Pending;
170 DebugInfo->ClientMonitorLatency = monitorPage->Latency[monitorGroup][ monitorOffset];
171 DebugInfo->ClientMonitorConnectionId = monitorPage->Parameter[monitorGroup][ monitorOffset].ConnectionId.u.Id;
172
173 RingBufferGetDebugInfo(&Channel->Inbound, &DebugInfo->Inbound);
174 RingBufferGetDebugInfo(&Channel->Outbound, &DebugInfo->Outbound);
175}
176
177
178/*++;
179
180Name:
181 VmbusChannelOpen()
182
183Description:
184 Open the specified channel.
185
186--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700187int VmbusChannelOpen(struct vmbus_channel *NewChannel,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700188 u32 SendRingBufferSize,
189 u32 RecvRingBufferSize,
Greg Kroah-Hartman8282c402009-07-14 15:06:28 -0700190 void * UserData,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700191 u32 UserDataLen,
Hank Janssen3e7ee492009-07-13 16:02:34 -0700192 PFN_CHANNEL_CALLBACK pfnOnChannelCallback,
Greg Kroah-Hartman8282c402009-07-14 15:06:28 -0700193 void * Context
Hank Janssen3e7ee492009-07-13 16:02:34 -0700194 )
195{
196 int ret=0;
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700197 struct vmbus_channel_open_channel *openMsg;
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700198 struct vmbus_channel_msginfo *openInfo;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700199 void *in, *out;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700200 unsigned long flags;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700201
202 DPRINT_ENTER(VMBUS);
203
Bill Pemberton454f18a2009-07-27 16:47:24 -0400204 /* Aligned to page size */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700205 ASSERT(!(SendRingBufferSize & (PAGE_SIZE -1)));
206 ASSERT(!(RecvRingBufferSize & (PAGE_SIZE -1)));
207
208 NewChannel->OnChannelCallback = pfnOnChannelCallback;
209 NewChannel->ChannelCallbackContext = Context;
210
Bill Pemberton454f18a2009-07-27 16:47:24 -0400211 /* Allocate the ring buffer */
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700212 out = osd_PageAlloc((SendRingBufferSize + RecvRingBufferSize) >> PAGE_SHIFT);
Bill Pemberton454f18a2009-07-27 16:47:24 -0400213 /* out = kzalloc(sendRingBufferSize + recvRingBufferSize, GFP_KERNEL); */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700214 ASSERT(out);
Greg Kroah-Hartmanc4b0bc92009-07-14 15:12:46 -0700215 ASSERT(((unsigned long)out & (PAGE_SIZE-1)) == 0);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700216
Greg Kroah-Hartmanc4b0bc92009-07-14 15:12:46 -0700217 in = (void*)((unsigned long)out + SendRingBufferSize);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700218
219 NewChannel->RingBufferPages = out;
220 NewChannel->RingBufferPageCount = (SendRingBufferSize + RecvRingBufferSize) >> PAGE_SHIFT;
221
222 RingBufferInit(&NewChannel->Outbound, out, SendRingBufferSize);
223
224 RingBufferInit(&NewChannel->Inbound, in, RecvRingBufferSize);
225
Bill Pemberton454f18a2009-07-27 16:47:24 -0400226 /* Establish the gpadl for the ring buffer */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700227 DPRINT_DBG(VMBUS, "Establishing ring buffer's gpadl for channel %p...", NewChannel);
228
229 NewChannel->RingBufferGpadlHandle = 0;
230
231 ret = VmbusChannelEstablishGpadl(NewChannel,
232 NewChannel->Outbound.RingBuffer,
233 SendRingBufferSize + RecvRingBufferSize,
234 &NewChannel->RingBufferGpadlHandle);
235
236 DPRINT_DBG(VMBUS, "channel %p <relid %d gpadl 0x%x send ring %p size %d recv ring %p size %d, downstreamoffset %d>",
237 NewChannel,
238 NewChannel->OfferMsg.ChildRelId,
239 NewChannel->RingBufferGpadlHandle,
240 NewChannel->Outbound.RingBuffer,
241 NewChannel->Outbound.RingSize,
242 NewChannel->Inbound.RingBuffer,
243 NewChannel->Inbound.RingSize,
244 SendRingBufferSize);
245
Bill Pemberton454f18a2009-07-27 16:47:24 -0400246 /* Create and init the channel open message */
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700247 openInfo = kmalloc(sizeof(*openInfo) + sizeof(struct vmbus_channel_open_channel), GFP_KERNEL);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700248 ASSERT(openInfo != NULL);
249
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700250 openInfo->WaitEvent = osd_WaitEventCreate();
Hank Janssen3e7ee492009-07-13 16:02:34 -0700251
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700252 openMsg = (struct vmbus_channel_open_channel *)openInfo->Msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700253 openMsg->Header.MessageType = ChannelMessageOpenChannel;
Bill Pemberton454f18a2009-07-27 16:47:24 -0400254 openMsg->OpenId = NewChannel->OfferMsg.ChildRelId; /* FIXME */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700255 openMsg->ChildRelId = NewChannel->OfferMsg.ChildRelId;
256 openMsg->RingBufferGpadlHandle = NewChannel->RingBufferGpadlHandle;
257 ASSERT(openMsg->RingBufferGpadlHandle);
258 openMsg->DownstreamRingBufferPageOffset = SendRingBufferSize >> PAGE_SHIFT;
Bill Pemberton454f18a2009-07-27 16:47:24 -0400259 openMsg->ServerContextAreaGpadlHandle = 0; /* TODO */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700260
261 ASSERT(UserDataLen <= MAX_USER_DEFINED_BYTES);
262 if (UserDataLen)
263 {
264 memcpy(openMsg->UserData, UserData, UserDataLen);
265 }
266
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700267 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700268 INSERT_TAIL_LIST(&gVmbusConnection.ChannelMsgList, &openInfo->MsgListEntry);
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700269 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700270
271 DPRINT_DBG(VMBUS, "Sending channel open msg...");
272
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700273 ret = VmbusPostMessage(openMsg, sizeof(struct vmbus_channel_open_channel));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700274 if (ret != 0)
275 {
276 DPRINT_ERR(VMBUS, "unable to open channel - %d", ret);
277 goto Cleanup;
278 }
279
Bill Pemberton454f18a2009-07-27 16:47:24 -0400280 /* FIXME: Need to time-out here */
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700281 osd_WaitEventWait(openInfo->WaitEvent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700282
283 if (openInfo->Response.OpenResult.Status == 0)
284 {
285 DPRINT_INFO(VMBUS, "channel <%p> open success!!", NewChannel);
286 }
287 else
288 {
289 DPRINT_INFO(VMBUS, "channel <%p> open failed - %d!!", NewChannel, openInfo->Response.OpenResult.Status);
290 }
291
292Cleanup:
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700293 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700294 REMOVE_ENTRY_LIST(&openInfo->MsgListEntry);
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700295 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700296
Bill Pemberton420beac2009-07-29 17:00:10 -0400297 kfree(openInfo->WaitEvent);
Greg Kroah-Hartman8c69f522009-07-15 12:48:29 -0700298 kfree(openInfo);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700299
300 DPRINT_EXIT(VMBUS);
301
302 return 0;
303}
304
305/*++;
306
307Name:
308 DumpGpadlBody()
309
310Description:
311 Dump the gpadl body message to the console for debugging purposes.
312
313--*/
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700314static void DumpGpadlBody(struct vmbus_channel_gpadl_body *Gpadl, u32 Len)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700315{
316 int i=0;
317 int pfnCount=0;
318
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700319 pfnCount = (Len - sizeof(struct vmbus_channel_gpadl_body))/ sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700320 DPRINT_DBG(VMBUS, "gpadl body - len %d pfn count %d", Len, pfnCount);
321
322 for (i=0; i< pfnCount; i++)
323 {
324 DPRINT_DBG(VMBUS, "gpadl body - %d) pfn %llu", i, Gpadl->Pfn[i]);
325 }
326}
327
328
329/*++;
330
331Name:
332 DumpGpadlHeader()
333
334Description:
335 Dump the gpadl header message to the console for debugging purposes.
336
337--*/
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700338static void DumpGpadlHeader(struct vmbus_channel_gpadl_header *Gpadl)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700339{
340 int i=0,j=0;
341 int pageCount=0;
342
343
344 DPRINT_DBG(VMBUS, "gpadl header - relid %d, range count %d, range buflen %d",
345 Gpadl->ChildRelId,
346 Gpadl->RangeCount,
347 Gpadl->RangeBufLen);
348 for (i=0; i< Gpadl->RangeCount; i++)
349 {
350 pageCount = Gpadl->Range[i].ByteCount >> PAGE_SHIFT;
351 pageCount = (pageCount > 26)? 26 : pageCount;
352
353 DPRINT_DBG(VMBUS, "gpadl range %d - len %d offset %d page count %d",
354 i, Gpadl->Range[i].ByteCount, Gpadl->Range[i].ByteOffset, pageCount);
355
356 for (j=0; j< pageCount; j++)
357 {
358 DPRINT_DBG(VMBUS, "%d) pfn %llu", j, Gpadl->Range[i].PfnArray[j]);
359 }
360 }
361}
362
363/*++;
364
365Name:
366 VmbusChannelCreateGpadlHeader()
367
368Description:
369 Creates a gpadl for the specified buffer
370
371--*/
372static int
373VmbusChannelCreateGpadlHeader(
Bill Pemberton454f18a2009-07-27 16:47:24 -0400374 void * Kbuffer, /* from kmalloc() */
375 u32 Size, /* page-size multiple */
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700376 struct vmbus_channel_msginfo **MsgInfo,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700377 u32 *MessageCount)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700378{
379 int i;
380 int pageCount;
381 unsigned long long pfn;
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700382 struct vmbus_channel_gpadl_header *gpaHeader;
383 struct vmbus_channel_gpadl_body *gpadlBody;
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700384 struct vmbus_channel_msginfo *msgHeader;
385 struct vmbus_channel_msginfo *msgBody;
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700386 u32 msgSize;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700387
388 int pfnSum, pfnCount, pfnLeft, pfnCurr, pfnSize;
389
Bill Pemberton454f18a2009-07-27 16:47:24 -0400390 /* ASSERT( (kbuffer & (PAGE_SIZE-1)) == 0); */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700391 ASSERT( (Size & (PAGE_SIZE-1)) == 0);
392
393 pageCount = Size >> PAGE_SHIFT;
Greg Kroah-Hartmanfa56d362009-07-29 15:39:27 -0700394 pfn = virt_to_phys(Kbuffer) >> PAGE_SHIFT;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700395
Bill Pemberton454f18a2009-07-27 16:47:24 -0400396 /* do we need a gpadl body msg */
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700397 pfnSize = MAX_SIZE_CHANNEL_MESSAGE - sizeof(struct vmbus_channel_gpadl_header) - sizeof(struct gpa_range);
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700398 pfnCount = pfnSize / sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700399
Bill Pemberton454f18a2009-07-27 16:47:24 -0400400 if (pageCount > pfnCount) /* we need a gpadl body */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700401 {
Bill Pemberton454f18a2009-07-27 16:47:24 -0400402 /* fill in the header */
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700403 msgSize = sizeof(struct vmbus_channel_msginfo) + sizeof(struct vmbus_channel_gpadl_header) + sizeof(struct gpa_range) + pfnCount*sizeof(u64);
Greg Kroah-Hartmane276a3a2009-07-15 12:47:43 -0700404 msgHeader = kzalloc(msgSize, GFP_KERNEL);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700405
406 INITIALIZE_LIST_HEAD(&msgHeader->SubMsgList);
407 msgHeader->MessageSize=msgSize;
408
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700409 gpaHeader = (struct vmbus_channel_gpadl_header *)msgHeader->Msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700410 gpaHeader->RangeCount = 1;
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700411 gpaHeader->RangeBufLen = sizeof(struct gpa_range) + pageCount*sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700412 gpaHeader->Range[0].ByteOffset = 0;
413 gpaHeader->Range[0].ByteCount = Size;
414 for (i=0; i<pfnCount; i++)
415 {
416 gpaHeader->Range[0].PfnArray[i] = pfn+i;
417 }
418 *MsgInfo = msgHeader;
419 *MessageCount = 1;
420
421 pfnSum = pfnCount;
422 pfnLeft = pageCount - pfnCount;
423
Bill Pemberton454f18a2009-07-27 16:47:24 -0400424 /* how many pfns can we fit */
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700425 pfnSize = MAX_SIZE_CHANNEL_MESSAGE - sizeof(struct vmbus_channel_gpadl_body);
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700426 pfnCount = pfnSize / sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700427
Bill Pemberton454f18a2009-07-27 16:47:24 -0400428 /* fill in the body */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700429 while (pfnLeft)
430 {
431 if (pfnLeft > pfnCount)
432 {
433 pfnCurr = pfnCount;
434 }
435 else
436 {
437 pfnCurr = pfnLeft;
438 }
439
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700440 msgSize = sizeof(struct vmbus_channel_msginfo) + sizeof(struct vmbus_channel_gpadl_body) + pfnCurr*sizeof(u64);
Greg Kroah-Hartmane276a3a2009-07-15 12:47:43 -0700441 msgBody = kzalloc(msgSize, GFP_KERNEL);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700442 ASSERT(msgBody);
443 msgBody->MessageSize = msgSize;
444 (*MessageCount)++;
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700445 gpadlBody = (struct vmbus_channel_gpadl_body *)msgBody->Msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700446
Bill Pemberton454f18a2009-07-27 16:47:24 -0400447 /* FIXME: Gpadl is u32 and we are using a pointer which could be 64-bit */
448 /* gpadlBody->Gpadl = kbuffer; */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700449 for (i=0; i<pfnCurr; i++)
450 {
451 gpadlBody->Pfn[i] = pfn + pfnSum + i;
452 }
453
Bill Pemberton454f18a2009-07-27 16:47:24 -0400454 /* add to msg header */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700455 INSERT_TAIL_LIST(&msgHeader->SubMsgList, &msgBody->MsgListEntry);
456 pfnSum += pfnCurr;
457 pfnLeft -= pfnCurr;
458 }
459 }
460 else
461 {
Bill Pemberton454f18a2009-07-27 16:47:24 -0400462 /* everything fits in a header */
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700463 msgSize = sizeof(struct vmbus_channel_msginfo) + sizeof(struct vmbus_channel_gpadl_header) + sizeof(struct gpa_range) + pageCount*sizeof(u64);
Greg Kroah-Hartmane276a3a2009-07-15 12:47:43 -0700464 msgHeader = kzalloc(msgSize, GFP_KERNEL);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700465 msgHeader->MessageSize=msgSize;
466
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700467 gpaHeader = (struct vmbus_channel_gpadl_header *)msgHeader->Msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700468 gpaHeader->RangeCount = 1;
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700469 gpaHeader->RangeBufLen = sizeof(struct gpa_range) + pageCount*sizeof(u64);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700470 gpaHeader->Range[0].ByteOffset = 0;
471 gpaHeader->Range[0].ByteCount = Size;
472 for (i=0; i<pageCount; i++)
473 {
474 gpaHeader->Range[0].PfnArray[i] = pfn+i;
475 }
476
477 *MsgInfo = msgHeader;
478 *MessageCount = 1;
479 }
480
481 return 0;
482}
483
484
485/*++;
486
487Name:
488 VmbusChannelEstablishGpadl()
489
490Description:
491 Estabish a GPADL for the specified buffer
492
493--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700494int VmbusChannelEstablishGpadl(struct vmbus_channel *Channel,
Bill Pemberton454f18a2009-07-27 16:47:24 -0400495 void * Kbuffer, /* from kmalloc() */
496 u32 Size, /* page-size multiple */
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700497 u32 *GpadlHandle
Hank Janssen3e7ee492009-07-13 16:02:34 -0700498 )
499{
500 int ret=0;
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700501 struct vmbus_channel_gpadl_header *gpadlMsg;
502 struct vmbus_channel_gpadl_body *gpadlBody;
503 /* struct vmbus_channel_gpadl_created *gpadlCreated; */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700504
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700505 struct vmbus_channel_msginfo *msgInfo;
506 struct vmbus_channel_msginfo *subMsgInfo;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700507
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700508 u32 msgCount;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700509 LIST_ENTRY* anchor;
510 LIST_ENTRY* curr;
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700511 u32 nextGpadlHandle;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700512 unsigned long flags;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700513
514 DPRINT_ENTER(VMBUS);
515
Bill Pembertonf4888412009-07-29 17:00:12 -0400516 nextGpadlHandle = atomic_read(&gVmbusConnection.NextGpadlHandle);
517 atomic_inc(&gVmbusConnection.NextGpadlHandle);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700518
519 VmbusChannelCreateGpadlHeader(Kbuffer, Size, &msgInfo, &msgCount);
520 ASSERT(msgInfo != NULL);
521 ASSERT(msgCount >0);
522
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700523 msgInfo->WaitEvent = osd_WaitEventCreate();
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700524 gpadlMsg = (struct vmbus_channel_gpadl_header *)msgInfo->Msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700525 gpadlMsg->Header.MessageType = ChannelMessageGpadlHeader;
526 gpadlMsg->ChildRelId = Channel->OfferMsg.ChildRelId;
527 gpadlMsg->Gpadl = nextGpadlHandle;
528
529 DumpGpadlHeader(gpadlMsg);
530
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700531 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700532 INSERT_TAIL_LIST(&gVmbusConnection.ChannelMsgList, &msgInfo->MsgListEntry);
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700533 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700534
535 DPRINT_DBG(VMBUS, "buffer %p, size %d msg cnt %d", Kbuffer, Size, msgCount);
536
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700537 DPRINT_DBG(VMBUS, "Sending GPADL Header - len %zd", msgInfo->MessageSize - sizeof(*msgInfo));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700538
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700539 ret = VmbusPostMessage(gpadlMsg, msgInfo->MessageSize - sizeof(*msgInfo));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700540 if (ret != 0)
541 {
542 DPRINT_ERR(VMBUS, "Unable to open channel - %d", ret);
543 goto Cleanup;
544 }
545
546 if (msgCount>1)
547 {
548 ITERATE_LIST_ENTRIES(anchor, curr, &msgInfo->SubMsgList)
549 {
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700550 subMsgInfo = (struct vmbus_channel_msginfo *)curr;
551 gpadlBody = (struct vmbus_channel_gpadl_body *)subMsgInfo->Msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700552
553 gpadlBody->Header.MessageType = ChannelMessageGpadlBody;
554 gpadlBody->Gpadl = nextGpadlHandle;
555
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700556 DPRINT_DBG(VMBUS, "Sending GPADL Body - len %zd", subMsgInfo->MessageSize - sizeof(*subMsgInfo));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700557
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700558 DumpGpadlBody(gpadlBody, subMsgInfo->MessageSize - sizeof(*subMsgInfo));
559 ret = VmbusPostMessage(gpadlBody, subMsgInfo->MessageSize - sizeof(*subMsgInfo));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700560 ASSERT(ret == 0);
561 }
562 }
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700563 osd_WaitEventWait(msgInfo->WaitEvent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700564
Bill Pemberton454f18a2009-07-27 16:47:24 -0400565 /* At this point, we received the gpadl created msg */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700566 DPRINT_DBG(VMBUS, "Received GPADL created (relid %d, status %d handle %x)",
567 Channel->OfferMsg.ChildRelId,
568 msgInfo->Response.GpadlCreated.CreationStatus,
569 gpadlMsg->Gpadl);
570
571 *GpadlHandle = gpadlMsg->Gpadl;
572
573Cleanup:
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700574 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700575 REMOVE_ENTRY_LIST(&msgInfo->MsgListEntry);
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700576 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700577
Bill Pemberton420beac2009-07-29 17:00:10 -0400578 kfree(msgInfo->WaitEvent);
Greg Kroah-Hartman8c69f522009-07-15 12:48:29 -0700579 kfree(msgInfo);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700580
581 DPRINT_EXIT(VMBUS);
582
583 return ret;
584}
585
586
587
588/*++;
589
590Name:
591 VmbusChannelTeardownGpadl()
592
593Description:
594 Teardown the specified GPADL handle
595
596--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700597int VmbusChannelTeardownGpadl(struct vmbus_channel *Channel, u32 GpadlHandle)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700598{
599 int ret=0;
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700600 struct vmbus_channel_gpadl_teardown *msg;
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700601 struct vmbus_channel_msginfo *info;
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700602 unsigned long flags;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700603
604 DPRINT_ENTER(VMBUS);
605
606 ASSERT(GpadlHandle != 0);
607
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700608 info = kmalloc(sizeof(*info) + sizeof(struct vmbus_channel_gpadl_teardown), GFP_KERNEL);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700609 ASSERT(info != NULL);
610
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700611 info->WaitEvent = osd_WaitEventCreate();
Hank Janssen3e7ee492009-07-13 16:02:34 -0700612
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700613 msg = (struct vmbus_channel_gpadl_teardown *)info->Msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700614
615 msg->Header.MessageType = ChannelMessageGpadlTeardown;
616 msg->ChildRelId = Channel->OfferMsg.ChildRelId;
617 msg->Gpadl = GpadlHandle;
618
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700619 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700620 INSERT_TAIL_LIST(&gVmbusConnection.ChannelMsgList, &info->MsgListEntry);
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700621 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700622
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700623 ret = VmbusPostMessage(msg, sizeof(struct vmbus_channel_gpadl_teardown));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700624 if (ret != 0)
625 {
Bill Pemberton454f18a2009-07-27 16:47:24 -0400626 /* TODO: */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700627 }
628
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700629 osd_WaitEventWait(info->WaitEvent);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700630
Bill Pemberton454f18a2009-07-27 16:47:24 -0400631 /* Received a torndown response */
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700632 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700633 REMOVE_ENTRY_LIST(&info->MsgListEntry);
Greg Kroah-Hartmandd0813b2009-07-15 14:56:45 -0700634 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700635
Bill Pemberton420beac2009-07-29 17:00:10 -0400636 kfree(info->WaitEvent);
Greg Kroah-Hartman8c69f522009-07-15 12:48:29 -0700637 kfree(info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700638
639 DPRINT_EXIT(VMBUS);
640
641 return ret;
642}
643
644
645/*++
646
647Name:
648 VmbusChannelClose()
649
650Description:
651 Close the specified channel
652
653--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700654void VmbusChannelClose(struct vmbus_channel *Channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700655{
656 int ret=0;
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700657 struct vmbus_channel_close_channel *msg;
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700658 struct vmbus_channel_msginfo *info;
Greg Kroah-Hartman0f5e44c2009-07-15 14:57:16 -0700659 unsigned long flags;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700660
661 DPRINT_ENTER(VMBUS);
662
Bill Pemberton454f18a2009-07-27 16:47:24 -0400663 /* Stop callback and cancel the timer asap */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700664 Channel->OnChannelCallback = NULL;
Greg Kroah-Hartmanc8a429a2009-07-29 15:40:57 -0700665 del_timer(&Channel->poll_timer);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700666
Bill Pemberton454f18a2009-07-27 16:47:24 -0400667 /* Send a closing message */
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700668 info = kmalloc(sizeof(*info) + sizeof(struct vmbus_channel_close_channel), GFP_KERNEL);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700669 ASSERT(info != NULL);
670
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700671 /* info->waitEvent = osd_WaitEventCreate(); */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700672
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700673 msg = (struct vmbus_channel_close_channel *)info->Msg;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700674 msg->Header.MessageType = ChannelMessageCloseChannel;
675 msg->ChildRelId = Channel->OfferMsg.ChildRelId;
676
Greg Kroah-Hartman82250212009-08-26 15:16:04 -0700677 ret = VmbusPostMessage(msg, sizeof(struct vmbus_channel_close_channel));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700678 if (ret != 0)
679 {
Bill Pemberton454f18a2009-07-27 16:47:24 -0400680 /* TODO: */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700681 }
682
Bill Pemberton454f18a2009-07-27 16:47:24 -0400683 /* Tear down the gpadl for the channel's ring buffer */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700684 if (Channel->RingBufferGpadlHandle)
685 {
686 VmbusChannelTeardownGpadl(Channel, Channel->RingBufferGpadlHandle);
687 }
688
Bill Pemberton454f18a2009-07-27 16:47:24 -0400689 /* TODO: Send a msg to release the childRelId */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700690
Bill Pemberton454f18a2009-07-27 16:47:24 -0400691 /* Cleanup the ring buffers for this channel */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700692 RingBufferCleanup(&Channel->Outbound);
693 RingBufferCleanup(&Channel->Inbound);
694
Greg Kroah-Hartmanbfc30aa2009-07-29 15:40:18 -0700695 osd_PageFree(Channel->RingBufferPages, Channel->RingBufferPageCount);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700696
Greg Kroah-Hartman8c69f522009-07-15 12:48:29 -0700697 kfree(info);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700698
Bill Pemberton454f18a2009-07-27 16:47:24 -0400699
700 /*
701 * If we are closing the channel during an error path in
702 * opening the channel, don't free the channel since the
703 * caller will free the channel
704 */
705
Hank Janssen3e7ee492009-07-13 16:02:34 -0700706 if (Channel->State == CHANNEL_OPEN_STATE)
707 {
Greg Kroah-Hartman0f5e44c2009-07-15 14:57:16 -0700708 spin_lock_irqsave(&gVmbusConnection.channel_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700709 REMOVE_ENTRY_LIST(&Channel->ListEntry);
Greg Kroah-Hartman0f5e44c2009-07-15 14:57:16 -0700710 spin_unlock_irqrestore(&gVmbusConnection.channel_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700711
712 FreeVmbusChannel(Channel);
713 }
714
715 DPRINT_EXIT(VMBUS);
716}
717
718
719/*++
720
721Name:
722 VmbusChannelSendPacket()
723
724Description:
725 Send the specified buffer on the given channel
726
727--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700728int VmbusChannelSendPacket(struct vmbus_channel *Channel,
Greg Kroah-Hartman8282c402009-07-14 15:06:28 -0700729 const void * Buffer,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700730 u32 BufferLen,
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700731 u64 RequestId,
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700732 enum vmbus_packet_type Type,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700733 u32 Flags
Hank Janssen3e7ee492009-07-13 16:02:34 -0700734)
735{
736 int ret=0;
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700737 struct vmpacket_descriptor desc;
738 u32 packetLen = sizeof(struct vmpacket_descriptor) + BufferLen;
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700739 u32 packetLenAligned = ALIGN_UP(packetLen, sizeof(u64));
Nicolas Palixb219b3f2009-07-30 17:37:23 +0200740 struct scatterlist bufferList[3];
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700741 u64 alignedData=0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700742
743 DPRINT_ENTER(VMBUS);
744 DPRINT_DBG(VMBUS, "channel %p buffer %p len %d", Channel, Buffer, BufferLen);
745
746 DumpVmbusChannel(Channel);
747
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700748 ASSERT((packetLenAligned - packetLen) < sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700749
Bill Pemberton454f18a2009-07-27 16:47:24 -0400750 /* Setup the descriptor */
751 desc.Type = Type; /* VmbusPacketTypeDataInBand; */
752 desc.Flags = Flags; /* VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED; */
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700753 desc.DataOffset8 = sizeof(struct vmpacket_descriptor) >> 3; /* in 8-bytes granularity */
Bill Pemberton454f18a2009-07-27 16:47:24 -0400754 desc.Length8 = (u16)(packetLenAligned >> 3);
755 desc.TransactionId = RequestId;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700756
Nicolas Palixb219b3f2009-07-30 17:37:23 +0200757 sg_init_table(bufferList,3);
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700758 sg_set_buf(&bufferList[0], &desc, sizeof(struct vmpacket_descriptor));
Nicolas Palixb219b3f2009-07-30 17:37:23 +0200759 sg_set_buf(&bufferList[1], Buffer, BufferLen);
760 sg_set_buf(&bufferList[2], &alignedData, packetLenAligned - packetLen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700761
762 ret = RingBufferWrite(
763 &Channel->Outbound,
764 bufferList,
765 3);
766
Bill Pemberton454f18a2009-07-27 16:47:24 -0400767 /* TODO: We should determine if this is optional */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700768 if (ret == 0 && !GetRingBufferInterruptMask(&Channel->Outbound))
769 {
770 VmbusChannelSetEvent(Channel);
771 }
772
773 DPRINT_EXIT(VMBUS);
774
775 return ret;
776}
777
778
779/*++
780
781Name:
782 VmbusChannelSendPacketPageBuffer()
783
784Description:
785 Send a range of single-page buffer packets using a GPADL Direct packet type.
786
787--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700788int VmbusChannelSendPacketPageBuffer(struct vmbus_channel *Channel,
Greg Kroah-Hartmanee3d7dd2009-08-20 12:17:36 -0700789 struct hv_page_buffer PageBuffers[],
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700790 u32 PageCount,
Greg Kroah-Hartman8282c402009-07-14 15:06:28 -0700791 void * Buffer,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700792 u32 BufferLen,
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700793 u64 RequestId
Hank Janssen3e7ee492009-07-13 16:02:34 -0700794)
795{
796 int ret=0;
797 int i=0;
Bill Pemberton0cf4fa82009-07-27 16:47:39 -0400798 struct VMBUS_CHANNEL_PACKET_PAGE_BUFFER desc;
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700799 u32 descSize;
800 u32 packetLen;
801 u32 packetLenAligned;
Nicolas Palixb219b3f2009-07-30 17:37:23 +0200802 struct scatterlist bufferList[3];
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700803 u64 alignedData=0;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700804
805 DPRINT_ENTER(VMBUS);
806
807 ASSERT(PageCount <= MAX_PAGE_BUFFER_COUNT);
808
809 DumpVmbusChannel(Channel);
810
Bill Pemberton454f18a2009-07-27 16:47:24 -0400811 /* Adjust the size down since VMBUS_CHANNEL_PACKET_PAGE_BUFFER is the largest size we support */
Greg Kroah-Hartmanee3d7dd2009-08-20 12:17:36 -0700812 descSize = sizeof(struct VMBUS_CHANNEL_PACKET_PAGE_BUFFER) - ((MAX_PAGE_BUFFER_COUNT - PageCount)*sizeof(struct hv_page_buffer));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700813 packetLen = descSize + BufferLen;
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700814 packetLenAligned = ALIGN_UP(packetLen, sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700815
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700816 ASSERT((packetLenAligned - packetLen) < sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700817
Bill Pemberton454f18a2009-07-27 16:47:24 -0400818 /* Setup the descriptor */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700819 desc.Type = VmbusPacketTypeDataUsingGpaDirect;
820 desc.Flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
Bill Pemberton454f18a2009-07-27 16:47:24 -0400821 desc.DataOffset8 = descSize >> 3; /* in 8-bytes grandularity */
822 desc.Length8 = (u16)(packetLenAligned >> 3);
823 desc.TransactionId = RequestId;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700824 desc.RangeCount = PageCount;
825
826 for (i=0; i<PageCount; i++)
827 {
828 desc.Range[i].Length = PageBuffers[i].Length;
829 desc.Range[i].Offset = PageBuffers[i].Offset;
830 desc.Range[i].Pfn = PageBuffers[i].Pfn;
831 }
832
Nicolas Palixb219b3f2009-07-30 17:37:23 +0200833 sg_init_table(bufferList,3);
834 sg_set_buf(&bufferList[0], &desc, descSize);
835 sg_set_buf(&bufferList[1], Buffer, BufferLen);
836 sg_set_buf(&bufferList[2], &alignedData, packetLenAligned - packetLen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700837
838 ret = RingBufferWrite(
839 &Channel->Outbound,
840 bufferList,
841 3);
842
Bill Pemberton454f18a2009-07-27 16:47:24 -0400843 /* TODO: We should determine if this is optional */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700844 if (ret == 0 && !GetRingBufferInterruptMask(&Channel->Outbound))
845 {
846 VmbusChannelSetEvent(Channel);
847 }
848
849 DPRINT_EXIT(VMBUS);
850
851 return ret;
852}
853
854
855
856/*++
857
858Name:
859 VmbusChannelSendPacketMultiPageBuffer()
860
861Description:
862 Send a multi-page buffer packet using a GPADL Direct packet type.
863
864--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700865int VmbusChannelSendPacketMultiPageBuffer(struct vmbus_channel *Channel,
Greg Kroah-Hartmanee3d7dd2009-08-20 12:17:36 -0700866 struct hv_multipage_buffer *MultiPageBuffer,
Greg Kroah-Hartman8282c402009-07-14 15:06:28 -0700867 void * Buffer,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700868 u32 BufferLen,
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700869 u64 RequestId
Hank Janssen3e7ee492009-07-13 16:02:34 -0700870)
871{
872 int ret=0;
Bill Pemberton3fcc5232009-07-27 16:47:40 -0400873 struct VMBUS_CHANNEL_PACKET_MULITPAGE_BUFFER desc;
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700874 u32 descSize;
875 u32 packetLen;
876 u32 packetLenAligned;
Nicolas Palixb219b3f2009-07-30 17:37:23 +0200877 struct scatterlist bufferList[3];
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700878 u64 alignedData=0;
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700879 u32 PfnCount = NUM_PAGES_SPANNED(MultiPageBuffer->Offset, MultiPageBuffer->Length);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700880
881 DPRINT_ENTER(VMBUS);
882
883 DumpVmbusChannel(Channel);
884
885 DPRINT_DBG(VMBUS, "data buffer - offset %u len %u pfn count %u", MultiPageBuffer->Offset, MultiPageBuffer->Length, PfnCount);
886
887 ASSERT(PfnCount > 0);
888 ASSERT(PfnCount <= MAX_MULTIPAGE_BUFFER_COUNT);
889
Bill Pemberton454f18a2009-07-27 16:47:24 -0400890 /* Adjust the size down since VMBUS_CHANNEL_PACKET_MULITPAGE_BUFFER is the largest size we support */
Bill Pemberton3fcc5232009-07-27 16:47:40 -0400891 descSize = sizeof(struct VMBUS_CHANNEL_PACKET_MULITPAGE_BUFFER) - ((MAX_MULTIPAGE_BUFFER_COUNT - PfnCount)*sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700892 packetLen = descSize + BufferLen;
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700893 packetLenAligned = ALIGN_UP(packetLen, sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700894
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700895 ASSERT((packetLenAligned - packetLen) < sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700896
Bill Pemberton454f18a2009-07-27 16:47:24 -0400897 /* Setup the descriptor */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700898 desc.Type = VmbusPacketTypeDataUsingGpaDirect;
899 desc.Flags = VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED;
Bill Pemberton454f18a2009-07-27 16:47:24 -0400900 desc.DataOffset8 = descSize >> 3; /* in 8-bytes grandularity */
901 desc.Length8 = (u16)(packetLenAligned >> 3);
902 desc.TransactionId = RequestId;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700903 desc.RangeCount = 1;
904
905 desc.Range.Length = MultiPageBuffer->Length;
906 desc.Range.Offset = MultiPageBuffer->Offset;
907
Greg Kroah-Hartman59471432009-07-14 15:10:26 -0700908 memcpy(desc.Range.PfnArray, MultiPageBuffer->PfnArray, PfnCount*sizeof(u64));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700909
Nicolas Palixb219b3f2009-07-30 17:37:23 +0200910 sg_init_table(bufferList,3);
911 sg_set_buf(&bufferList[0], &desc, descSize);
912 sg_set_buf(&bufferList[1], Buffer, BufferLen);
913 sg_set_buf(&bufferList[2], &alignedData, packetLenAligned - packetLen);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700914
915 ret = RingBufferWrite(
916 &Channel->Outbound,
917 bufferList,
918 3);
919
Bill Pemberton454f18a2009-07-27 16:47:24 -0400920 /* TODO: We should determine if this is optional */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700921 if (ret == 0 && !GetRingBufferInterruptMask(&Channel->Outbound))
922 {
923 VmbusChannelSetEvent(Channel);
924 }
925
926 DPRINT_EXIT(VMBUS);
927
928 return ret;
929}
930
931
932/*++
933
934Name:
935 VmbusChannelRecvPacket()
936
937Description:
938 Retrieve the user packet on the specified channel
939
940--*/
Bill Pemberton454f18a2009-07-27 16:47:24 -0400941/* TODO: Do we ever receive a gpa direct packet other than the ones we send ? */
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -0700942int VmbusChannelRecvPacket(struct vmbus_channel *Channel,
Greg Kroah-Hartman46a05252009-08-17 17:21:31 -0700943 void *Buffer,
944 u32 BufferLen,
945 u32 *BufferActualLen,
946 u64 *RequestId)
Hank Janssen3e7ee492009-07-13 16:02:34 -0700947{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700948 struct vmpacket_descriptor desc;
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -0700949 u32 packetLen;
950 u32 userLen;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700951 int ret;
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -0700952 unsigned long flags;
Hank Janssen3e7ee492009-07-13 16:02:34 -0700953
954 DPRINT_ENTER(VMBUS);
955
956 *BufferActualLen = 0;
957 *RequestId = 0;
958
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -0700959 spin_lock_irqsave(&Channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700960
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -0700961 ret = RingBufferPeek(&Channel->Inbound, &desc, sizeof(struct vmpacket_descriptor));
Hank Janssen3e7ee492009-07-13 16:02:34 -0700962 if (ret != 0)
963 {
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -0700964 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700965
Bill Pemberton454f18a2009-07-27 16:47:24 -0400966 /* DPRINT_DBG(VMBUS, "nothing to read!!"); */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700967 DPRINT_EXIT(VMBUS);
968 return 0;
969 }
970
Bill Pemberton454f18a2009-07-27 16:47:24 -0400971 /* VmbusChannelClearEvent(Channel); */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700972
973 packetLen = desc.Length8 << 3;
974 userLen = packetLen - (desc.DataOffset8 << 3);
Bill Pemberton454f18a2009-07-27 16:47:24 -0400975 /* ASSERT(userLen > 0); */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700976
977 DPRINT_DBG(VMBUS, "packet received on channel %p relid %d <type %d flag %d tid %llx pktlen %d datalen %d> ",
978 Channel,
979 Channel->OfferMsg.ChildRelId,
980 desc.Type,
981 desc.Flags,
982 desc.TransactionId, packetLen, userLen);
983
984 *BufferActualLen = userLen;
985
986 if (userLen > BufferLen)
987 {
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -0700988 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -0700989
990 DPRINT_ERR(VMBUS, "buffer too small - got %d needs %d", BufferLen, userLen);
991 DPRINT_EXIT(VMBUS);
992
993 return -1;
994 }
995
996 *RequestId = desc.TransactionId;
997
Bill Pemberton454f18a2009-07-27 16:47:24 -0400998 /* Copy over the packet to the user buffer */
Hank Janssen3e7ee492009-07-13 16:02:34 -0700999 ret = RingBufferRead(&Channel->Inbound, Buffer, userLen, (desc.DataOffset8 << 3));
1000
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -07001001 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -07001002
1003 DPRINT_EXIT(VMBUS);
1004
1005 return 0;
1006}
1007
1008/*++
1009
1010Name:
1011 VmbusChannelRecvPacketRaw()
1012
1013Description:
1014 Retrieve the raw packet on the specified channel
1015
1016--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -07001017int VmbusChannelRecvPacketRaw(struct vmbus_channel *Channel,
Greg Kroah-Hartman8282c402009-07-14 15:06:28 -07001018 void * Buffer,
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -07001019 u32 BufferLen,
1020 u32* BufferActualLen,
Greg Kroah-Hartman59471432009-07-14 15:10:26 -07001021 u64* RequestId
Hank Janssen3e7ee492009-07-13 16:02:34 -07001022 )
1023{
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -07001024 struct vmpacket_descriptor desc;
Greg Kroah-Hartman4d643112009-07-14 15:09:36 -07001025 u32 packetLen;
1026 u32 userLen;
Hank Janssen3e7ee492009-07-13 16:02:34 -07001027 int ret;
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -07001028 unsigned long flags;
Hank Janssen3e7ee492009-07-13 16:02:34 -07001029
1030 DPRINT_ENTER(VMBUS);
1031
1032 *BufferActualLen = 0;
1033 *RequestId = 0;
1034
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -07001035 spin_lock_irqsave(&Channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -07001036
Greg Kroah-Hartman8dc0a062009-08-27 16:02:36 -07001037 ret = RingBufferPeek(&Channel->Inbound, &desc, sizeof(struct vmpacket_descriptor));
Hank Janssen3e7ee492009-07-13 16:02:34 -07001038 if (ret != 0)
1039 {
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -07001040 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -07001041
Bill Pemberton454f18a2009-07-27 16:47:24 -04001042 /* DPRINT_DBG(VMBUS, "nothing to read!!"); */
Hank Janssen3e7ee492009-07-13 16:02:34 -07001043 DPRINT_EXIT(VMBUS);
1044 return 0;
1045 }
1046
Bill Pemberton454f18a2009-07-27 16:47:24 -04001047 /* VmbusChannelClearEvent(Channel); */
Hank Janssen3e7ee492009-07-13 16:02:34 -07001048
1049 packetLen = desc.Length8 << 3;
1050 userLen = packetLen - (desc.DataOffset8 << 3);
1051
1052 DPRINT_DBG(VMBUS, "packet received on channel %p relid %d <type %d flag %d tid %llx pktlen %d datalen %d> ",
1053 Channel,
1054 Channel->OfferMsg.ChildRelId,
1055 desc.Type,
1056 desc.Flags,
1057 desc.TransactionId, packetLen, userLen);
1058
1059 *BufferActualLen = packetLen;
1060
1061 if (packetLen > BufferLen)
1062 {
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -07001063 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -07001064
1065 DPRINT_ERR(VMBUS, "buffer too small - needed %d bytes but got space for only %d bytes", packetLen, BufferLen);
1066 DPRINT_EXIT(VMBUS);
1067 return -2;
1068 }
1069
1070 *RequestId = desc.TransactionId;
1071
Bill Pemberton454f18a2009-07-27 16:47:24 -04001072 /* Copy over the entire packet to the user buffer */
Hank Janssen3e7ee492009-07-13 16:02:34 -07001073 ret = RingBufferRead(&Channel->Inbound, Buffer, packetLen, 0);
1074
Greg Kroah-Hartman54411c42009-07-15 14:48:32 -07001075 spin_unlock_irqrestore(&Channel->inbound_lock, flags);
Hank Janssen3e7ee492009-07-13 16:02:34 -07001076
1077 DPRINT_EXIT(VMBUS);
1078
1079 return 0;
1080}
1081
1082
1083/*++
1084
1085Name:
1086 VmbusChannelOnChannelEvent()
1087
1088Description:
1089 Channel event callback
1090
1091--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -07001092void VmbusChannelOnChannelEvent(struct vmbus_channel *Channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -07001093{
1094 DumpVmbusChannel(Channel);
1095 ASSERT(Channel->OnChannelCallback);
1096#ifdef ENABLE_POLLING
Greg Kroah-Hartmanc8a429a2009-07-29 15:40:57 -07001097 del_timer(&Channel->poll_timer);
Hank Janssen3e7ee492009-07-13 16:02:34 -07001098 Channel->OnChannelCallback(Channel->ChannelCallbackContext);
Greg Kroah-Hartmanc8a429a2009-07-29 15:40:57 -07001099 channel->poll_timer.expires(jiffies + usecs_to_jiffies(100);
1100 add_timer(&channel->poll_timer);
Hank Janssen3e7ee492009-07-13 16:02:34 -07001101#else
1102 Channel->OnChannelCallback(Channel->ChannelCallbackContext);
1103#endif
1104}
1105
1106/*++
1107
1108Name:
1109 VmbusChannelOnTimer()
1110
1111Description:
1112 Timer event callback
1113
1114--*/
Greg Kroah-Hartman46a05252009-08-17 17:21:31 -07001115void VmbusChannelOnTimer(unsigned long data)
Hank Janssen3e7ee492009-07-13 16:02:34 -07001116{
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -07001117 struct vmbus_channel *channel = (struct vmbus_channel *)data;
Hank Janssen3e7ee492009-07-13 16:02:34 -07001118
1119 if (channel->OnChannelCallback)
1120 {
1121 channel->OnChannelCallback(channel->ChannelCallbackContext);
1122#ifdef ENABLE_POLLING
Greg Kroah-Hartmanc8a429a2009-07-29 15:40:57 -07001123 channel->poll_timer.expires(jiffies + usecs_to_jiffies(100);
1124 add_timer(&channel->poll_timer);
Hank Janssen3e7ee492009-07-13 16:02:34 -07001125#endif
1126 }
1127}
1128
1129
1130/*++
1131
1132Name:
1133 DumpVmbusChannel()
1134
1135Description:
1136 Dump vmbus channel info to the console
1137
1138--*/
Greg Kroah-Hartmanaded71652009-08-18 15:21:19 -07001139static void DumpVmbusChannel(struct vmbus_channel *Channel)
Hank Janssen3e7ee492009-07-13 16:02:34 -07001140{
1141 DPRINT_DBG(VMBUS, "Channel (%d)", Channel->OfferMsg.ChildRelId);
1142 DumpRingInfo(&Channel->Outbound, "Outbound ");
1143 DumpRingInfo(&Channel->Inbound, "Inbound ");
1144}
1145
1146
Bill Pemberton454f18a2009-07-27 16:47:24 -04001147/* eof */