|  | /* | 
|  | * Copyright (c) 2009, Microsoft Corporation. | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or modify it | 
|  | * under the terms and conditions of the GNU General Public License, | 
|  | * version 2, as published by the Free Software Foundation. | 
|  | * | 
|  | * This program is distributed in the hope it will be useful, but WITHOUT | 
|  | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | 
|  | * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for | 
|  | * more details. | 
|  | * | 
|  | * You should have received a copy of the GNU General Public License along with | 
|  | * this program; if not, write to the Free Software Foundation, Inc., 59 Temple | 
|  | * Place - Suite 330, Boston, MA 02111-1307 USA. | 
|  | * | 
|  | * Authors: | 
|  | *   Haiyang Zhang <haiyangz@microsoft.com> | 
|  | *   Hank Janssen  <hjanssen@microsoft.com> | 
|  | */ | 
|  | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | 
|  |  | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/sched.h> | 
|  | #include <linux/wait.h> | 
|  | #include <linux/mm.h> | 
|  | #include <linux/slab.h> | 
|  | #include <linux/list.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/completion.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/hyperv.h> | 
|  | #include <asm/mshyperv.h> | 
|  |  | 
|  | #include "hyperv_vmbus.h" | 
|  |  | 
|  | static void init_vp_index(struct vmbus_channel *channel, u16 dev_type); | 
|  |  | 
|  | static const struct vmbus_device vmbus_devs[] = { | 
|  | /* IDE */ | 
|  | { .dev_type = HV_IDE, | 
|  | HV_IDE_GUID, | 
|  | .perf_device = true, | 
|  | }, | 
|  |  | 
|  | /* SCSI */ | 
|  | { .dev_type = HV_SCSI, | 
|  | HV_SCSI_GUID, | 
|  | .perf_device = true, | 
|  | }, | 
|  |  | 
|  | /* Fibre Channel */ | 
|  | { .dev_type = HV_FC, | 
|  | HV_SYNTHFC_GUID, | 
|  | .perf_device = true, | 
|  | }, | 
|  |  | 
|  | /* Synthetic NIC */ | 
|  | { .dev_type = HV_NIC, | 
|  | HV_NIC_GUID, | 
|  | .perf_device = true, | 
|  | }, | 
|  |  | 
|  | /* Network Direct */ | 
|  | { .dev_type = HV_ND, | 
|  | HV_ND_GUID, | 
|  | .perf_device = true, | 
|  | }, | 
|  |  | 
|  | /* PCIE */ | 
|  | { .dev_type = HV_PCIE, | 
|  | HV_PCIE_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Synthetic Frame Buffer */ | 
|  | { .dev_type = HV_FB, | 
|  | HV_SYNTHVID_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Synthetic Keyboard */ | 
|  | { .dev_type = HV_KBD, | 
|  | HV_KBD_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Synthetic MOUSE */ | 
|  | { .dev_type = HV_MOUSE, | 
|  | HV_MOUSE_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* KVP */ | 
|  | { .dev_type = HV_KVP, | 
|  | HV_KVP_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Time Synch */ | 
|  | { .dev_type = HV_TS, | 
|  | HV_TS_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Heartbeat */ | 
|  | { .dev_type = HV_HB, | 
|  | HV_HEART_BEAT_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Shutdown */ | 
|  | { .dev_type = HV_SHUTDOWN, | 
|  | HV_SHUTDOWN_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* File copy */ | 
|  | { .dev_type = HV_FCOPY, | 
|  | HV_FCOPY_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Backup */ | 
|  | { .dev_type = HV_BACKUP, | 
|  | HV_VSS_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Dynamic Memory */ | 
|  | { .dev_type = HV_DM, | 
|  | HV_DM_GUID, | 
|  | .perf_device = false, | 
|  | }, | 
|  |  | 
|  | /* Unknown GUID */ | 
|  | { .dev_type = HV_UNKNOWN, | 
|  | .perf_device = false, | 
|  | }, | 
|  | }; | 
|  |  | 
|  | static const struct { | 
|  | uuid_le guid; | 
|  | } vmbus_unsupported_devs[] = { | 
|  | { HV_AVMA1_GUID }, | 
|  | { HV_AVMA2_GUID }, | 
|  | { HV_RDV_GUID	}, | 
|  | }; | 
|  |  | 
|  | /* | 
|  | * The rescinded channel may be blocked waiting for a response from the host; | 
|  | * take care of that. | 
|  | */ | 
|  | static void vmbus_rescind_cleanup(struct vmbus_channel *channel) | 
|  | { | 
|  | struct vmbus_channel_msginfo *msginfo; | 
|  | unsigned long flags; | 
|  |  | 
|  |  | 
|  | spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
|  | channel->rescind = true; | 
|  | list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
|  | msglistentry) { | 
|  |  | 
|  | if (msginfo->waiting_channel == channel) { | 
|  | complete(&msginfo->waitevent); | 
|  | break; | 
|  | } | 
|  | } | 
|  | spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
|  | } | 
|  |  | 
|  | static bool is_unsupported_vmbus_devs(const uuid_le *guid) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < ARRAY_SIZE(vmbus_unsupported_devs); i++) | 
|  | if (!uuid_le_cmp(*guid, vmbus_unsupported_devs[i].guid)) | 
|  | return true; | 
|  | return false; | 
|  | } | 
|  |  | 
|  | static u16 hv_get_dev_type(const struct vmbus_channel *channel) | 
|  | { | 
|  | const uuid_le *guid = &channel->offermsg.offer.if_type; | 
|  | u16 i; | 
|  |  | 
|  | if (is_hvsock_channel(channel) || is_unsupported_vmbus_devs(guid)) | 
|  | return HV_UNKNOWN; | 
|  |  | 
|  | for (i = HV_IDE; i < HV_UNKNOWN; i++) { | 
|  | if (!uuid_le_cmp(*guid, vmbus_devs[i].guid)) | 
|  | return i; | 
|  | } | 
|  | pr_info("Unknown GUID: %pUl\n", guid); | 
|  | return i; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * vmbus_prep_negotiate_resp() - Create default response for Hyper-V Negotiate message | 
|  | * @icmsghdrp: Pointer to msg header structure | 
|  | * @icmsg_negotiate: Pointer to negotiate message structure | 
|  | * @buf: Raw buffer channel data | 
|  | * | 
|  | * @icmsghdrp is of type &struct icmsg_hdr. | 
|  | * Set up and fill in default negotiate response message. | 
|  | * | 
|  | * The fw_version and fw_vercnt specifies the framework version that | 
|  | * we can support. | 
|  | * | 
|  | * The srv_version and srv_vercnt specifies the service | 
|  | * versions we can support. | 
|  | * | 
|  | * Versions are given in decreasing order. | 
|  | * | 
|  | * nego_fw_version and nego_srv_version store the selected protocol versions. | 
|  | * | 
|  | * Mainly used by Hyper-V drivers. | 
|  | */ | 
|  | bool vmbus_prep_negotiate_resp(struct icmsg_hdr *icmsghdrp, | 
|  | u8 *buf, const int *fw_version, int fw_vercnt, | 
|  | const int *srv_version, int srv_vercnt, | 
|  | int *nego_fw_version, int *nego_srv_version) | 
|  | { | 
|  | int icframe_major, icframe_minor; | 
|  | int icmsg_major, icmsg_minor; | 
|  | int fw_major, fw_minor; | 
|  | int srv_major, srv_minor; | 
|  | int i, j; | 
|  | bool found_match = false; | 
|  | struct icmsg_negotiate *negop; | 
|  |  | 
|  | icmsghdrp->icmsgsize = 0x10; | 
|  | negop = (struct icmsg_negotiate *)&buf[ | 
|  | sizeof(struct vmbuspipe_hdr) + | 
|  | sizeof(struct icmsg_hdr)]; | 
|  |  | 
|  | icframe_major = negop->icframe_vercnt; | 
|  | icframe_minor = 0; | 
|  |  | 
|  | icmsg_major = negop->icmsg_vercnt; | 
|  | icmsg_minor = 0; | 
|  |  | 
|  | /* | 
|  | * Select the framework version number we will | 
|  | * support. | 
|  | */ | 
|  |  | 
|  | for (i = 0; i < fw_vercnt; i++) { | 
|  | fw_major = (fw_version[i] >> 16); | 
|  | fw_minor = (fw_version[i] & 0xFFFF); | 
|  |  | 
|  | for (j = 0; j < negop->icframe_vercnt; j++) { | 
|  | if ((negop->icversion_data[j].major == fw_major) && | 
|  | (negop->icversion_data[j].minor == fw_minor)) { | 
|  | icframe_major = negop->icversion_data[j].major; | 
|  | icframe_minor = negop->icversion_data[j].minor; | 
|  | found_match = true; | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | if (found_match) | 
|  | break; | 
|  | } | 
|  |  | 
|  | if (!found_match) | 
|  | goto fw_error; | 
|  |  | 
|  | found_match = false; | 
|  |  | 
|  | for (i = 0; i < srv_vercnt; i++) { | 
|  | srv_major = (srv_version[i] >> 16); | 
|  | srv_minor = (srv_version[i] & 0xFFFF); | 
|  |  | 
|  | for (j = negop->icframe_vercnt; | 
|  | (j < negop->icframe_vercnt + negop->icmsg_vercnt); | 
|  | j++) { | 
|  |  | 
|  | if ((negop->icversion_data[j].major == srv_major) && | 
|  | (negop->icversion_data[j].minor == srv_minor)) { | 
|  |  | 
|  | icmsg_major = negop->icversion_data[j].major; | 
|  | icmsg_minor = negop->icversion_data[j].minor; | 
|  | found_match = true; | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | if (found_match) | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Respond with the framework and service | 
|  | * version numbers we can support. | 
|  | */ | 
|  |  | 
|  | fw_error: | 
|  | if (!found_match) { | 
|  | negop->icframe_vercnt = 0; | 
|  | negop->icmsg_vercnt = 0; | 
|  | } else { | 
|  | negop->icframe_vercnt = 1; | 
|  | negop->icmsg_vercnt = 1; | 
|  | } | 
|  |  | 
|  | if (nego_fw_version) | 
|  | *nego_fw_version = (icframe_major << 16) | icframe_minor; | 
|  |  | 
|  | if (nego_srv_version) | 
|  | *nego_srv_version = (icmsg_major << 16) | icmsg_minor; | 
|  |  | 
|  | negop->icversion_data[0].major = icframe_major; | 
|  | negop->icversion_data[0].minor = icframe_minor; | 
|  | negop->icversion_data[1].major = icmsg_major; | 
|  | negop->icversion_data[1].minor = icmsg_minor; | 
|  | return found_match; | 
|  | } | 
|  |  | 
|  | EXPORT_SYMBOL_GPL(vmbus_prep_negotiate_resp); | 
|  |  | 
|  | /* | 
|  | * alloc_channel - Allocate and initialize a vmbus channel object | 
|  | */ | 
|  | static struct vmbus_channel *alloc_channel(void) | 
|  | { | 
|  | struct vmbus_channel *channel; | 
|  |  | 
|  | channel = kzalloc(sizeof(*channel), GFP_ATOMIC); | 
|  | if (!channel) | 
|  | return NULL; | 
|  |  | 
|  | spin_lock_init(&channel->lock); | 
|  | init_completion(&channel->rescind_event); | 
|  |  | 
|  | INIT_LIST_HEAD(&channel->sc_list); | 
|  | INIT_LIST_HEAD(&channel->percpu_list); | 
|  |  | 
|  | tasklet_init(&channel->callback_event, | 
|  | vmbus_on_event, (unsigned long)channel); | 
|  |  | 
|  | return channel; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * free_channel - Release the resources used by the vmbus channel object | 
|  | */ | 
|  | static void free_channel(struct vmbus_channel *channel) | 
|  | { | 
|  | tasklet_kill(&channel->callback_event); | 
|  |  | 
|  | kobject_put(&channel->kobj); | 
|  | } | 
|  |  | 
|  | static void percpu_channel_enq(void *arg) | 
|  | { | 
|  | struct vmbus_channel *channel = arg; | 
|  | struct hv_per_cpu_context *hv_cpu | 
|  | = this_cpu_ptr(hv_context.cpu_context); | 
|  |  | 
|  | list_add_tail_rcu(&channel->percpu_list, &hv_cpu->chan_list); | 
|  | } | 
|  |  | 
|  | static void percpu_channel_deq(void *arg) | 
|  | { | 
|  | struct vmbus_channel *channel = arg; | 
|  |  | 
|  | list_del_rcu(&channel->percpu_list); | 
|  | } | 
|  |  | 
|  |  | 
|  | static void vmbus_release_relid(u32 relid) | 
|  | { | 
|  | struct vmbus_channel_relid_released msg; | 
|  | int ret; | 
|  |  | 
|  | memset(&msg, 0, sizeof(struct vmbus_channel_relid_released)); | 
|  | msg.child_relid = relid; | 
|  | msg.header.msgtype = CHANNELMSG_RELID_RELEASED; | 
|  | ret = vmbus_post_msg(&msg, sizeof(struct vmbus_channel_relid_released), | 
|  | true); | 
|  |  | 
|  | trace_vmbus_release_relid(&msg, ret); | 
|  | } | 
|  |  | 
|  | void hv_process_channel_removal(u32 relid) | 
|  | { | 
|  | unsigned long flags; | 
|  | struct vmbus_channel *primary_channel, *channel; | 
|  |  | 
|  | BUG_ON(!mutex_is_locked(&vmbus_connection.channel_mutex)); | 
|  |  | 
|  | /* | 
|  | * Make sure channel is valid as we may have raced. | 
|  | */ | 
|  | channel = relid2channel(relid); | 
|  | if (!channel) | 
|  | return; | 
|  |  | 
|  | BUG_ON(!channel->rescind); | 
|  | if (channel->target_cpu != get_cpu()) { | 
|  | put_cpu(); | 
|  | smp_call_function_single(channel->target_cpu, | 
|  | percpu_channel_deq, channel, true); | 
|  | } else { | 
|  | percpu_channel_deq(channel); | 
|  | put_cpu(); | 
|  | } | 
|  |  | 
|  | if (channel->primary_channel == NULL) { | 
|  | list_del(&channel->listentry); | 
|  |  | 
|  | primary_channel = channel; | 
|  | } else { | 
|  | primary_channel = channel->primary_channel; | 
|  | spin_lock_irqsave(&primary_channel->lock, flags); | 
|  | list_del(&channel->sc_list); | 
|  | primary_channel->num_sc--; | 
|  | spin_unlock_irqrestore(&primary_channel->lock, flags); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * We need to free the bit for init_vp_index() to work in the case | 
|  | * of sub-channel, when we reload drivers like hv_netvsc. | 
|  | */ | 
|  | if (channel->affinity_policy == HV_LOCALIZED) | 
|  | cpumask_clear_cpu(channel->target_cpu, | 
|  | &primary_channel->alloced_cpus_in_node); | 
|  |  | 
|  | vmbus_release_relid(relid); | 
|  |  | 
|  | free_channel(channel); | 
|  | } | 
|  |  | 
|  | void vmbus_free_channels(void) | 
|  | { | 
|  | struct vmbus_channel *channel, *tmp; | 
|  |  | 
|  | list_for_each_entry_safe(channel, tmp, &vmbus_connection.chn_list, | 
|  | listentry) { | 
|  | /* hv_process_channel_removal() needs this */ | 
|  | channel->rescind = true; | 
|  |  | 
|  | vmbus_device_unregister(channel->device_obj); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* Note: the function can run concurrently for primary/sub channels. */ | 
|  | static void vmbus_add_channel_work(struct work_struct *work) | 
|  | { | 
|  | struct vmbus_channel *newchannel = | 
|  | container_of(work, struct vmbus_channel, add_channel_work); | 
|  | struct vmbus_channel *primary_channel = newchannel->primary_channel; | 
|  | unsigned long flags; | 
|  | u16 dev_type; | 
|  | int ret; | 
|  |  | 
|  | dev_type = hv_get_dev_type(newchannel); | 
|  |  | 
|  | init_vp_index(newchannel, dev_type); | 
|  |  | 
|  | if (newchannel->target_cpu != get_cpu()) { | 
|  | put_cpu(); | 
|  | smp_call_function_single(newchannel->target_cpu, | 
|  | percpu_channel_enq, | 
|  | newchannel, true); | 
|  | } else { | 
|  | percpu_channel_enq(newchannel); | 
|  | put_cpu(); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This state is used to indicate a successful open | 
|  | * so that when we do close the channel normally, we | 
|  | * can cleanup properly. | 
|  | */ | 
|  | newchannel->state = CHANNEL_OPEN_STATE; | 
|  |  | 
|  | if (primary_channel != NULL) { | 
|  | /* newchannel is a sub-channel. */ | 
|  | struct hv_device *dev = primary_channel->device_obj; | 
|  |  | 
|  | if (vmbus_add_channel_kobj(dev, newchannel)) | 
|  | goto err_deq_chan; | 
|  |  | 
|  | if (primary_channel->sc_creation_callback != NULL) | 
|  | primary_channel->sc_creation_callback(newchannel); | 
|  |  | 
|  | newchannel->probe_done = true; | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Start the process of binding the primary channel to the driver | 
|  | */ | 
|  | newchannel->device_obj = vmbus_device_create( | 
|  | &newchannel->offermsg.offer.if_type, | 
|  | &newchannel->offermsg.offer.if_instance, | 
|  | newchannel); | 
|  | if (!newchannel->device_obj) | 
|  | goto err_deq_chan; | 
|  |  | 
|  | newchannel->device_obj->device_id = dev_type; | 
|  | /* | 
|  | * Add the new device to the bus. This will kick off device-driver | 
|  | * binding which eventually invokes the device driver's AddDevice() | 
|  | * method. | 
|  | */ | 
|  | ret = vmbus_device_register(newchannel->device_obj); | 
|  |  | 
|  | if (ret != 0) { | 
|  | pr_err("unable to add child device object (relid %d)\n", | 
|  | newchannel->offermsg.child_relid); | 
|  | kfree(newchannel->device_obj); | 
|  | goto err_deq_chan; | 
|  | } | 
|  |  | 
|  | newchannel->probe_done = true; | 
|  | return; | 
|  |  | 
|  | err_deq_chan: | 
|  | mutex_lock(&vmbus_connection.channel_mutex); | 
|  |  | 
|  | /* | 
|  | * We need to set the flag, otherwise | 
|  | * vmbus_onoffer_rescind() can be blocked. | 
|  | */ | 
|  | newchannel->probe_done = true; | 
|  |  | 
|  | if (primary_channel == NULL) { | 
|  | list_del(&newchannel->listentry); | 
|  | } else { | 
|  | spin_lock_irqsave(&primary_channel->lock, flags); | 
|  | list_del(&newchannel->sc_list); | 
|  | spin_unlock_irqrestore(&primary_channel->lock, flags); | 
|  | } | 
|  |  | 
|  | mutex_unlock(&vmbus_connection.channel_mutex); | 
|  |  | 
|  | if (newchannel->target_cpu != get_cpu()) { | 
|  | put_cpu(); | 
|  | smp_call_function_single(newchannel->target_cpu, | 
|  | percpu_channel_deq, | 
|  | newchannel, true); | 
|  | } else { | 
|  | percpu_channel_deq(newchannel); | 
|  | put_cpu(); | 
|  | } | 
|  |  | 
|  | vmbus_release_relid(newchannel->offermsg.child_relid); | 
|  |  | 
|  | free_channel(newchannel); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_process_offer - Process the offer by creating a channel/device | 
|  | * associated with this offer | 
|  | */ | 
|  | static void vmbus_process_offer(struct vmbus_channel *newchannel) | 
|  | { | 
|  | struct vmbus_channel *channel; | 
|  | struct workqueue_struct *wq; | 
|  | unsigned long flags; | 
|  | bool fnew = true; | 
|  |  | 
|  | mutex_lock(&vmbus_connection.channel_mutex); | 
|  |  | 
|  | /* | 
|  | * Now that we have acquired the channel_mutex, | 
|  | * we can release the potentially racing rescind thread. | 
|  | */ | 
|  | atomic_dec(&vmbus_connection.offer_in_progress); | 
|  |  | 
|  | list_for_each_entry(channel, &vmbus_connection.chn_list, listentry) { | 
|  | if (!uuid_le_cmp(channel->offermsg.offer.if_type, | 
|  | newchannel->offermsg.offer.if_type) && | 
|  | !uuid_le_cmp(channel->offermsg.offer.if_instance, | 
|  | newchannel->offermsg.offer.if_instance)) { | 
|  | fnew = false; | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | if (fnew) | 
|  | list_add_tail(&newchannel->listentry, | 
|  | &vmbus_connection.chn_list); | 
|  | else { | 
|  | /* | 
|  | * Check to see if this is a valid sub-channel. | 
|  | */ | 
|  | if (newchannel->offermsg.offer.sub_channel_index == 0) { | 
|  | mutex_unlock(&vmbus_connection.channel_mutex); | 
|  | /* | 
|  | * Don't call free_channel(), because newchannel->kobj | 
|  | * is not initialized yet. | 
|  | */ | 
|  | kfree(newchannel); | 
|  | WARN_ON_ONCE(1); | 
|  | return; | 
|  | } | 
|  | /* | 
|  | * Process the sub-channel. | 
|  | */ | 
|  | newchannel->primary_channel = channel; | 
|  | spin_lock_irqsave(&channel->lock, flags); | 
|  | list_add_tail(&newchannel->sc_list, &channel->sc_list); | 
|  | spin_unlock_irqrestore(&channel->lock, flags); | 
|  | } | 
|  |  | 
|  | mutex_unlock(&vmbus_connection.channel_mutex); | 
|  |  | 
|  | /* | 
|  | * vmbus_process_offer() mustn't call channel->sc_creation_callback() | 
|  | * directly for sub-channels, because sc_creation_callback() -> | 
|  | * vmbus_open() may never get the host's response to the | 
|  | * OPEN_CHANNEL message (the host may rescind a channel at any time, | 
|  | * e.g. in the case of hot removing a NIC), and vmbus_onoffer_rescind() | 
|  | * may not wake up the vmbus_open() as it's blocked due to a non-zero | 
|  | * vmbus_connection.offer_in_progress, and finally we have a deadlock. | 
|  | * | 
|  | * The above is also true for primary channels, if the related device | 
|  | * drivers use sync probing mode by default. | 
|  | * | 
|  | * And, usually the handling of primary channels and sub-channels can | 
|  | * depend on each other, so we should offload them to different | 
|  | * workqueues to avoid possible deadlock, e.g. in sync-probing mode, | 
|  | * NIC1's netvsc_subchan_work() can race with NIC2's netvsc_probe() -> | 
|  | * rtnl_lock(), and causes deadlock: the former gets the rtnl_lock | 
|  | * and waits for all the sub-channels to appear, but the latter | 
|  | * can't get the rtnl_lock and this blocks the handling of | 
|  | * sub-channels. | 
|  | */ | 
|  | INIT_WORK(&newchannel->add_channel_work, vmbus_add_channel_work); | 
|  | wq = fnew ? vmbus_connection.handle_primary_chan_wq : | 
|  | vmbus_connection.handle_sub_chan_wq; | 
|  | queue_work(wq, &newchannel->add_channel_work); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * We use this state to statically distribute the channel interrupt load. | 
|  | */ | 
|  | static int next_numa_node_id; | 
|  | /* | 
|  | * init_vp_index() accesses global variables like next_numa_node_id, and | 
|  | * it can run concurrently for primary channels and sub-channels: see | 
|  | * vmbus_process_offer(), so we need the lock to protect the global | 
|  | * variables. | 
|  | */ | 
|  | static DEFINE_SPINLOCK(bind_channel_to_cpu_lock); | 
|  |  | 
|  | /* | 
|  | * Starting with Win8, we can statically distribute the incoming | 
|  | * channel interrupt load by binding a channel to VCPU. | 
|  | * We distribute the interrupt loads to one or more NUMA nodes based on | 
|  | * the channel's affinity_policy. | 
|  | * | 
|  | * For pre-win8 hosts or non-performance critical channels we assign the | 
|  | * first CPU in the first NUMA node. | 
|  | */ | 
|  | static void init_vp_index(struct vmbus_channel *channel, u16 dev_type) | 
|  | { | 
|  | u32 cur_cpu; | 
|  | bool perf_chn = vmbus_devs[dev_type].perf_device; | 
|  | struct vmbus_channel *primary = channel->primary_channel; | 
|  | int next_node; | 
|  | cpumask_var_t available_mask; | 
|  | struct cpumask *alloced_mask; | 
|  |  | 
|  | if ((vmbus_proto_version == VERSION_WS2008) || | 
|  | (vmbus_proto_version == VERSION_WIN7) || (!perf_chn) || | 
|  | !alloc_cpumask_var(&available_mask, GFP_KERNEL)) { | 
|  | /* | 
|  | * Prior to win8, all channel interrupts are | 
|  | * delivered on cpu 0. | 
|  | * Also if the channel is not a performance critical | 
|  | * channel, bind it to cpu 0. | 
|  | * In case alloc_cpumask_var() fails, bind it to cpu 0. | 
|  | */ | 
|  | channel->numa_node = 0; | 
|  | channel->target_cpu = 0; | 
|  | channel->target_vp = hv_cpu_number_to_vp_number(0); | 
|  | return; | 
|  | } | 
|  |  | 
|  | spin_lock(&bind_channel_to_cpu_lock); | 
|  |  | 
|  | /* | 
|  | * Based on the channel affinity policy, we will assign the NUMA | 
|  | * nodes. | 
|  | */ | 
|  |  | 
|  | if ((channel->affinity_policy == HV_BALANCED) || (!primary)) { | 
|  | while (true) { | 
|  | next_node = next_numa_node_id++; | 
|  | if (next_node == nr_node_ids) { | 
|  | next_node = next_numa_node_id = 0; | 
|  | continue; | 
|  | } | 
|  | if (cpumask_empty(cpumask_of_node(next_node))) | 
|  | continue; | 
|  | break; | 
|  | } | 
|  | channel->numa_node = next_node; | 
|  | primary = channel; | 
|  | } | 
|  | alloced_mask = &hv_context.hv_numa_map[primary->numa_node]; | 
|  |  | 
|  | if (cpumask_weight(alloced_mask) == | 
|  | cpumask_weight(cpumask_of_node(primary->numa_node))) { | 
|  | /* | 
|  | * We have cycled through all the CPUs in the node; | 
|  | * reset the alloced map. | 
|  | */ | 
|  | cpumask_clear(alloced_mask); | 
|  | } | 
|  |  | 
|  | cpumask_xor(available_mask, alloced_mask, | 
|  | cpumask_of_node(primary->numa_node)); | 
|  |  | 
|  | cur_cpu = -1; | 
|  |  | 
|  | if (primary->affinity_policy == HV_LOCALIZED) { | 
|  | /* | 
|  | * Normally Hyper-V host doesn't create more subchannels | 
|  | * than there are VCPUs on the node but it is possible when not | 
|  | * all present VCPUs on the node are initialized by guest. | 
|  | * Clear the alloced_cpus_in_node to start over. | 
|  | */ | 
|  | if (cpumask_equal(&primary->alloced_cpus_in_node, | 
|  | cpumask_of_node(primary->numa_node))) | 
|  | cpumask_clear(&primary->alloced_cpus_in_node); | 
|  | } | 
|  |  | 
|  | while (true) { | 
|  | cur_cpu = cpumask_next(cur_cpu, available_mask); | 
|  | if (cur_cpu >= nr_cpu_ids) { | 
|  | cur_cpu = -1; | 
|  | cpumask_copy(available_mask, | 
|  | cpumask_of_node(primary->numa_node)); | 
|  | continue; | 
|  | } | 
|  |  | 
|  | if (primary->affinity_policy == HV_LOCALIZED) { | 
|  | /* | 
|  | * NOTE: in the case of sub-channel, we clear the | 
|  | * sub-channel related bit(s) in | 
|  | * primary->alloced_cpus_in_node in | 
|  | * hv_process_channel_removal(), so when we | 
|  | * reload drivers like hv_netvsc in SMP guest, here | 
|  | * we're able to re-allocate | 
|  | * bit from primary->alloced_cpus_in_node. | 
|  | */ | 
|  | if (!cpumask_test_cpu(cur_cpu, | 
|  | &primary->alloced_cpus_in_node)) { | 
|  | cpumask_set_cpu(cur_cpu, | 
|  | &primary->alloced_cpus_in_node); | 
|  | cpumask_set_cpu(cur_cpu, alloced_mask); | 
|  | break; | 
|  | } | 
|  | } else { | 
|  | cpumask_set_cpu(cur_cpu, alloced_mask); | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | channel->target_cpu = cur_cpu; | 
|  | channel->target_vp = hv_cpu_number_to_vp_number(cur_cpu); | 
|  |  | 
|  | spin_unlock(&bind_channel_to_cpu_lock); | 
|  |  | 
|  | free_cpumask_var(available_mask); | 
|  | } | 
|  |  | 
|  | static void vmbus_wait_for_unload(void) | 
|  | { | 
|  | int cpu; | 
|  | void *page_addr; | 
|  | struct hv_message *msg; | 
|  | struct vmbus_channel_message_header *hdr; | 
|  | u32 message_type; | 
|  |  | 
|  | /* | 
|  | * CHANNELMSG_UNLOAD_RESPONSE is always delivered to the CPU which was | 
|  | * used for initial contact or to CPU0 depending on host version. When | 
|  | * we're crashing on a different CPU let's hope that IRQ handler on | 
|  | * the cpu which receives CHANNELMSG_UNLOAD_RESPONSE is still | 
|  | * functional and vmbus_unload_response() will complete | 
|  | * vmbus_connection.unload_event. If not, the last thing we can do is | 
|  | * read message pages for all CPUs directly. | 
|  | */ | 
|  | while (1) { | 
|  | if (completion_done(&vmbus_connection.unload_event)) | 
|  | break; | 
|  |  | 
|  | for_each_online_cpu(cpu) { | 
|  | struct hv_per_cpu_context *hv_cpu | 
|  | = per_cpu_ptr(hv_context.cpu_context, cpu); | 
|  |  | 
|  | page_addr = hv_cpu->synic_message_page; | 
|  | msg = (struct hv_message *)page_addr | 
|  | + VMBUS_MESSAGE_SINT; | 
|  |  | 
|  | message_type = READ_ONCE(msg->header.message_type); | 
|  | if (message_type == HVMSG_NONE) | 
|  | continue; | 
|  |  | 
|  | hdr = (struct vmbus_channel_message_header *) | 
|  | msg->u.payload; | 
|  |  | 
|  | if (hdr->msgtype == CHANNELMSG_UNLOAD_RESPONSE) | 
|  | complete(&vmbus_connection.unload_event); | 
|  |  | 
|  | vmbus_signal_eom(msg, message_type); | 
|  | } | 
|  |  | 
|  | mdelay(10); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * We're crashing and already got the UNLOAD_RESPONSE, cleanup all | 
|  | * maybe-pending messages on all CPUs to be able to receive new | 
|  | * messages after we reconnect. | 
|  | */ | 
|  | for_each_online_cpu(cpu) { | 
|  | struct hv_per_cpu_context *hv_cpu | 
|  | = per_cpu_ptr(hv_context.cpu_context, cpu); | 
|  |  | 
|  | page_addr = hv_cpu->synic_message_page; | 
|  | msg = (struct hv_message *)page_addr + VMBUS_MESSAGE_SINT; | 
|  | msg->header.message_type = HVMSG_NONE; | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_unload_response - Handler for the unload response. | 
|  | */ | 
|  | static void vmbus_unload_response(struct vmbus_channel_message_header *hdr) | 
|  | { | 
|  | /* | 
|  | * This is a global event; just wakeup the waiting thread. | 
|  | * Once we successfully unload, we can cleanup the monitor state. | 
|  | */ | 
|  | complete(&vmbus_connection.unload_event); | 
|  | } | 
|  |  | 
|  | void vmbus_initiate_unload(bool crash) | 
|  | { | 
|  | struct vmbus_channel_message_header hdr; | 
|  |  | 
|  | /* Pre-Win2012R2 hosts don't support reconnect */ | 
|  | if (vmbus_proto_version < VERSION_WIN8_1) | 
|  | return; | 
|  |  | 
|  | init_completion(&vmbus_connection.unload_event); | 
|  | memset(&hdr, 0, sizeof(struct vmbus_channel_message_header)); | 
|  | hdr.msgtype = CHANNELMSG_UNLOAD; | 
|  | vmbus_post_msg(&hdr, sizeof(struct vmbus_channel_message_header), | 
|  | !crash); | 
|  |  | 
|  | /* | 
|  | * vmbus_initiate_unload() is also called on crash and the crash can be | 
|  | * happening in an interrupt context, where scheduling is impossible. | 
|  | */ | 
|  | if (!crash) | 
|  | wait_for_completion(&vmbus_connection.unload_event); | 
|  | else | 
|  | vmbus_wait_for_unload(); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_onoffer - Handler for channel offers from vmbus in parent partition. | 
|  | * | 
|  | */ | 
|  | static void vmbus_onoffer(struct vmbus_channel_message_header *hdr) | 
|  | { | 
|  | struct vmbus_channel_offer_channel *offer; | 
|  | struct vmbus_channel *newchannel; | 
|  |  | 
|  | offer = (struct vmbus_channel_offer_channel *)hdr; | 
|  |  | 
|  | trace_vmbus_onoffer(offer); | 
|  |  | 
|  | /* Allocate the channel object and save this offer. */ | 
|  | newchannel = alloc_channel(); | 
|  | if (!newchannel) { | 
|  | vmbus_release_relid(offer->child_relid); | 
|  | atomic_dec(&vmbus_connection.offer_in_progress); | 
|  | pr_err("Unable to allocate channel object\n"); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Setup state for signalling the host. | 
|  | */ | 
|  | newchannel->sig_event = VMBUS_EVENT_CONNECTION_ID; | 
|  |  | 
|  | if (vmbus_proto_version != VERSION_WS2008) { | 
|  | newchannel->is_dedicated_interrupt = | 
|  | (offer->is_dedicated_interrupt != 0); | 
|  | newchannel->sig_event = offer->connection_id; | 
|  | } | 
|  |  | 
|  | memcpy(&newchannel->offermsg, offer, | 
|  | sizeof(struct vmbus_channel_offer_channel)); | 
|  | newchannel->monitor_grp = (u8)offer->monitorid / 32; | 
|  | newchannel->monitor_bit = (u8)offer->monitorid % 32; | 
|  |  | 
|  | vmbus_process_offer(newchannel); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_onoffer_rescind - Rescind offer handler. | 
|  | * | 
|  | * We queue a work item to process this offer synchronously | 
|  | */ | 
|  | static void vmbus_onoffer_rescind(struct vmbus_channel_message_header *hdr) | 
|  | { | 
|  | struct vmbus_channel_rescind_offer *rescind; | 
|  | struct vmbus_channel *channel; | 
|  | struct device *dev; | 
|  |  | 
|  | rescind = (struct vmbus_channel_rescind_offer *)hdr; | 
|  |  | 
|  | trace_vmbus_onoffer_rescind(rescind); | 
|  |  | 
|  | /* | 
|  | * The offer msg and the corresponding rescind msg | 
|  | * from the host are guranteed to be ordered - | 
|  | * offer comes in first and then the rescind. | 
|  | * Since we process these events in work elements, | 
|  | * and with preemption, we may end up processing | 
|  | * the events out of order. Given that we handle these | 
|  | * work elements on the same CPU, this is possible only | 
|  | * in the case of preemption. In any case wait here | 
|  | * until the offer processing has moved beyond the | 
|  | * point where the channel is discoverable. | 
|  | */ | 
|  |  | 
|  | while (atomic_read(&vmbus_connection.offer_in_progress) != 0) { | 
|  | /* | 
|  | * We wait here until any channel offer is currently | 
|  | * being processed. | 
|  | */ | 
|  | msleep(1); | 
|  | } | 
|  |  | 
|  | mutex_lock(&vmbus_connection.channel_mutex); | 
|  | channel = relid2channel(rescind->child_relid); | 
|  | mutex_unlock(&vmbus_connection.channel_mutex); | 
|  |  | 
|  | if (channel == NULL) { | 
|  | /* | 
|  | * We failed in processing the offer message; | 
|  | * we would have cleaned up the relid in that | 
|  | * failure path. | 
|  | */ | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Before setting channel->rescind in vmbus_rescind_cleanup(), we | 
|  | * should make sure the channel callback is not running any more. | 
|  | */ | 
|  | vmbus_reset_channel_cb(channel); | 
|  |  | 
|  | /* | 
|  | * Now wait for offer handling to complete. | 
|  | */ | 
|  | vmbus_rescind_cleanup(channel); | 
|  | while (READ_ONCE(channel->probe_done) == false) { | 
|  | /* | 
|  | * We wait here until any channel offer is currently | 
|  | * being processed. | 
|  | */ | 
|  | msleep(1); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * At this point, the rescind handling can proceed safely. | 
|  | */ | 
|  |  | 
|  | if (channel->device_obj) { | 
|  | if (channel->chn_rescind_callback) { | 
|  | channel->chn_rescind_callback(channel); | 
|  | return; | 
|  | } | 
|  | /* | 
|  | * We will have to unregister this device from the | 
|  | * driver core. | 
|  | */ | 
|  | dev = get_device(&channel->device_obj->device); | 
|  | if (dev) { | 
|  | vmbus_device_unregister(channel->device_obj); | 
|  | put_device(dev); | 
|  | } | 
|  | } | 
|  | if (channel->primary_channel != NULL) { | 
|  | /* | 
|  | * Sub-channel is being rescinded. Following is the channel | 
|  | * close sequence when initiated from the driveri (refer to | 
|  | * vmbus_close() for details): | 
|  | * 1. Close all sub-channels first | 
|  | * 2. Then close the primary channel. | 
|  | */ | 
|  | mutex_lock(&vmbus_connection.channel_mutex); | 
|  | if (channel->state == CHANNEL_OPEN_STATE) { | 
|  | /* | 
|  | * The channel is currently not open; | 
|  | * it is safe for us to cleanup the channel. | 
|  | */ | 
|  | hv_process_channel_removal(rescind->child_relid); | 
|  | } else { | 
|  | complete(&channel->rescind_event); | 
|  | } | 
|  | mutex_unlock(&vmbus_connection.channel_mutex); | 
|  | } | 
|  | } | 
|  |  | 
|  | void vmbus_hvsock_device_unregister(struct vmbus_channel *channel) | 
|  | { | 
|  | BUG_ON(!is_hvsock_channel(channel)); | 
|  |  | 
|  | /* We always get a rescind msg when a connection is closed. */ | 
|  | while (!READ_ONCE(channel->probe_done) || !READ_ONCE(channel->rescind)) | 
|  | msleep(1); | 
|  |  | 
|  | vmbus_device_unregister(channel->device_obj); | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vmbus_hvsock_device_unregister); | 
|  |  | 
|  |  | 
|  | /* | 
|  | * vmbus_onoffers_delivered - | 
|  | * This is invoked when all offers have been delivered. | 
|  | * | 
|  | * Nothing to do here. | 
|  | */ | 
|  | static void vmbus_onoffers_delivered( | 
|  | struct vmbus_channel_message_header *hdr) | 
|  | { | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_onopen_result - Open result handler. | 
|  | * | 
|  | * This is invoked when we received a response to our channel open request. | 
|  | * Find the matching request, copy the response and signal the requesting | 
|  | * thread. | 
|  | */ | 
|  | static void vmbus_onopen_result(struct vmbus_channel_message_header *hdr) | 
|  | { | 
|  | struct vmbus_channel_open_result *result; | 
|  | struct vmbus_channel_msginfo *msginfo; | 
|  | struct vmbus_channel_message_header *requestheader; | 
|  | struct vmbus_channel_open_channel *openmsg; | 
|  | unsigned long flags; | 
|  |  | 
|  | result = (struct vmbus_channel_open_result *)hdr; | 
|  |  | 
|  | trace_vmbus_onopen_result(result); | 
|  |  | 
|  | /* | 
|  | * Find the open msg, copy the result and signal/unblock the wait event | 
|  | */ | 
|  | spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
|  |  | 
|  | list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
|  | msglistentry) { | 
|  | requestheader = | 
|  | (struct vmbus_channel_message_header *)msginfo->msg; | 
|  |  | 
|  | if (requestheader->msgtype == CHANNELMSG_OPENCHANNEL) { | 
|  | openmsg = | 
|  | (struct vmbus_channel_open_channel *)msginfo->msg; | 
|  | if (openmsg->child_relid == result->child_relid && | 
|  | openmsg->openid == result->openid) { | 
|  | memcpy(&msginfo->response.open_result, | 
|  | result, | 
|  | sizeof( | 
|  | struct vmbus_channel_open_result)); | 
|  | complete(&msginfo->waitevent); | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  | spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_ongpadl_created - GPADL created handler. | 
|  | * | 
|  | * This is invoked when we received a response to our gpadl create request. | 
|  | * Find the matching request, copy the response and signal the requesting | 
|  | * thread. | 
|  | */ | 
|  | static void vmbus_ongpadl_created(struct vmbus_channel_message_header *hdr) | 
|  | { | 
|  | struct vmbus_channel_gpadl_created *gpadlcreated; | 
|  | struct vmbus_channel_msginfo *msginfo; | 
|  | struct vmbus_channel_message_header *requestheader; | 
|  | struct vmbus_channel_gpadl_header *gpadlheader; | 
|  | unsigned long flags; | 
|  |  | 
|  | gpadlcreated = (struct vmbus_channel_gpadl_created *)hdr; | 
|  |  | 
|  | trace_vmbus_ongpadl_created(gpadlcreated); | 
|  |  | 
|  | /* | 
|  | * Find the establish msg, copy the result and signal/unblock the wait | 
|  | * event | 
|  | */ | 
|  | spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
|  |  | 
|  | list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
|  | msglistentry) { | 
|  | requestheader = | 
|  | (struct vmbus_channel_message_header *)msginfo->msg; | 
|  |  | 
|  | if (requestheader->msgtype == CHANNELMSG_GPADL_HEADER) { | 
|  | gpadlheader = | 
|  | (struct vmbus_channel_gpadl_header *)requestheader; | 
|  |  | 
|  | if ((gpadlcreated->child_relid == | 
|  | gpadlheader->child_relid) && | 
|  | (gpadlcreated->gpadl == gpadlheader->gpadl)) { | 
|  | memcpy(&msginfo->response.gpadl_created, | 
|  | gpadlcreated, | 
|  | sizeof( | 
|  | struct vmbus_channel_gpadl_created)); | 
|  | complete(&msginfo->waitevent); | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  | spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_ongpadl_torndown - GPADL torndown handler. | 
|  | * | 
|  | * This is invoked when we received a response to our gpadl teardown request. | 
|  | * Find the matching request, copy the response and signal the requesting | 
|  | * thread. | 
|  | */ | 
|  | static void vmbus_ongpadl_torndown( | 
|  | struct vmbus_channel_message_header *hdr) | 
|  | { | 
|  | struct vmbus_channel_gpadl_torndown *gpadl_torndown; | 
|  | struct vmbus_channel_msginfo *msginfo; | 
|  | struct vmbus_channel_message_header *requestheader; | 
|  | struct vmbus_channel_gpadl_teardown *gpadl_teardown; | 
|  | unsigned long flags; | 
|  |  | 
|  | gpadl_torndown = (struct vmbus_channel_gpadl_torndown *)hdr; | 
|  |  | 
|  | trace_vmbus_ongpadl_torndown(gpadl_torndown); | 
|  |  | 
|  | /* | 
|  | * Find the open msg, copy the result and signal/unblock the wait event | 
|  | */ | 
|  | spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
|  |  | 
|  | list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
|  | msglistentry) { | 
|  | requestheader = | 
|  | (struct vmbus_channel_message_header *)msginfo->msg; | 
|  |  | 
|  | if (requestheader->msgtype == CHANNELMSG_GPADL_TEARDOWN) { | 
|  | gpadl_teardown = | 
|  | (struct vmbus_channel_gpadl_teardown *)requestheader; | 
|  |  | 
|  | if (gpadl_torndown->gpadl == gpadl_teardown->gpadl) { | 
|  | memcpy(&msginfo->response.gpadl_torndown, | 
|  | gpadl_torndown, | 
|  | sizeof( | 
|  | struct vmbus_channel_gpadl_torndown)); | 
|  | complete(&msginfo->waitevent); | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  | spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_onversion_response - Version response handler | 
|  | * | 
|  | * This is invoked when we received a response to our initiate contact request. | 
|  | * Find the matching request, copy the response and signal the requesting | 
|  | * thread. | 
|  | */ | 
|  | static void vmbus_onversion_response( | 
|  | struct vmbus_channel_message_header *hdr) | 
|  | { | 
|  | struct vmbus_channel_msginfo *msginfo; | 
|  | struct vmbus_channel_message_header *requestheader; | 
|  | struct vmbus_channel_version_response *version_response; | 
|  | unsigned long flags; | 
|  |  | 
|  | version_response = (struct vmbus_channel_version_response *)hdr; | 
|  |  | 
|  | trace_vmbus_onversion_response(version_response); | 
|  |  | 
|  | spin_lock_irqsave(&vmbus_connection.channelmsg_lock, flags); | 
|  |  | 
|  | list_for_each_entry(msginfo, &vmbus_connection.chn_msg_list, | 
|  | msglistentry) { | 
|  | requestheader = | 
|  | (struct vmbus_channel_message_header *)msginfo->msg; | 
|  |  | 
|  | if (requestheader->msgtype == | 
|  | CHANNELMSG_INITIATE_CONTACT) { | 
|  | memcpy(&msginfo->response.version_response, | 
|  | version_response, | 
|  | sizeof(struct vmbus_channel_version_response)); | 
|  | complete(&msginfo->waitevent); | 
|  | } | 
|  | } | 
|  | spin_unlock_irqrestore(&vmbus_connection.channelmsg_lock, flags); | 
|  | } | 
|  |  | 
|  | /* Channel message dispatch table */ | 
|  | const struct vmbus_channel_message_table_entry | 
|  | channel_message_table[CHANNELMSG_COUNT] = { | 
|  | { CHANNELMSG_INVALID,			0, NULL }, | 
|  | { CHANNELMSG_OFFERCHANNEL,		0, vmbus_onoffer }, | 
|  | { CHANNELMSG_RESCIND_CHANNELOFFER,	0, vmbus_onoffer_rescind }, | 
|  | { CHANNELMSG_REQUESTOFFERS,		0, NULL }, | 
|  | { CHANNELMSG_ALLOFFERS_DELIVERED,	1, vmbus_onoffers_delivered }, | 
|  | { CHANNELMSG_OPENCHANNEL,		0, NULL }, | 
|  | { CHANNELMSG_OPENCHANNEL_RESULT,	1, vmbus_onopen_result }, | 
|  | { CHANNELMSG_CLOSECHANNEL,		0, NULL }, | 
|  | { CHANNELMSG_GPADL_HEADER,		0, NULL }, | 
|  | { CHANNELMSG_GPADL_BODY,		0, NULL }, | 
|  | { CHANNELMSG_GPADL_CREATED,		1, vmbus_ongpadl_created }, | 
|  | { CHANNELMSG_GPADL_TEARDOWN,		0, NULL }, | 
|  | { CHANNELMSG_GPADL_TORNDOWN,		1, vmbus_ongpadl_torndown }, | 
|  | { CHANNELMSG_RELID_RELEASED,		0, NULL }, | 
|  | { CHANNELMSG_INITIATE_CONTACT,		0, NULL }, | 
|  | { CHANNELMSG_VERSION_RESPONSE,		1, vmbus_onversion_response }, | 
|  | { CHANNELMSG_UNLOAD,			0, NULL }, | 
|  | { CHANNELMSG_UNLOAD_RESPONSE,		1, vmbus_unload_response }, | 
|  | { CHANNELMSG_18,			0, NULL }, | 
|  | { CHANNELMSG_19,			0, NULL }, | 
|  | { CHANNELMSG_20,			0, NULL }, | 
|  | { CHANNELMSG_TL_CONNECT_REQUEST,	0, NULL }, | 
|  | }; | 
|  |  | 
|  | /* | 
|  | * vmbus_onmessage - Handler for channel protocol messages. | 
|  | * | 
|  | * This is invoked in the vmbus worker thread context. | 
|  | */ | 
|  | void vmbus_onmessage(void *context) | 
|  | { | 
|  | struct hv_message *msg = context; | 
|  | struct vmbus_channel_message_header *hdr; | 
|  | int size; | 
|  |  | 
|  | hdr = (struct vmbus_channel_message_header *)msg->u.payload; | 
|  | size = msg->header.payload_size; | 
|  |  | 
|  | trace_vmbus_on_message(hdr); | 
|  |  | 
|  | if (hdr->msgtype >= CHANNELMSG_COUNT) { | 
|  | pr_err("Received invalid channel message type %d size %d\n", | 
|  | hdr->msgtype, size); | 
|  | print_hex_dump_bytes("", DUMP_PREFIX_NONE, | 
|  | (unsigned char *)msg->u.payload, size); | 
|  | return; | 
|  | } | 
|  |  | 
|  | if (channel_message_table[hdr->msgtype].message_handler) | 
|  | channel_message_table[hdr->msgtype].message_handler(hdr); | 
|  | else | 
|  | pr_err("Unhandled channel message type %d\n", hdr->msgtype); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * vmbus_request_offers - Send a request to get all our pending offers. | 
|  | */ | 
|  | int vmbus_request_offers(void) | 
|  | { | 
|  | struct vmbus_channel_message_header *msg; | 
|  | struct vmbus_channel_msginfo *msginfo; | 
|  | int ret; | 
|  |  | 
|  | msginfo = kmalloc(sizeof(*msginfo) + | 
|  | sizeof(struct vmbus_channel_message_header), | 
|  | GFP_KERNEL); | 
|  | if (!msginfo) | 
|  | return -ENOMEM; | 
|  |  | 
|  | msg = (struct vmbus_channel_message_header *)msginfo->msg; | 
|  |  | 
|  | msg->msgtype = CHANNELMSG_REQUESTOFFERS; | 
|  |  | 
|  | ret = vmbus_post_msg(msg, sizeof(struct vmbus_channel_message_header), | 
|  | true); | 
|  |  | 
|  | trace_vmbus_request_offers(ret); | 
|  |  | 
|  | if (ret != 0) { | 
|  | pr_err("Unable to request offers - %d\n", ret); | 
|  |  | 
|  | goto cleanup; | 
|  | } | 
|  |  | 
|  | cleanup: | 
|  | kfree(msginfo); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Retrieve the (sub) channel on which to send an outgoing request. | 
|  | * When a primary channel has multiple sub-channels, we try to | 
|  | * distribute the load equally amongst all available channels. | 
|  | */ | 
|  | struct vmbus_channel *vmbus_get_outgoing_channel(struct vmbus_channel *primary) | 
|  | { | 
|  | struct list_head *cur, *tmp; | 
|  | int cur_cpu; | 
|  | struct vmbus_channel *cur_channel; | 
|  | struct vmbus_channel *outgoing_channel = primary; | 
|  | int next_channel; | 
|  | int i = 1; | 
|  |  | 
|  | if (list_empty(&primary->sc_list)) | 
|  | return outgoing_channel; | 
|  |  | 
|  | next_channel = primary->next_oc++; | 
|  |  | 
|  | if (next_channel > (primary->num_sc)) { | 
|  | primary->next_oc = 0; | 
|  | return outgoing_channel; | 
|  | } | 
|  |  | 
|  | cur_cpu = hv_cpu_number_to_vp_number(smp_processor_id()); | 
|  | list_for_each_safe(cur, tmp, &primary->sc_list) { | 
|  | cur_channel = list_entry(cur, struct vmbus_channel, sc_list); | 
|  | if (cur_channel->state != CHANNEL_OPENED_STATE) | 
|  | continue; | 
|  |  | 
|  | if (cur_channel->target_vp == cur_cpu) | 
|  | return cur_channel; | 
|  |  | 
|  | if (i == next_channel) | 
|  | return cur_channel; | 
|  |  | 
|  | i++; | 
|  | } | 
|  |  | 
|  | return outgoing_channel; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vmbus_get_outgoing_channel); | 
|  |  | 
|  | static void invoke_sc_cb(struct vmbus_channel *primary_channel) | 
|  | { | 
|  | struct list_head *cur, *tmp; | 
|  | struct vmbus_channel *cur_channel; | 
|  |  | 
|  | if (primary_channel->sc_creation_callback == NULL) | 
|  | return; | 
|  |  | 
|  | list_for_each_safe(cur, tmp, &primary_channel->sc_list) { | 
|  | cur_channel = list_entry(cur, struct vmbus_channel, sc_list); | 
|  |  | 
|  | primary_channel->sc_creation_callback(cur_channel); | 
|  | } | 
|  | } | 
|  |  | 
|  | void vmbus_set_sc_create_callback(struct vmbus_channel *primary_channel, | 
|  | void (*sc_cr_cb)(struct vmbus_channel *new_sc)) | 
|  | { | 
|  | primary_channel->sc_creation_callback = sc_cr_cb; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vmbus_set_sc_create_callback); | 
|  |  | 
|  | bool vmbus_are_subchannels_present(struct vmbus_channel *primary) | 
|  | { | 
|  | bool ret; | 
|  |  | 
|  | ret = !list_empty(&primary->sc_list); | 
|  |  | 
|  | if (ret) { | 
|  | /* | 
|  | * Invoke the callback on sub-channel creation. | 
|  | * This will present a uniform interface to the | 
|  | * clients. | 
|  | */ | 
|  | invoke_sc_cb(primary); | 
|  | } | 
|  |  | 
|  | return ret; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vmbus_are_subchannels_present); | 
|  |  | 
|  | void vmbus_set_chn_rescind_callback(struct vmbus_channel *channel, | 
|  | void (*chn_rescind_cb)(struct vmbus_channel *)) | 
|  | { | 
|  | channel->chn_rescind_callback = chn_rescind_cb; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vmbus_set_chn_rescind_callback); |