channel_mgmt.c 33.0 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
/*
 * Copyright (c) 2009, Microsoft Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
 * Place - Suite 330, Boston, MA 02111-1307 USA.
 *
 * Authors:
 *   Haiyang Zhang <haiyangz@microsoft.com>
 *   Hank Janssen  <hjanssen@microsoft.com>
 */
21 22
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

23
#include <linux/kernel.h>
24
#include <linux/interrupt.h>
25 26
#include <linux/sched.h>
#include <linux/wait.h>
27
#include <linux/mm.h>
28
#include <linux/slab.h>
29
#include <linux/list.h>
30
#include <linux/module.h>
31
#include <linux/completion.h>
32
#include <linux/delay.h>
33
#include <linux/hyperv.h>
34
#include <asm/mshyperv.h>
35

36
#include "hyperv_vmbus.h"
37

38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137
static void init_vp_index(struct vmbus_channel *channel, u16 dev_type);

static const struct vmbus_device vmbus_devs[] = {
	/* IDE */
	{ .dev_type = HV_IDE,
	  HV_IDE_GUID,
	  .perf_device = true,
	},

	/* SCSI */
	{ .dev_type = HV_SCSI,
	  HV_SCSI_GUID,
	  .perf_device = true,
	},

	/* Fibre Channel */
	{ .dev_type = HV_FC,
	  HV_SYNTHFC_GUID,
	  .perf_device = true,
	},

	/* Synthetic NIC */
	{ .dev_type = HV_NIC,
	  HV_NIC_GUID,
	  .perf_device = true,
	},

	/* Network Direct */
	{ .dev_type = HV_ND,
	  HV_ND_GUID,
	  .perf_device = true,
	},

	/* PCIE */
	{ .dev_type = HV_PCIE,
	  HV_PCIE_GUID,
	  .perf_device = true,
	},

	/* Synthetic Frame Buffer */
	{ .dev_type = HV_FB,
	  HV_SYNTHVID_GUID,
	  .perf_device = false,
	},

	/* Synthetic Keyboard */
	{ .dev_type = HV_KBD,
	  HV_KBD_GUID,
	  .perf_device = false,
	},

	/* Synthetic MOUSE */
	{ .dev_type = HV_MOUSE,
	  HV_MOUSE_GUID,
	  .perf_device = false,
	},

	/* KVP */
	{ .dev_type = HV_KVP,
	  HV_KVP_GUID,
	  .perf_device = false,
	},

	/* Time Synch */
	{ .dev_type = HV_TS,
	  HV_TS_GUID,
	  .perf_device = false,
	},

	/* Heartbeat */
	{ .dev_type = HV_HB,
	  HV_HEART_BEAT_GUID,
	  .perf_device = false,
	},

	/* Shutdown */
	{ .dev_type = HV_SHUTDOWN,
	  HV_SHUTDOWN_GUID,
	  .perf_device = false,
	},

	/* File copy */
	{ .dev_type = HV_FCOPY,
	  HV_FCOPY_GUID,
	  .perf_device = false,
	},

	/* Backup */
	{ .dev_type = HV_BACKUP,
	  HV_VSS_GUID,
	  .perf_device = false,
	},

	/* Dynamic Memory */
	{ .dev_type = HV_DM,
	  HV_DM_GUID,
	  .perf_device = false,
	},

	/* Unknown GUID */
H
Haiyang Zhang 已提交
138
	{ .dev_type = HV_UNKNOWN,
139 140 141 142
	  .perf_device = false,
	},
};

143 144 145 146 147 148 149 150
static const struct {
	uuid_le guid;
} vmbus_unsupported_devs[] = {
	{ HV_AVMA1_GUID },
	{ HV_AVMA2_GUID },
	{ HV_RDV_GUID	},
};

151 152 153 154 155 156 157 158 159 160 161
/*
 * The rescinded channel may be blocked waiting for a response from the host;
 * take care of that.
 */
static void vmbus_rescind_cleanup(struct vmbus_channel *channel)
{
	struct vmbus_channel_msginfo *msginfo;
	unsigned long flags;


	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
162
	channel->rescind = true;
163 164 165 166 167 168 169 170 171 172 173
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {

		if (msginfo->waiting_channel == channel) {
			complete(&msginfo->waitevent);
			break;
		}
	}
	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
}

174 175 176 177 178 179 180 181 182 183 184
static bool is_unsupported_vmbus_devs(const uuid_le *guid)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(vmbus_unsupported_devs); i++)
		if (!uuid_le_cmp(*guid, vmbus_unsupported_devs[i].guid))
			return true;
	return false;
}

static u16 hv_get_dev_type(const struct vmbus_channel *channel)
185
{
186
	const uuid_le *guid = &channel->offermsg.offer.if_type;
187 188
	u16 i;

189
	if (is_hvsock_channel(channel) || is_unsupported_vmbus_devs(guid))
H
Haiyang Zhang 已提交
190
		return HV_UNKNOWN;
191

H
Haiyang Zhang 已提交
192
	for (i = HV_IDE; i < HV_UNKNOWN; i++) {
193 194 195 196 197 198
		if (!uuid_le_cmp(*guid, vmbus_devs[i].guid))
			return i;
	}
	pr_info("Unknown GUID: %pUl\n", guid);
	return i;
}
199

200
/**
201
 * vmbus_prep_negotiate_resp() - Create default response for Hyper-V Negotiate message
202 203 204 205 206
 * @icmsghdrp: Pointer to msg header structure
 * @icmsg_negotiate: Pointer to negotiate message structure
 * @buf: Raw buffer channel data
 *
 * @icmsghdrp is of type &struct icmsg_hdr.
207 208
 * Set up and fill in default negotiate response message.
 *
209 210 211 212 213 214 215 216 217
 * The fw_version and fw_vercnt specifies the framework version that
 * we can support.
 *
 * The srv_version and srv_vercnt specifies the service
 * versions we can support.
 *
 * Versions are given in decreasing order.
 *
 * nego_fw_version and nego_srv_version store the selected protocol versions.
218 219 220
 *
 * Mainly used by Hyper-V drivers.
 */
221
bool vmbus_prep_negotiate_resp(struct icmsg_hdr *icmsghdrp,
222 223 224
				u8 *buf, const int *fw_version, int fw_vercnt,
				const int *srv_version, int srv_vercnt,
				int *nego_fw_version, int *nego_srv_version)
225
{
226 227 228 229
	int icframe_major, icframe_minor;
	int icmsg_major, icmsg_minor;
	int fw_major, fw_minor;
	int srv_major, srv_minor;
230
	int i, j;
231
	bool found_match = false;
232
	struct icmsg_negotiate *negop;
233

234 235 236 237
	icmsghdrp->icmsgsize = 0x10;
	negop = (struct icmsg_negotiate *)&buf[
		sizeof(struct vmbuspipe_hdr) +
		sizeof(struct icmsg_hdr)];
238

239 240 241 242 243
	icframe_major = negop->icframe_vercnt;
	icframe_minor = 0;

	icmsg_major = negop->icmsg_vercnt;
	icmsg_minor = 0;
244 245 246 247 248 249

	/*
	 * Select the framework version number we will
	 * support.
	 */

250 251 252 253 254 255 256 257 258 259 260 261
	for (i = 0; i < fw_vercnt; i++) {
		fw_major = (fw_version[i] >> 16);
		fw_minor = (fw_version[i] & 0xFFFF);

		for (j = 0; j < negop->icframe_vercnt; j++) {
			if ((negop->icversion_data[j].major == fw_major) &&
			    (negop->icversion_data[j].minor == fw_minor)) {
				icframe_major = negop->icversion_data[j].major;
				icframe_minor = negop->icversion_data[j].minor;
				found_match = true;
				break;
			}
262
		}
263 264 265

		if (found_match)
			break;
266 267
	}

268 269 270 271 272
	if (!found_match)
		goto fw_error;

	found_match = false;

273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288
	for (i = 0; i < srv_vercnt; i++) {
		srv_major = (srv_version[i] >> 16);
		srv_minor = (srv_version[i] & 0xFFFF);

		for (j = negop->icframe_vercnt;
			(j < negop->icframe_vercnt + negop->icmsg_vercnt);
			j++) {

			if ((negop->icversion_data[j].major == srv_major) &&
				(negop->icversion_data[j].minor == srv_minor)) {

				icmsg_major = negop->icversion_data[j].major;
				icmsg_minor = negop->icversion_data[j].minor;
				found_match = true;
				break;
			}
289
		}
290 291 292

		if (found_match)
			break;
293
	}
294

295
	/*
296
	 * Respond with the framework and service
297 298
	 * version numbers we can support.
	 */
299 300 301 302 303 304 305 306 307 308

fw_error:
	if (!found_match) {
		negop->icframe_vercnt = 0;
		negop->icmsg_vercnt = 0;
	} else {
		negop->icframe_vercnt = 1;
		negop->icmsg_vercnt = 1;
	}

309 310 311 312 313 314
	if (nego_fw_version)
		*nego_fw_version = (icframe_major << 16) | icframe_minor;

	if (nego_srv_version)
		*nego_srv_version = (icmsg_major << 16) | icmsg_minor;

315 316 317 318 319
	negop->icversion_data[0].major = icframe_major;
	negop->icversion_data[0].minor = icframe_minor;
	negop->icversion_data[1].major = icmsg_major;
	negop->icversion_data[1].minor = icmsg_minor;
	return found_match;
320
}
321

322
EXPORT_SYMBOL_GPL(vmbus_prep_negotiate_resp);
323

324
/*
325
 * alloc_channel - Allocate and initialize a vmbus channel object
326
 */
327
static struct vmbus_channel *alloc_channel(void)
328
{
329
	struct vmbus_channel *channel;
330

331
	channel = kzalloc(sizeof(*channel), GFP_ATOMIC);
332 333 334
	if (!channel)
		return NULL;

335
	spin_lock_init(&channel->lock);
336 337

	INIT_LIST_HEAD(&channel->sc_list);
338
	INIT_LIST_HEAD(&channel->percpu_list);
339

340 341 342
	tasklet_init(&channel->callback_event,
		     vmbus_on_event, (unsigned long)channel);

343 344 345
	return channel;
}

346
/*
347
 * free_channel - Release the resources used by the vmbus channel object
348
 */
349
static void free_channel(struct vmbus_channel *channel)
350
{
351
	tasklet_kill(&channel->callback_event);
352 353

	kfree_rcu(channel, rcu);
354 355
}

356 357 358
static void percpu_channel_enq(void *arg)
{
	struct vmbus_channel *channel = arg;
359 360
	struct hv_per_cpu_context *hv_cpu
		= this_cpu_ptr(hv_context.cpu_context);
361

362
	list_add_tail_rcu(&channel->percpu_list, &hv_cpu->chan_list);
363
}
364

365 366 367 368
static void percpu_channel_deq(void *arg)
{
	struct vmbus_channel *channel = arg;

369
	list_del_rcu(&channel->percpu_list);
370
}
371

372

373
static void vmbus_release_relid(u32 relid)
374
{
375
	struct vmbus_channel_relid_released msg;
376

377
	memset(&msg, 0, sizeof(struct vmbus_channel_relid_released));
378
	msg.child_relid = relid;
379
	msg.header.msgtype = CHANNELMSG_RELID_RELEASED;
380 381
	vmbus_post_msg(&msg, sizeof(struct vmbus_channel_relid_released),
		       true);
382
}
383

384
void hv_process_channel_removal(u32 relid)
385 386
{
	unsigned long flags;
387
	struct vmbus_channel *primary_channel, *channel;
388

389
	BUG_ON(!mutex_is_locked(&vmbus_connection.channel_mutex));
390

391 392 393 394 395 396 397 398
	/*
	 * Make sure channel is valid as we may have raced.
	 */
	channel = relid2channel(relid);
	if (!channel)
		return;

	BUG_ON(!channel->rescind);
399 400
	if (channel->target_cpu != get_cpu()) {
		put_cpu();
401 402
		smp_call_function_single(channel->target_cpu,
					 percpu_channel_deq, channel, true);
403
	} else {
404
		percpu_channel_deq(channel);
405 406
		put_cpu();
	}
407

408 409
	if (channel->primary_channel == NULL) {
		list_del(&channel->listentry);
410 411

		primary_channel = channel;
412 413
	} else {
		primary_channel = channel->primary_channel;
414
		spin_lock_irqsave(&primary_channel->lock, flags);
415
		list_del(&channel->sc_list);
416
		primary_channel->num_sc--;
417
		spin_unlock_irqrestore(&primary_channel->lock, flags);
418
	}
419 420 421 422 423

	/*
	 * We need to free the bit for init_vp_index() to work in the case
	 * of sub-channel, when we reload drivers like hv_netvsc.
	 */
424 425 426
	if (channel->affinity_policy == HV_LOCALIZED)
		cpumask_clear_cpu(channel->target_cpu,
				  &primary_channel->alloced_cpus_in_node);
427

428 429
	vmbus_release_relid(relid);

430
	free_channel(channel);
431
}
432

433 434
void vmbus_free_channels(void)
{
435 436 437 438
	struct vmbus_channel *channel, *tmp;

	list_for_each_entry_safe(channel, tmp, &vmbus_connection.chn_list,
		listentry) {
439
		/* hv_process_channel_removal() needs this */
440
		channel->rescind = true;
441 442 443 444 445

		vmbus_device_unregister(channel->device_obj);
	}
}

446
/*
447
 * vmbus_process_offer - Process the offer by creating a channel/device
448
 * associated with this offer
449
 */
450
static void vmbus_process_offer(struct vmbus_channel *newchannel)
451
{
452
	struct vmbus_channel *channel;
453
	bool fnew = true;
454
	unsigned long flags;
455
	u16 dev_type;
456
	int ret;
457

458
	/* Make sure this is a new offer */
459
	mutex_lock(&vmbus_connection.channel_mutex);
460

461 462 463 464 465 466
	/*
	 * Now that we have acquired the channel_mutex,
	 * we can release the potentially racing rescind thread.
	 */
	atomic_dec(&vmbus_connection.offer_in_progress);

467
	list_for_each_entry(channel, &vmbus_connection.chn_list, listentry) {
468 469 470 471
		if (!uuid_le_cmp(channel->offermsg.offer.if_type,
			newchannel->offermsg.offer.if_type) &&
			!uuid_le_cmp(channel->offermsg.offer.if_instance,
				newchannel->offermsg.offer.if_instance)) {
472
			fnew = false;
473 474 475 476
			break;
		}
	}

477
	if (fnew)
478
		list_add_tail(&newchannel->listentry,
479
			      &vmbus_connection.chn_list);
480

481
	mutex_unlock(&vmbus_connection.channel_mutex);
482

483
	if (!fnew) {
484 485 486 487 488 489 490 491
		/*
		 * Check to see if this is a sub-channel.
		 */
		if (newchannel->offermsg.offer.sub_channel_index != 0) {
			/*
			 * Process the sub-channel.
			 */
			newchannel->primary_channel = channel;
492
			spin_lock_irqsave(&channel->lock, flags);
493
			list_add_tail(&newchannel->sc_list, &channel->sc_list);
494
			channel->num_sc++;
495
			spin_unlock_irqrestore(&channel->lock, flags);
496
		} else {
497
			goto err_free_chan;
498
		}
499
	}
500

501
	dev_type = hv_get_dev_type(newchannel);
502 503

	init_vp_index(newchannel, dev_type);
504

505 506 507 508 509 510 511 512
	if (newchannel->target_cpu != get_cpu()) {
		put_cpu();
		smp_call_function_single(newchannel->target_cpu,
					 percpu_channel_enq,
					 newchannel, true);
	} else {
		percpu_channel_enq(newchannel);
		put_cpu();
513 514
	}

515 516 517 518 519 520 521
	/*
	 * This state is used to indicate a successful open
	 * so that when we do close the channel normally, we
	 * can cleanup properly
	 */
	newchannel->state = CHANNEL_OPEN_STATE;

522 523 524
	if (!fnew) {
		if (channel->sc_creation_callback != NULL)
			channel->sc_creation_callback(newchannel);
525
		newchannel->probe_done = true;
526 527 528
		return;
	}

529 530 531
	/*
	 * Start the process of binding this offer to the driver
	 * We need to set the DeviceObject field before calling
532
	 * vmbus_child_dev_add()
533
	 */
534
	newchannel->device_obj = vmbus_device_create(
535 536
		&newchannel->offermsg.offer.if_type,
		&newchannel->offermsg.offer.if_instance,
537
		newchannel);
538
	if (!newchannel->device_obj)
539
		goto err_deq_chan;
540

541
	newchannel->device_obj->device_id = dev_type;
542 543 544 545 546
	/*
	 * Add the new device to the bus. This will kick off device-driver
	 * binding which eventually invokes the device driver's AddDevice()
	 * method.
	 */
547 548 549
	ret = vmbus_device_register(newchannel->device_obj);

	if (ret != 0) {
550 551 552 553 554
		pr_err("unable to add child device object (relid %d)\n",
			newchannel->offermsg.child_relid);
		kfree(newchannel->device_obj);
		goto err_deq_chan;
	}
555

556
	newchannel->probe_done = true;
557
	return;
558

559
err_deq_chan:
560
	mutex_lock(&vmbus_connection.channel_mutex);
561
	list_del(&newchannel->listentry);
562
	mutex_unlock(&vmbus_connection.channel_mutex);
563 564 565 566 567 568 569 570 571

	if (newchannel->target_cpu != get_cpu()) {
		put_cpu();
		smp_call_function_single(newchannel->target_cpu,
					 percpu_channel_deq, newchannel, true);
	} else {
		percpu_channel_deq(newchannel);
		put_cpu();
	}
572 573

	vmbus_release_relid(newchannel->offermsg.child_relid);
574

575 576
err_free_chan:
	free_channel(newchannel);
577 578
}

579 580 581
/*
 * We use this state to statically distribute the channel interrupt load.
 */
582
static int next_numa_node_id;
583 584 585

/*
 * Starting with Win8, we can statically distribute the incoming
586 587 588 589 590 591 592 593
 * channel interrupt load by binding a channel to VCPU.
 * We do this in a hierarchical fashion:
 * First distribute the primary channels across available NUMA nodes
 * and then distribute the subchannels amongst the CPUs in the NUMA
 * node assigned to the primary channel.
 *
 * For pre-win8 hosts or non-performance critical channels we assign the
 * first CPU in the first NUMA node.
594
 */
595
static void init_vp_index(struct vmbus_channel *channel, u16 dev_type)
596 597
{
	u32 cur_cpu;
598
	bool perf_chn = vmbus_devs[dev_type].perf_device;
599 600 601
	struct vmbus_channel *primary = channel->primary_channel;
	int next_node;
	struct cpumask available_mask;
602
	struct cpumask *alloced_mask;
603 604 605 606 607 608 609 610 611

	if ((vmbus_proto_version == VERSION_WS2008) ||
	    (vmbus_proto_version == VERSION_WIN7) || (!perf_chn)) {
		/*
		 * Prior to win8, all channel interrupts are
		 * delivered on cpu 0.
		 * Also if the channel is not a performance critical
		 * channel, bind it to cpu 0.
		 */
612
		channel->numa_node = 0;
613
		channel->target_cpu = 0;
V
Vitaly Kuznetsov 已提交
614
		channel->target_vp = hv_cpu_number_to_vp_number(0);
615
		return;
616
	}
617 618

	/*
619 620
	 * Based on the channel affinity policy, we will assign the NUMA
	 * nodes.
621
	 */
622 623

	if ((channel->affinity_policy == HV_BALANCED) || (!primary)) {
624 625
		while (true) {
			next_node = next_numa_node_id++;
626
			if (next_node == nr_node_ids) {
627
				next_node = next_numa_node_id = 0;
628 629
				continue;
			}
630 631 632 633 634 635 636
			if (cpumask_empty(cpumask_of_node(next_node)))
				continue;
			break;
		}
		channel->numa_node = next_node;
		primary = channel;
	}
637
	alloced_mask = &hv_context.hv_numa_map[primary->numa_node];
638

639
	if (cpumask_weight(alloced_mask) ==
640
	    cpumask_weight(cpumask_of_node(primary->numa_node))) {
641
		/*
642 643
		 * We have cycled through all the CPUs in the node;
		 * reset the alloced map.
644
		 */
645
		cpumask_clear(alloced_mask);
646 647
	}

648
	cpumask_xor(&available_mask, alloced_mask,
649 650
		    cpumask_of_node(primary->numa_node));

651
	cur_cpu = -1;
652

653 654 655 656 657 658 659 660 661 662 663
	if (primary->affinity_policy == HV_LOCALIZED) {
		/*
		 * Normally Hyper-V host doesn't create more subchannels
		 * than there are VCPUs on the node but it is possible when not
		 * all present VCPUs on the node are initialized by guest.
		 * Clear the alloced_cpus_in_node to start over.
		 */
		if (cpumask_equal(&primary->alloced_cpus_in_node,
				  cpumask_of_node(primary->numa_node)))
			cpumask_clear(&primary->alloced_cpus_in_node);
	}
664

665 666 667 668 669 670 671 672 673
	while (true) {
		cur_cpu = cpumask_next(cur_cpu, &available_mask);
		if (cur_cpu >= nr_cpu_ids) {
			cur_cpu = -1;
			cpumask_copy(&available_mask,
				     cpumask_of_node(primary->numa_node));
			continue;
		}

674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691
		if (primary->affinity_policy == HV_LOCALIZED) {
			/*
			 * NOTE: in the case of sub-channel, we clear the
			 * sub-channel related bit(s) in
			 * primary->alloced_cpus_in_node in
			 * hv_process_channel_removal(), so when we
			 * reload drivers like hv_netvsc in SMP guest, here
			 * we're able to re-allocate
			 * bit from primary->alloced_cpus_in_node.
			 */
			if (!cpumask_test_cpu(cur_cpu,
					      &primary->alloced_cpus_in_node)) {
				cpumask_set_cpu(cur_cpu,
						&primary->alloced_cpus_in_node);
				cpumask_set_cpu(cur_cpu, alloced_mask);
				break;
			}
		} else {
692 693 694 695
			cpumask_set_cpu(cur_cpu, alloced_mask);
			break;
		}
	}
696

697
	channel->target_cpu = cur_cpu;
V
Vitaly Kuznetsov 已提交
698
	channel->target_vp = hv_cpu_number_to_vp_number(cur_cpu);
699 700
}

701 702
static void vmbus_wait_for_unload(void)
{
703 704 705
	int cpu;
	void *page_addr;
	struct hv_message *msg;
706
	struct vmbus_channel_message_header *hdr;
707
	u32 message_type;
708

709 710 711 712 713 714 715 716 717
	/*
	 * CHANNELMSG_UNLOAD_RESPONSE is always delivered to the CPU which was
	 * used for initial contact or to CPU0 depending on host version. When
	 * we're crashing on a different CPU let's hope that IRQ handler on
	 * the cpu which receives CHANNELMSG_UNLOAD_RESPONSE is still
	 * functional and vmbus_unload_response() will complete
	 * vmbus_connection.unload_event. If not, the last thing we can do is
	 * read message pages for all CPUs directly.
	 */
718
	while (1) {
719 720
		if (completion_done(&vmbus_connection.unload_event))
			break;
721

722
		for_each_online_cpu(cpu) {
723 724 725 726 727 728
			struct hv_per_cpu_context *hv_cpu
				= per_cpu_ptr(hv_context.cpu_context, cpu);

			page_addr = hv_cpu->synic_message_page;
			msg = (struct hv_message *)page_addr
				+ VMBUS_MESSAGE_SINT;
729

730 731 732
			message_type = READ_ONCE(msg->header.message_type);
			if (message_type == HVMSG_NONE)
				continue;
733

734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751
			hdr = (struct vmbus_channel_message_header *)
				msg->u.payload;

			if (hdr->msgtype == CHANNELMSG_UNLOAD_RESPONSE)
				complete(&vmbus_connection.unload_event);

			vmbus_signal_eom(msg, message_type);
		}

		mdelay(10);
	}

	/*
	 * We're crashing and already got the UNLOAD_RESPONSE, cleanup all
	 * maybe-pending messages on all CPUs to be able to receive new
	 * messages after we reconnect.
	 */
	for_each_online_cpu(cpu) {
752 753 754 755
		struct hv_per_cpu_context *hv_cpu
			= per_cpu_ptr(hv_context.cpu_context, cpu);

		page_addr = hv_cpu->synic_message_page;
756 757
		msg = (struct hv_message *)page_addr + VMBUS_MESSAGE_SINT;
		msg->header.message_type = HVMSG_NONE;
758 759 760
	}
}

761 762 763 764 765 766 767 768 769 770 771 772
/*
 * vmbus_unload_response - Handler for the unload response.
 */
static void vmbus_unload_response(struct vmbus_channel_message_header *hdr)
{
	/*
	 * This is a global event; just wakeup the waiting thread.
	 * Once we successfully unload, we can cleanup the monitor state.
	 */
	complete(&vmbus_connection.unload_event);
}

773
void vmbus_initiate_unload(bool crash)
774 775 776
{
	struct vmbus_channel_message_header hdr;

777 778 779 780
	/* Pre-Win2012R2 hosts don't support reconnect */
	if (vmbus_proto_version < VERSION_WIN8_1)
		return;

781 782 783
	init_completion(&vmbus_connection.unload_event);
	memset(&hdr, 0, sizeof(struct vmbus_channel_message_header));
	hdr.msgtype = CHANNELMSG_UNLOAD;
784 785
	vmbus_post_msg(&hdr, sizeof(struct vmbus_channel_message_header),
		       !crash);
786

787 788 789 790
	/*
	 * vmbus_initiate_unload() is also called on crash and the crash can be
	 * happening in an interrupt context, where scheduling is impossible.
	 */
791
	if (!crash)
792 793 794
		wait_for_completion(&vmbus_connection.unload_event);
	else
		vmbus_wait_for_unload();
795 796
}

797
/*
798
 * vmbus_onoffer - Handler for channel offers from vmbus in parent partition.
799 800
 *
 */
801
static void vmbus_onoffer(struct vmbus_channel_message_header *hdr)
802
{
803
	struct vmbus_channel_offer_channel *offer;
804
	struct vmbus_channel *newchannel;
805

806
	offer = (struct vmbus_channel_offer_channel *)hdr;
807

808
	/* Allocate the channel object and save this offer. */
809
	newchannel = alloc_channel();
810
	if (!newchannel) {
811
		vmbus_release_relid(offer->child_relid);
812
		atomic_dec(&vmbus_connection.offer_in_progress);
813
		pr_err("Unable to allocate channel object\n");
814 815 816
		return;
	}

817 818 819
	/*
	 * Setup state for signalling the host.
	 */
820
	newchannel->sig_event = VMBUS_EVENT_CONNECTION_ID;
821 822 823 824

	if (vmbus_proto_version != VERSION_WS2008) {
		newchannel->is_dedicated_interrupt =
				(offer->is_dedicated_interrupt != 0);
825
		newchannel->sig_event = offer->connection_id;
826 827
	}

828
	memcpy(&newchannel->offermsg, offer,
829
	       sizeof(struct vmbus_channel_offer_channel));
830 831
	newchannel->monitor_grp = (u8)offer->monitorid / 32;
	newchannel->monitor_bit = (u8)offer->monitorid % 32;
832

833
	vmbus_process_offer(newchannel);
834 835
}

836
/*
837
 * vmbus_onoffer_rescind - Rescind offer handler.
838 839 840
 *
 * We queue a work item to process this offer synchronously
 */
841
static void vmbus_onoffer_rescind(struct vmbus_channel_message_header *hdr)
842
{
843
	struct vmbus_channel_rescind_offer *rescind;
844
	struct vmbus_channel *channel;
845
	struct device *dev;
846

847
	rescind = (struct vmbus_channel_rescind_offer *)hdr;
848

849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869
	/*
	 * The offer msg and the corresponding rescind msg
	 * from the host are guranteed to be ordered -
	 * offer comes in first and then the rescind.
	 * Since we process these events in work elements,
	 * and with preemption, we may end up processing
	 * the events out of order. Given that we handle these
	 * work elements on the same CPU, this is possible only
	 * in the case of preemption. In any case wait here
	 * until the offer processing has moved beyond the
	 * point where the channel is discoverable.
	 */

	while (atomic_read(&vmbus_connection.offer_in_progress) != 0) {
		/*
		 * We wait here until any channel offer is currently
		 * being processed.
		 */
		msleep(1);
	}

870
	mutex_lock(&vmbus_connection.channel_mutex);
871
	channel = relid2channel(rescind->child_relid);
872
	mutex_unlock(&vmbus_connection.channel_mutex);
873

874
	if (channel == NULL) {
875
		/*
876 877 878
		 * We failed in processing the offer message;
		 * we would have cleaned up the relid in that
		 * failure path.
879
		 */
880
		return;
881
	}
882

883 884 885 886 887 888 889 890 891 892 893 894 895 896 897
	/*
	 * Now wait for offer handling to complete.
	 */
	while (READ_ONCE(channel->probe_done) == false) {
		/*
		 * We wait here until any channel offer is currently
		 * being processed.
		 */
		msleep(1);
	}

	/*
	 * At this point, the rescind handling can proceed safely.
	 */

898
	if (channel->device_obj) {
899 900
		if (channel->chn_rescind_callback) {
			channel->chn_rescind_callback(channel);
901
			vmbus_rescind_cleanup(channel);
902
			return;
903
		}
904 905 906 907 908 909
		/*
		 * We will have to unregister this device from the
		 * driver core.
		 */
		dev = get_device(&channel->device_obj->device);
		if (dev) {
910
			vmbus_rescind_cleanup(channel);
911 912 913
			vmbus_device_unregister(channel->device_obj);
			put_device(dev);
		}
914
	}
915 916 917 918 919 920 921 922
	if (channel->primary_channel != NULL) {
		/*
		 * Sub-channel is being rescinded. Following is the channel
		 * close sequence when initiated from the driveri (refer to
		 * vmbus_close() for details):
		 * 1. Close all sub-channels first
		 * 2. Then close the primary channel.
		 */
923 924
		mutex_lock(&vmbus_connection.channel_mutex);
		vmbus_rescind_cleanup(channel);
925 926 927 928 929
		if (channel->state == CHANNEL_OPEN_STATE) {
			/*
			 * The channel is currently not open;
			 * it is safe for us to cleanup the channel.
			 */
930
			hv_process_channel_removal(rescind->child_relid);
931
		}
932
		mutex_unlock(&vmbus_connection.channel_mutex);
933
	}
934 935 936 937 938 939 940 941
}

void vmbus_hvsock_device_unregister(struct vmbus_channel *channel)
{
	BUG_ON(!is_hvsock_channel(channel));

	channel->rescind = true;
	vmbus_device_unregister(channel->device_obj);
942
}
943 944
EXPORT_SYMBOL_GPL(vmbus_hvsock_device_unregister);

945

946
/*
947 948
 * vmbus_onoffers_delivered -
 * This is invoked when all offers have been delivered.
949 950 951
 *
 * Nothing to do here.
 */
952
static void vmbus_onoffers_delivered(
953
			struct vmbus_channel_message_header *hdr)
954 955 956
{
}

957
/*
958
 * vmbus_onopen_result - Open result handler.
959 960 961 962 963
 *
 * This is invoked when we received a response to our channel open request.
 * Find the matching request, copy the response and signal the requesting
 * thread.
 */
964
static void vmbus_onopen_result(struct vmbus_channel_message_header *hdr)
965
{
966
	struct vmbus_channel_open_result *result;
967 968 969
	struct vmbus_channel_msginfo *msginfo;
	struct vmbus_channel_message_header *requestheader;
	struct vmbus_channel_open_channel *openmsg;
970
	unsigned long flags;
971

972
	result = (struct vmbus_channel_open_result *)hdr;
973

974 975 976
	/*
	 * Find the open msg, copy the result and signal/unblock the wait event
	 */
977
	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
978

979 980
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {
981
		requestheader =
982
			(struct vmbus_channel_message_header *)msginfo->msg;
983

984
		if (requestheader->msgtype == CHANNELMSG_OPENCHANNEL) {
985
			openmsg =
986 987 988 989
			(struct vmbus_channel_open_channel *)msginfo->msg;
			if (openmsg->child_relid == result->child_relid &&
			    openmsg->openid == result->openid) {
				memcpy(&msginfo->response.open_result,
990
				       result,
991 992 993
				       sizeof(
					struct vmbus_channel_open_result));
				complete(&msginfo->waitevent);
994 995 996 997
				break;
			}
		}
	}
998
	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
999 1000
}

1001
/*
1002
 * vmbus_ongpadl_created - GPADL created handler.
1003 1004 1005 1006 1007
 *
 * This is invoked when we received a response to our gpadl create request.
 * Find the matching request, copy the response and signal the requesting
 * thread.
 */
1008
static void vmbus_ongpadl_created(struct vmbus_channel_message_header *hdr)
1009
{
1010 1011 1012 1013
	struct vmbus_channel_gpadl_created *gpadlcreated;
	struct vmbus_channel_msginfo *msginfo;
	struct vmbus_channel_message_header *requestheader;
	struct vmbus_channel_gpadl_header *gpadlheader;
1014
	unsigned long flags;
1015

1016
	gpadlcreated = (struct vmbus_channel_gpadl_created *)hdr;
1017

1018 1019 1020 1021
	/*
	 * Find the establish msg, copy the result and signal/unblock the wait
	 * event
	 */
1022
	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
1023

1024 1025
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {
1026
		requestheader =
1027
			(struct vmbus_channel_message_header *)msginfo->msg;
1028

1029
		if (requestheader->msgtype == CHANNELMSG_GPADL_HEADER) {
1030 1031 1032
			gpadlheader =
			(struct vmbus_channel_gpadl_header *)requestheader;

1033 1034 1035 1036
			if ((gpadlcreated->child_relid ==
			     gpadlheader->child_relid) &&
			    (gpadlcreated->gpadl == gpadlheader->gpadl)) {
				memcpy(&msginfo->response.gpadl_created,
1037
				       gpadlcreated,
1038 1039 1040
				       sizeof(
					struct vmbus_channel_gpadl_created));
				complete(&msginfo->waitevent);
1041 1042 1043 1044
				break;
			}
		}
	}
1045
	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
1046 1047
}

1048
/*
1049
 * vmbus_ongpadl_torndown - GPADL torndown handler.
1050 1051 1052 1053 1054
 *
 * This is invoked when we received a response to our gpadl teardown request.
 * Find the matching request, copy the response and signal the requesting
 * thread.
 */
1055
static void vmbus_ongpadl_torndown(
1056
			struct vmbus_channel_message_header *hdr)
1057
{
1058 1059 1060 1061
	struct vmbus_channel_gpadl_torndown *gpadl_torndown;
	struct vmbus_channel_msginfo *msginfo;
	struct vmbus_channel_message_header *requestheader;
	struct vmbus_channel_gpadl_teardown *gpadl_teardown;
1062
	unsigned long flags;
1063

1064
	gpadl_torndown = (struct vmbus_channel_gpadl_torndown *)hdr;
1065 1066 1067 1068

	/*
	 * Find the open msg, copy the result and signal/unblock the wait event
	 */
1069
	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
1070

1071 1072
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {
1073
		requestheader =
1074
			(struct vmbus_channel_message_header *)msginfo->msg;
1075

1076
		if (requestheader->msgtype == CHANNELMSG_GPADL_TEARDOWN) {
1077 1078
			gpadl_teardown =
			(struct vmbus_channel_gpadl_teardown *)requestheader;
1079

1080 1081
			if (gpadl_torndown->gpadl == gpadl_teardown->gpadl) {
				memcpy(&msginfo->response.gpadl_torndown,
1082
				       gpadl_torndown,
1083 1084 1085
				       sizeof(
					struct vmbus_channel_gpadl_torndown));
				complete(&msginfo->waitevent);
1086 1087 1088 1089
				break;
			}
		}
	}
1090
	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
1091 1092
}

1093
/*
1094
 * vmbus_onversion_response - Version response handler
1095 1096 1097 1098 1099
 *
 * This is invoked when we received a response to our initiate contact request.
 * Find the matching request, copy the response and signal the requesting
 * thread.
 */
1100
static void vmbus_onversion_response(
1101
		struct vmbus_channel_message_header *hdr)
1102
{
1103 1104 1105
	struct vmbus_channel_msginfo *msginfo;
	struct vmbus_channel_message_header *requestheader;
	struct vmbus_channel_version_response *version_response;
1106
	unsigned long flags;
1107

1108
	version_response = (struct vmbus_channel_version_response *)hdr;
1109
	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
1110

1111 1112
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {
1113
		requestheader =
1114
			(struct vmbus_channel_message_header *)msginfo->msg;
1115

1116 1117 1118
		if (requestheader->msgtype ==
		    CHANNELMSG_INITIATE_CONTACT) {
			memcpy(&msginfo->response.version_response,
1119
			      version_response,
1120
			      sizeof(struct vmbus_channel_version_response));
1121
			complete(&msginfo->waitevent);
1122 1123
		}
	}
1124
	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags);
1125 1126
}

1127
/* Channel message dispatch table */
1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151
const struct vmbus_channel_message_table_entry
channel_message_table[CHANNELMSG_COUNT] = {
	{ CHANNELMSG_INVALID,			0, NULL },
	{ CHANNELMSG_OFFERCHANNEL,		0, vmbus_onoffer },
	{ CHANNELMSG_RESCIND_CHANNELOFFER,	0, vmbus_onoffer_rescind },
	{ CHANNELMSG_REQUESTOFFERS,		0, NULL },
	{ CHANNELMSG_ALLOFFERS_DELIVERED,	1, vmbus_onoffers_delivered },
	{ CHANNELMSG_OPENCHANNEL,		0, NULL },
	{ CHANNELMSG_OPENCHANNEL_RESULT,	1, vmbus_onopen_result },
	{ CHANNELMSG_CLOSECHANNEL,		0, NULL },
	{ CHANNELMSG_GPADL_HEADER,		0, NULL },
	{ CHANNELMSG_GPADL_BODY,		0, NULL },
	{ CHANNELMSG_GPADL_CREATED,		1, vmbus_ongpadl_created },
	{ CHANNELMSG_GPADL_TEARDOWN,		0, NULL },
	{ CHANNELMSG_GPADL_TORNDOWN,		1, vmbus_ongpadl_torndown },
	{ CHANNELMSG_RELID_RELEASED,		0, NULL },
	{ CHANNELMSG_INITIATE_CONTACT,		0, NULL },
	{ CHANNELMSG_VERSION_RESPONSE,		1, vmbus_onversion_response },
	{ CHANNELMSG_UNLOAD,			0, NULL },
	{ CHANNELMSG_UNLOAD_RESPONSE,		1, vmbus_unload_response },
	{ CHANNELMSG_18,			0, NULL },
	{ CHANNELMSG_19,			0, NULL },
	{ CHANNELMSG_20,			0, NULL },
	{ CHANNELMSG_TL_CONNECT_REQUEST,	0, NULL },
1152 1153
};

1154
/*
1155
 * vmbus_onmessage - Handler for channel protocol messages.
1156 1157 1158
 *
 * This is invoked in the vmbus worker thread context.
 */
1159
void vmbus_onmessage(void *context)
1160
{
1161
	struct hv_message *msg = context;
1162
	struct vmbus_channel_message_header *hdr;
1163 1164
	int size;

1165 1166
	hdr = (struct vmbus_channel_message_header *)msg->u.payload;
	size = msg->header.payload_size;
1167

1168
	if (hdr->msgtype >= CHANNELMSG_COUNT) {
1169
		pr_err("Received invalid channel message type %d size %d\n",
1170
			   hdr->msgtype, size);
1171
		print_hex_dump_bytes("", DUMP_PREFIX_NONE,
1172
				     (unsigned char *)msg->u.payload, size);
1173 1174 1175
		return;
	}

1176 1177
	if (channel_message_table[hdr->msgtype].message_handler)
		channel_message_table[hdr->msgtype].message_handler(hdr);
1178
	else
1179
		pr_err("Unhandled channel message type %d\n", hdr->msgtype);
1180 1181
}

1182
/*
1183
 * vmbus_request_offers - Send a request to get all our pending offers.
1184
 */
1185
int vmbus_request_offers(void)
1186
{
1187
	struct vmbus_channel_message_header *msg;
1188
	struct vmbus_channel_msginfo *msginfo;
1189
	int ret;
1190

1191
	msginfo = kmalloc(sizeof(*msginfo) +
1192 1193
			  sizeof(struct vmbus_channel_message_header),
			  GFP_KERNEL);
1194
	if (!msginfo)
1195
		return -ENOMEM;
1196

1197
	msg = (struct vmbus_channel_message_header *)msginfo->msg;
1198

1199
	msg->msgtype = CHANNELMSG_REQUESTOFFERS;
1200 1201


1202 1203
	ret = vmbus_post_msg(msg, sizeof(struct vmbus_channel_message_header),
			     true);
1204
	if (ret != 0) {
1205
		pr_err("Unable to request offers - %d\n", ret);
1206

1207 1208
		goto cleanup;
	}
1209

1210
cleanup:
1211
	kfree(msginfo);
1212 1213 1214 1215

	return ret;
}

1216 1217
/*
 * Retrieve the (sub) channel on which to send an outgoing request.
1218 1219
 * When a primary channel has multiple sub-channels, we try to
 * distribute the load equally amongst all available channels.
1220 1221 1222 1223
 */
struct vmbus_channel *vmbus_get_outgoing_channel(struct vmbus_channel *primary)
{
	struct list_head *cur, *tmp;
1224
	int cur_cpu;
1225 1226
	struct vmbus_channel *cur_channel;
	struct vmbus_channel *outgoing_channel = primary;
1227 1228
	int next_channel;
	int i = 1;
1229 1230 1231 1232

	if (list_empty(&primary->sc_list))
		return outgoing_channel;

1233 1234 1235 1236 1237 1238 1239
	next_channel = primary->next_oc++;

	if (next_channel > (primary->num_sc)) {
		primary->next_oc = 0;
		return outgoing_channel;
	}

V
Vitaly Kuznetsov 已提交
1240
	cur_cpu = hv_cpu_number_to_vp_number(smp_processor_id());
1241 1242 1243 1244 1245 1246 1247 1248
	list_for_each_safe(cur, tmp, &primary->sc_list) {
		cur_channel = list_entry(cur, struct vmbus_channel, sc_list);
		if (cur_channel->state != CHANNEL_OPENED_STATE)
			continue;

		if (cur_channel->target_vp == cur_cpu)
			return cur_channel;

1249 1250
		if (i == next_channel)
			return cur_channel;
1251

1252
		i++;
1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298
	}

	return outgoing_channel;
}
EXPORT_SYMBOL_GPL(vmbus_get_outgoing_channel);

static void invoke_sc_cb(struct vmbus_channel *primary_channel)
{
	struct list_head *cur, *tmp;
	struct vmbus_channel *cur_channel;

	if (primary_channel->sc_creation_callback == NULL)
		return;

	list_for_each_safe(cur, tmp, &primary_channel->sc_list) {
		cur_channel = list_entry(cur, struct vmbus_channel, sc_list);

		primary_channel->sc_creation_callback(cur_channel);
	}
}

void vmbus_set_sc_create_callback(struct vmbus_channel *primary_channel,
				void (*sc_cr_cb)(struct vmbus_channel *new_sc))
{
	primary_channel->sc_creation_callback = sc_cr_cb;
}
EXPORT_SYMBOL_GPL(vmbus_set_sc_create_callback);

bool vmbus_are_subchannels_present(struct vmbus_channel *primary)
{
	bool ret;

	ret = !list_empty(&primary->sc_list);

	if (ret) {
		/*
		 * Invoke the callback on sub-channel creation.
		 * This will present a uniform interface to the
		 * clients.
		 */
		invoke_sc_cb(primary);
	}

	return ret;
}
EXPORT_SYMBOL_GPL(vmbus_are_subchannels_present);
1299 1300 1301 1302 1303 1304 1305

void vmbus_set_chn_rescind_callback(struct vmbus_channel *channel,
		void (*chn_rescind_cb)(struct vmbus_channel *))
{
	channel->chn_rescind_callback = chn_rescind_cb;
}
EXPORT_SYMBOL_GPL(vmbus_set_chn_rescind_callback);