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