Merge remote-tracking branch 'asoc/fix/max98357a' into asoc-linus
[deliverable/linux.git] / drivers / 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 */
0a46618d
HJ
21#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
22
a0086dc5 23#include <linux/kernel.h>
0c3b7b2f
S
24#include <linux/sched.h>
25#include <linux/wait.h>
a0086dc5 26#include <linux/mm.h>
5a0e3ad6 27#include <linux/slab.h>
53af545b 28#include <linux/list.h>
c88c4e4c 29#include <linux/module.h>
8b5d6d3b 30#include <linux/completion.h>
46a97191 31#include <linux/hyperv.h>
3f335ea2 32
0f2a6619 33#include "hyperv_vmbus.h"
3e7ee490 34
1d7e907f 35struct vmbus_channel_message_table_entry {
cf9dcba7 36 enum vmbus_channel_message_type message_type;
fa90f1de 37 void (*message_handler)(struct vmbus_channel_message_header *msg);
1d7e907f 38};
3e7ee490 39
c88c4e4c
HJ
40
41/**
da0e9631 42 * vmbus_prep_negotiate_resp() - Create default response for Hyper-V Negotiate message
c88c4e4c
HJ
43 * @icmsghdrp: Pointer to msg header structure
44 * @icmsg_negotiate: Pointer to negotiate message structure
45 * @buf: Raw buffer channel data
46 *
47 * @icmsghdrp is of type &struct icmsg_hdr.
48 * @negop is of type &struct icmsg_negotiate.
c836d0ab
S
49 * Set up and fill in default negotiate response message.
50 *
6741335b
S
51 * The fw_version specifies the framework version that
52 * we can support and srv_version specifies the service
53 * version we can support.
c88c4e4c
HJ
54 *
55 * Mainly used by Hyper-V drivers.
56 */
6741335b 57bool vmbus_prep_negotiate_resp(struct icmsg_hdr *icmsghdrp,
c836d0ab 58 struct icmsg_negotiate *negop, u8 *buf,
6741335b 59 int fw_version, int srv_version)
c88c4e4c 60{
6741335b
S
61 int icframe_major, icframe_minor;
62 int icmsg_major, icmsg_minor;
63 int fw_major, fw_minor;
64 int srv_major, srv_minor;
c836d0ab 65 int i;
6741335b 66 bool found_match = false;
c836d0ab 67
a3605300 68 icmsghdrp->icmsgsize = 0x10;
6741335b
S
69 fw_major = (fw_version >> 16);
70 fw_minor = (fw_version & 0xFFFF);
71
72 srv_major = (srv_version >> 16);
73 srv_minor = (srv_version & 0xFFFF);
c88c4e4c 74
a3605300
S
75 negop = (struct icmsg_negotiate *)&buf[
76 sizeof(struct vmbuspipe_hdr) +
77 sizeof(struct icmsg_hdr)];
c88c4e4c 78
6741335b
S
79 icframe_major = negop->icframe_vercnt;
80 icframe_minor = 0;
81
82 icmsg_major = negop->icmsg_vercnt;
83 icmsg_minor = 0;
c836d0ab
S
84
85 /*
86 * Select the framework version number we will
87 * support.
88 */
89
90 for (i = 0; i < negop->icframe_vercnt; i++) {
6741335b
S
91 if ((negop->icversion_data[i].major == fw_major) &&
92 (negop->icversion_data[i].minor == fw_minor)) {
93 icframe_major = negop->icversion_data[i].major;
94 icframe_minor = negop->icversion_data[i].minor;
95 found_match = true;
96 }
c836d0ab
S
97 }
98
6741335b
S
99 if (!found_match)
100 goto fw_error;
101
102 found_match = false;
103
c836d0ab
S
104 for (i = negop->icframe_vercnt;
105 (i < negop->icframe_vercnt + negop->icmsg_vercnt); i++) {
6741335b
S
106 if ((negop->icversion_data[i].major == srv_major) &&
107 (negop->icversion_data[i].minor == srv_minor)) {
108 icmsg_major = negop->icversion_data[i].major;
109 icmsg_minor = negop->icversion_data[i].minor;
110 found_match = true;
111 }
c88c4e4c 112 }
a3605300 113
c836d0ab 114 /*
6741335b 115 * Respond with the framework and service
c836d0ab
S
116 * version numbers we can support.
117 */
6741335b
S
118
119fw_error:
120 if (!found_match) {
121 negop->icframe_vercnt = 0;
122 negop->icmsg_vercnt = 0;
123 } else {
124 negop->icframe_vercnt = 1;
125 negop->icmsg_vercnt = 1;
126 }
127
128 negop->icversion_data[0].major = icframe_major;
129 negop->icversion_data[0].minor = icframe_minor;
130 negop->icversion_data[1].major = icmsg_major;
131 negop->icversion_data[1].minor = icmsg_minor;
132 return found_match;
c88c4e4c 133}
a3605300 134
da0e9631 135EXPORT_SYMBOL_GPL(vmbus_prep_negotiate_resp);
c88c4e4c 136
3e189519 137/*
e98cb276 138 * alloc_channel - Allocate and initialize a vmbus channel object
bd60c33e 139 */
50fe56d2 140static struct vmbus_channel *alloc_channel(void)
3e7ee490 141{
aded7165 142 struct vmbus_channel *channel;
3e7ee490 143
aded7165 144 channel = kzalloc(sizeof(*channel), GFP_ATOMIC);
3e7ee490 145 if (!channel)
3e7ee490 146 return NULL;
3e7ee490 147
54411c42 148 spin_lock_init(&channel->inbound_lock);
67fae053 149 spin_lock_init(&channel->lock);
e68d2971
S
150
151 INIT_LIST_HEAD(&channel->sc_list);
3a28fa35 152 INIT_LIST_HEAD(&channel->percpu_list);
3e7ee490 153
c50f7fb2
HZ
154 channel->controlwq = create_workqueue("hv_vmbus_ctl");
155 if (!channel->controlwq) {
8c69f52a 156 kfree(channel);
3e7ee490
HJ
157 return NULL;
158 }
159
160 return channel;
161}
162
3e189519 163/*
e98cb276 164 * release_hannel - Release the vmbus channel object itself
bd60c33e 165 */
4b2f9abe 166static void release_channel(struct work_struct *work)
3e7ee490 167{
4b2f9abe
TT
168 struct vmbus_channel *channel = container_of(work,
169 struct vmbus_channel,
170 work);
3e7ee490 171
c50f7fb2 172 destroy_workqueue(channel->controlwq);
3e7ee490 173
8c69f52a 174 kfree(channel);
3e7ee490
HJ
175}
176
3e189519 177/*
e98cb276 178 * free_channel - Release the resources used by the vmbus channel object
bd60c33e 179 */
9f3e28e3 180static void free_channel(struct vmbus_channel *channel)
3e7ee490 181{
3e7ee490 182
bd60c33e
GKH
183 /*
184 * We have to release the channel's workqueue/thread in the vmbus's
185 * workqueue/thread context
186 * ie we can't destroy ourselves.
187 */
4b2f9abe 188 INIT_WORK(&channel->work, release_channel);
da9fcb72 189 queue_work(vmbus_connection.work_queue, &channel->work);
3e7ee490
HJ
190}
191
3a28fa35
S
192static void percpu_channel_enq(void *arg)
193{
194 struct vmbus_channel *channel = arg;
195 int cpu = smp_processor_id();
196
197 list_add_tail(&channel->percpu_list, &hv_context.percpu_list[cpu]);
198}
8b5d6d3b 199
3a28fa35
S
200static void percpu_channel_deq(void *arg)
201{
202 struct vmbus_channel *channel = arg;
203
204 list_del(&channel->percpu_list);
205}
8b5d6d3b 206
4b2f9abe
TT
207/*
208 * vmbus_process_rescind_offer -
209 * Rescind the offer by initiating a device removal
210 */
211static void vmbus_process_rescind_offer(struct work_struct *work)
212{
213 struct vmbus_channel *channel = container_of(work,
214 struct vmbus_channel,
215 work);
c8705979 216 unsigned long flags;
e68d2971 217 struct vmbus_channel *primary_channel;
c8705979 218 struct vmbus_channel_relid_released msg;
04a258c1
VK
219 struct device *dev;
220
221 if (channel->device_obj) {
222 dev = get_device(&channel->device_obj->device);
223 if (dev) {
224 vmbus_device_unregister(channel->device_obj);
225 put_device(dev);
226 }
227 }
4b2f9abe 228
c8705979
S
229 memset(&msg, 0, sizeof(struct vmbus_channel_relid_released));
230 msg.child_relid = channel->offermsg.child_relid;
231 msg.header.msgtype = CHANNELMSG_RELID_RELEASED;
232 vmbus_post_msg(&msg, sizeof(struct vmbus_channel_relid_released));
233
2115b561
S
234 if (channel->target_cpu != get_cpu()) {
235 put_cpu();
3a28fa35
S
236 smp_call_function_single(channel->target_cpu,
237 percpu_channel_deq, channel, true);
2115b561 238 } else {
3a28fa35 239 percpu_channel_deq(channel);
2115b561
S
240 put_cpu();
241 }
3a28fa35 242
e68d2971
S
243 if (channel->primary_channel == NULL) {
244 spin_lock_irqsave(&vmbus_connection.channel_lock, flags);
245 list_del(&channel->listentry);
246 spin_unlock_irqrestore(&vmbus_connection.channel_lock, flags);
247 } else {
248 primary_channel = channel->primary_channel;
67fae053 249 spin_lock_irqsave(&primary_channel->lock, flags);
565ce642 250 list_del(&channel->sc_list);
67fae053 251 spin_unlock_irqrestore(&primary_channel->lock, flags);
e68d2971 252 }
c8705979 253 free_channel(channel);
4b2f9abe 254}
8b5d6d3b 255
93e5bd06
S
256void vmbus_free_channels(void)
257{
258 struct vmbus_channel *channel;
259
260 list_for_each_entry(channel, &vmbus_connection.chn_list, listentry) {
261 vmbus_device_unregister(channel->device_obj);
262 kfree(channel->device_obj);
263 free_channel(channel);
264 }
265}
266
3e189519 267/*
e98cb276 268 * vmbus_process_offer - Process the offer by creating a channel/device
c88c4e4c 269 * associated with this offer
bd60c33e 270 */
4b2f9abe 271static void vmbus_process_offer(struct work_struct *work)
3e7ee490 272{
4b2f9abe
TT
273 struct vmbus_channel *newchannel = container_of(work,
274 struct vmbus_channel,
275 work);
aded7165 276 struct vmbus_channel *channel;
188963ec 277 bool fnew = true;
3a28fa35 278 bool enq = false;
bd60c33e 279 int ret;
0f5e44ca 280 unsigned long flags;
3e7ee490 281
454f18a9 282 /* Make sure this is a new offer */
15b2f647 283 spin_lock_irqsave(&vmbus_connection.channel_lock, flags);
3e7ee490 284
da9fcb72 285 list_for_each_entry(channel, &vmbus_connection.chn_list, listentry) {
358d2ee2
S
286 if (!uuid_le_cmp(channel->offermsg.offer.if_type,
287 newchannel->offermsg.offer.if_type) &&
288 !uuid_le_cmp(channel->offermsg.offer.if_instance,
289 newchannel->offermsg.offer.if_instance)) {
188963ec 290 fnew = false;
3e7ee490
HJ
291 break;
292 }
293 }
294
3a28fa35 295 if (fnew) {
c50f7fb2 296 list_add_tail(&newchannel->listentry,
da9fcb72 297 &vmbus_connection.chn_list);
3a28fa35
S
298 enq = true;
299 }
bd60c33e 300
15b2f647 301 spin_unlock_irqrestore(&vmbus_connection.channel_lock, flags);
3e7ee490 302
3a28fa35 303 if (enq) {
2115b561
S
304 if (newchannel->target_cpu != get_cpu()) {
305 put_cpu();
3a28fa35
S
306 smp_call_function_single(newchannel->target_cpu,
307 percpu_channel_enq,
308 newchannel, true);
2115b561 309 } else {
3a28fa35 310 percpu_channel_enq(newchannel);
2115b561
S
311 put_cpu();
312 }
3a28fa35 313 }
188963ec 314 if (!fnew) {
e68d2971
S
315 /*
316 * Check to see if this is a sub-channel.
317 */
318 if (newchannel->offermsg.offer.sub_channel_index != 0) {
319 /*
320 * Process the sub-channel.
321 */
322 newchannel->primary_channel = channel;
67fae053 323 spin_lock_irqsave(&channel->lock, flags);
e68d2971 324 list_add_tail(&newchannel->sc_list, &channel->sc_list);
67fae053 325 spin_unlock_irqrestore(&channel->lock, flags);
3a28fa35 326
2115b561
S
327 if (newchannel->target_cpu != get_cpu()) {
328 put_cpu();
3a28fa35
S
329 smp_call_function_single(newchannel->target_cpu,
330 percpu_channel_enq,
331 newchannel, true);
2115b561 332 } else {
3a28fa35 333 percpu_channel_enq(newchannel);
2115b561
S
334 put_cpu();
335 }
3a28fa35 336
e68d2971
S
337 newchannel->state = CHANNEL_OPEN_STATE;
338 if (channel->sc_creation_callback != NULL)
339 channel->sc_creation_callback(newchannel);
340
d7f2fbaf 341 goto done_init_rescind;
e68d2971
S
342 }
343
9c3a6f7e 344 goto err_free_chan;
3e7ee490
HJ
345 }
346
42dceebe
S
347 /*
348 * This state is used to indicate a successful open
349 * so that when we do close the channel normally, we
350 * can cleanup properly
351 */
352 newchannel->state = CHANNEL_OPEN_STATE;
353
bd60c33e
GKH
354 /*
355 * Start the process of binding this offer to the driver
356 * We need to set the DeviceObject field before calling
646f1ea3 357 * vmbus_child_dev_add()
bd60c33e 358 */
f2c73011 359 newchannel->device_obj = vmbus_device_create(
767dff68
HZ
360 &newchannel->offermsg.offer.if_type,
361 &newchannel->offermsg.offer.if_instance,
188963ec 362 newchannel);
9c3a6f7e
VK
363 if (!newchannel->device_obj)
364 goto err_free_chan;
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 */
22794281 371 ret = vmbus_device_register(newchannel->device_obj);
bd60c33e 372 if (ret != 0) {
0a46618d 373 pr_err("unable to add child device object (relid %d)\n",
c50f7fb2 374 newchannel->offermsg.child_relid);
3e7ee490 375
15b2f647 376 spin_lock_irqsave(&vmbus_connection.channel_lock, flags);
c50f7fb2 377 list_del(&newchannel->listentry);
15b2f647 378 spin_unlock_irqrestore(&vmbus_connection.channel_lock, flags);
8b8ee675 379 kfree(newchannel->device_obj);
9c3a6f7e 380 goto err_free_chan;
3e7ee490 381 }
d7f2fbaf
VK
382done_init_rescind:
383 spin_lock_irqsave(&newchannel->lock, flags);
384 /* The next possible work is rescind handling */
385 INIT_WORK(&newchannel->work, vmbus_process_rescind_offer);
386 /* Check if rescind offer was already received */
387 if (newchannel->rescind)
388 queue_work(newchannel->controlwq, &newchannel->work);
389 spin_unlock_irqrestore(&newchannel->lock, flags);
9c3a6f7e
VK
390 return;
391err_free_chan:
392 free_channel(newchannel);
3e7ee490
HJ
393}
394
a119845f
S
395enum {
396 IDE = 0,
397 SCSI,
398 NIC,
399 MAX_PERF_CHN,
400};
401
402/*
7fb96565 403 * This is an array of device_ids (device types) that are performance critical.
a119845f
S
404 * We attempt to distribute the interrupt load for these devices across
405 * all available CPUs.
406 */
7fb96565 407static const struct hv_vmbus_device_id hp_devs[] = {
a119845f 408 /* IDE */
7fb96565 409 { HV_IDE_GUID, },
a119845f 410 /* Storage - SCSI */
7fb96565 411 { HV_SCSI_GUID, },
a119845f 412 /* Network */
7fb96565 413 { HV_NIC_GUID, },
a119845f
S
414};
415
416
417/*
418 * We use this state to statically distribute the channel interrupt load.
419 */
420static u32 next_vp;
421
422/*
423 * Starting with Win8, we can statically distribute the incoming
424 * channel interrupt load by binding a channel to VCPU. We
425 * implement here a simple round robin scheme for distributing
426 * the interrupt load.
427 * We will bind channels that are not performance critical to cpu 0 and
428 * performance critical channels (IDE, SCSI and Network) will be uniformly
429 * distributed across all available CPUs.
430 */
f9da455b 431static void init_vp_index(struct vmbus_channel *channel, const uuid_le *type_guid)
a119845f
S
432{
433 u32 cur_cpu;
434 int i;
435 bool perf_chn = false;
436 u32 max_cpus = num_online_cpus();
437
438 for (i = IDE; i < MAX_PERF_CHN; i++) {
7fb96565 439 if (!memcmp(type_guid->b, hp_devs[i].guid,
a119845f
S
440 sizeof(uuid_le))) {
441 perf_chn = true;
442 break;
443 }
444 }
445 if ((vmbus_proto_version == VERSION_WS2008) ||
446 (vmbus_proto_version == VERSION_WIN7) || (!perf_chn)) {
447 /*
448 * Prior to win8, all channel interrupts are
449 * delivered on cpu 0.
450 * Also if the channel is not a performance critical
451 * channel, bind it to cpu 0.
452 */
d3ba720d
S
453 channel->target_cpu = 0;
454 channel->target_vp = 0;
455 return;
a119845f
S
456 }
457 cur_cpu = (++next_vp % max_cpus);
d3ba720d
S
458 channel->target_cpu = cur_cpu;
459 channel->target_vp = hv_context.vp_index[cur_cpu];
a119845f
S
460}
461
3e189519 462/*
e98cb276 463 * vmbus_onoffer - Handler for channel offers from vmbus in parent partition.
bd60c33e 464 *
bd60c33e 465 */
e98cb276 466static void vmbus_onoffer(struct vmbus_channel_message_header *hdr)
3e7ee490 467{
bd60c33e 468 struct vmbus_channel_offer_channel *offer;
188963ec 469 struct vmbus_channel *newchannel;
3e7ee490 470
bd60c33e 471 offer = (struct vmbus_channel_offer_channel *)hdr;
3e7ee490 472
454f18a9 473 /* Allocate the channel object and save this offer. */
e98cb276 474 newchannel = alloc_channel();
188963ec 475 if (!newchannel) {
0a46618d 476 pr_err("Unable to allocate channel object\n");
3e7ee490
HJ
477 return;
478 }
479
132368bd
S
480 /*
481 * By default we setup state to enable batched
482 * reading. A specific service can choose to
483 * disable this prior to opening the channel.
484 */
485 newchannel->batched_reading = true;
486
b3bf60c7
S
487 /*
488 * Setup state for signalling the host.
489 */
490 newchannel->sig_event = (struct hv_input_signal_event *)
491 (ALIGN((unsigned long)
492 &newchannel->sig_buf,
493 HV_HYPERCALL_PARAM_ALIGN));
494
495 newchannel->sig_event->connectionid.asu32 = 0;
496 newchannel->sig_event->connectionid.u.id = VMBUS_EVENT_CONNECTION_ID;
497 newchannel->sig_event->flag_number = 0;
498 newchannel->sig_event->rsvdz = 0;
499
500 if (vmbus_proto_version != VERSION_WS2008) {
501 newchannel->is_dedicated_interrupt =
502 (offer->is_dedicated_interrupt != 0);
503 newchannel->sig_event->connectionid.u.id =
504 offer->connection_id;
505 }
506
d3ba720d 507 init_vp_index(newchannel, &offer->offer.if_type);
abbf3b2a 508
c50f7fb2 509 memcpy(&newchannel->offermsg, offer,
bd60c33e 510 sizeof(struct vmbus_channel_offer_channel));
c50f7fb2
HZ
511 newchannel->monitor_grp = (u8)offer->monitorid / 32;
512 newchannel->monitor_bit = (u8)offer->monitorid % 32;
3e7ee490 513
4b2f9abe
TT
514 INIT_WORK(&newchannel->work, vmbus_process_offer);
515 queue_work(newchannel->controlwq, &newchannel->work);
3e7ee490
HJ
516}
517
3e189519 518/*
e98cb276 519 * vmbus_onoffer_rescind - Rescind offer handler.
bd60c33e
GKH
520 *
521 * We queue a work item to process this offer synchronously
522 */
e98cb276 523static void vmbus_onoffer_rescind(struct vmbus_channel_message_header *hdr)
3e7ee490 524{
bd60c33e 525 struct vmbus_channel_rescind_offer *rescind;
aded7165 526 struct vmbus_channel *channel;
d7f2fbaf 527 unsigned long flags;
3e7ee490 528
bd60c33e 529 rescind = (struct vmbus_channel_rescind_offer *)hdr;
c6977677 530 channel = relid2channel(rescind->child_relid);
98e08702
HJ
531
532 if (channel == NULL)
533 /* Just return here, no channel found */
3e7ee490 534 return;
3e7ee490 535
d7f2fbaf 536 spin_lock_irqsave(&channel->lock, flags);
c3582a2c 537 channel->rescind = true;
d7f2fbaf
VK
538 /*
539 * channel->work.func != vmbus_process_rescind_offer means we are still
540 * processing offer request and the rescind offer processing should be
541 * postponed. It will be done at the very end of vmbus_process_offer()
542 * as rescind flag is being checked there.
543 */
544 if (channel->work.func == vmbus_process_rescind_offer)
545 /* work is initialized for vmbus_process_rescind_offer() from
546 * vmbus_process_offer() where the channel got created */
547 queue_work(channel->controlwq, &channel->work);
c3582a2c 548
d7f2fbaf 549 spin_unlock_irqrestore(&channel->lock, flags);
3e7ee490
HJ
550}
551
3e189519 552/*
e98cb276
HZ
553 * vmbus_onoffers_delivered -
554 * This is invoked when all offers have been delivered.
bd60c33e
GKH
555 *
556 * Nothing to do here.
557 */
e98cb276 558static void vmbus_onoffers_delivered(
bd60c33e 559 struct vmbus_channel_message_header *hdr)
3e7ee490 560{
3e7ee490
HJ
561}
562
3e189519 563/*
e98cb276 564 * vmbus_onopen_result - Open result handler.
bd60c33e
GKH
565 *
566 * This is invoked when we received a response to our channel open request.
567 * Find the matching request, copy the response and signal the requesting
568 * thread.
569 */
e98cb276 570static void vmbus_onopen_result(struct vmbus_channel_message_header *hdr)
3e7ee490 571{
bd60c33e 572 struct vmbus_channel_open_result *result;
188963ec
HZ
573 struct vmbus_channel_msginfo *msginfo;
574 struct vmbus_channel_message_header *requestheader;
575 struct vmbus_channel_open_channel *openmsg;
dd0813b6 576 unsigned long flags;
3e7ee490 577
bd60c33e 578 result = (struct vmbus_channel_open_result *)hdr;
3e7ee490 579
bd60c33e
GKH
580 /*
581 * Find the open msg, copy the result and signal/unblock the wait event
582 */
15b2f647 583 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 584
ebb61e5f
HJ
585 list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
586 msglistentry) {
188963ec 587 requestheader =
c50f7fb2 588 (struct vmbus_channel_message_header *)msginfo->msg;
188963ec 589
c50f7fb2 590 if (requestheader->msgtype == CHANNELMSG_OPENCHANNEL) {
188963ec 591 openmsg =
c50f7fb2
HZ
592 (struct vmbus_channel_open_channel *)msginfo->msg;
593 if (openmsg->child_relid == result->child_relid &&
594 openmsg->openid == result->openid) {
595 memcpy(&msginfo->response.open_result,
bd60c33e 596 result,
9568a193
S
597 sizeof(
598 struct vmbus_channel_open_result));
599 complete(&msginfo->waitevent);
3e7ee490
HJ
600 break;
601 }
602 }
603 }
15b2f647 604 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490
HJ
605}
606
3e189519 607/*
e98cb276 608 * vmbus_ongpadl_created - GPADL created handler.
bd60c33e
GKH
609 *
610 * This is invoked when we received a response to our gpadl create request.
611 * Find the matching request, copy the response and signal the requesting
612 * thread.
613 */
e98cb276 614static void vmbus_ongpadl_created(struct vmbus_channel_message_header *hdr)
3e7ee490 615{
188963ec 616 struct vmbus_channel_gpadl_created *gpadlcreated;
188963ec
HZ
617 struct vmbus_channel_msginfo *msginfo;
618 struct vmbus_channel_message_header *requestheader;
619 struct vmbus_channel_gpadl_header *gpadlheader;
dd0813b6 620 unsigned long flags;
3e7ee490 621
188963ec 622 gpadlcreated = (struct vmbus_channel_gpadl_created *)hdr;
3e7ee490 623
bd60c33e
GKH
624 /*
625 * Find the establish msg, copy the result and signal/unblock the wait
626 * event
627 */
15b2f647 628 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 629
ebb61e5f
HJ
630 list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
631 msglistentry) {
188963ec 632 requestheader =
c50f7fb2 633 (struct vmbus_channel_message_header *)msginfo->msg;
188963ec 634
c50f7fb2 635 if (requestheader->msgtype == CHANNELMSG_GPADL_HEADER) {
188963ec
HZ
636 gpadlheader =
637 (struct vmbus_channel_gpadl_header *)requestheader;
638
c50f7fb2
HZ
639 if ((gpadlcreated->child_relid ==
640 gpadlheader->child_relid) &&
641 (gpadlcreated->gpadl == gpadlheader->gpadl)) {
642 memcpy(&msginfo->response.gpadl_created,
188963ec 643 gpadlcreated,
9568a193
S
644 sizeof(
645 struct vmbus_channel_gpadl_created));
646 complete(&msginfo->waitevent);
3e7ee490
HJ
647 break;
648 }
649 }
650 }
15b2f647 651 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490
HJ
652}
653
3e189519 654/*
e98cb276 655 * vmbus_ongpadl_torndown - GPADL torndown handler.
bd60c33e
GKH
656 *
657 * This is invoked when we received a response to our gpadl teardown request.
658 * Find the matching request, copy the response and signal the requesting
659 * thread.
660 */
e98cb276 661static void vmbus_ongpadl_torndown(
bd60c33e 662 struct vmbus_channel_message_header *hdr)
3e7ee490 663{
188963ec 664 struct vmbus_channel_gpadl_torndown *gpadl_torndown;
188963ec
HZ
665 struct vmbus_channel_msginfo *msginfo;
666 struct vmbus_channel_message_header *requestheader;
667 struct vmbus_channel_gpadl_teardown *gpadl_teardown;
dd0813b6 668 unsigned long flags;
3e7ee490 669
188963ec 670 gpadl_torndown = (struct vmbus_channel_gpadl_torndown *)hdr;
bd60c33e
GKH
671
672 /*
673 * Find the open msg, copy the result and signal/unblock the wait event
674 */
15b2f647 675 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 676
ebb61e5f
HJ
677 list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
678 msglistentry) {
188963ec 679 requestheader =
c50f7fb2 680 (struct vmbus_channel_message_header *)msginfo->msg;
3e7ee490 681
c50f7fb2 682 if (requestheader->msgtype == CHANNELMSG_GPADL_TEARDOWN) {
188963ec
HZ
683 gpadl_teardown =
684 (struct vmbus_channel_gpadl_teardown *)requestheader;
3e7ee490 685
c50f7fb2
HZ
686 if (gpadl_torndown->gpadl == gpadl_teardown->gpadl) {
687 memcpy(&msginfo->response.gpadl_torndown,
188963ec 688 gpadl_torndown,
9568a193
S
689 sizeof(
690 struct vmbus_channel_gpadl_torndown));
691 complete(&msginfo->waitevent);
3e7ee490
HJ
692 break;
693 }
694 }
695 }
15b2f647 696 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490
HJ
697}
698
3e189519 699/*
e98cb276 700 * vmbus_onversion_response - Version response handler
bd60c33e
GKH
701 *
702 * This is invoked when we received a response to our initiate contact request.
703 * Find the matching request, copy the response and signal the requesting
704 * thread.
705 */
e98cb276 706static void vmbus_onversion_response(
bd60c33e 707 struct vmbus_channel_message_header *hdr)
3e7ee490 708{
188963ec
HZ
709 struct vmbus_channel_msginfo *msginfo;
710 struct vmbus_channel_message_header *requestheader;
188963ec 711 struct vmbus_channel_version_response *version_response;
dd0813b6 712 unsigned long flags;
3e7ee490 713
188963ec 714 version_response = (struct vmbus_channel_version_response *)hdr;
15b2f647 715 spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
3e7ee490 716
ebb61e5f
HJ
717 list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
718 msglistentry) {
188963ec 719 requestheader =
c50f7fb2 720 (struct vmbus_channel_message_header *)msginfo->msg;
3e7ee490 721
c50f7fb2
HZ
722 if (requestheader->msgtype ==
723 CHANNELMSG_INITIATE_CONTACT) {
c50f7fb2 724 memcpy(&msginfo->response.version_response,
188963ec 725 version_response,
bd60c33e 726 sizeof(struct vmbus_channel_version_response));
9568a193 727 complete(&msginfo->waitevent);
3e7ee490
HJ
728 }
729 }
15b2f647 730 spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
3e7ee490
HJ
731}
732
c8212f04
GKH
733/* Channel message dispatch table */
734static struct vmbus_channel_message_table_entry
b7c6b02f 735 channel_message_table[CHANNELMSG_COUNT] = {
c50f7fb2
HZ
736 {CHANNELMSG_INVALID, NULL},
737 {CHANNELMSG_OFFERCHANNEL, vmbus_onoffer},
738 {CHANNELMSG_RESCIND_CHANNELOFFER, vmbus_onoffer_rescind},
739 {CHANNELMSG_REQUESTOFFERS, NULL},
740 {CHANNELMSG_ALLOFFERS_DELIVERED, vmbus_onoffers_delivered},
741 {CHANNELMSG_OPENCHANNEL, NULL},
742 {CHANNELMSG_OPENCHANNEL_RESULT, vmbus_onopen_result},
743 {CHANNELMSG_CLOSECHANNEL, NULL},
744 {CHANNELMSG_GPADL_HEADER, NULL},
745 {CHANNELMSG_GPADL_BODY, NULL},
746 {CHANNELMSG_GPADL_CREATED, vmbus_ongpadl_created},
747 {CHANNELMSG_GPADL_TEARDOWN, NULL},
748 {CHANNELMSG_GPADL_TORNDOWN, vmbus_ongpadl_torndown},
749 {CHANNELMSG_RELID_RELEASED, NULL},
750 {CHANNELMSG_INITIATE_CONTACT, NULL},
751 {CHANNELMSG_VERSION_RESPONSE, vmbus_onversion_response},
752 {CHANNELMSG_UNLOAD, NULL},
c8212f04
GKH
753};
754
3e189519 755/*
e98cb276 756 * vmbus_onmessage - Handler for channel protocol messages.
bd60c33e
GKH
757 *
758 * This is invoked in the vmbus worker thread context.
759 */
e98cb276 760void vmbus_onmessage(void *context)
3e7ee490 761{
188963ec 762 struct hv_message *msg = context;
82250213 763 struct vmbus_channel_message_header *hdr;
3e7ee490
HJ
764 int size;
765
f6feebe0
HZ
766 hdr = (struct vmbus_channel_message_header *)msg->u.payload;
767 size = msg->header.payload_size;
3e7ee490 768
c50f7fb2 769 if (hdr->msgtype >= CHANNELMSG_COUNT) {
0a46618d 770 pr_err("Received invalid channel message type %d size %d\n",
c50f7fb2 771 hdr->msgtype, size);
04f50c4d 772 print_hex_dump_bytes("", DUMP_PREFIX_NONE,
f6feebe0 773 (unsigned char *)msg->u.payload, size);
3e7ee490
HJ
774 return;
775 }
776
b7c6b02f
S
777 if (channel_message_table[hdr->msgtype].message_handler)
778 channel_message_table[hdr->msgtype].message_handler(hdr);
3e7ee490 779 else
0a46618d 780 pr_err("Unhandled channel message type %d\n", hdr->msgtype);
3e7ee490
HJ
781}
782
3e189519 783/*
e98cb276 784 * vmbus_request_offers - Send a request to get all our pending offers.
bd60c33e 785 */
e98cb276 786int vmbus_request_offers(void)
3e7ee490 787{
82250213 788 struct vmbus_channel_message_header *msg;
188963ec 789 struct vmbus_channel_msginfo *msginfo;
9568a193 790 int ret, t;
3e7ee490 791
188963ec 792 msginfo = kmalloc(sizeof(*msginfo) +
bd60c33e
GKH
793 sizeof(struct vmbus_channel_message_header),
794 GFP_KERNEL);
188963ec 795 if (!msginfo)
75910f23 796 return -ENOMEM;
3e7ee490 797
9568a193 798 init_completion(&msginfo->waitevent);
75910f23 799
c50f7fb2 800 msg = (struct vmbus_channel_message_header *)msginfo->msg;
3e7ee490 801
c50f7fb2 802 msg->msgtype = CHANNELMSG_REQUESTOFFERS;
3e7ee490 803
3e7ee490 804
c6977677 805 ret = vmbus_post_msg(msg,
bd60c33e
GKH
806 sizeof(struct vmbus_channel_message_header));
807 if (ret != 0) {
0a46618d 808 pr_err("Unable to request offers - %d\n", ret);
3e7ee490 809
0c3b7b2f
S
810 goto cleanup;
811 }
3e7ee490 812
2dfde964 813 t = wait_for_completion_timeout(&msginfo->waitevent, 5*HZ);
9568a193 814 if (t == 0) {
0c3b7b2f
S
815 ret = -ETIMEDOUT;
816 goto cleanup;
3e7ee490 817 }
3e7ee490 818
3e7ee490
HJ
819
820
0c3b7b2f 821cleanup:
dd9b15dc 822 kfree(msginfo);
3e7ee490 823
3e7ee490
HJ
824 return ret;
825}
826
e68d2971
S
827/*
828 * Retrieve the (sub) channel on which to send an outgoing request.
829 * When a primary channel has multiple sub-channels, we choose a
830 * channel whose VCPU binding is closest to the VCPU on which
831 * this call is being made.
832 */
833struct vmbus_channel *vmbus_get_outgoing_channel(struct vmbus_channel *primary)
834{
835 struct list_head *cur, *tmp;
87712bf8 836 int cur_cpu;
e68d2971
S
837 struct vmbus_channel *cur_channel;
838 struct vmbus_channel *outgoing_channel = primary;
839 int cpu_distance, new_cpu_distance;
840
841 if (list_empty(&primary->sc_list))
842 return outgoing_channel;
843
87712bf8
S
844 cur_cpu = hv_context.vp_index[get_cpu()];
845 put_cpu();
e68d2971
S
846 list_for_each_safe(cur, tmp, &primary->sc_list) {
847 cur_channel = list_entry(cur, struct vmbus_channel, sc_list);
848 if (cur_channel->state != CHANNEL_OPENED_STATE)
849 continue;
850
851 if (cur_channel->target_vp == cur_cpu)
852 return cur_channel;
853
854 cpu_distance = ((outgoing_channel->target_vp > cur_cpu) ?
855 (outgoing_channel->target_vp - cur_cpu) :
856 (cur_cpu - outgoing_channel->target_vp));
857
858 new_cpu_distance = ((cur_channel->target_vp > cur_cpu) ?
859 (cur_channel->target_vp - cur_cpu) :
860 (cur_cpu - cur_channel->target_vp));
861
862 if (cpu_distance < new_cpu_distance)
863 continue;
864
865 outgoing_channel = cur_channel;
866 }
867
868 return outgoing_channel;
869}
870EXPORT_SYMBOL_GPL(vmbus_get_outgoing_channel);
871
872static void invoke_sc_cb(struct vmbus_channel *primary_channel)
873{
874 struct list_head *cur, *tmp;
875 struct vmbus_channel *cur_channel;
876
877 if (primary_channel->sc_creation_callback == NULL)
878 return;
879
880 list_for_each_safe(cur, tmp, &primary_channel->sc_list) {
881 cur_channel = list_entry(cur, struct vmbus_channel, sc_list);
882
883 primary_channel->sc_creation_callback(cur_channel);
884 }
885}
886
887void vmbus_set_sc_create_callback(struct vmbus_channel *primary_channel,
888 void (*sc_cr_cb)(struct vmbus_channel *new_sc))
889{
890 primary_channel->sc_creation_callback = sc_cr_cb;
891}
892EXPORT_SYMBOL_GPL(vmbus_set_sc_create_callback);
893
894bool vmbus_are_subchannels_present(struct vmbus_channel *primary)
895{
896 bool ret;
897
898 ret = !list_empty(&primary->sc_list);
899
900 if (ret) {
901 /*
902 * Invoke the callback on sub-channel creation.
903 * This will present a uniform interface to the
904 * clients.
905 */
906 invoke_sc_cb(primary);
907 }
908
909 return ret;
910}
911EXPORT_SYMBOL_GPL(vmbus_are_subchannels_present);
This page took 0.494868 seconds and 5 git commands to generate.