Commit | Line | Data |
---|---|---|
c88c4e4c HJ |
1 | /* |
2 | * Copyright (c) 2010, 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> | |
20 | */ | |
af7a5b6e HJ |
21 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
22 | ||
c88c4e4c HJ |
23 | #include <linux/kernel.h> |
24 | #include <linux/init.h> | |
25 | #include <linux/module.h> | |
26 | #include <linux/slab.h> | |
27 | #include <linux/sysctl.h> | |
9e629075 | 28 | #include <linux/reboot.h> |
46a97191 | 29 | #include <linux/hyperv.h> |
c88c4e4c | 30 | |
a29b643c S |
31 | static void shutdown_onchannelcallback(void *context); |
32 | static struct hv_util_service util_shutdown = { | |
33 | .util_cb = shutdown_onchannelcallback, | |
34 | }; | |
35 | ||
36 | static void timesync_onchannelcallback(void *context); | |
37 | static struct hv_util_service util_timesynch = { | |
38 | .util_cb = timesync_onchannelcallback, | |
39 | }; | |
40 | ||
41 | static void heartbeat_onchannelcallback(void *context); | |
42 | static struct hv_util_service util_heartbeat = { | |
43 | .util_cb = heartbeat_onchannelcallback, | |
44 | }; | |
45 | ||
46 | static struct hv_util_service util_kvp = { | |
47 | .util_cb = hv_kvp_onchannelcallback, | |
48 | .util_init = hv_kvp_init, | |
49 | .util_deinit = hv_kvp_deinit, | |
50 | }; | |
c88c4e4c | 51 | |
6610944a | 52 | static void shutdown_onchannelcallback(void *context) |
c88c4e4c HJ |
53 | { |
54 | struct vmbus_channel *channel = context; | |
45241e50 | 55 | u32 recvlen; |
c88c4e4c HJ |
56 | u64 requestid; |
57 | u8 execute_shutdown = false; | |
a29b643c | 58 | u8 *shut_txf_buf = util_shutdown.recv_buffer; |
c88c4e4c HJ |
59 | |
60 | struct shutdown_msg_data *shutdown_msg; | |
61 | ||
62 | struct icmsg_hdr *icmsghdrp; | |
63 | struct icmsg_negotiate *negop = NULL; | |
64 | ||
45241e50 HJ |
65 | vmbus_recvpacket(channel, shut_txf_buf, |
66 | PAGE_SIZE, &recvlen, &requestid); | |
c88c4e4c HJ |
67 | |
68 | if (recvlen > 0) { | |
45241e50 | 69 | icmsghdrp = (struct icmsg_hdr *)&shut_txf_buf[ |
c88c4e4c HJ |
70 | sizeof(struct vmbuspipe_hdr)]; |
71 | ||
72 | if (icmsghdrp->icmsgtype == ICMSGTYPE_NEGOTIATE) { | |
c836d0ab S |
73 | vmbus_prep_negotiate_resp(icmsghdrp, negop, |
74 | shut_txf_buf, MAX_SRV_VER, MAX_SRV_VER); | |
c88c4e4c | 75 | } else { |
45241e50 HJ |
76 | shutdown_msg = |
77 | (struct shutdown_msg_data *)&shut_txf_buf[ | |
78 | sizeof(struct vmbuspipe_hdr) + | |
79 | sizeof(struct icmsg_hdr)]; | |
c88c4e4c HJ |
80 | |
81 | switch (shutdown_msg->flags) { | |
82 | case 0: | |
83 | case 1: | |
84 | icmsghdrp->status = HV_S_OK; | |
85 | execute_shutdown = true; | |
86 | ||
af7a5b6e | 87 | pr_info("Shutdown request received -" |
32235b07 | 88 | " graceful shutdown initiated\n"); |
c88c4e4c HJ |
89 | break; |
90 | default: | |
91 | icmsghdrp->status = HV_E_FAIL; | |
92 | execute_shutdown = false; | |
93 | ||
af7a5b6e HJ |
94 | pr_info("Shutdown request received -" |
95 | " Invalid request\n"); | |
c88c4e4c | 96 | break; |
95cd17c9 | 97 | } |
c88c4e4c HJ |
98 | } |
99 | ||
100 | icmsghdrp->icflags = ICMSGHDRFLAG_TRANSACTION | |
101 | | ICMSGHDRFLAG_RESPONSE; | |
102 | ||
45241e50 | 103 | vmbus_sendpacket(channel, shut_txf_buf, |
c88c4e4c | 104 | recvlen, requestid, |
415f2287 | 105 | VM_PKT_DATA_INBAND, 0); |
c88c4e4c HJ |
106 | } |
107 | ||
c88c4e4c | 108 | if (execute_shutdown == true) |
ae2a0b42 | 109 | orderly_poweroff(true); |
c88c4e4c HJ |
110 | } |
111 | ||
39c4e9c3 | 112 | /* |
e9ec3603 | 113 | * Set guest time to host UTC time. |
39c4e9c3 | 114 | */ |
e9ec3603 | 115 | static inline void do_adj_guesttime(u64 hosttime) |
39c4e9c3 HZ |
116 | { |
117 | s64 host_tns; | |
118 | struct timespec host_ts; | |
39c4e9c3 HZ |
119 | |
120 | host_tns = (hosttime - WLTIMEDELTA) * 100; | |
121 | host_ts = ns_to_timespec(host_tns); | |
122 | ||
e9ec3603 HZ |
123 | do_settimeofday(&host_ts); |
124 | } | |
125 | ||
95ff7cde S |
126 | /* |
127 | * Set the host time in a process context. | |
128 | */ | |
129 | ||
130 | struct adj_time_work { | |
131 | struct work_struct work; | |
132 | u64 host_time; | |
133 | }; | |
134 | ||
135 | static void hv_set_host_time(struct work_struct *work) | |
136 | { | |
137 | struct adj_time_work *wrk; | |
138 | ||
139 | wrk = container_of(work, struct adj_time_work, work); | |
140 | do_adj_guesttime(wrk->host_time); | |
141 | kfree(wrk); | |
142 | } | |
143 | ||
e9ec3603 HZ |
144 | /* |
145 | * Synchronize time with host after reboot, restore, etc. | |
146 | * | |
147 | * ICTIMESYNCFLAG_SYNC flag bit indicates reboot, restore events of the VM. | |
148 | * After reboot the flag ICTIMESYNCFLAG_SYNC is included in the first time | |
149 | * message after the timesync channel is opened. Since the hv_utils module is | |
150 | * loaded after hv_vmbus, the first message is usually missed. The other | |
151 | * thing is, systime is automatically set to emulated hardware clock which may | |
152 | * not be UTC time or in the same time zone. So, to override these effects, we | |
153 | * use the first 50 time samples for initial system time setting. | |
154 | */ | |
155 | static inline void adj_guesttime(u64 hosttime, u8 flags) | |
156 | { | |
95ff7cde | 157 | struct adj_time_work *wrk; |
e9ec3603 HZ |
158 | static s32 scnt = 50; |
159 | ||
95ff7cde S |
160 | wrk = kmalloc(sizeof(struct adj_time_work), GFP_ATOMIC); |
161 | if (wrk == NULL) | |
162 | return; | |
163 | ||
164 | wrk->host_time = hosttime; | |
39c4e9c3 | 165 | if ((flags & ICTIMESYNCFLAG_SYNC) != 0) { |
95ff7cde S |
166 | INIT_WORK(&wrk->work, hv_set_host_time); |
167 | schedule_work(&wrk->work); | |
39c4e9c3 HZ |
168 | return; |
169 | } | |
170 | ||
e9ec3603 | 171 | if ((flags & ICTIMESYNCFLAG_SAMPLE) != 0 && scnt > 0) { |
39c4e9c3 | 172 | scnt--; |
95ff7cde S |
173 | INIT_WORK(&wrk->work, hv_set_host_time); |
174 | schedule_work(&wrk->work); | |
175 | } else | |
176 | kfree(wrk); | |
39c4e9c3 HZ |
177 | } |
178 | ||
179 | /* | |
180 | * Time Sync Channel message handler. | |
181 | */ | |
182 | static void timesync_onchannelcallback(void *context) | |
183 | { | |
184 | struct vmbus_channel *channel = context; | |
45241e50 | 185 | u32 recvlen; |
39c4e9c3 HZ |
186 | u64 requestid; |
187 | struct icmsg_hdr *icmsghdrp; | |
188 | struct ictimesync_data *timedatap; | |
a29b643c | 189 | u8 *time_txf_buf = util_timesynch.recv_buffer; |
39c4e9c3 | 190 | |
45241e50 HJ |
191 | vmbus_recvpacket(channel, time_txf_buf, |
192 | PAGE_SIZE, &recvlen, &requestid); | |
39c4e9c3 HZ |
193 | |
194 | if (recvlen > 0) { | |
45241e50 | 195 | icmsghdrp = (struct icmsg_hdr *)&time_txf_buf[ |
39c4e9c3 HZ |
196 | sizeof(struct vmbuspipe_hdr)]; |
197 | ||
198 | if (icmsghdrp->icmsgtype == ICMSGTYPE_NEGOTIATE) { | |
c836d0ab S |
199 | vmbus_prep_negotiate_resp(icmsghdrp, NULL, time_txf_buf, |
200 | MAX_SRV_VER, MAX_SRV_VER); | |
39c4e9c3 | 201 | } else { |
45241e50 | 202 | timedatap = (struct ictimesync_data *)&time_txf_buf[ |
39c4e9c3 HZ |
203 | sizeof(struct vmbuspipe_hdr) + |
204 | sizeof(struct icmsg_hdr)]; | |
205 | adj_guesttime(timedatap->parenttime, timedatap->flags); | |
206 | } | |
207 | ||
208 | icmsghdrp->icflags = ICMSGHDRFLAG_TRANSACTION | |
209 | | ICMSGHDRFLAG_RESPONSE; | |
210 | ||
45241e50 | 211 | vmbus_sendpacket(channel, time_txf_buf, |
39c4e9c3 | 212 | recvlen, requestid, |
415f2287 | 213 | VM_PKT_DATA_INBAND, 0); |
39c4e9c3 | 214 | } |
39c4e9c3 HZ |
215 | } |
216 | ||
9153f7b9 HJ |
217 | /* |
218 | * Heartbeat functionality. | |
219 | * Every two seconds, Hyper-V send us a heartbeat request message. | |
220 | * we respond to this message, and Hyper-V knows we are alive. | |
221 | */ | |
222 | static void heartbeat_onchannelcallback(void *context) | |
223 | { | |
224 | struct vmbus_channel *channel = context; | |
45241e50 | 225 | u32 recvlen; |
9153f7b9 HJ |
226 | u64 requestid; |
227 | struct icmsg_hdr *icmsghdrp; | |
228 | struct heartbeat_msg_data *heartbeat_msg; | |
a29b643c | 229 | u8 *hbeat_txf_buf = util_heartbeat.recv_buffer; |
9153f7b9 | 230 | |
45241e50 HJ |
231 | vmbus_recvpacket(channel, hbeat_txf_buf, |
232 | PAGE_SIZE, &recvlen, &requestid); | |
9153f7b9 HJ |
233 | |
234 | if (recvlen > 0) { | |
45241e50 | 235 | icmsghdrp = (struct icmsg_hdr *)&hbeat_txf_buf[ |
9153f7b9 HJ |
236 | sizeof(struct vmbuspipe_hdr)]; |
237 | ||
238 | if (icmsghdrp->icmsgtype == ICMSGTYPE_NEGOTIATE) { | |
c836d0ab S |
239 | vmbus_prep_negotiate_resp(icmsghdrp, NULL, |
240 | hbeat_txf_buf, MAX_SRV_VER, MAX_SRV_VER); | |
9153f7b9 | 241 | } else { |
45241e50 HJ |
242 | heartbeat_msg = |
243 | (struct heartbeat_msg_data *)&hbeat_txf_buf[ | |
244 | sizeof(struct vmbuspipe_hdr) + | |
245 | sizeof(struct icmsg_hdr)]; | |
9153f7b9 | 246 | |
9153f7b9 HJ |
247 | heartbeat_msg->seq_num += 1; |
248 | } | |
249 | ||
250 | icmsghdrp->icflags = ICMSGHDRFLAG_TRANSACTION | |
251 | | ICMSGHDRFLAG_RESPONSE; | |
252 | ||
45241e50 | 253 | vmbus_sendpacket(channel, hbeat_txf_buf, |
9153f7b9 | 254 | recvlen, requestid, |
415f2287 | 255 | VM_PKT_DATA_INBAND, 0); |
9153f7b9 | 256 | } |
9153f7b9 | 257 | } |
39c4e9c3 | 258 | |
84946899 S |
259 | static int util_probe(struct hv_device *dev, |
260 | const struct hv_vmbus_device_id *dev_id) | |
283f2129 | 261 | { |
a29b643c S |
262 | struct hv_util_service *srv = |
263 | (struct hv_util_service *)dev_id->driver_data; | |
264 | int ret; | |
265 | ||
9b595780 | 266 | srv->recv_buffer = kmalloc(PAGE_SIZE * 2, GFP_KERNEL); |
a29b643c S |
267 | if (!srv->recv_buffer) |
268 | return -ENOMEM; | |
269 | if (srv->util_init) { | |
270 | ret = srv->util_init(srv); | |
271 | if (ret) { | |
4e65f6e8 S |
272 | ret = -ENODEV; |
273 | goto error1; | |
a29b643c S |
274 | } |
275 | } | |
276 | ||
9b595780 | 277 | ret = vmbus_open(dev->channel, 4 * PAGE_SIZE, 4 * PAGE_SIZE, NULL, 0, |
4e65f6e8 S |
278 | srv->util_cb, dev->channel); |
279 | if (ret) | |
280 | goto error; | |
281 | ||
a29b643c | 282 | hv_set_drvdata(dev, srv); |
283f2129 | 283 | return 0; |
4e65f6e8 S |
284 | |
285 | error: | |
286 | if (srv->util_deinit) | |
287 | srv->util_deinit(); | |
288 | error1: | |
289 | kfree(srv->recv_buffer); | |
290 | return ret; | |
283f2129 S |
291 | } |
292 | ||
293 | static int util_remove(struct hv_device *dev) | |
294 | { | |
a29b643c S |
295 | struct hv_util_service *srv = hv_get_drvdata(dev); |
296 | ||
4e65f6e8 | 297 | vmbus_close(dev->channel); |
a29b643c S |
298 | if (srv->util_deinit) |
299 | srv->util_deinit(); | |
300 | kfree(srv->recv_buffer); | |
301 | ||
283f2129 S |
302 | return 0; |
303 | } | |
304 | ||
305 | static const struct hv_vmbus_device_id id_table[] = { | |
c45cf2d4 GKH |
306 | /* Shutdown guid */ |
307 | { VMBUS_DEVICE(0x31, 0x60, 0x0B, 0X0E, 0x13, 0x52, 0x34, 0x49, | |
a29b643c S |
308 | 0x81, 0x8B, 0x38, 0XD9, 0x0C, 0xED, 0x39, 0xDB) |
309 | .driver_data = (unsigned long)&util_shutdown }, | |
c45cf2d4 GKH |
310 | /* Time synch guid */ |
311 | { VMBUS_DEVICE(0x30, 0xe6, 0x27, 0x95, 0xae, 0xd0, 0x7b, 0x49, | |
a29b643c S |
312 | 0xad, 0xce, 0xe8, 0x0a, 0xb0, 0x17, 0x5c, 0xaf) |
313 | .driver_data = (unsigned long)&util_timesynch }, | |
c45cf2d4 GKH |
314 | /* Heartbeat guid */ |
315 | { VMBUS_DEVICE(0x39, 0x4f, 0x16, 0x57, 0x15, 0x91, 0x78, 0x4e, | |
a29b643c S |
316 | 0xab, 0x55, 0x38, 0x2f, 0x3b, 0xd5, 0x42, 0x2d) |
317 | .driver_data = (unsigned long)&util_heartbeat }, | |
c45cf2d4 GKH |
318 | /* KVP guid */ |
319 | { VMBUS_DEVICE(0xe7, 0xf4, 0xa0, 0xa9, 0x45, 0x5a, 0x96, 0x4d, | |
a29b643c S |
320 | 0xb8, 0x27, 0x8a, 0x84, 0x1e, 0x8c, 0x3, 0xe6) |
321 | .driver_data = (unsigned long)&util_kvp }, | |
c45cf2d4 | 322 | { }, |
283f2129 S |
323 | }; |
324 | ||
325 | MODULE_DEVICE_TABLE(vmbus, id_table); | |
326 | ||
327 | /* The one and only one */ | |
328 | static struct hv_driver util_drv = { | |
768fa219 | 329 | .name = "hv_util", |
283f2129 S |
330 | .id_table = id_table, |
331 | .probe = util_probe, | |
332 | .remove = util_remove, | |
333 | }; | |
334 | ||
c88c4e4c HJ |
335 | static int __init init_hyperv_utils(void) |
336 | { | |
af7a5b6e | 337 | pr_info("Registering HyperV Utility Driver\n"); |
c88c4e4c | 338 | |
4e65f6e8 | 339 | return vmbus_driver_register(&util_drv); |
c88c4e4c HJ |
340 | } |
341 | ||
342 | static void exit_hyperv_utils(void) | |
343 | { | |
af7a5b6e | 344 | pr_info("De-Registered HyperV Utility Driver\n"); |
c88c4e4c | 345 | |
768fa219 | 346 | vmbus_driver_unregister(&util_drv); |
c88c4e4c HJ |
347 | } |
348 | ||
349 | module_init(init_hyperv_utils); | |
350 | module_exit(exit_hyperv_utils); | |
351 | ||
352 | MODULE_DESCRIPTION("Hyper-V Utilities"); | |
353 | MODULE_VERSION(HV_DRV_VERSION); | |
354 | MODULE_LICENSE("GPL"); |