vmbus_heartbeat.c revision 302698
1/*- 2 * Copyright (c) 2014,2016 Microsoft Corp. 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice unmodified, this list of conditions, and the following 10 * disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 * 26 * $FreeBSD: head/sys/dev/hyperv/utilities/hv_heartbeat.c 302698 2016-07-13 05:01:12Z sephe $ 27 */ 28 29#include <sys/param.h> 30#include <sys/kernel.h> 31#include <sys/bus.h> 32#include <sys/malloc.h> 33#include <sys/module.h> 34#include <sys/timetc.h> 35#include <sys/syscallsubr.h> 36 37#include <dev/hyperv/include/hyperv.h> 38#include "hv_util.h" 39#include "vmbus_if.h" 40 41/* Heartbeat Service */ 42static const hv_guid service_guid = { .data = 43 {0x39, 0x4f, 0x16, 0x57, 0x15, 0x91, 0x78, 0x4e, 44 0xab, 0x55, 0x38, 0x2f, 0x3b, 0xd5, 0x42, 0x2d} }; 45 46/** 47 * Process heartbeat message 48 */ 49static void 50hv_heartbeat_cb(void *context) 51{ 52 uint8_t* buf; 53 hv_vmbus_channel* channel; 54 uint32_t recvlen; 55 uint64_t requestid; 56 int ret; 57 58 struct hv_vmbus_heartbeat_msg_data* heartbeat_msg; 59 struct hv_vmbus_icmsg_hdr* icmsghdrp; 60 hv_util_sc *softc; 61 62 softc = (hv_util_sc*)context; 63 buf = softc->receive_buffer; 64 channel = softc->hv_dev->channel; 65 66 ret = hv_vmbus_channel_recv_packet(channel, buf, PAGE_SIZE, &recvlen, 67 &requestid); 68 69 if ((ret == 0) && recvlen > 0) { 70 71 icmsghdrp = (struct hv_vmbus_icmsg_hdr *) 72 &buf[sizeof(struct hv_vmbus_pipe_hdr)]; 73 74 if (icmsghdrp->icmsgtype == HV_ICMSGTYPE_NEGOTIATE) { 75 hv_negotiate_version(icmsghdrp, NULL, buf); 76 77 } else { 78 heartbeat_msg = 79 (struct hv_vmbus_heartbeat_msg_data *) 80 &buf[sizeof(struct hv_vmbus_pipe_hdr) + 81 sizeof(struct hv_vmbus_icmsg_hdr)]; 82 83 heartbeat_msg->seq_num += 1; 84 } 85 86 icmsghdrp->icflags = HV_ICMSGHDRFLAG_TRANSACTION | 87 HV_ICMSGHDRFLAG_RESPONSE; 88 89 hv_vmbus_channel_send_packet(channel, buf, recvlen, requestid, 90 HV_VMBUS_PACKET_TYPE_DATA_IN_BAND, 0); 91 } 92} 93 94static int 95hv_heartbeat_probe(device_t dev) 96{ 97 if (resource_disabled("hvheartbeat", 0)) 98 return ENXIO; 99 100 if (VMBUS_PROBE_GUID(device_get_parent(dev), dev, &service_guid) == 0) { 101 device_set_desc(dev, "Hyper-V Heartbeat Service"); 102 return BUS_PROBE_DEFAULT; 103 } 104 return ENXIO; 105} 106 107static int 108hv_heartbeat_attach(device_t dev) 109{ 110 hv_util_sc *softc = (hv_util_sc*)device_get_softc(dev); 111 112 softc->callback = hv_heartbeat_cb; 113 114 return hv_util_attach(dev); 115} 116 117static device_method_t heartbeat_methods[] = { 118 /* Device interface */ 119 DEVMETHOD(device_probe, hv_heartbeat_probe), 120 DEVMETHOD(device_attach, hv_heartbeat_attach), 121 DEVMETHOD(device_detach, hv_util_detach), 122 { 0, 0 } 123}; 124 125static driver_t heartbeat_driver = { "hvheartbeat", heartbeat_methods, sizeof(hv_util_sc)}; 126 127static devclass_t heartbeat_devclass; 128 129DRIVER_MODULE(hv_heartbeat, vmbus, heartbeat_driver, heartbeat_devclass, NULL, NULL); 130MODULE_VERSION(hv_heartbeat, 1); 131MODULE_DEPEND(hv_heartbeat, vmbus, 1, 1, 1); 132