sys/dev/hyperv/utilities/hv_heartbeat.c

   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$
  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 #include <sys/systm.h>
  37
  38 #include <dev/hyperv/include/hyperv.h>
  39 #include <dev/hyperv/include/vmbus.h>
  40 #include <dev/hyperv/utilities/hv_utilreg.h>
  41 #include "hv_util.h"
  42 #include "vmbus_if.h"
  43
  44 /* Heartbeat Service */
  45 static const struct hyperv_guid service_guid = { .hv_guid =
  46         {0x39, 0x4f, 0x16, 0x57, 0x15, 0x91, 0x78, 0x4e,
  47         0xab, 0x55, 0x38, 0x2f, 0x3b, 0xd5, 0x42, 0x2d} };
  48
  49 /**
  50  * Process heartbeat message
  51  */
  52 static void
  53 hv_heartbeat_cb(struct vmbus_channel *channel, void *context)
  54 {
  55         uint8_t*                buf;
  56         int                     recvlen;
  57         uint64_t                requestid;
  58         int                     ret;
  59
  60         struct hv_vmbus_heartbeat_msg_data*     heartbeat_msg;
  61         struct hv_vmbus_icmsg_hdr*              icmsghdrp;
  62         hv_util_sc                      *softc;
  63
  64         softc = (hv_util_sc*)context;
  65         buf = softc->receive_buffer;;
  66
  67         recvlen = PAGE_SIZE;
  68         ret = vmbus_chan_recv(channel, buf, &recvlen, &requestid);
  69         KASSERT(ret != ENOBUFS, ("hvheartbeat recvbuf is not large enough"));
  70         /* XXX check recvlen to make sure that it contains enough data */
  71
  72         if ((ret == 0) && recvlen > 0) {
  73
  74             icmsghdrp = (struct hv_vmbus_icmsg_hdr *)
  75                 &buf[sizeof(struct hv_vmbus_pipe_hdr)];
  76
  77             if (icmsghdrp->icmsgtype == HV_ICMSGTYPE_NEGOTIATE) {
  78                 hv_negotiate_version(icmsghdrp, NULL, buf);
  79
  80             } else {
  81                 heartbeat_msg =
  82                     (struct hv_vmbus_heartbeat_msg_data *)
  83                         &buf[sizeof(struct hv_vmbus_pipe_hdr) +
  84                              sizeof(struct hv_vmbus_icmsg_hdr)];
  85
  86                 heartbeat_msg->seq_num += 1;
  87             }
  88
  89             icmsghdrp->icflags = HV_ICMSGHDRFLAG_TRANSACTION |
  90                                  HV_ICMSGHDRFLAG_RESPONSE;
  91
  92             vmbus_chan_send(channel, VMBUS_CHANPKT_TYPE_INBAND, 0,
  93                 buf, recvlen, requestid);
  94         }
  95 }
  96
  97 static int
  98 hv_heartbeat_probe(device_t dev)
  99 {
 100         if (resource_disabled("hvheartbeat", 0))
 101                 return ENXIO;
 102
 103         if (VMBUS_PROBE_GUID(device_get_parent(dev), dev, &service_guid) == 0) {
 104                 device_set_desc(dev, "Hyper-V Heartbeat Service");
 105                 return BUS_PROBE_DEFAULT;
 106         }
 107         return ENXIO;
 108 }
 109
 110 static int
 111 hv_heartbeat_attach(device_t dev)
 112 {
 113         hv_util_sc *softc = (hv_util_sc*)device_get_softc(dev);
 114
 115         softc->callback = hv_heartbeat_cb;
 116
 117         return hv_util_attach(dev);
 118 }
 119
 120 static device_method_t heartbeat_methods[] = {
 121         /* Device interface */
 122         DEVMETHOD(device_probe, hv_heartbeat_probe),
 123         DEVMETHOD(device_attach, hv_heartbeat_attach),
 124         DEVMETHOD(device_detach, hv_util_detach),
 125         { 0, 0 }
 126 };
 127
 128 static driver_t heartbeat_driver = { "hvheartbeat", heartbeat_methods, sizeof(hv_util_sc)};
 129
 130 static devclass_t heartbeat_devclass;
 131
 132 DRIVER_MODULE(hv_heartbeat, vmbus, heartbeat_driver, heartbeat_devclass, NULL, NULL);
 133 MODULE_VERSION(hv_heartbeat, 1);
 134 MODULE_DEPEND(hv_heartbeat, vmbus, 1, 1, 1);