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
  37 #include <dev/hyperv/include/hyperv.h>
  38 #include "hv_util.h"
  39 #include "vmbus_if.h"
  40
  41 /* Heartbeat Service */
  42 static 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  */
  49 static void
  50 hv_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->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
  94 static int
  95 hv_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
 107 static int
 108 hv_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
 117 static 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
 125 static driver_t heartbeat_driver = { "hvheartbeat", heartbeat_methods, sizeof(hv_util_sc)};
 126
 127 static devclass_t heartbeat_devclass;
 128
 129 DRIVER_MODULE(hv_heartbeat, vmbus, heartbeat_driver, heartbeat_devclass, NULL, NULL);
 130 MODULE_VERSION(hv_heartbeat, 1);
 131 MODULE_DEPEND(hv_heartbeat, vmbus, 1, 1, 1);