Staging: speakup: spk_types: trival coding style issue
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / hv / channel_mgmt.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 */
a0086dc5
GKH
21#include <linux/kernel.h>
22#include <linux/mm.h>
5a0e3ad6 23#include <linux/slab.h>
53af545b 24#include <linux/list.h>
c88c4e4c 25#include <linux/module.h>
8b5d6d3b 26#include <linux/completion.h>
4983b39a 27#include "osd.h"
645954c5 28#include "logging.h"
72daf320 29#include "vmbus_private.h"
c88c4e4c 30#include "utils.h"
3e7ee490 31
1d7e907f 32struct vmbus_channel_message_table_entry {
c8212f04
GKH
33 enum vmbus_channel_message_type messageType;
34 void (*messageHandler)(struct vmbus_channel_message_header *msg);
1d7e907f 35};
3e7ee490 36
9153f7b9
HJ
37#define MAX_MSG_TYPES 3
38#define MAX_NUM_DEVICE_CLASSES_SUPPORTED 7
c88c4e4c 39
bd60c33e 40static const struct hv_guid
c88c4e4c 41 gSupportedDeviceClasses[MAX_NUM_DEVICE_CLASSES_SUPPORTED] = {
454f18a9 42 /* {ba6163d9-04a1-4d29-b605-72e2ffb1dc7f} */
caf26a31
GKH
43 /* Storage - SCSI */
44 {
45 .data = {
46 0xd9, 0x63, 0x61, 0xba, 0xa1, 0x04, 0x29, 0x4d,
47 0xb6, 0x05, 0x72, 0xe2, 0xff, 0xb1, 0xdc, 0x7f
48 }
49 },
50
454f18a9 51 /* {F8615163-DF3E-46c5-913F-F2D2F965ED0E} */
caf26a31
GKH
52 /* Network */
53 {
54 .data = {
55 0x63, 0x51, 0x61, 0xF8, 0x3E, 0xDF, 0xc5, 0x46,
56 0x91, 0x3F, 0xF2, 0xD2, 0xF9, 0x65, 0xED, 0x0E
57 }
58 },
59
454f18a9 60 /* {CFA8B69E-5B4A-4cc0-B98B-8BA1A1F3F95A} */
caf26a31
GKH
61 /* Input */
62 {
63 .data = {
64 0x9E, 0xB6, 0xA8, 0xCF, 0x4A, 0x5B, 0xc0, 0x4c,
65 0xB9, 0x8B, 0x8B, 0xA1, 0xA1, 0xF3, 0xF9, 0x5A
66 }
67 },
3e7ee490 68
caf26a31
GKH
69 /* {32412632-86cb-44a2-9b5c-50d1417354f5} */
70 /* IDE */
71 {
72 .data = {
73 0x32, 0x26, 0x41, 0x32, 0xcb, 0x86, 0xa2, 0x44,
74 0x9b, 0x5c, 0x50, 0xd1, 0x41, 0x73, 0x54, 0xf5
75 }
76 },
c88c4e4c
HJ
77 /* 0E0B6031-5213-4934-818B-38D90CED39DB */
78 /* Shutdown */
79 {
80 .data = {
81 0x31, 0x60, 0x0B, 0X0E, 0x13, 0x52, 0x34, 0x49,
82 0x81, 0x8B, 0x38, 0XD9, 0x0C, 0xED, 0x39, 0xDB
83 }
84 },
39c4e9c3
HZ
85 /* {9527E630-D0AE-497b-ADCE-E80AB0175CAF} */
86 /* TimeSync */
87 {
88 .data = {
89 0x30, 0xe6, 0x27, 0x95, 0xae, 0xd0, 0x7b, 0x49,
90 0xad, 0xce, 0xe8, 0x0a, 0xb0, 0x17, 0x5c, 0xaf
91 }
92 },
9153f7b9
HJ
93 /* {57164f39-9115-4e78-ab55-382f3bd5422d} */
94 /* Heartbeat */
95 {
96 .data = {
97 0x39, 0x4f, 0x16, 0x57, 0x15, 0x91, 0x78, 0x4e,
98 0xab, 0x55, 0x38, 0x2f, 0x3b, 0xd5, 0x42, 0x2d
99 }
100 },
3e7ee490
HJ
101};
102
c88c4e4c
HJ
103
104/**
105 * prep_negotiate_resp() - Create default response for Hyper-V Negotiate message
106 * @icmsghdrp: Pointer to msg header structure
107 * @icmsg_negotiate: Pointer to negotiate message structure
108 * @buf: Raw buffer channel data
109 *
110 * @icmsghdrp is of type &struct icmsg_hdr.
111 * @negop is of type &struct icmsg_negotiate.
112 * Set up and fill in default negotiate response message. This response can
113 * come from both the vmbus driver and the hv_utils driver. The current api
114 * will respond properly to both Windows 2008 and Windows 2008-R2 operating
115 * systems.
116 *
117 * Mainly used by Hyper-V drivers.
118 */
119void prep_negotiate_resp(struct icmsg_hdr *icmsghdrp,
120 struct icmsg_negotiate *negop,
121 u8 *buf)
122{
123 if (icmsghdrp->icmsgtype == ICMSGTYPE_NEGOTIATE) {
124 icmsghdrp->icmsgsize = 0x10;
125
126 negop = (struct icmsg_negotiate *)&buf[
127 sizeof(struct vmbuspipe_hdr) +
128 sizeof(struct icmsg_hdr)];
129
130 if (negop->icframe_vercnt == 2 &&
131 negop->icversion_data[1].major == 3) {
132 negop->icversion_data[0].major = 3;
133 negop->icversion_data[0].minor = 0;
134 negop->icversion_data[1].major = 3;
135 negop->icversion_data[1].minor = 0;
136 } else {
137 negop->icversion_data[0].major = 1;
138 negop->icversion_data[0].minor = 0;
139 negop->icversion_data[1].major = 1;
140 negop->icversion_data[1].minor = 0;
141 }
142
143 negop->icframe_vercnt = 1;
144 negop->icmsg_vercnt = 1;
145 }
146}
147EXPORT_SYMBOL(prep_negotiate_resp);
148
149/**
150 * chn_cb_negotiate() - Default handler for non IDE/SCSI/NETWORK
151 * Hyper-V requests
152 * @context: Pointer to argument structure.
153 *
154 * Set up the default handler for non device driver specific requests
155 * from Hyper-V. This stub responds to the default negotiate messages
156 * that come in for every non IDE/SCSI/Network request.
157 * This behavior is normally overwritten in the hv_utils driver. That
158 * driver handles requests like gracefull shutdown, heartbeats etc.
159 *
160 * Mainly used by Hyper-V drivers.
161 */
162void chn_cb_negotiate(void *context)
163{
164 struct vmbus_channel *channel = context;
165 u8 *buf;
166 u32 buflen, recvlen;
167 u64 requestid;
168
169 struct icmsg_hdr *icmsghdrp;
170 struct icmsg_negotiate *negop = NULL;
171
172 buflen = PAGE_SIZE;
173 buf = kmalloc(buflen, GFP_ATOMIC);
174
fff41b2e 175 vmbus_recvpacket(channel, buf, buflen, &recvlen, &requestid);
c88c4e4c
HJ
176
177 if (recvlen > 0) {
178 icmsghdrp = (struct icmsg_hdr *)&buf[
179 sizeof(struct vmbuspipe_hdr)];
180
181 prep_negotiate_resp(icmsghdrp, negop, buf);
182
183 icmsghdrp->icflags = ICMSGHDRFLAG_TRANSACTION
184 | ICMSGHDRFLAG_RESPONSE;
185
fff41b2e 186 vmbus_sendpacket(channel, buf,
c88c4e4c
HJ
187 recvlen, requestid,
188 VmbusPacketTypeDataInBand, 0);
189 }
190
191 kfree(buf);
192}
193EXPORT_SYMBOL(chn_cb_negotiate);
194
195/*
196 * Function table used for message responses for non IDE/SCSI/Network type
197 * messages. (Such as KVP/Shutdown etc)
198 */
199struct hyperv_service_callback hv_cb_utils[MAX_MSG_TYPES] = {
200 /* 0E0B6031-5213-4934-818B-38D90CED39DB */
201 /* Shutdown */
202 {
203 .msg_type = HV_SHUTDOWN_MSG,
204 .data = {
205 0x31, 0x60, 0x0B, 0X0E, 0x13, 0x52, 0x34, 0x49,
206 0x81, 0x8B, 0x38, 0XD9, 0x0C, 0xED, 0x39, 0xDB
207 },
208 .callback = chn_cb_negotiate,
209 .log_msg = "Shutdown channel functionality initialized"
210 },
39c4e9c3
HZ
211
212 /* {9527E630-D0AE-497b-ADCE-E80AB0175CAF} */
213 /* TimeSync */
214 {
215 .msg_type = HV_TIMESYNC_MSG,
216 .data = {
217 0x30, 0xe6, 0x27, 0x95, 0xae, 0xd0, 0x7b, 0x49,
218 0xad, 0xce, 0xe8, 0x0a, 0xb0, 0x17, 0x5c, 0xaf
219 },
220 .callback = chn_cb_negotiate,
221 .log_msg = "Timesync channel functionality initialized"
222 },
9153f7b9
HJ
223 /* {57164f39-9115-4e78-ab55-382f3bd5422d} */
224 /* Heartbeat */
225 {
226 .msg_type = HV_HEARTBEAT_MSG,
227 .data = {
228 0x39, 0x4f, 0x16, 0x57, 0x15, 0x91, 0x78, 0x4e,
229 0xab, 0x55, 0x38, 0x2f, 0x3b, 0xd5, 0x42, 0x2d
230 },
231 .callback = chn_cb_negotiate,
232 .log_msg = "Heartbeat channel functionality initialized"
233 },
c88c4e4c
HJ
234};
235EXPORT_SYMBOL(hv_cb_utils);
236
3e189519 237/*
e98cb276 238 * alloc_channel - Allocate and initialize a vmbus channel object
bd60c33e 239 */
50fe56d2 240static struct vmbus_channel *alloc_channel(void)
3e7ee490 241{
aded7165 242 struct vmbus_channel *channel;
3e7ee490 243
aded7165 244 channel = kzalloc(sizeof(*channel), GFP_ATOMIC);
3e7ee490 245 if (!channel)
3e7ee490 246 return NULL;
3e7ee490 247
54411c42 248 spin_lock_init(&channel->inbound_lock);
3e7ee490 249
c8a429a4
GKH
250 init_timer(&channel->poll_timer);
251 channel->poll_timer.data = (unsigned long)channel;
fff41b2e 252 channel->poll_timer.function = vmbus_ontimer;
3e7ee490 253
de65a384 254 channel->ControlWQ = create_workqueue("hv_vmbus_ctl");
bd60c33e 255 if (!channel->ControlWQ) {
8c69f52a 256 kfree(channel);
3e7ee490
HJ
257 return NULL;
258 }
259
260 return channel;
261}
262
3e189519 263/*
e98cb276 264 * release_hannel - Release the vmbus channel object itself
bd60c33e 265 */
e98cb276 266static inline void release_channel(void *context)
3e7ee490 267{
bd60c33e 268 struct vmbus_channel *channel = context;
3e7ee490 269
3e7ee490 270 DPRINT_DBG(VMBUS, "releasing channel (%p)", channel);
de65a384 271 destroy_workqueue(channel->ControlWQ);
3e7ee490
HJ
272 DPRINT_DBG(VMBUS, "channel released (%p)", channel);
273
8c69f52a 274 kfree(channel);
3e7ee490
HJ
275}
276
3e189519 277/*
e98cb276 278 * free_channel - Release the resources used by the vmbus channel object
bd60c33e 279 */
e98cb276 280void free_channel(struct vmbus_channel *channel)
3e7ee490 281{
188963ec 282 del_timer_sync(&channel->poll_timer);
3e7ee490 283
bd60c33e
GKH
284 /*
285 * We have to release the channel's workqueue/thread in the vmbus's
286 * workqueue/thread context
287 * ie we can't destroy ourselves.
288 */
e98cb276 289 osd_schedule_callback(gVmbusConnection.WorkQueue, release_channel,
188963ec 290 channel);
3e7ee490
HJ
291}
292
8b5d6d3b
HZ
293
294DECLARE_COMPLETION(hv_channel_ready);
295
296/*
297 * Count initialized channels, and ensure all channels are ready when hv_vmbus
298 * module loading completes.
299 */
300static void count_hv_channel(void)
301{
302 static int counter;
303 unsigned long flags;
304
305 spin_lock_irqsave(&gVmbusConnection.channel_lock, flags);
306 if (++counter == MAX_MSG_TYPES)
307 complete(&hv_channel_ready);
308 spin_unlock_irqrestore(&gVmbusConnection.channel_lock, flags);
309}
310
311
3e189519 312/*
e98cb276 313 * vmbus_process_offer - Process the offer by creating a channel/device
c88c4e4c 314 * associated with this offer
bd60c33e 315 */
e98cb276 316static void vmbus_process_offer(void *context)
3e7ee490 317{
188963ec 318 struct vmbus_channel *newchannel = context;
aded7165 319 struct vmbus_channel *channel;
188963ec 320 bool fnew = true;
bd60c33e 321 int ret;
c88c4e4c 322 int cnt;
0f5e44ca 323 unsigned long flags;
3e7ee490 324
454f18a9 325 /* Make sure this is a new offer */
0f5e44ca 326 spin_lock_irqsave(&gVmbusConnection.channel_lock, flags);
3e7ee490 327
53af545b 328 list_for_each_entry(channel, &gVmbusConnection.ChannelList, ListEntry) {
bd60c33e 329 if (!memcmp(&channel->OfferMsg.Offer.InterfaceType,
188963ec 330 &newchannel->OfferMsg.Offer.InterfaceType,
bd60c33e
GKH
331 sizeof(struct hv_guid)) &&
332 !memcmp(&channel->OfferMsg.Offer.InterfaceInstance,
188963ec 333 &newchannel->OfferMsg.Offer.InterfaceInstance,
bd60c33e 334 sizeof(struct hv_guid))) {
188963ec 335 fnew = false;
3e7ee490
HJ
336 break;
337 }
338 }
339
188963ec
HZ
340 if (fnew)
341 list_add_tail(&newchannel->ListEntry,
53af545b 342 &gVmbusConnection.ChannelList);
bd60c33e 343
0f5e44ca 344 spin_unlock_irqrestore(&gVmbusConnection.channel_lock, flags);
3e7ee490 345
188963ec 346 if (!fnew) {
bd60c33e 347 DPRINT_DBG(VMBUS, "Ignoring duplicate offer for relid (%d)",
188963ec 348 newchannel->OfferMsg.ChildRelId);
e98cb276 349 free_channel(newchannel);
3e7ee490
HJ
350 return;
351 }
352
bd60c33e
GKH
353 /*
354 * Start the process of binding this offer to the driver
355 * We need to set the DeviceObject field before calling
356 * VmbusChildDeviceAdd()
357 */
188963ec
HZ
358 newchannel->DeviceObject = VmbusChildDeviceCreate(
359 &newchannel->OfferMsg.Offer.InterfaceType,
360 &newchannel->OfferMsg.Offer.InterfaceInstance,
361 newchannel);
3e7ee490 362
bd60c33e 363 DPRINT_DBG(VMBUS, "child device object allocated - %p",
188963ec 364 newchannel->DeviceObject);
3e7ee490 365
454f18a9
BP
366 /*
367 * Add the new device to the bus. This will kick off device-driver
368 * binding which eventually invokes the device driver's AddDevice()
369 * method.
370 */
188963ec 371 ret = VmbusChildDeviceAdd(newchannel->DeviceObject);
bd60c33e
GKH
372 if (ret != 0) {
373 DPRINT_ERR(VMBUS,
374 "unable to add child device object (relid %d)",
188963ec 375 newchannel->OfferMsg.ChildRelId);
3e7ee490 376
0f5e44ca 377 spin_lock_irqsave(&gVmbusConnection.channel_lock, flags);
188963ec 378 list_del(&newchannel->ListEntry);
0f5e44ca 379 spin_unlock_irqrestore(&gVmbusConnection.channel_lock, flags);
3e7ee490 380
e98cb276 381 free_channel(newchannel);
bd60c33e 382 } else {
454f18a9
BP
383 /*
384 * This state is used to indicate a successful open
385 * so that when we do close the channel normally, we
386 * can cleanup properly
387 */
188963ec 388 newchannel->State = CHANNEL_OPEN_STATE;
c88c4e4c 389
8b5d6d3b
HZ
390 /* Open IC channels */
391 for (cnt = 0; cnt < MAX_MSG_TYPES; cnt++) {
188963ec 392 if (memcmp(&newchannel->OfferMsg.Offer.InterfaceType,
c88c4e4c 393 &hv_cb_utils[cnt].data,
8b5d6d3b 394 sizeof(struct hv_guid)) == 0 &&
188963ec 395 vmbus_open(newchannel, 2 * PAGE_SIZE,
8b5d6d3b
HZ
396 2 * PAGE_SIZE, NULL, 0,
397 hv_cb_utils[cnt].callback,
188963ec
HZ
398 newchannel) == 0) {
399 hv_cb_utils[cnt].channel = newchannel;
c88c4e4c 400 DPRINT_INFO(VMBUS, "%s",
8b5d6d3b
HZ
401 hv_cb_utils[cnt].log_msg);
402 count_hv_channel();
c88c4e4c 403 }
c88c4e4c 404 }
3e7ee490 405 }
3e7ee490
HJ
406}
407
3e189519 408/*
e98cb276
HZ
409 * vmbus_process_rescind_offer -
410 * Rescind the offer by initiating a device removal
bd60c33e 411 */
e98cb276 412static void vmbus_process_rescind_offer(void *context)
3e7ee490 413{
aded7165 414 struct vmbus_channel *channel = context;
3e7ee490 415
3e7ee490 416 VmbusChildDeviceRemove(channel->DeviceObject);
3e7ee490
HJ
417}
418
3e189519 419/*
e98cb276 420 * vmbus_onoffer - Handler for channel offers from vmbus in parent partition.
bd60c33e
GKH
421 *
422 * We ignore all offers except network and storage offers. For each network and
423 * storage offers, we create a channel object and queue a work item to the
424 * channel object to process the offer synchronously
425 */
e98cb276 426static void vmbus_onoffer(struct vmbus_channel_message_header *hdr)
3e7ee490 427{
bd60c33e 428 struct vmbus_channel_offer_channel *offer;
188963ec
HZ
429 struct vmbus_channel *newchannel;
430 struct hv_guid *guidtype;
431 struct hv_guid *guidinstance;
3e7ee490 432 int i;
188963ec 433 int fsupported = 0;
3e7ee490 434
bd60c33e
GKH
435 offer = (struct vmbus_channel_offer_channel *)hdr;
436 for (i = 0; i < MAX_NUM_DEVICE_CLASSES_SUPPORTED; i++) {
437 if (memcmp(&offer->Offer.InterfaceType,
438 &gSupportedDeviceClasses[i], sizeof(struct hv_guid)) == 0) {
188963ec 439 fsupported = 1;
3e7ee490
HJ
440 break;
441 }
442 }
443
188963ec 444 if (!fsupported) {
bd60c33e
GKH
445 DPRINT_DBG(VMBUS, "Ignoring channel offer notification for "
446 "child relid %d", offer->ChildRelId);
3e7ee490
HJ
447 return;
448 }
449
188963ec
HZ
450 guidtype = &offer->Offer.InterfaceType;
451 guidinstance = &offer->Offer.InterfaceInstance;
3e7ee490 452
bd60c33e
GKH
453 DPRINT_INFO(VMBUS, "Channel offer notification - "
454 "child relid %d monitor id %d allocated %d, "
455 "type {%02x%02x%02x%02x-%02x%02x-%02x%02x-"
456 "%02x%02x%02x%02x%02x%02x%02x%02x} "
457 "instance {%02x%02x%02x%02x-%02x%02x-%02x%02x-"
458 "%02x%02x%02x%02x%02x%02x%02x%02x}",
459 offer->ChildRelId, offer->MonitorId,
460 offer->MonitorAllocated,
188963ec
HZ
461 guidtype->data[3], guidtype->data[2],
462 guidtype->data[1], guidtype->data[0],
463 guidtype->data[5], guidtype->data[4],
464 guidtype->data[7], guidtype->data[6],
465 guidtype->data[8], guidtype->data[9],
466 guidtype->data[10], guidtype->data[11],
467 guidtype->data[12], guidtype->data[13],
468 guidtype->data[14], guidtype->data[15],
469 guidinstance->data[3], guidinstance->data[2],
470 guidinstance->data[1], guidinstance->data[0],
471 guidinstance->data[5], guidinstance->data[4],
472 guidinstance->data[7], guidinstance->data[6],
473 guidinstance->data[8], guidinstance->data[9],
474 guidinstance->data[10], guidinstance->data[11],
475 guidinstance->data[12], guidinstance->data[13],
476 guidinstance->data[14], guidinstance->data[15]);
3e7ee490 477
454f18a9 478 /* Allocate the channel object and save this offer. */
e98cb276 479 newchannel = alloc_channel();
188963ec 480 if (!newchannel) {
3e7ee490
HJ
481 DPRINT_ERR(VMBUS, "unable to allocate channel object");
482 return;
483 }
484
188963ec 485 DPRINT_DBG(VMBUS, "channel object allocated - %p", newchannel);
3e7ee490 486
188963ec 487 memcpy(&newchannel->OfferMsg, offer,
bd60c33e 488 sizeof(struct vmbus_channel_offer_channel));
188963ec
HZ
489 newchannel->MonitorGroup = (u8)offer->MonitorId / 32;
490 newchannel->MonitorBit = (u8)offer->MonitorId % 32;
3e7ee490 491
454f18a9 492 /* TODO: Make sure the offer comes from our parent partition */
e98cb276 493 osd_schedule_callback(newchannel->ControlWQ, vmbus_process_offer,
188963ec 494 newchannel);
3e7ee490
HJ
495}
496
3e189519 497/*
e98cb276 498 * vmbus_onoffer_rescind - Rescind offer handler.
bd60c33e
GKH
499 *
500 * We queue a work item to process this offer synchronously
501 */
e98cb276 502static void vmbus_onoffer_rescind(struct vmbus_channel_message_header *hdr)
3e7ee490 503{
bd60c33e 504 struct vmbus_channel_rescind_offer *rescind;
aded7165 505 struct vmbus_channel *channel;
3e7ee490 506
bd60c33e 507 rescind = (struct vmbus_channel_rescind_offer *)hdr;
3e7ee490 508 channel = GetChannelFromRelId(rescind->ChildRelId);
bd60c33e
GKH
509 if (channel == NULL) {
510 DPRINT_DBG(VMBUS, "channel not found for relId %d",
511 rescind->ChildRelId);
3e7ee490
HJ
512 return;
513 }
514
de65a384 515 osd_schedule_callback(channel->ControlWQ,
e98cb276 516 vmbus_process_rescind_offer,
de65a384 517 channel);
3e7ee490
HJ
518}
519
3e189519 520/*
e98cb276
HZ
521 * vmbus_onoffers_delivered -
522 * This is invoked when all offers have been delivered.
bd60c33e
GKH
523 *
524 * Nothing to do here.
525 */
e98cb276 526static void vmbus_onoffers_delivered(
bd60c33e 527 struct vmbus_channel_message_header *hdr)
3e7ee490 528{
3e7ee490
HJ
529}
530
3e189519 531/*
e98cb276 532 * vmbus_onopen_result - Open result handler.
bd60c33e
GKH
533 *
534 * This is invoked when we received a response to our channel open request.
535 * Find the matching request, copy the response and signal the requesting
536 * thread.
537 */
e98cb276 538static void vmbus_onopen_result(struct vmbus_channel_message_header *hdr)
3e7ee490 539{
bd60c33e 540 struct vmbus_channel_open_result *result;
53af545b 541 struct list_head *curr;
188963ec
HZ
542 struct vmbus_channel_msginfo *msginfo;
543 struct vmbus_channel_message_header *requestheader;
544 struct vmbus_channel_open_channel *openmsg;
dd0813b6 545 unsigned long flags;
3e7ee490 546
bd60c33e 547 result = (struct vmbus_channel_open_result *)hdr;
3e7ee490
HJ
548 DPRINT_DBG(VMBUS, "vmbus open result - %d", result->Status);
549
bd60c33e
GKH
550 /*
551 * Find the open msg, copy the result and signal/unblock the wait event
552 */
dd0813b6 553 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490 554
53af545b
BP
555 list_for_each(curr, &gVmbusConnection.ChannelMsgList) {
556/* FIXME: this should probably use list_entry() instead */
188963ec
HZ
557 msginfo = (struct vmbus_channel_msginfo *)curr;
558 requestheader =
559 (struct vmbus_channel_message_header *)msginfo->Msg;
560
561 if (requestheader->MessageType == ChannelMessageOpenChannel) {
562 openmsg =
563 (struct vmbus_channel_open_channel *)msginfo->Msg;
564 if (openmsg->ChildRelId == result->ChildRelId &&
565 openmsg->OpenId == result->OpenId) {
566 memcpy(&msginfo->Response.OpenResult,
bd60c33e
GKH
567 result,
568 sizeof(struct vmbus_channel_open_result));
188963ec 569 osd_WaitEventSet(msginfo->WaitEvent);
3e7ee490
HJ
570 break;
571 }
572 }
573 }
dd0813b6 574 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490
HJ
575}
576
3e189519 577/*
e98cb276 578 * vmbus_ongpadl_created - GPADL created handler.
bd60c33e
GKH
579 *
580 * This is invoked when we received a response to our gpadl create request.
581 * Find the matching request, copy the response and signal the requesting
582 * thread.
583 */
e98cb276 584static void vmbus_ongpadl_created(struct vmbus_channel_message_header *hdr)
3e7ee490 585{
188963ec 586 struct vmbus_channel_gpadl_created *gpadlcreated;
53af545b 587 struct list_head *curr;
188963ec
HZ
588 struct vmbus_channel_msginfo *msginfo;
589 struct vmbus_channel_message_header *requestheader;
590 struct vmbus_channel_gpadl_header *gpadlheader;
dd0813b6 591 unsigned long flags;
3e7ee490 592
188963ec 593 gpadlcreated = (struct vmbus_channel_gpadl_created *)hdr;
bd60c33e 594 DPRINT_DBG(VMBUS, "vmbus gpadl created result - %d",
188963ec 595 gpadlcreated->CreationStatus);
3e7ee490 596
bd60c33e
GKH
597 /*
598 * Find the establish msg, copy the result and signal/unblock the wait
599 * event
600 */
dd0813b6 601 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490 602
53af545b
BP
603 list_for_each(curr, &gVmbusConnection.ChannelMsgList) {
604/* FIXME: this should probably use list_entry() instead */
188963ec
HZ
605 msginfo = (struct vmbus_channel_msginfo *)curr;
606 requestheader =
607 (struct vmbus_channel_message_header *)msginfo->Msg;
608
609 if (requestheader->MessageType == ChannelMessageGpadlHeader) {
610 gpadlheader =
611 (struct vmbus_channel_gpadl_header *)requestheader;
612
613 if ((gpadlcreated->ChildRelId ==
614 gpadlheader->ChildRelId) &&
615 (gpadlcreated->Gpadl == gpadlheader->Gpadl)) {
616 memcpy(&msginfo->Response.GpadlCreated,
617 gpadlcreated,
bd60c33e 618 sizeof(struct vmbus_channel_gpadl_created));
188963ec 619 osd_WaitEventSet(msginfo->WaitEvent);
3e7ee490
HJ
620 break;
621 }
622 }
623 }
dd0813b6 624 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490
HJ
625}
626
3e189519 627/*
e98cb276 628 * vmbus_ongpadl_torndown - GPADL torndown handler.
bd60c33e
GKH
629 *
630 * This is invoked when we received a response to our gpadl teardown request.
631 * Find the matching request, copy the response and signal the requesting
632 * thread.
633 */
e98cb276 634static void vmbus_ongpadl_torndown(
bd60c33e 635 struct vmbus_channel_message_header *hdr)
3e7ee490 636{
188963ec 637 struct vmbus_channel_gpadl_torndown *gpadl_torndown;
53af545b 638 struct list_head *curr;
188963ec
HZ
639 struct vmbus_channel_msginfo *msginfo;
640 struct vmbus_channel_message_header *requestheader;
641 struct vmbus_channel_gpadl_teardown *gpadl_teardown;
dd0813b6 642 unsigned long flags;
3e7ee490 643
188963ec 644 gpadl_torndown = (struct vmbus_channel_gpadl_torndown *)hdr;
bd60c33e
GKH
645
646 /*
647 * Find the open msg, copy the result and signal/unblock the wait event
648 */
dd0813b6 649 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490 650
53af545b
BP
651 list_for_each(curr, &gVmbusConnection.ChannelMsgList) {
652/* FIXME: this should probably use list_entry() instead */
188963ec
HZ
653 msginfo = (struct vmbus_channel_msginfo *)curr;
654 requestheader =
655 (struct vmbus_channel_message_header *)msginfo->Msg;
3e7ee490 656
188963ec
HZ
657 if (requestheader->MessageType == ChannelMessageGpadlTeardown) {
658 gpadl_teardown =
659 (struct vmbus_channel_gpadl_teardown *)requestheader;
3e7ee490 660
188963ec
HZ
661 if (gpadl_torndown->Gpadl == gpadl_teardown->Gpadl) {
662 memcpy(&msginfo->Response.GpadlTorndown,
663 gpadl_torndown,
bd60c33e 664 sizeof(struct vmbus_channel_gpadl_torndown));
188963ec 665 osd_WaitEventSet(msginfo->WaitEvent);
3e7ee490
HJ
666 break;
667 }
668 }
669 }
dd0813b6 670 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490
HJ
671}
672
3e189519 673/*
e98cb276 674 * vmbus_onversion_response - Version response handler
bd60c33e
GKH
675 *
676 * This is invoked when we received a response to our initiate contact request.
677 * Find the matching request, copy the response and signal the requesting
678 * thread.
679 */
e98cb276 680static void vmbus_onversion_response(
bd60c33e 681 struct vmbus_channel_message_header *hdr)
3e7ee490 682{
53af545b 683 struct list_head *curr;
188963ec
HZ
684 struct vmbus_channel_msginfo *msginfo;
685 struct vmbus_channel_message_header *requestheader;
82250213 686 struct vmbus_channel_initiate_contact *initiate;
188963ec 687 struct vmbus_channel_version_response *version_response;
dd0813b6 688 unsigned long flags;
3e7ee490 689
188963ec 690 version_response = (struct vmbus_channel_version_response *)hdr;
dd0813b6 691 spin_lock_irqsave(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490 692
53af545b
BP
693 list_for_each(curr, &gVmbusConnection.ChannelMsgList) {
694/* FIXME: this should probably use list_entry() instead */
188963ec
HZ
695 msginfo = (struct vmbus_channel_msginfo *)curr;
696 requestheader =
697 (struct vmbus_channel_message_header *)msginfo->Msg;
3e7ee490 698
188963ec 699 if (requestheader->MessageType ==
bd60c33e 700 ChannelMessageInitiateContact) {
188963ec
HZ
701 initiate =
702 (struct vmbus_channel_initiate_contact *)requestheader;
703 memcpy(&msginfo->Response.VersionResponse,
704 version_response,
bd60c33e 705 sizeof(struct vmbus_channel_version_response));
188963ec 706 osd_WaitEventSet(msginfo->WaitEvent);
3e7ee490
HJ
707 }
708 }
dd0813b6 709 spin_unlock_irqrestore(&gVmbusConnection.channelmsg_lock, flags);
3e7ee490
HJ
710}
711
c8212f04
GKH
712/* Channel message dispatch table */
713static struct vmbus_channel_message_table_entry
714 gChannelMessageTable[ChannelMessageCount] = {
715 {ChannelMessageInvalid, NULL},
e98cb276
HZ
716 {ChannelMessageOfferChannel, vmbus_onoffer},
717 {ChannelMessageRescindChannelOffer, vmbus_onoffer_rescind},
c8212f04 718 {ChannelMessageRequestOffers, NULL},
e98cb276 719 {ChannelMessageAllOffersDelivered, vmbus_onoffers_delivered},
c8212f04 720 {ChannelMessageOpenChannel, NULL},
e98cb276 721 {ChannelMessageOpenChannelResult, vmbus_onopen_result},
c8212f04
GKH
722 {ChannelMessageCloseChannel, NULL},
723 {ChannelMessageGpadlHeader, NULL},
724 {ChannelMessageGpadlBody, NULL},
e98cb276 725 {ChannelMessageGpadlCreated, vmbus_ongpadl_created},
c8212f04 726 {ChannelMessageGpadlTeardown, NULL},
e98cb276 727 {ChannelMessageGpadlTorndown, vmbus_ongpadl_torndown},
c8212f04
GKH
728 {ChannelMessageRelIdReleased, NULL},
729 {ChannelMessageInitiateContact, NULL},
e98cb276 730 {ChannelMessageVersionResponse, vmbus_onversion_response},
c8212f04
GKH
731 {ChannelMessageUnload, NULL},
732};
733
3e189519 734/*
e98cb276 735 * vmbus_onmessage - Handler for channel protocol messages.
bd60c33e
GKH
736 *
737 * This is invoked in the vmbus worker thread context.
738 */
e98cb276 739void vmbus_onmessage(void *context)
3e7ee490 740{
188963ec 741 struct hv_message *msg = context;
82250213 742 struct vmbus_channel_message_header *hdr;
3e7ee490
HJ
743 int size;
744
82250213 745 hdr = (struct vmbus_channel_message_header *)msg->u.Payload;
bd60c33e 746 size = msg->Header.PayloadSize;
3e7ee490
HJ
747
748 DPRINT_DBG(VMBUS, "message type %d size %d", hdr->MessageType, size);
749
bd60c33e
GKH
750 if (hdr->MessageType >= ChannelMessageCount) {
751 DPRINT_ERR(VMBUS,
752 "Received invalid channel message type %d size %d",
753 hdr->MessageType, size);
04f50c4d
GKH
754 print_hex_dump_bytes("", DUMP_PREFIX_NONE,
755 (unsigned char *)msg->u.Payload, size);
8c69f52a 756 kfree(msg);
3e7ee490
HJ
757 return;
758 }
759
760 if (gChannelMessageTable[hdr->MessageType].messageHandler)
3e7ee490 761 gChannelMessageTable[hdr->MessageType].messageHandler(hdr);
3e7ee490 762 else
bd60c33e
GKH
763 DPRINT_ERR(VMBUS, "Unhandled channel message type %d",
764 hdr->MessageType);
3e7ee490 765
454f18a9 766 /* Free the msg that was allocated in VmbusOnMsgDPC() */
8c69f52a 767 kfree(msg);
3e7ee490
HJ
768}
769
3e189519 770/*
e98cb276 771 * vmbus_request_offers - Send a request to get all our pending offers.
bd60c33e 772 */
e98cb276 773int vmbus_request_offers(void)
3e7ee490 774{
82250213 775 struct vmbus_channel_message_header *msg;
188963ec 776 struct vmbus_channel_msginfo *msginfo;
bd60c33e 777 int ret;
3e7ee490 778
188963ec 779 msginfo = kmalloc(sizeof(*msginfo) +
bd60c33e
GKH
780 sizeof(struct vmbus_channel_message_header),
781 GFP_KERNEL);
188963ec 782 if (!msginfo)
75910f23 783 return -ENOMEM;
3e7ee490 784
188963ec
HZ
785 msginfo->WaitEvent = osd_WaitEventCreate();
786 if (!msginfo->WaitEvent) {
787 kfree(msginfo);
75910f23
BP
788 return -ENOMEM;
789 }
790
188963ec 791 msg = (struct vmbus_channel_message_header *)msginfo->Msg;
3e7ee490
HJ
792
793 msg->MessageType = ChannelMessageRequestOffers;
794
795 /*SpinlockAcquire(gVmbusConnection.channelMsgLock);
bd60c33e
GKH
796 INSERT_TAIL_LIST(&gVmbusConnection.channelMsgList,
797 &msgInfo->msgListEntry);
3e7ee490
HJ
798 SpinlockRelease(gVmbusConnection.channelMsgLock);*/
799
bd60c33e
GKH
800 ret = VmbusPostMessage(msg,
801 sizeof(struct vmbus_channel_message_header));
802 if (ret != 0) {
3e7ee490
HJ
803 DPRINT_ERR(VMBUS, "Unable to request offers - %d", ret);
804
805 /*SpinlockAcquire(gVmbusConnection.channelMsgLock);
806 REMOVE_ENTRY_LIST(&msgInfo->msgListEntry);
807 SpinlockRelease(gVmbusConnection.channelMsgLock);*/
808
809 goto Cleanup;
810 }
bfc30aae 811 /* osd_WaitEventWait(msgInfo->waitEvent); */
3e7ee490
HJ
812
813 /*SpinlockAcquire(gVmbusConnection.channelMsgLock);
814 REMOVE_ENTRY_LIST(&msgInfo->msgListEntry);
815 SpinlockRelease(gVmbusConnection.channelMsgLock);*/
816
817
818Cleanup:
188963ec
HZ
819 if (msginfo) {
820 kfree(msginfo->WaitEvent);
821 kfree(msginfo);
3e7ee490
HJ
822 }
823
3e7ee490
HJ
824 return ret;
825}
826
3e189519 827/*
e98cb276 828 * vmbus_release_unattached_channels - Release channels that are
3e189519 829 * unattached/unconnected ie (no drivers associated)
bd60c33e 830 */
e98cb276 831void vmbus_release_unattached_channels(void)
3e7ee490 832{
53af545b 833 struct vmbus_channel *channel, *pos;
aded7165 834 struct vmbus_channel *start = NULL;
0f5e44ca 835 unsigned long flags;
3e7ee490 836
0f5e44ca 837 spin_lock_irqsave(&gVmbusConnection.channel_lock, flags);
3e7ee490 838
53af545b
BP
839 list_for_each_entry_safe(channel, pos, &gVmbusConnection.ChannelList,
840 ListEntry) {
3e7ee490
HJ
841 if (channel == start)
842 break;
843
bd60c33e 844 if (!channel->DeviceObject->Driver) {
53af545b 845 list_del(&channel->ListEntry);
bd60c33e
GKH
846 DPRINT_INFO(VMBUS,
847 "Releasing unattached device object %p",
848 channel->DeviceObject);
3e7ee490
HJ
849
850 VmbusChildDeviceRemove(channel->DeviceObject);
e98cb276 851 free_channel(channel);
bd60c33e 852 } else {
3e7ee490 853 if (!start)
3e7ee490 854 start = channel;
3e7ee490
HJ
855 }
856 }
857
0f5e44ca 858 spin_unlock_irqrestore(&gVmbusConnection.channel_lock, flags);
3e7ee490
HJ
859}
860
454f18a9 861/* eof */