channel_mgmt.c 33.1 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
}

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

940 941 942 943
	/* We always get a rescind msg when a connection is closed. */
	while (!READ_ONCE(channel->probe_done) || !READ_ONCE(channel->rescind))
		msleep(1);

944
	vmbus_device_unregister(channel->device_obj);
945
}
946 947
EXPORT_SYMBOL_GPL(vmbus_hvsock_device_unregister);

948

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

960
/*
961
 * vmbus_onopen_result - Open result handler.
962 963 964 965 966
 *
 * 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.
 */
967
static void vmbus_onopen_result(struct vmbus_channel_message_header *hdr)
968
{
969
	struct vmbus_channel_open_result *result;
970 971 972
	struct vmbus_channel_msginfo *msginfo;
	struct vmbus_channel_message_header *requestheader;
	struct vmbus_channel_open_channel *openmsg;
973
	unsigned long flags;
974

975
	result = (struct vmbus_channel_open_result *)hdr;
976

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

982 983
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {
984
		requestheader =
985
			(struct vmbus_channel_message_header *)msginfo->msg;
986

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

1004
/*
1005
 * vmbus_ongpadl_created - GPADL created handler.
1006 1007 1008 1009 1010
 *
 * 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.
 */
1011
static void vmbus_ongpadl_created(struct vmbus_channel_message_header *hdr)
1012
{
1013 1014 1015 1016
	struct vmbus_channel_gpadl_created *gpadlcreated;
	struct vmbus_channel_msginfo *msginfo;
	struct vmbus_channel_message_header *requestheader;
	struct vmbus_channel_gpadl_header *gpadlheader;
1017
	unsigned long flags;
1018

1019
	gpadlcreated = (struct vmbus_channel_gpadl_created *)hdr;
1020

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

1027 1028
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {
1029
		requestheader =
1030
			(struct vmbus_channel_message_header *)msginfo->msg;
1031

1032
		if (requestheader->msgtype == CHANNELMSG_GPADL_HEADER) {
1033 1034 1035
			gpadlheader =
			(struct vmbus_channel_gpadl_header *)requestheader;

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

1051
/*
1052
 * vmbus_ongpadl_torndown - GPADL torndown handler.
1053 1054 1055 1056 1057
 *
 * 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.
 */
1058
static void vmbus_ongpadl_torndown(
1059
			struct vmbus_channel_message_header *hdr)
1060
{
1061 1062 1063 1064
	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;
1065
	unsigned long flags;
1066

1067
	gpadl_torndown = (struct vmbus_channel_gpadl_torndown *)hdr;
1068 1069 1070 1071

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

1074 1075
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {
1076
		requestheader =
1077
			(struct vmbus_channel_message_header *)msginfo->msg;
1078

1079
		if (requestheader->msgtype == CHANNELMSG_GPADL_TEARDOWN) {
1080 1081
			gpadl_teardown =
			(struct vmbus_channel_gpadl_teardown *)requestheader;
1082

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

1096
/*
1097
 * vmbus_onversion_response - Version response handler
1098 1099 1100 1101 1102
 *
 * 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.
 */
1103
static void vmbus_onversion_response(
1104
		struct vmbus_channel_message_header *hdr)
1105
{
1106 1107 1108
	struct vmbus_channel_msginfo *msginfo;
	struct vmbus_channel_message_header *requestheader;
	struct vmbus_channel_version_response *version_response;
1109
	unsigned long flags;
1110

1111
	version_response = (struct vmbus_channel_version_response *)hdr;
1112
	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags);
1113

1114 1115
	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list,
				msglistentry) {
1116
		requestheader =
1117
			(struct vmbus_channel_message_header *)msginfo->msg;
1118

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

1130
/* Channel message dispatch table */
1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154
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 },
1155 1156
};

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

1168 1169
	hdr = (struct vmbus_channel_message_header *)msg->u.payload;
	size = msg->header.payload_size;
1170

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

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

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

1194
	msginfo = kmalloc(sizeof(*msginfo) +
1195 1196
			  sizeof(struct vmbus_channel_message_header),
			  GFP_KERNEL);
1197
	if (!msginfo)
1198
		return -ENOMEM;
1199

1200
	msg = (struct vmbus_channel_message_header *)msginfo->msg;
1201

1202
	msg->msgtype = CHANNELMSG_REQUESTOFFERS;
1203 1204


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

1210 1211
		goto cleanup;
	}
1212

1213
cleanup:
1214
	kfree(msginfo);
1215 1216 1217 1218

	return ret;
}

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

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

1236 1237 1238 1239 1240 1241 1242
	next_channel = primary->next_oc++;

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

V
Vitaly Kuznetsov 已提交
1243
	cur_cpu = hv_cpu_number_to_vp_number(smp_processor_id());
1244 1245 1246 1247 1248 1249 1250 1251
	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;

1252 1253
		if (i == next_channel)
			return cur_channel;
1254

1255
		i++;
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 1299 1300 1301
	}

	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);
1302 1303 1304 1305 1306 1307 1308

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);