| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 1 | /* | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 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> | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 20 |  */ | 
| Hank Janssen | 0a46618 | 2011-03-29 13:58:47 -0700 | [diff] [blame] | 21 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | 
 | 22 |  | 
| Greg Kroah-Hartman | a0086dc | 2009-08-17 17:22:08 -0700 | [diff] [blame] | 23 | #include <linux/kernel.h> | 
| K. Y. Srinivasan | 0c3b7b2 | 2011-02-11 09:59:43 -0800 | [diff] [blame] | 24 | #include <linux/sched.h> | 
 | 25 | #include <linux/wait.h> | 
| Greg Kroah-Hartman | a0086dc | 2009-08-17 17:22:08 -0700 | [diff] [blame] | 26 | #include <linux/mm.h> | 
| Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 27 | #include <linux/slab.h> | 
| Bill Pemberton | 53af545 | 2009-09-11 21:46:44 -0400 | [diff] [blame] | 28 | #include <linux/list.h> | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 29 | #include <linux/module.h> | 
| Haiyang Zhang | 8b5d6d3 | 2010-05-28 23:22:44 +0000 | [diff] [blame] | 30 | #include <linux/completion.h> | 
| Greg Kroah-Hartman | 46a9719 | 2011-10-04 12:29:52 -0700 | [diff] [blame] | 31 | #include <linux/hyperv.h> | 
| K. Y. Srinivasan | 3f335ea | 2011-05-12 19:34:15 -0700 | [diff] [blame] | 32 |  | 
| K. Y. Srinivasan | 0f2a661 | 2011-05-12 19:34:28 -0700 | [diff] [blame] | 33 | #include "hyperv_vmbus.h" | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 34 |  | 
| Greg Kroah-Hartman | 1d7e907 | 2009-08-28 16:26:11 -0700 | [diff] [blame] | 35 | struct vmbus_channel_message_table_entry { | 
| K. Y. Srinivasan | cf9dcba | 2011-05-10 07:55:37 -0700 | [diff] [blame] | 36 | 	enum vmbus_channel_message_type message_type; | 
| K. Y. Srinivasan | fa90f1d | 2011-05-10 07:55:36 -0700 | [diff] [blame] | 37 | 	void (*message_handler)(struct vmbus_channel_message_header *msg); | 
| Greg Kroah-Hartman | 1d7e907 | 2009-08-28 16:26:11 -0700 | [diff] [blame] | 38 | }; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 39 |  | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 40 |  | 
 | 41 | /** | 
| Greg Kroah-Hartman | da0e963 | 2011-10-11 08:42:28 -0600 | [diff] [blame] | 42 |  * vmbus_prep_negotiate_resp() - Create default response for Hyper-V Negotiate message | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 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. | 
| K. Y. Srinivasan | c836d0a | 2012-05-12 13:44:58 -0700 | [diff] [blame] | 49 |  * Set up and fill in default negotiate response message. | 
 | 50 |  * | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 51 |  * The fw_version specifies the  framework version that | 
 | 52 |  * we can support and srv_version specifies the service | 
 | 53 |  * version we can support. | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 54 |  * | 
 | 55 |  * Mainly used by Hyper-V drivers. | 
 | 56 |  */ | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 57 | bool vmbus_prep_negotiate_resp(struct icmsg_hdr *icmsghdrp, | 
| K. Y. Srinivasan | c836d0a | 2012-05-12 13:44:58 -0700 | [diff] [blame] | 58 | 				struct icmsg_negotiate *negop, u8 *buf, | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 59 | 				int fw_version, int srv_version) | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 60 | { | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 61 | 	int icframe_major, icframe_minor; | 
 | 62 | 	int icmsg_major, icmsg_minor; | 
 | 63 | 	int fw_major, fw_minor; | 
 | 64 | 	int srv_major, srv_minor; | 
| K. Y. Srinivasan | c836d0a | 2012-05-12 13:44:58 -0700 | [diff] [blame] | 65 | 	int i; | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 66 | 	bool found_match = false; | 
| K. Y. Srinivasan | c836d0a | 2012-05-12 13:44:58 -0700 | [diff] [blame] | 67 |  | 
| K. Y. Srinivasan | a360530 | 2012-05-12 13:44:57 -0700 | [diff] [blame] | 68 | 	icmsghdrp->icmsgsize = 0x10; | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 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); | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 74 |  | 
| K. Y. Srinivasan | a360530 | 2012-05-12 13:44:57 -0700 | [diff] [blame] | 75 | 	negop = (struct icmsg_negotiate *)&buf[ | 
 | 76 | 		sizeof(struct vmbuspipe_hdr) + | 
 | 77 | 		sizeof(struct icmsg_hdr)]; | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 78 |  | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 79 | 	icframe_major = negop->icframe_vercnt; | 
 | 80 | 	icframe_minor = 0; | 
 | 81 |  | 
 | 82 | 	icmsg_major = negop->icmsg_vercnt; | 
 | 83 | 	icmsg_minor = 0; | 
| K. Y. Srinivasan | c836d0a | 2012-05-12 13:44:58 -0700 | [diff] [blame] | 84 |  | 
 | 85 | 	/* | 
 | 86 | 	 * Select the framework version number we will | 
 | 87 | 	 * support. | 
 | 88 | 	 */ | 
 | 89 |  | 
 | 90 | 	for (i = 0; i < negop->icframe_vercnt; i++) { | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 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 | 		} | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 97 | 	} | 
| K. Y. Srinivasan | a360530 | 2012-05-12 13:44:57 -0700 | [diff] [blame] | 98 |  | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 99 | 	if (!found_match) | 
 | 100 | 		goto fw_error; | 
 | 101 |  | 
 | 102 | 	found_match = false; | 
 | 103 |  | 
| K. Y. Srinivasan | c836d0a | 2012-05-12 13:44:58 -0700 | [diff] [blame] | 104 | 	for (i = negop->icframe_vercnt; | 
 | 105 | 		 (i < negop->icframe_vercnt + negop->icmsg_vercnt); i++) { | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 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 | 		} | 
| K. Y. Srinivasan | c836d0a | 2012-05-12 13:44:58 -0700 | [diff] [blame] | 112 | 	} | 
 | 113 |  | 
 | 114 | 	/* | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 115 | 	 * Respond with the framework and service | 
| K. Y. Srinivasan | c836d0a | 2012-05-12 13:44:58 -0700 | [diff] [blame] | 116 | 	 * version numbers we can support. | 
 | 117 | 	 */ | 
| K. Y. Srinivasan | 6741335 | 2013-07-02 10:31:30 -0700 | [diff] [blame] | 118 |  | 
 | 119 | fw_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; | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 133 | } | 
| K. Y. Srinivasan | a360530 | 2012-05-12 13:44:57 -0700 | [diff] [blame] | 134 |  | 
| Greg Kroah-Hartman | da0e963 | 2011-10-11 08:42:28 -0600 | [diff] [blame] | 135 | EXPORT_SYMBOL_GPL(vmbus_prep_negotiate_resp); | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 136 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 137 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 138 |  * alloc_channel - Allocate and initialize a vmbus channel object | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 139 |  */ | 
| Greg Kroah-Hartman | 50fe56d | 2010-10-20 15:51:57 -0700 | [diff] [blame] | 140 | static struct vmbus_channel *alloc_channel(void) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 141 | { | 
| Greg Kroah-Hartman | aded716 | 2009-08-18 15:21:19 -0700 | [diff] [blame] | 142 | 	struct vmbus_channel *channel; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 143 |  | 
| Greg Kroah-Hartman | aded716 | 2009-08-18 15:21:19 -0700 | [diff] [blame] | 144 | 	channel = kzalloc(sizeof(*channel), GFP_ATOMIC); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 145 | 	if (!channel) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 146 | 		return NULL; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 147 |  | 
| Greg Kroah-Hartman | 54411c4 | 2009-07-15 14:48:32 -0700 | [diff] [blame] | 148 | 	spin_lock_init(&channel->inbound_lock); | 
| K. Y. Srinivasan | e68d297 | 2013-05-23 12:02:32 -0700 | [diff] [blame] | 149 | 	spin_lock_init(&channel->sc_lock); | 
 | 150 |  | 
 | 151 | 	INIT_LIST_HEAD(&channel->sc_list); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 152 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 153 | 	channel->controlwq = create_workqueue("hv_vmbus_ctl"); | 
 | 154 | 	if (!channel->controlwq) { | 
| Greg Kroah-Hartman | 8c69f52 | 2009-07-15 12:48:29 -0700 | [diff] [blame] | 155 | 		kfree(channel); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 156 | 		return NULL; | 
 | 157 | 	} | 
 | 158 |  | 
 | 159 | 	return channel; | 
 | 160 | } | 
 | 161 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 162 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 163 |  * release_hannel - Release the vmbus channel object itself | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 164 |  */ | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 165 | static void release_channel(struct work_struct *work) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 166 | { | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 167 | 	struct vmbus_channel *channel = container_of(work, | 
 | 168 | 						     struct vmbus_channel, | 
 | 169 | 						     work); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 170 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 171 | 	destroy_workqueue(channel->controlwq); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 172 |  | 
| Greg Kroah-Hartman | 8c69f52 | 2009-07-15 12:48:29 -0700 | [diff] [blame] | 173 | 	kfree(channel); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 174 | } | 
 | 175 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 176 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 177 |  * free_channel - Release the resources used by the vmbus channel object | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 178 |  */ | 
| Greg Kroah-Hartman | 9f3e28e | 2011-10-11 09:40:01 -0600 | [diff] [blame] | 179 | static void free_channel(struct vmbus_channel *channel) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 180 | { | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 181 |  | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 182 | 	/* | 
 | 183 | 	 * We have to release the channel's workqueue/thread in the vmbus's | 
 | 184 | 	 * workqueue/thread context | 
 | 185 | 	 * ie we can't destroy ourselves. | 
 | 186 | 	 */ | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 187 | 	INIT_WORK(&channel->work, release_channel); | 
| Haiyang Zhang | da9fcb7 | 2011-01-26 12:12:14 -0800 | [diff] [blame] | 188 | 	queue_work(vmbus_connection.work_queue, &channel->work); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 189 | } | 
 | 190 |  | 
| Haiyang Zhang | 8b5d6d3 | 2010-05-28 23:22:44 +0000 | [diff] [blame] | 191 |  | 
| Haiyang Zhang | 8b5d6d3 | 2010-05-28 23:22:44 +0000 | [diff] [blame] | 192 |  | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 193 | /* | 
 | 194 |  * vmbus_process_rescind_offer - | 
 | 195 |  * Rescind the offer by initiating a device removal | 
 | 196 |  */ | 
 | 197 | static void vmbus_process_rescind_offer(struct work_struct *work) | 
 | 198 | { | 
 | 199 | 	struct vmbus_channel *channel = container_of(work, | 
 | 200 | 						     struct vmbus_channel, | 
 | 201 | 						     work); | 
| K. Y. Srinivasan | c870597 | 2013-03-15 12:25:44 -0700 | [diff] [blame] | 202 | 	unsigned long flags; | 
| K. Y. Srinivasan | e68d297 | 2013-05-23 12:02:32 -0700 | [diff] [blame] | 203 | 	struct vmbus_channel *primary_channel; | 
| K. Y. Srinivasan | c870597 | 2013-03-15 12:25:44 -0700 | [diff] [blame] | 204 | 	struct vmbus_channel_relid_released msg; | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 205 |  | 
| K. Y. Srinivasan | 696453b | 2011-09-08 07:24:14 -0700 | [diff] [blame] | 206 | 	vmbus_device_unregister(channel->device_obj); | 
| K. Y. Srinivasan | c870597 | 2013-03-15 12:25:44 -0700 | [diff] [blame] | 207 | 	memset(&msg, 0, sizeof(struct vmbus_channel_relid_released)); | 
 | 208 | 	msg.child_relid = channel->offermsg.child_relid; | 
 | 209 | 	msg.header.msgtype = CHANNELMSG_RELID_RELEASED; | 
 | 210 | 	vmbus_post_msg(&msg, sizeof(struct vmbus_channel_relid_released)); | 
 | 211 |  | 
| K. Y. Srinivasan | e68d297 | 2013-05-23 12:02:32 -0700 | [diff] [blame] | 212 | 	if (channel->primary_channel == NULL) { | 
 | 213 | 		spin_lock_irqsave(&vmbus_connection.channel_lock, flags); | 
 | 214 | 		list_del(&channel->listentry); | 
 | 215 | 		spin_unlock_irqrestore(&vmbus_connection.channel_lock, flags); | 
 | 216 | 	} else { | 
 | 217 | 		primary_channel = channel->primary_channel; | 
 | 218 | 		spin_lock_irqsave(&primary_channel->sc_lock, flags); | 
 | 219 | 		list_del(&channel->listentry); | 
 | 220 | 		spin_unlock_irqrestore(&primary_channel->sc_lock, flags); | 
 | 221 | 	} | 
| K. Y. Srinivasan | c870597 | 2013-03-15 12:25:44 -0700 | [diff] [blame] | 222 | 	free_channel(channel); | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 223 | } | 
| Haiyang Zhang | 8b5d6d3 | 2010-05-28 23:22:44 +0000 | [diff] [blame] | 224 |  | 
| K. Y. Srinivasan | 93e5bd0 | 2011-12-12 09:29:17 -0800 | [diff] [blame] | 225 | void vmbus_free_channels(void) | 
 | 226 | { | 
 | 227 | 	struct vmbus_channel *channel; | 
 | 228 |  | 
 | 229 | 	list_for_each_entry(channel, &vmbus_connection.chn_list, listentry) { | 
 | 230 | 		vmbus_device_unregister(channel->device_obj); | 
 | 231 | 		kfree(channel->device_obj); | 
 | 232 | 		free_channel(channel); | 
 | 233 | 	} | 
 | 234 | } | 
 | 235 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 236 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 237 |  * vmbus_process_offer - Process the offer by creating a channel/device | 
| Hank Janssen | c88c4e4 | 2010-05-04 15:55:05 -0700 | [diff] [blame] | 238 |  * associated with this offer | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 239 |  */ | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 240 | static void vmbus_process_offer(struct work_struct *work) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 241 | { | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 242 | 	struct vmbus_channel *newchannel = container_of(work, | 
 | 243 | 							struct vmbus_channel, | 
 | 244 | 							work); | 
| Greg Kroah-Hartman | aded716 | 2009-08-18 15:21:19 -0700 | [diff] [blame] | 245 | 	struct vmbus_channel *channel; | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 246 | 	bool fnew = true; | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 247 | 	int ret; | 
| Greg Kroah-Hartman | 0f5e44c | 2009-07-15 14:57:16 -0700 | [diff] [blame] | 248 | 	unsigned long flags; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 249 |  | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 250 | 	/* The next possible work is rescind handling */ | 
 | 251 | 	INIT_WORK(&newchannel->work, vmbus_process_rescind_offer); | 
 | 252 |  | 
| Bill Pemberton | 454f18a | 2009-07-27 16:47:24 -0400 | [diff] [blame] | 253 | 	/* Make sure this is a new offer */ | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 254 | 	spin_lock_irqsave(&vmbus_connection.channel_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 255 |  | 
| Haiyang Zhang | da9fcb7 | 2011-01-26 12:12:14 -0800 | [diff] [blame] | 256 | 	list_for_each_entry(channel, &vmbus_connection.chn_list, listentry) { | 
| K. Y. Srinivasan | 358d2ee | 2011-08-25 09:48:28 -0700 | [diff] [blame] | 257 | 		if (!uuid_le_cmp(channel->offermsg.offer.if_type, | 
 | 258 | 			newchannel->offermsg.offer.if_type) && | 
 | 259 | 			!uuid_le_cmp(channel->offermsg.offer.if_instance, | 
 | 260 | 				newchannel->offermsg.offer.if_instance)) { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 261 | 			fnew = false; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 262 | 			break; | 
 | 263 | 		} | 
 | 264 | 	} | 
 | 265 |  | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 266 | 	if (fnew) | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 267 | 		list_add_tail(&newchannel->listentry, | 
| Haiyang Zhang | da9fcb7 | 2011-01-26 12:12:14 -0800 | [diff] [blame] | 268 | 			      &vmbus_connection.chn_list); | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 269 |  | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 270 | 	spin_unlock_irqrestore(&vmbus_connection.channel_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 271 |  | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 272 | 	if (!fnew) { | 
| K. Y. Srinivasan | e68d297 | 2013-05-23 12:02:32 -0700 | [diff] [blame] | 273 | 		/* | 
 | 274 | 		 * Check to see if this is a sub-channel. | 
 | 275 | 		 */ | 
 | 276 | 		if (newchannel->offermsg.offer.sub_channel_index != 0) { | 
 | 277 | 			/* | 
 | 278 | 			 * Process the sub-channel. | 
 | 279 | 			 */ | 
 | 280 | 			newchannel->primary_channel = channel; | 
 | 281 | 			spin_lock_irqsave(&channel->sc_lock, flags); | 
 | 282 | 			list_add_tail(&newchannel->sc_list, &channel->sc_list); | 
 | 283 | 			spin_unlock_irqrestore(&channel->sc_lock, flags); | 
 | 284 | 			newchannel->state = CHANNEL_OPEN_STATE; | 
 | 285 | 			if (channel->sc_creation_callback != NULL) | 
 | 286 | 				channel->sc_creation_callback(newchannel); | 
 | 287 |  | 
 | 288 | 			return; | 
 | 289 | 		} | 
 | 290 |  | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 291 | 		free_channel(newchannel); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 292 | 		return; | 
 | 293 | 	} | 
 | 294 |  | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 295 | 	/* | 
| K. Y. Srinivasan | 42dceeb | 2013-08-26 14:08:58 -0700 | [diff] [blame] | 296 | 	 * This state is used to indicate a successful open | 
 | 297 | 	 * so that when we do close the channel normally, we | 
 | 298 | 	 * can cleanup properly | 
 | 299 | 	 */ | 
 | 300 | 	newchannel->state = CHANNEL_OPEN_STATE; | 
 | 301 |  | 
 | 302 | 	/* | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 303 | 	 * Start the process of binding this offer to the driver | 
 | 304 | 	 * We need to set the DeviceObject field before calling | 
| Haiyang Zhang | 646f1ea | 2011-01-26 12:12:10 -0800 | [diff] [blame] | 305 | 	 * vmbus_child_dev_add() | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 306 | 	 */ | 
| K. Y. Srinivasan | f2c7301 | 2011-09-08 07:24:12 -0700 | [diff] [blame] | 307 | 	newchannel->device_obj = vmbus_device_create( | 
| Haiyang Zhang | 767dff6 | 2011-01-26 12:12:12 -0800 | [diff] [blame] | 308 | 		&newchannel->offermsg.offer.if_type, | 
 | 309 | 		&newchannel->offermsg.offer.if_instance, | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 310 | 		newchannel); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 311 |  | 
| Bill Pemberton | 454f18a | 2009-07-27 16:47:24 -0400 | [diff] [blame] | 312 | 	/* | 
 | 313 | 	 * Add the new device to the bus. This will kick off device-driver | 
 | 314 | 	 * binding which eventually invokes the device driver's AddDevice() | 
 | 315 | 	 * method. | 
 | 316 | 	 */ | 
| K. Y. Srinivasan | 2279428 | 2011-09-08 07:24:13 -0700 | [diff] [blame] | 317 | 	ret = vmbus_device_register(newchannel->device_obj); | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 318 | 	if (ret != 0) { | 
| Hank Janssen | 0a46618 | 2011-03-29 13:58:47 -0700 | [diff] [blame] | 319 | 		pr_err("unable to add child device object (relid %d)\n", | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 320 | 			   newchannel->offermsg.child_relid); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 321 |  | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 322 | 		spin_lock_irqsave(&vmbus_connection.channel_lock, flags); | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 323 | 		list_del(&newchannel->listentry); | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 324 | 		spin_unlock_irqrestore(&vmbus_connection.channel_lock, flags); | 
| K. Y. Srinivasan | 8b8ee67 | 2011-12-12 09:29:16 -0800 | [diff] [blame] | 325 | 		kfree(newchannel->device_obj); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 326 |  | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 327 | 		free_channel(newchannel); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 328 | 	} | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 329 | } | 
 | 330 |  | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 331 | enum { | 
 | 332 | 	IDE = 0, | 
 | 333 | 	SCSI, | 
 | 334 | 	NIC, | 
 | 335 | 	MAX_PERF_CHN, | 
 | 336 | }; | 
 | 337 |  | 
 | 338 | /* | 
| K. Y. Srinivasan | 7fb9656 | 2013-01-23 17:42:40 -0800 | [diff] [blame] | 339 |  * This is an array of device_ids (device types) that are performance critical. | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 340 |  * We attempt to distribute the interrupt load for these devices across | 
 | 341 |  * all available CPUs. | 
 | 342 |  */ | 
| K. Y. Srinivasan | 7fb9656 | 2013-01-23 17:42:40 -0800 | [diff] [blame] | 343 | static const struct hv_vmbus_device_id hp_devs[] = { | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 344 | 	/* IDE */ | 
| K. Y. Srinivasan | 7fb9656 | 2013-01-23 17:42:40 -0800 | [diff] [blame] | 345 | 	{ HV_IDE_GUID, }, | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 346 | 	/* Storage - SCSI */ | 
| K. Y. Srinivasan | 7fb9656 | 2013-01-23 17:42:40 -0800 | [diff] [blame] | 347 | 	{ HV_SCSI_GUID, }, | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 348 | 	/* Network */ | 
| K. Y. Srinivasan | 7fb9656 | 2013-01-23 17:42:40 -0800 | [diff] [blame] | 349 | 	{ HV_NIC_GUID, }, | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 350 | }; | 
 | 351 |  | 
 | 352 |  | 
 | 353 | /* | 
 | 354 |  * We use this state to statically distribute the channel interrupt load. | 
 | 355 |  */ | 
 | 356 | static u32  next_vp; | 
 | 357 |  | 
 | 358 | /* | 
 | 359 |  * Starting with Win8, we can statically distribute the incoming | 
 | 360 |  * channel interrupt load by binding a channel to VCPU. We | 
 | 361 |  * implement here a simple round robin scheme for distributing | 
 | 362 |  * the interrupt load. | 
 | 363 |  * We will bind channels that are not performance critical to cpu 0 and | 
 | 364 |  * performance critical channels (IDE, SCSI and Network) will be uniformly | 
 | 365 |  * distributed across all available CPUs. | 
 | 366 |  */ | 
 | 367 | static u32 get_vp_index(uuid_le *type_guid) | 
 | 368 | { | 
 | 369 | 	u32 cur_cpu; | 
 | 370 | 	int i; | 
 | 371 | 	bool perf_chn = false; | 
 | 372 | 	u32 max_cpus = num_online_cpus(); | 
 | 373 |  | 
 | 374 | 	for (i = IDE; i < MAX_PERF_CHN; i++) { | 
| K. Y. Srinivasan | 7fb9656 | 2013-01-23 17:42:40 -0800 | [diff] [blame] | 375 | 		if (!memcmp(type_guid->b, hp_devs[i].guid, | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 376 | 				 sizeof(uuid_le))) { | 
 | 377 | 			perf_chn = true; | 
 | 378 | 			break; | 
 | 379 | 		} | 
 | 380 | 	} | 
 | 381 | 	if ((vmbus_proto_version == VERSION_WS2008) || | 
 | 382 | 	    (vmbus_proto_version == VERSION_WIN7) || (!perf_chn)) { | 
 | 383 | 		/* | 
 | 384 | 		 * Prior to win8, all channel interrupts are | 
 | 385 | 		 * delivered on cpu 0. | 
 | 386 | 		 * Also if the channel is not a performance critical | 
 | 387 | 		 * channel, bind it to cpu 0. | 
 | 388 | 		 */ | 
 | 389 | 		return 0; | 
 | 390 | 	} | 
 | 391 | 	cur_cpu = (++next_vp % max_cpus); | 
| K. Y. Srinivasan | d2242a3 | 2013-05-17 09:30:35 -0700 | [diff] [blame] | 392 | 	return hv_context.vp_index[cur_cpu]; | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 393 | } | 
 | 394 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 395 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 396 |  * vmbus_onoffer - Handler for channel offers from vmbus in parent partition. | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 397 |  * | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 398 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 399 | static void vmbus_onoffer(struct vmbus_channel_message_header *hdr) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 400 | { | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 401 | 	struct vmbus_channel_offer_channel *offer; | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 402 | 	struct vmbus_channel *newchannel; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 403 |  | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 404 | 	offer = (struct vmbus_channel_offer_channel *)hdr; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 405 |  | 
| Bill Pemberton | 454f18a | 2009-07-27 16:47:24 -0400 | [diff] [blame] | 406 | 	/* Allocate the channel object and save this offer. */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 407 | 	newchannel = alloc_channel(); | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 408 | 	if (!newchannel) { | 
| Hank Janssen | 0a46618 | 2011-03-29 13:58:47 -0700 | [diff] [blame] | 409 | 		pr_err("Unable to allocate channel object\n"); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 410 | 		return; | 
 | 411 | 	} | 
 | 412 |  | 
| K. Y. Srinivasan | 132368b | 2012-12-01 06:46:33 -0800 | [diff] [blame] | 413 | 	/* | 
 | 414 | 	 * By default we setup state to enable batched | 
 | 415 | 	 * reading. A specific service can choose to | 
 | 416 | 	 * disable this prior to opening the channel. | 
 | 417 | 	 */ | 
 | 418 | 	newchannel->batched_reading = true; | 
 | 419 |  | 
| K. Y. Srinivasan | b3bf60c | 2012-12-01 06:46:45 -0800 | [diff] [blame] | 420 | 	/* | 
 | 421 | 	 * Setup state for signalling the host. | 
 | 422 | 	 */ | 
 | 423 | 	newchannel->sig_event = (struct hv_input_signal_event *) | 
 | 424 | 				(ALIGN((unsigned long) | 
 | 425 | 				&newchannel->sig_buf, | 
 | 426 | 				HV_HYPERCALL_PARAM_ALIGN)); | 
 | 427 |  | 
 | 428 | 	newchannel->sig_event->connectionid.asu32 = 0; | 
 | 429 | 	newchannel->sig_event->connectionid.u.id = VMBUS_EVENT_CONNECTION_ID; | 
 | 430 | 	newchannel->sig_event->flag_number = 0; | 
 | 431 | 	newchannel->sig_event->rsvdz = 0; | 
 | 432 |  | 
 | 433 | 	if (vmbus_proto_version != VERSION_WS2008) { | 
 | 434 | 		newchannel->is_dedicated_interrupt = | 
 | 435 | 				(offer->is_dedicated_interrupt != 0); | 
 | 436 | 		newchannel->sig_event->connectionid.u.id = | 
 | 437 | 				offer->connection_id; | 
 | 438 | 	} | 
 | 439 |  | 
| K. Y. Srinivasan | a119845 | 2012-12-01 06:46:50 -0800 | [diff] [blame] | 440 | 	newchannel->target_vp = get_vp_index(&offer->offer.if_type); | 
| K. Y. Srinivasan | abbf3b2 | 2012-12-01 06:46:48 -0800 | [diff] [blame] | 441 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 442 | 	memcpy(&newchannel->offermsg, offer, | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 443 | 	       sizeof(struct vmbus_channel_offer_channel)); | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 444 | 	newchannel->monitor_grp = (u8)offer->monitorid / 32; | 
 | 445 | 	newchannel->monitor_bit = (u8)offer->monitorid % 32; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 446 |  | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 447 | 	INIT_WORK(&newchannel->work, vmbus_process_offer); | 
 | 448 | 	queue_work(newchannel->controlwq, &newchannel->work); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 449 | } | 
 | 450 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 451 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 452 |  * vmbus_onoffer_rescind - Rescind offer handler. | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 453 |  * | 
 | 454 |  * We queue a work item to process this offer synchronously | 
 | 455 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 456 | static void vmbus_onoffer_rescind(struct vmbus_channel_message_header *hdr) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 457 | { | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 458 | 	struct vmbus_channel_rescind_offer *rescind; | 
| Greg Kroah-Hartman | aded716 | 2009-08-18 15:21:19 -0700 | [diff] [blame] | 459 | 	struct vmbus_channel *channel; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 460 |  | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 461 | 	rescind = (struct vmbus_channel_rescind_offer *)hdr; | 
| Haiyang Zhang | c697767 | 2011-01-26 12:12:08 -0800 | [diff] [blame] | 462 | 	channel = relid2channel(rescind->child_relid); | 
| Hank Janssen | 98e0870 | 2011-03-29 13:58:44 -0700 | [diff] [blame] | 463 |  | 
 | 464 | 	if (channel == NULL) | 
 | 465 | 		/* Just return here, no channel found */ | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 466 | 		return; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 467 |  | 
| Timo Teräs | 4b2f9ab | 2010-12-15 20:48:09 +0200 | [diff] [blame] | 468 | 	/* work is initialized for vmbus_process_rescind_offer() from | 
 | 469 | 	 * vmbus_process_offer() where the channel got created */ | 
 | 470 | 	queue_work(channel->controlwq, &channel->work); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 471 | } | 
 | 472 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 473 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 474 |  * vmbus_onoffers_delivered - | 
 | 475 |  * This is invoked when all offers have been delivered. | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 476 |  * | 
 | 477 |  * Nothing to do here. | 
 | 478 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 479 | static void vmbus_onoffers_delivered( | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 480 | 			struct vmbus_channel_message_header *hdr) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 481 | { | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 482 | } | 
 | 483 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 484 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 485 |  * vmbus_onopen_result - Open result handler. | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 486 |  * | 
 | 487 |  * This is invoked when we received a response to our channel open request. | 
 | 488 |  * Find the matching request, copy the response and signal the requesting | 
 | 489 |  * thread. | 
 | 490 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 491 | static void vmbus_onopen_result(struct vmbus_channel_message_header *hdr) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 492 | { | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 493 | 	struct vmbus_channel_open_result *result; | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 494 | 	struct vmbus_channel_msginfo *msginfo; | 
 | 495 | 	struct vmbus_channel_message_header *requestheader; | 
 | 496 | 	struct vmbus_channel_open_channel *openmsg; | 
| Greg Kroah-Hartman | dd0813b | 2009-07-15 14:56:45 -0700 | [diff] [blame] | 497 | 	unsigned long flags; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 498 |  | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 499 | 	result = (struct vmbus_channel_open_result *)hdr; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 500 |  | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 501 | 	/* | 
 | 502 | 	 * Find the open msg, copy the result and signal/unblock the wait event | 
 | 503 | 	 */ | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 504 | 	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 505 |  | 
| Hank Janssen | ebb61e5 | 2011-02-18 12:39:57 -0800 | [diff] [blame] | 506 | 	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
 | 507 | 				msglistentry) { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 508 | 		requestheader = | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 509 | 			(struct vmbus_channel_message_header *)msginfo->msg; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 510 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 511 | 		if (requestheader->msgtype == CHANNELMSG_OPENCHANNEL) { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 512 | 			openmsg = | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 513 | 			(struct vmbus_channel_open_channel *)msginfo->msg; | 
 | 514 | 			if (openmsg->child_relid == result->child_relid && | 
 | 515 | 			    openmsg->openid == result->openid) { | 
 | 516 | 				memcpy(&msginfo->response.open_result, | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 517 | 				       result, | 
| K. Y. Srinivasan | 9568a19 | 2011-05-10 07:55:39 -0700 | [diff] [blame] | 518 | 				       sizeof( | 
 | 519 | 					struct vmbus_channel_open_result)); | 
 | 520 | 				complete(&msginfo->waitevent); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 521 | 				break; | 
 | 522 | 			} | 
 | 523 | 		} | 
 | 524 | 	} | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 525 | 	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 526 | } | 
 | 527 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 528 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 529 |  * vmbus_ongpadl_created - GPADL created handler. | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 530 |  * | 
 | 531 |  * This is invoked when we received a response to our gpadl create request. | 
 | 532 |  * Find the matching request, copy the response and signal the requesting | 
 | 533 |  * thread. | 
 | 534 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 535 | static void vmbus_ongpadl_created(struct vmbus_channel_message_header *hdr) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 536 | { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 537 | 	struct vmbus_channel_gpadl_created *gpadlcreated; | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 538 | 	struct vmbus_channel_msginfo *msginfo; | 
 | 539 | 	struct vmbus_channel_message_header *requestheader; | 
 | 540 | 	struct vmbus_channel_gpadl_header *gpadlheader; | 
| Greg Kroah-Hartman | dd0813b | 2009-07-15 14:56:45 -0700 | [diff] [blame] | 541 | 	unsigned long flags; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 542 |  | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 543 | 	gpadlcreated = (struct vmbus_channel_gpadl_created *)hdr; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 544 |  | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 545 | 	/* | 
 | 546 | 	 * Find the establish msg, copy the result and signal/unblock the wait | 
 | 547 | 	 * event | 
 | 548 | 	 */ | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 549 | 	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 550 |  | 
| Hank Janssen | ebb61e5 | 2011-02-18 12:39:57 -0800 | [diff] [blame] | 551 | 	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
 | 552 | 				msglistentry) { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 553 | 		requestheader = | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 554 | 			(struct vmbus_channel_message_header *)msginfo->msg; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 555 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 556 | 		if (requestheader->msgtype == CHANNELMSG_GPADL_HEADER) { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 557 | 			gpadlheader = | 
 | 558 | 			(struct vmbus_channel_gpadl_header *)requestheader; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 559 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 560 | 			if ((gpadlcreated->child_relid == | 
 | 561 | 			     gpadlheader->child_relid) && | 
 | 562 | 			    (gpadlcreated->gpadl == gpadlheader->gpadl)) { | 
 | 563 | 				memcpy(&msginfo->response.gpadl_created, | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 564 | 				       gpadlcreated, | 
| K. Y. Srinivasan | 9568a19 | 2011-05-10 07:55:39 -0700 | [diff] [blame] | 565 | 				       sizeof( | 
 | 566 | 					struct vmbus_channel_gpadl_created)); | 
 | 567 | 				complete(&msginfo->waitevent); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 568 | 				break; | 
 | 569 | 			} | 
 | 570 | 		} | 
 | 571 | 	} | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 572 | 	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 573 | } | 
 | 574 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 575 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 576 |  * vmbus_ongpadl_torndown - GPADL torndown handler. | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 577 |  * | 
 | 578 |  * This is invoked when we received a response to our gpadl teardown request. | 
 | 579 |  * Find the matching request, copy the response and signal the requesting | 
 | 580 |  * thread. | 
 | 581 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 582 | static void vmbus_ongpadl_torndown( | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 583 | 			struct vmbus_channel_message_header *hdr) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 584 | { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 585 | 	struct vmbus_channel_gpadl_torndown *gpadl_torndown; | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 586 | 	struct vmbus_channel_msginfo *msginfo; | 
 | 587 | 	struct vmbus_channel_message_header *requestheader; | 
 | 588 | 	struct vmbus_channel_gpadl_teardown *gpadl_teardown; | 
| Greg Kroah-Hartman | dd0813b | 2009-07-15 14:56:45 -0700 | [diff] [blame] | 589 | 	unsigned long flags; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 590 |  | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 591 | 	gpadl_torndown = (struct vmbus_channel_gpadl_torndown *)hdr; | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 592 |  | 
 | 593 | 	/* | 
 | 594 | 	 * Find the open msg, copy the result and signal/unblock the wait event | 
 | 595 | 	 */ | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 596 | 	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 597 |  | 
| Hank Janssen | ebb61e5 | 2011-02-18 12:39:57 -0800 | [diff] [blame] | 598 | 	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
 | 599 | 				msglistentry) { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 600 | 		requestheader = | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 601 | 			(struct vmbus_channel_message_header *)msginfo->msg; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 602 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 603 | 		if (requestheader->msgtype == CHANNELMSG_GPADL_TEARDOWN) { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 604 | 			gpadl_teardown = | 
 | 605 | 			(struct vmbus_channel_gpadl_teardown *)requestheader; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 606 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 607 | 			if (gpadl_torndown->gpadl == gpadl_teardown->gpadl) { | 
 | 608 | 				memcpy(&msginfo->response.gpadl_torndown, | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 609 | 				       gpadl_torndown, | 
| K. Y. Srinivasan | 9568a19 | 2011-05-10 07:55:39 -0700 | [diff] [blame] | 610 | 				       sizeof( | 
 | 611 | 					struct vmbus_channel_gpadl_torndown)); | 
 | 612 | 				complete(&msginfo->waitevent); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 613 | 				break; | 
 | 614 | 			} | 
 | 615 | 		} | 
 | 616 | 	} | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 617 | 	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 618 | } | 
 | 619 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 620 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 621 |  * vmbus_onversion_response - Version response handler | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 622 |  * | 
 | 623 |  * This is invoked when we received a response to our initiate contact request. | 
 | 624 |  * Find the matching request, copy the response and signal the requesting | 
 | 625 |  * thread. | 
 | 626 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 627 | static void vmbus_onversion_response( | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 628 | 		struct vmbus_channel_message_header *hdr) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 629 | { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 630 | 	struct vmbus_channel_msginfo *msginfo; | 
 | 631 | 	struct vmbus_channel_message_header *requestheader; | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 632 | 	struct vmbus_channel_version_response *version_response; | 
| Greg Kroah-Hartman | dd0813b | 2009-07-15 14:56:45 -0700 | [diff] [blame] | 633 | 	unsigned long flags; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 634 |  | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 635 | 	version_response = (struct vmbus_channel_version_response *)hdr; | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 636 | 	spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 637 |  | 
| Hank Janssen | ebb61e5 | 2011-02-18 12:39:57 -0800 | [diff] [blame] | 638 | 	list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
 | 639 | 				msglistentry) { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 640 | 		requestheader = | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 641 | 			(struct vmbus_channel_message_header *)msginfo->msg; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 642 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 643 | 		if (requestheader->msgtype == | 
 | 644 | 		    CHANNELMSG_INITIATE_CONTACT) { | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 645 | 			memcpy(&msginfo->response.version_response, | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 646 | 			      version_response, | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 647 | 			      sizeof(struct vmbus_channel_version_response)); | 
| K. Y. Srinivasan | 9568a19 | 2011-05-10 07:55:39 -0700 | [diff] [blame] | 648 | 			complete(&msginfo->waitevent); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 649 | 		} | 
 | 650 | 	} | 
| Haiyang Zhang | 15b2f64 | 2011-01-26 12:12:07 -0800 | [diff] [blame] | 651 | 	spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 652 | } | 
 | 653 |  | 
| Greg Kroah-Hartman | c8212f0 | 2009-08-31 21:51:50 -0700 | [diff] [blame] | 654 | /* Channel message dispatch table */ | 
 | 655 | static struct vmbus_channel_message_table_entry | 
| K. Y. Srinivasan | b7c6b02 | 2011-05-10 07:55:38 -0700 | [diff] [blame] | 656 | 	channel_message_table[CHANNELMSG_COUNT] = { | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 657 | 	{CHANNELMSG_INVALID,			NULL}, | 
 | 658 | 	{CHANNELMSG_OFFERCHANNEL,		vmbus_onoffer}, | 
 | 659 | 	{CHANNELMSG_RESCIND_CHANNELOFFER,	vmbus_onoffer_rescind}, | 
 | 660 | 	{CHANNELMSG_REQUESTOFFERS,		NULL}, | 
 | 661 | 	{CHANNELMSG_ALLOFFERS_DELIVERED,	vmbus_onoffers_delivered}, | 
 | 662 | 	{CHANNELMSG_OPENCHANNEL,		NULL}, | 
 | 663 | 	{CHANNELMSG_OPENCHANNEL_RESULT,	vmbus_onopen_result}, | 
 | 664 | 	{CHANNELMSG_CLOSECHANNEL,		NULL}, | 
 | 665 | 	{CHANNELMSG_GPADL_HEADER,		NULL}, | 
 | 666 | 	{CHANNELMSG_GPADL_BODY,		NULL}, | 
 | 667 | 	{CHANNELMSG_GPADL_CREATED,		vmbus_ongpadl_created}, | 
 | 668 | 	{CHANNELMSG_GPADL_TEARDOWN,		NULL}, | 
 | 669 | 	{CHANNELMSG_GPADL_TORNDOWN,		vmbus_ongpadl_torndown}, | 
 | 670 | 	{CHANNELMSG_RELID_RELEASED,		NULL}, | 
 | 671 | 	{CHANNELMSG_INITIATE_CONTACT,		NULL}, | 
 | 672 | 	{CHANNELMSG_VERSION_RESPONSE,		vmbus_onversion_response}, | 
 | 673 | 	{CHANNELMSG_UNLOAD,			NULL}, | 
| Greg Kroah-Hartman | c8212f0 | 2009-08-31 21:51:50 -0700 | [diff] [blame] | 674 | }; | 
 | 675 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 676 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 677 |  * vmbus_onmessage - Handler for channel protocol messages. | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 678 |  * | 
 | 679 |  * This is invoked in the vmbus worker thread context. | 
 | 680 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 681 | void vmbus_onmessage(void *context) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 682 | { | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 683 | 	struct hv_message *msg = context; | 
| Greg Kroah-Hartman | 8225021 | 2009-08-26 15:16:04 -0700 | [diff] [blame] | 684 | 	struct vmbus_channel_message_header *hdr; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 685 | 	int size; | 
 | 686 |  | 
| Haiyang Zhang | f6feebe | 2010-11-08 14:04:39 -0800 | [diff] [blame] | 687 | 	hdr = (struct vmbus_channel_message_header *)msg->u.payload; | 
 | 688 | 	size = msg->header.payload_size; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 689 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 690 | 	if (hdr->msgtype >= CHANNELMSG_COUNT) { | 
| Hank Janssen | 0a46618 | 2011-03-29 13:58:47 -0700 | [diff] [blame] | 691 | 		pr_err("Received invalid channel message type %d size %d\n", | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 692 | 			   hdr->msgtype, size); | 
| Greg Kroah-Hartman | 04f50c4 | 2009-07-16 12:35:37 -0700 | [diff] [blame] | 693 | 		print_hex_dump_bytes("", DUMP_PREFIX_NONE, | 
| Haiyang Zhang | f6feebe | 2010-11-08 14:04:39 -0800 | [diff] [blame] | 694 | 				     (unsigned char *)msg->u.payload, size); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 695 | 		return; | 
 | 696 | 	} | 
 | 697 |  | 
| K. Y. Srinivasan | b7c6b02 | 2011-05-10 07:55:38 -0700 | [diff] [blame] | 698 | 	if (channel_message_table[hdr->msgtype].message_handler) | 
 | 699 | 		channel_message_table[hdr->msgtype].message_handler(hdr); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 700 | 	else | 
| Hank Janssen | 0a46618 | 2011-03-29 13:58:47 -0700 | [diff] [blame] | 701 | 		pr_err("Unhandled channel message type %d\n", hdr->msgtype); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 702 | } | 
 | 703 |  | 
| Hank Janssen | 3e18951 | 2010-03-04 22:11:00 +0000 | [diff] [blame] | 704 | /* | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 705 |  * vmbus_request_offers - Send a request to get all our pending offers. | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 706 |  */ | 
| Haiyang Zhang | e98cb27 | 2010-10-15 10:14:07 -0700 | [diff] [blame] | 707 | int vmbus_request_offers(void) | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 708 | { | 
| Greg Kroah-Hartman | 8225021 | 2009-08-26 15:16:04 -0700 | [diff] [blame] | 709 | 	struct vmbus_channel_message_header *msg; | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 710 | 	struct vmbus_channel_msginfo *msginfo; | 
| K. Y. Srinivasan | 9568a19 | 2011-05-10 07:55:39 -0700 | [diff] [blame] | 711 | 	int ret, t; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 712 |  | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 713 | 	msginfo = kmalloc(sizeof(*msginfo) + | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 714 | 			  sizeof(struct vmbus_channel_message_header), | 
 | 715 | 			  GFP_KERNEL); | 
| Haiyang Zhang | 188963e | 2010-10-15 10:14:06 -0700 | [diff] [blame] | 716 | 	if (!msginfo) | 
| Bill Pemberton | 75910f2 | 2010-05-05 15:27:31 -0400 | [diff] [blame] | 717 | 		return -ENOMEM; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 718 |  | 
| K. Y. Srinivasan | 9568a19 | 2011-05-10 07:55:39 -0700 | [diff] [blame] | 719 | 	init_completion(&msginfo->waitevent); | 
| Bill Pemberton | 75910f2 | 2010-05-05 15:27:31 -0400 | [diff] [blame] | 720 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 721 | 	msg = (struct vmbus_channel_message_header *)msginfo->msg; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 722 |  | 
| Haiyang Zhang | c50f7fb | 2010-11-08 14:04:38 -0800 | [diff] [blame] | 723 | 	msg->msgtype = CHANNELMSG_REQUESTOFFERS; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 724 |  | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 725 |  | 
| Haiyang Zhang | c697767 | 2011-01-26 12:12:08 -0800 | [diff] [blame] | 726 | 	ret = vmbus_post_msg(msg, | 
| Greg Kroah-Hartman | bd60c33 | 2009-08-31 21:47:21 -0700 | [diff] [blame] | 727 | 			       sizeof(struct vmbus_channel_message_header)); | 
 | 728 | 	if (ret != 0) { | 
| Hank Janssen | 0a46618 | 2011-03-29 13:58:47 -0700 | [diff] [blame] | 729 | 		pr_err("Unable to request offers - %d\n", ret); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 730 |  | 
| K. Y. Srinivasan | 0c3b7b2 | 2011-02-11 09:59:43 -0800 | [diff] [blame] | 731 | 		goto cleanup; | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 732 | 	} | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 733 |  | 
| K. Y. Srinivasan | 2dfde96 | 2011-06-16 13:16:34 -0700 | [diff] [blame] | 734 | 	t = wait_for_completion_timeout(&msginfo->waitevent, 5*HZ); | 
| K. Y. Srinivasan | 9568a19 | 2011-05-10 07:55:39 -0700 | [diff] [blame] | 735 | 	if (t == 0) { | 
| K. Y. Srinivasan | 0c3b7b2 | 2011-02-11 09:59:43 -0800 | [diff] [blame] | 736 | 		ret = -ETIMEDOUT; | 
 | 737 | 		goto cleanup; | 
 | 738 | 	} | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 739 |  | 
 | 740 |  | 
| K. Y. Srinivasan | 0c3b7b2 | 2011-02-11 09:59:43 -0800 | [diff] [blame] | 741 |  | 
 | 742 | cleanup: | 
| Ilia Mirkin | dd9b15d | 2011-03-13 00:29:00 -0500 | [diff] [blame] | 743 | 	kfree(msginfo); | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 744 |  | 
| Hank Janssen | 3e7ee49 | 2009-07-13 16:02:34 -0700 | [diff] [blame] | 745 | 	return ret; | 
 | 746 | } | 
 | 747 |  | 
| K. Y. Srinivasan | e68d297 | 2013-05-23 12:02:32 -0700 | [diff] [blame] | 748 | /* | 
 | 749 |  * Retrieve the (sub) channel on which to send an outgoing request. | 
 | 750 |  * When a primary channel has multiple sub-channels, we choose a | 
 | 751 |  * channel whose VCPU binding is closest to the VCPU on which | 
 | 752 |  * this call is being made. | 
 | 753 |  */ | 
 | 754 | struct vmbus_channel *vmbus_get_outgoing_channel(struct vmbus_channel *primary) | 
 | 755 | { | 
 | 756 | 	struct list_head *cur, *tmp; | 
 | 757 | 	int cur_cpu = hv_context.vp_index[smp_processor_id()]; | 
 | 758 | 	struct vmbus_channel *cur_channel; | 
 | 759 | 	struct vmbus_channel *outgoing_channel = primary; | 
 | 760 | 	int cpu_distance, new_cpu_distance; | 
 | 761 |  | 
 | 762 | 	if (list_empty(&primary->sc_list)) | 
 | 763 | 		return outgoing_channel; | 
 | 764 |  | 
 | 765 | 	list_for_each_safe(cur, tmp, &primary->sc_list) { | 
 | 766 | 		cur_channel = list_entry(cur, struct vmbus_channel, sc_list); | 
 | 767 | 		if (cur_channel->state != CHANNEL_OPENED_STATE) | 
 | 768 | 			continue; | 
 | 769 |  | 
 | 770 | 		if (cur_channel->target_vp == cur_cpu) | 
 | 771 | 			return cur_channel; | 
 | 772 |  | 
 | 773 | 		cpu_distance = ((outgoing_channel->target_vp > cur_cpu) ? | 
 | 774 | 				(outgoing_channel->target_vp - cur_cpu) : | 
 | 775 | 				(cur_cpu - outgoing_channel->target_vp)); | 
 | 776 |  | 
 | 777 | 		new_cpu_distance = ((cur_channel->target_vp > cur_cpu) ? | 
 | 778 | 				(cur_channel->target_vp - cur_cpu) : | 
 | 779 | 				(cur_cpu - cur_channel->target_vp)); | 
 | 780 |  | 
 | 781 | 		if (cpu_distance < new_cpu_distance) | 
 | 782 | 			continue; | 
 | 783 |  | 
 | 784 | 		outgoing_channel = cur_channel; | 
 | 785 | 	} | 
 | 786 |  | 
 | 787 | 	return outgoing_channel; | 
 | 788 | } | 
 | 789 | EXPORT_SYMBOL_GPL(vmbus_get_outgoing_channel); | 
 | 790 |  | 
 | 791 | static void invoke_sc_cb(struct vmbus_channel *primary_channel) | 
 | 792 | { | 
 | 793 | 	struct list_head *cur, *tmp; | 
 | 794 | 	struct vmbus_channel *cur_channel; | 
 | 795 |  | 
 | 796 | 	if (primary_channel->sc_creation_callback == NULL) | 
 | 797 | 		return; | 
 | 798 |  | 
 | 799 | 	list_for_each_safe(cur, tmp, &primary_channel->sc_list) { | 
 | 800 | 		cur_channel = list_entry(cur, struct vmbus_channel, sc_list); | 
 | 801 |  | 
 | 802 | 		primary_channel->sc_creation_callback(cur_channel); | 
 | 803 | 	} | 
 | 804 | } | 
 | 805 |  | 
 | 806 | void vmbus_set_sc_create_callback(struct vmbus_channel *primary_channel, | 
 | 807 | 				void (*sc_cr_cb)(struct vmbus_channel *new_sc)) | 
 | 808 | { | 
 | 809 | 	primary_channel->sc_creation_callback = sc_cr_cb; | 
 | 810 | } | 
 | 811 | EXPORT_SYMBOL_GPL(vmbus_set_sc_create_callback); | 
 | 812 |  | 
 | 813 | bool vmbus_are_subchannels_present(struct vmbus_channel *primary) | 
 | 814 | { | 
 | 815 | 	bool ret; | 
 | 816 |  | 
 | 817 | 	ret = !list_empty(&primary->sc_list); | 
 | 818 |  | 
 | 819 | 	if (ret) { | 
 | 820 | 		/* | 
 | 821 | 		 * Invoke the callback on sub-channel creation. | 
 | 822 | 		 * This will present a uniform interface to the | 
 | 823 | 		 * clients. | 
 | 824 | 		 */ | 
 | 825 | 		invoke_sc_cb(primary); | 
 | 826 | 	} | 
 | 827 |  | 
 | 828 | 	return ret; | 
 | 829 | } | 
 | 830 | EXPORT_SYMBOL_GPL(vmbus_are_subchannels_present); |