Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[platform/kernel/linux-starfive.git] / drivers / hv / vmbus_drv.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (c) 2009, Microsoft Corporation.
4  *
5  * Authors:
6  *   Haiyang Zhang <haiyangz@microsoft.com>
7  *   Hank Janssen  <hjanssen@microsoft.com>
8  *   K. Y. Srinivasan <kys@microsoft.com>
9  */
10 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
11
12 #include <linux/init.h>
13 #include <linux/module.h>
14 #include <linux/device.h>
15 #include <linux/interrupt.h>
16 #include <linux/sysctl.h>
17 #include <linux/slab.h>
18 #include <linux/acpi.h>
19 #include <linux/completion.h>
20 #include <linux/hyperv.h>
21 #include <linux/kernel_stat.h>
22 #include <linux/clockchips.h>
23 #include <linux/cpu.h>
24 #include <linux/sched/task_stack.h>
25
26 #include <asm/mshyperv.h>
27 #include <linux/delay.h>
28 #include <linux/notifier.h>
29 #include <linux/ptrace.h>
30 #include <linux/screen_info.h>
31 #include <linux/kdebug.h>
32 #include <linux/efi.h>
33 #include <linux/random.h>
34 #include <linux/syscore_ops.h>
35 #include <clocksource/hyperv_timer.h>
36 #include "hyperv_vmbus.h"
37
38 struct vmbus_dynid {
39         struct list_head node;
40         struct hv_vmbus_device_id id;
41 };
42
43 static struct acpi_device  *hv_acpi_dev;
44
45 static struct completion probe_event;
46
47 static int hyperv_cpuhp_online;
48
49 static void *hv_panic_page;
50
51 static int hyperv_panic_event(struct notifier_block *nb, unsigned long val,
52                               void *args)
53 {
54         struct pt_regs *regs;
55
56         regs = current_pt_regs();
57
58         hyperv_report_panic(regs, val);
59         return NOTIFY_DONE;
60 }
61
62 static int hyperv_die_event(struct notifier_block *nb, unsigned long val,
63                             void *args)
64 {
65         struct die_args *die = (struct die_args *)args;
66         struct pt_regs *regs = die->regs;
67
68         hyperv_report_panic(regs, val);
69         return NOTIFY_DONE;
70 }
71
72 static struct notifier_block hyperv_die_block = {
73         .notifier_call = hyperv_die_event,
74 };
75 static struct notifier_block hyperv_panic_block = {
76         .notifier_call = hyperv_panic_event,
77 };
78
79 static const char *fb_mmio_name = "fb_range";
80 static struct resource *fb_mmio;
81 static struct resource *hyperv_mmio;
82 static DEFINE_MUTEX(hyperv_mmio_lock);
83
84 static int vmbus_exists(void)
85 {
86         if (hv_acpi_dev == NULL)
87                 return -ENODEV;
88
89         return 0;
90 }
91
92 #define VMBUS_ALIAS_LEN ((sizeof((struct hv_vmbus_device_id *)0)->guid) * 2)
93 static void print_alias_name(struct hv_device *hv_dev, char *alias_name)
94 {
95         int i;
96         for (i = 0; i < VMBUS_ALIAS_LEN; i += 2)
97                 sprintf(&alias_name[i], "%02x", hv_dev->dev_type.b[i/2]);
98 }
99
100 static u8 channel_monitor_group(const struct vmbus_channel *channel)
101 {
102         return (u8)channel->offermsg.monitorid / 32;
103 }
104
105 static u8 channel_monitor_offset(const struct vmbus_channel *channel)
106 {
107         return (u8)channel->offermsg.monitorid % 32;
108 }
109
110 static u32 channel_pending(const struct vmbus_channel *channel,
111                            const struct hv_monitor_page *monitor_page)
112 {
113         u8 monitor_group = channel_monitor_group(channel);
114
115         return monitor_page->trigger_group[monitor_group].pending;
116 }
117
118 static u32 channel_latency(const struct vmbus_channel *channel,
119                            const struct hv_monitor_page *monitor_page)
120 {
121         u8 monitor_group = channel_monitor_group(channel);
122         u8 monitor_offset = channel_monitor_offset(channel);
123
124         return monitor_page->latency[monitor_group][monitor_offset];
125 }
126
127 static u32 channel_conn_id(struct vmbus_channel *channel,
128                            struct hv_monitor_page *monitor_page)
129 {
130         u8 monitor_group = channel_monitor_group(channel);
131         u8 monitor_offset = channel_monitor_offset(channel);
132         return monitor_page->parameter[monitor_group][monitor_offset].connectionid.u.id;
133 }
134
135 static ssize_t id_show(struct device *dev, struct device_attribute *dev_attr,
136                        char *buf)
137 {
138         struct hv_device *hv_dev = device_to_hv_device(dev);
139
140         if (!hv_dev->channel)
141                 return -ENODEV;
142         return sprintf(buf, "%d\n", hv_dev->channel->offermsg.child_relid);
143 }
144 static DEVICE_ATTR_RO(id);
145
146 static ssize_t state_show(struct device *dev, struct device_attribute *dev_attr,
147                           char *buf)
148 {
149         struct hv_device *hv_dev = device_to_hv_device(dev);
150
151         if (!hv_dev->channel)
152                 return -ENODEV;
153         return sprintf(buf, "%d\n", hv_dev->channel->state);
154 }
155 static DEVICE_ATTR_RO(state);
156
157 static ssize_t monitor_id_show(struct device *dev,
158                                struct device_attribute *dev_attr, char *buf)
159 {
160         struct hv_device *hv_dev = device_to_hv_device(dev);
161
162         if (!hv_dev->channel)
163                 return -ENODEV;
164         return sprintf(buf, "%d\n", hv_dev->channel->offermsg.monitorid);
165 }
166 static DEVICE_ATTR_RO(monitor_id);
167
168 static ssize_t class_id_show(struct device *dev,
169                                struct device_attribute *dev_attr, char *buf)
170 {
171         struct hv_device *hv_dev = device_to_hv_device(dev);
172
173         if (!hv_dev->channel)
174                 return -ENODEV;
175         return sprintf(buf, "{%pUl}\n",
176                        hv_dev->channel->offermsg.offer.if_type.b);
177 }
178 static DEVICE_ATTR_RO(class_id);
179
180 static ssize_t device_id_show(struct device *dev,
181                               struct device_attribute *dev_attr, char *buf)
182 {
183         struct hv_device *hv_dev = device_to_hv_device(dev);
184
185         if (!hv_dev->channel)
186                 return -ENODEV;
187         return sprintf(buf, "{%pUl}\n",
188                        hv_dev->channel->offermsg.offer.if_instance.b);
189 }
190 static DEVICE_ATTR_RO(device_id);
191
192 static ssize_t modalias_show(struct device *dev,
193                              struct device_attribute *dev_attr, char *buf)
194 {
195         struct hv_device *hv_dev = device_to_hv_device(dev);
196         char alias_name[VMBUS_ALIAS_LEN + 1];
197
198         print_alias_name(hv_dev, alias_name);
199         return sprintf(buf, "vmbus:%s\n", alias_name);
200 }
201 static DEVICE_ATTR_RO(modalias);
202
203 #ifdef CONFIG_NUMA
204 static ssize_t numa_node_show(struct device *dev,
205                               struct device_attribute *attr, char *buf)
206 {
207         struct hv_device *hv_dev = device_to_hv_device(dev);
208
209         if (!hv_dev->channel)
210                 return -ENODEV;
211
212         return sprintf(buf, "%d\n", hv_dev->channel->numa_node);
213 }
214 static DEVICE_ATTR_RO(numa_node);
215 #endif
216
217 static ssize_t server_monitor_pending_show(struct device *dev,
218                                            struct device_attribute *dev_attr,
219                                            char *buf)
220 {
221         struct hv_device *hv_dev = device_to_hv_device(dev);
222
223         if (!hv_dev->channel)
224                 return -ENODEV;
225         return sprintf(buf, "%d\n",
226                        channel_pending(hv_dev->channel,
227                                        vmbus_connection.monitor_pages[0]));
228 }
229 static DEVICE_ATTR_RO(server_monitor_pending);
230
231 static ssize_t client_monitor_pending_show(struct device *dev,
232                                            struct device_attribute *dev_attr,
233                                            char *buf)
234 {
235         struct hv_device *hv_dev = device_to_hv_device(dev);
236
237         if (!hv_dev->channel)
238                 return -ENODEV;
239         return sprintf(buf, "%d\n",
240                        channel_pending(hv_dev->channel,
241                                        vmbus_connection.monitor_pages[1]));
242 }
243 static DEVICE_ATTR_RO(client_monitor_pending);
244
245 static ssize_t server_monitor_latency_show(struct device *dev,
246                                            struct device_attribute *dev_attr,
247                                            char *buf)
248 {
249         struct hv_device *hv_dev = device_to_hv_device(dev);
250
251         if (!hv_dev->channel)
252                 return -ENODEV;
253         return sprintf(buf, "%d\n",
254                        channel_latency(hv_dev->channel,
255                                        vmbus_connection.monitor_pages[0]));
256 }
257 static DEVICE_ATTR_RO(server_monitor_latency);
258
259 static ssize_t client_monitor_latency_show(struct device *dev,
260                                            struct device_attribute *dev_attr,
261                                            char *buf)
262 {
263         struct hv_device *hv_dev = device_to_hv_device(dev);
264
265         if (!hv_dev->channel)
266                 return -ENODEV;
267         return sprintf(buf, "%d\n",
268                        channel_latency(hv_dev->channel,
269                                        vmbus_connection.monitor_pages[1]));
270 }
271 static DEVICE_ATTR_RO(client_monitor_latency);
272
273 static ssize_t server_monitor_conn_id_show(struct device *dev,
274                                            struct device_attribute *dev_attr,
275                                            char *buf)
276 {
277         struct hv_device *hv_dev = device_to_hv_device(dev);
278
279         if (!hv_dev->channel)
280                 return -ENODEV;
281         return sprintf(buf, "%d\n",
282                        channel_conn_id(hv_dev->channel,
283                                        vmbus_connection.monitor_pages[0]));
284 }
285 static DEVICE_ATTR_RO(server_monitor_conn_id);
286
287 static ssize_t client_monitor_conn_id_show(struct device *dev,
288                                            struct device_attribute *dev_attr,
289                                            char *buf)
290 {
291         struct hv_device *hv_dev = device_to_hv_device(dev);
292
293         if (!hv_dev->channel)
294                 return -ENODEV;
295         return sprintf(buf, "%d\n",
296                        channel_conn_id(hv_dev->channel,
297                                        vmbus_connection.monitor_pages[1]));
298 }
299 static DEVICE_ATTR_RO(client_monitor_conn_id);
300
301 static ssize_t out_intr_mask_show(struct device *dev,
302                                   struct device_attribute *dev_attr, char *buf)
303 {
304         struct hv_device *hv_dev = device_to_hv_device(dev);
305         struct hv_ring_buffer_debug_info outbound;
306         int ret;
307
308         if (!hv_dev->channel)
309                 return -ENODEV;
310
311         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->outbound,
312                                           &outbound);
313         if (ret < 0)
314                 return ret;
315
316         return sprintf(buf, "%d\n", outbound.current_interrupt_mask);
317 }
318 static DEVICE_ATTR_RO(out_intr_mask);
319
320 static ssize_t out_read_index_show(struct device *dev,
321                                    struct device_attribute *dev_attr, char *buf)
322 {
323         struct hv_device *hv_dev = device_to_hv_device(dev);
324         struct hv_ring_buffer_debug_info outbound;
325         int ret;
326
327         if (!hv_dev->channel)
328                 return -ENODEV;
329
330         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->outbound,
331                                           &outbound);
332         if (ret < 0)
333                 return ret;
334         return sprintf(buf, "%d\n", outbound.current_read_index);
335 }
336 static DEVICE_ATTR_RO(out_read_index);
337
338 static ssize_t out_write_index_show(struct device *dev,
339                                     struct device_attribute *dev_attr,
340                                     char *buf)
341 {
342         struct hv_device *hv_dev = device_to_hv_device(dev);
343         struct hv_ring_buffer_debug_info outbound;
344         int ret;
345
346         if (!hv_dev->channel)
347                 return -ENODEV;
348
349         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->outbound,
350                                           &outbound);
351         if (ret < 0)
352                 return ret;
353         return sprintf(buf, "%d\n", outbound.current_write_index);
354 }
355 static DEVICE_ATTR_RO(out_write_index);
356
357 static ssize_t out_read_bytes_avail_show(struct device *dev,
358                                          struct device_attribute *dev_attr,
359                                          char *buf)
360 {
361         struct hv_device *hv_dev = device_to_hv_device(dev);
362         struct hv_ring_buffer_debug_info outbound;
363         int ret;
364
365         if (!hv_dev->channel)
366                 return -ENODEV;
367
368         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->outbound,
369                                           &outbound);
370         if (ret < 0)
371                 return ret;
372         return sprintf(buf, "%d\n", outbound.bytes_avail_toread);
373 }
374 static DEVICE_ATTR_RO(out_read_bytes_avail);
375
376 static ssize_t out_write_bytes_avail_show(struct device *dev,
377                                           struct device_attribute *dev_attr,
378                                           char *buf)
379 {
380         struct hv_device *hv_dev = device_to_hv_device(dev);
381         struct hv_ring_buffer_debug_info outbound;
382         int ret;
383
384         if (!hv_dev->channel)
385                 return -ENODEV;
386
387         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->outbound,
388                                           &outbound);
389         if (ret < 0)
390                 return ret;
391         return sprintf(buf, "%d\n", outbound.bytes_avail_towrite);
392 }
393 static DEVICE_ATTR_RO(out_write_bytes_avail);
394
395 static ssize_t in_intr_mask_show(struct device *dev,
396                                  struct device_attribute *dev_attr, char *buf)
397 {
398         struct hv_device *hv_dev = device_to_hv_device(dev);
399         struct hv_ring_buffer_debug_info inbound;
400         int ret;
401
402         if (!hv_dev->channel)
403                 return -ENODEV;
404
405         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->inbound, &inbound);
406         if (ret < 0)
407                 return ret;
408
409         return sprintf(buf, "%d\n", inbound.current_interrupt_mask);
410 }
411 static DEVICE_ATTR_RO(in_intr_mask);
412
413 static ssize_t in_read_index_show(struct device *dev,
414                                   struct device_attribute *dev_attr, char *buf)
415 {
416         struct hv_device *hv_dev = device_to_hv_device(dev);
417         struct hv_ring_buffer_debug_info inbound;
418         int ret;
419
420         if (!hv_dev->channel)
421                 return -ENODEV;
422
423         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->inbound, &inbound);
424         if (ret < 0)
425                 return ret;
426
427         return sprintf(buf, "%d\n", inbound.current_read_index);
428 }
429 static DEVICE_ATTR_RO(in_read_index);
430
431 static ssize_t in_write_index_show(struct device *dev,
432                                    struct device_attribute *dev_attr, char *buf)
433 {
434         struct hv_device *hv_dev = device_to_hv_device(dev);
435         struct hv_ring_buffer_debug_info inbound;
436         int ret;
437
438         if (!hv_dev->channel)
439                 return -ENODEV;
440
441         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->inbound, &inbound);
442         if (ret < 0)
443                 return ret;
444
445         return sprintf(buf, "%d\n", inbound.current_write_index);
446 }
447 static DEVICE_ATTR_RO(in_write_index);
448
449 static ssize_t in_read_bytes_avail_show(struct device *dev,
450                                         struct device_attribute *dev_attr,
451                                         char *buf)
452 {
453         struct hv_device *hv_dev = device_to_hv_device(dev);
454         struct hv_ring_buffer_debug_info inbound;
455         int ret;
456
457         if (!hv_dev->channel)
458                 return -ENODEV;
459
460         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->inbound, &inbound);
461         if (ret < 0)
462                 return ret;
463
464         return sprintf(buf, "%d\n", inbound.bytes_avail_toread);
465 }
466 static DEVICE_ATTR_RO(in_read_bytes_avail);
467
468 static ssize_t in_write_bytes_avail_show(struct device *dev,
469                                          struct device_attribute *dev_attr,
470                                          char *buf)
471 {
472         struct hv_device *hv_dev = device_to_hv_device(dev);
473         struct hv_ring_buffer_debug_info inbound;
474         int ret;
475
476         if (!hv_dev->channel)
477                 return -ENODEV;
478
479         ret = hv_ringbuffer_get_debuginfo(&hv_dev->channel->inbound, &inbound);
480         if (ret < 0)
481                 return ret;
482
483         return sprintf(buf, "%d\n", inbound.bytes_avail_towrite);
484 }
485 static DEVICE_ATTR_RO(in_write_bytes_avail);
486
487 static ssize_t channel_vp_mapping_show(struct device *dev,
488                                        struct device_attribute *dev_attr,
489                                        char *buf)
490 {
491         struct hv_device *hv_dev = device_to_hv_device(dev);
492         struct vmbus_channel *channel = hv_dev->channel, *cur_sc;
493         unsigned long flags;
494         int buf_size = PAGE_SIZE, n_written, tot_written;
495         struct list_head *cur;
496
497         if (!channel)
498                 return -ENODEV;
499
500         tot_written = snprintf(buf, buf_size, "%u:%u\n",
501                 channel->offermsg.child_relid, channel->target_cpu);
502
503         spin_lock_irqsave(&channel->lock, flags);
504
505         list_for_each(cur, &channel->sc_list) {
506                 if (tot_written >= buf_size - 1)
507                         break;
508
509                 cur_sc = list_entry(cur, struct vmbus_channel, sc_list);
510                 n_written = scnprintf(buf + tot_written,
511                                      buf_size - tot_written,
512                                      "%u:%u\n",
513                                      cur_sc->offermsg.child_relid,
514                                      cur_sc->target_cpu);
515                 tot_written += n_written;
516         }
517
518         spin_unlock_irqrestore(&channel->lock, flags);
519
520         return tot_written;
521 }
522 static DEVICE_ATTR_RO(channel_vp_mapping);
523
524 static ssize_t vendor_show(struct device *dev,
525                            struct device_attribute *dev_attr,
526                            char *buf)
527 {
528         struct hv_device *hv_dev = device_to_hv_device(dev);
529         return sprintf(buf, "0x%x\n", hv_dev->vendor_id);
530 }
531 static DEVICE_ATTR_RO(vendor);
532
533 static ssize_t device_show(struct device *dev,
534                            struct device_attribute *dev_attr,
535                            char *buf)
536 {
537         struct hv_device *hv_dev = device_to_hv_device(dev);
538         return sprintf(buf, "0x%x\n", hv_dev->device_id);
539 }
540 static DEVICE_ATTR_RO(device);
541
542 static ssize_t driver_override_store(struct device *dev,
543                                      struct device_attribute *attr,
544                                      const char *buf, size_t count)
545 {
546         struct hv_device *hv_dev = device_to_hv_device(dev);
547         char *driver_override, *old, *cp;
548
549         /* We need to keep extra room for a newline */
550         if (count >= (PAGE_SIZE - 1))
551                 return -EINVAL;
552
553         driver_override = kstrndup(buf, count, GFP_KERNEL);
554         if (!driver_override)
555                 return -ENOMEM;
556
557         cp = strchr(driver_override, '\n');
558         if (cp)
559                 *cp = '\0';
560
561         device_lock(dev);
562         old = hv_dev->driver_override;
563         if (strlen(driver_override)) {
564                 hv_dev->driver_override = driver_override;
565         } else {
566                 kfree(driver_override);
567                 hv_dev->driver_override = NULL;
568         }
569         device_unlock(dev);
570
571         kfree(old);
572
573         return count;
574 }
575
576 static ssize_t driver_override_show(struct device *dev,
577                                     struct device_attribute *attr, char *buf)
578 {
579         struct hv_device *hv_dev = device_to_hv_device(dev);
580         ssize_t len;
581
582         device_lock(dev);
583         len = snprintf(buf, PAGE_SIZE, "%s\n", hv_dev->driver_override);
584         device_unlock(dev);
585
586         return len;
587 }
588 static DEVICE_ATTR_RW(driver_override);
589
590 /* Set up per device attributes in /sys/bus/vmbus/devices/<bus device> */
591 static struct attribute *vmbus_dev_attrs[] = {
592         &dev_attr_id.attr,
593         &dev_attr_state.attr,
594         &dev_attr_monitor_id.attr,
595         &dev_attr_class_id.attr,
596         &dev_attr_device_id.attr,
597         &dev_attr_modalias.attr,
598 #ifdef CONFIG_NUMA
599         &dev_attr_numa_node.attr,
600 #endif
601         &dev_attr_server_monitor_pending.attr,
602         &dev_attr_client_monitor_pending.attr,
603         &dev_attr_server_monitor_latency.attr,
604         &dev_attr_client_monitor_latency.attr,
605         &dev_attr_server_monitor_conn_id.attr,
606         &dev_attr_client_monitor_conn_id.attr,
607         &dev_attr_out_intr_mask.attr,
608         &dev_attr_out_read_index.attr,
609         &dev_attr_out_write_index.attr,
610         &dev_attr_out_read_bytes_avail.attr,
611         &dev_attr_out_write_bytes_avail.attr,
612         &dev_attr_in_intr_mask.attr,
613         &dev_attr_in_read_index.attr,
614         &dev_attr_in_write_index.attr,
615         &dev_attr_in_read_bytes_avail.attr,
616         &dev_attr_in_write_bytes_avail.attr,
617         &dev_attr_channel_vp_mapping.attr,
618         &dev_attr_vendor.attr,
619         &dev_attr_device.attr,
620         &dev_attr_driver_override.attr,
621         NULL,
622 };
623
624 /*
625  * Device-level attribute_group callback function. Returns the permission for
626  * each attribute, and returns 0 if an attribute is not visible.
627  */
628 static umode_t vmbus_dev_attr_is_visible(struct kobject *kobj,
629                                          struct attribute *attr, int idx)
630 {
631         struct device *dev = kobj_to_dev(kobj);
632         const struct hv_device *hv_dev = device_to_hv_device(dev);
633
634         /* Hide the monitor attributes if the monitor mechanism is not used. */
635         if (!hv_dev->channel->offermsg.monitor_allocated &&
636             (attr == &dev_attr_monitor_id.attr ||
637              attr == &dev_attr_server_monitor_pending.attr ||
638              attr == &dev_attr_client_monitor_pending.attr ||
639              attr == &dev_attr_server_monitor_latency.attr ||
640              attr == &dev_attr_client_monitor_latency.attr ||
641              attr == &dev_attr_server_monitor_conn_id.attr ||
642              attr == &dev_attr_client_monitor_conn_id.attr))
643                 return 0;
644
645         return attr->mode;
646 }
647
648 static const struct attribute_group vmbus_dev_group = {
649         .attrs = vmbus_dev_attrs,
650         .is_visible = vmbus_dev_attr_is_visible
651 };
652 __ATTRIBUTE_GROUPS(vmbus_dev);
653
654 /*
655  * vmbus_uevent - add uevent for our device
656  *
657  * This routine is invoked when a device is added or removed on the vmbus to
658  * generate a uevent to udev in the userspace. The udev will then look at its
659  * rule and the uevent generated here to load the appropriate driver
660  *
661  * The alias string will be of the form vmbus:guid where guid is the string
662  * representation of the device guid (each byte of the guid will be
663  * represented with two hex characters.
664  */
665 static int vmbus_uevent(struct device *device, struct kobj_uevent_env *env)
666 {
667         struct hv_device *dev = device_to_hv_device(device);
668         int ret;
669         char alias_name[VMBUS_ALIAS_LEN + 1];
670
671         print_alias_name(dev, alias_name);
672         ret = add_uevent_var(env, "MODALIAS=vmbus:%s", alias_name);
673         return ret;
674 }
675
676 static const struct hv_vmbus_device_id *
677 hv_vmbus_dev_match(const struct hv_vmbus_device_id *id, const guid_t *guid)
678 {
679         if (id == NULL)
680                 return NULL; /* empty device table */
681
682         for (; !guid_is_null(&id->guid); id++)
683                 if (guid_equal(&id->guid, guid))
684                         return id;
685
686         return NULL;
687 }
688
689 static const struct hv_vmbus_device_id *
690 hv_vmbus_dynid_match(struct hv_driver *drv, const guid_t *guid)
691 {
692         const struct hv_vmbus_device_id *id = NULL;
693         struct vmbus_dynid *dynid;
694
695         spin_lock(&drv->dynids.lock);
696         list_for_each_entry(dynid, &drv->dynids.list, node) {
697                 if (guid_equal(&dynid->id.guid, guid)) {
698                         id = &dynid->id;
699                         break;
700                 }
701         }
702         spin_unlock(&drv->dynids.lock);
703
704         return id;
705 }
706
707 static const struct hv_vmbus_device_id vmbus_device_null;
708
709 /*
710  * Return a matching hv_vmbus_device_id pointer.
711  * If there is no match, return NULL.
712  */
713 static const struct hv_vmbus_device_id *hv_vmbus_get_id(struct hv_driver *drv,
714                                                         struct hv_device *dev)
715 {
716         const guid_t *guid = &dev->dev_type;
717         const struct hv_vmbus_device_id *id;
718
719         /* When driver_override is set, only bind to the matching driver */
720         if (dev->driver_override && strcmp(dev->driver_override, drv->name))
721                 return NULL;
722
723         /* Look at the dynamic ids first, before the static ones */
724         id = hv_vmbus_dynid_match(drv, guid);
725         if (!id)
726                 id = hv_vmbus_dev_match(drv->id_table, guid);
727
728         /* driver_override will always match, send a dummy id */
729         if (!id && dev->driver_override)
730                 id = &vmbus_device_null;
731
732         return id;
733 }
734
735 /* vmbus_add_dynid - add a new device ID to this driver and re-probe devices */
736 static int vmbus_add_dynid(struct hv_driver *drv, guid_t *guid)
737 {
738         struct vmbus_dynid *dynid;
739
740         dynid = kzalloc(sizeof(*dynid), GFP_KERNEL);
741         if (!dynid)
742                 return -ENOMEM;
743
744         dynid->id.guid = *guid;
745
746         spin_lock(&drv->dynids.lock);
747         list_add_tail(&dynid->node, &drv->dynids.list);
748         spin_unlock(&drv->dynids.lock);
749
750         return driver_attach(&drv->driver);
751 }
752
753 static void vmbus_free_dynids(struct hv_driver *drv)
754 {
755         struct vmbus_dynid *dynid, *n;
756
757         spin_lock(&drv->dynids.lock);
758         list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
759                 list_del(&dynid->node);
760                 kfree(dynid);
761         }
762         spin_unlock(&drv->dynids.lock);
763 }
764
765 /*
766  * store_new_id - sysfs frontend to vmbus_add_dynid()
767  *
768  * Allow GUIDs to be added to an existing driver via sysfs.
769  */
770 static ssize_t new_id_store(struct device_driver *driver, const char *buf,
771                             size_t count)
772 {
773         struct hv_driver *drv = drv_to_hv_drv(driver);
774         guid_t guid;
775         ssize_t retval;
776
777         retval = guid_parse(buf, &guid);
778         if (retval)
779                 return retval;
780
781         if (hv_vmbus_dynid_match(drv, &guid))
782                 return -EEXIST;
783
784         retval = vmbus_add_dynid(drv, &guid);
785         if (retval)
786                 return retval;
787         return count;
788 }
789 static DRIVER_ATTR_WO(new_id);
790
791 /*
792  * store_remove_id - remove a PCI device ID from this driver
793  *
794  * Removes a dynamic pci device ID to this driver.
795  */
796 static ssize_t remove_id_store(struct device_driver *driver, const char *buf,
797                                size_t count)
798 {
799         struct hv_driver *drv = drv_to_hv_drv(driver);
800         struct vmbus_dynid *dynid, *n;
801         guid_t guid;
802         ssize_t retval;
803
804         retval = guid_parse(buf, &guid);
805         if (retval)
806                 return retval;
807
808         retval = -ENODEV;
809         spin_lock(&drv->dynids.lock);
810         list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
811                 struct hv_vmbus_device_id *id = &dynid->id;
812
813                 if (guid_equal(&id->guid, &guid)) {
814                         list_del(&dynid->node);
815                         kfree(dynid);
816                         retval = count;
817                         break;
818                 }
819         }
820         spin_unlock(&drv->dynids.lock);
821
822         return retval;
823 }
824 static DRIVER_ATTR_WO(remove_id);
825
826 static struct attribute *vmbus_drv_attrs[] = {
827         &driver_attr_new_id.attr,
828         &driver_attr_remove_id.attr,
829         NULL,
830 };
831 ATTRIBUTE_GROUPS(vmbus_drv);
832
833
834 /*
835  * vmbus_match - Attempt to match the specified device to the specified driver
836  */
837 static int vmbus_match(struct device *device, struct device_driver *driver)
838 {
839         struct hv_driver *drv = drv_to_hv_drv(driver);
840         struct hv_device *hv_dev = device_to_hv_device(device);
841
842         /* The hv_sock driver handles all hv_sock offers. */
843         if (is_hvsock_channel(hv_dev->channel))
844                 return drv->hvsock;
845
846         if (hv_vmbus_get_id(drv, hv_dev))
847                 return 1;
848
849         return 0;
850 }
851
852 /*
853  * vmbus_probe - Add the new vmbus's child device
854  */
855 static int vmbus_probe(struct device *child_device)
856 {
857         int ret = 0;
858         struct hv_driver *drv =
859                         drv_to_hv_drv(child_device->driver);
860         struct hv_device *dev = device_to_hv_device(child_device);
861         const struct hv_vmbus_device_id *dev_id;
862
863         dev_id = hv_vmbus_get_id(drv, dev);
864         if (drv->probe) {
865                 ret = drv->probe(dev, dev_id);
866                 if (ret != 0)
867                         pr_err("probe failed for device %s (%d)\n",
868                                dev_name(child_device), ret);
869
870         } else {
871                 pr_err("probe not set for driver %s\n",
872                        dev_name(child_device));
873                 ret = -ENODEV;
874         }
875         return ret;
876 }
877
878 /*
879  * vmbus_remove - Remove a vmbus device
880  */
881 static int vmbus_remove(struct device *child_device)
882 {
883         struct hv_driver *drv;
884         struct hv_device *dev = device_to_hv_device(child_device);
885
886         if (child_device->driver) {
887                 drv = drv_to_hv_drv(child_device->driver);
888                 if (drv->remove)
889                         drv->remove(dev);
890         }
891
892         return 0;
893 }
894
895
896 /*
897  * vmbus_shutdown - Shutdown a vmbus device
898  */
899 static void vmbus_shutdown(struct device *child_device)
900 {
901         struct hv_driver *drv;
902         struct hv_device *dev = device_to_hv_device(child_device);
903
904
905         /* The device may not be attached yet */
906         if (!child_device->driver)
907                 return;
908
909         drv = drv_to_hv_drv(child_device->driver);
910
911         if (drv->shutdown)
912                 drv->shutdown(dev);
913 }
914
915 #ifdef CONFIG_PM_SLEEP
916 /*
917  * vmbus_suspend - Suspend a vmbus device
918  */
919 static int vmbus_suspend(struct device *child_device)
920 {
921         struct hv_driver *drv;
922         struct hv_device *dev = device_to_hv_device(child_device);
923
924         /* The device may not be attached yet */
925         if (!child_device->driver)
926                 return 0;
927
928         drv = drv_to_hv_drv(child_device->driver);
929         if (!drv->suspend)
930                 return -EOPNOTSUPP;
931
932         return drv->suspend(dev);
933 }
934
935 /*
936  * vmbus_resume - Resume a vmbus device
937  */
938 static int vmbus_resume(struct device *child_device)
939 {
940         struct hv_driver *drv;
941         struct hv_device *dev = device_to_hv_device(child_device);
942
943         /* The device may not be attached yet */
944         if (!child_device->driver)
945                 return 0;
946
947         drv = drv_to_hv_drv(child_device->driver);
948         if (!drv->resume)
949                 return -EOPNOTSUPP;
950
951         return drv->resume(dev);
952 }
953 #endif /* CONFIG_PM_SLEEP */
954
955 /*
956  * vmbus_device_release - Final callback release of the vmbus child device
957  */
958 static void vmbus_device_release(struct device *device)
959 {
960         struct hv_device *hv_dev = device_to_hv_device(device);
961         struct vmbus_channel *channel = hv_dev->channel;
962
963         hv_debug_rm_dev_dir(hv_dev);
964
965         mutex_lock(&vmbus_connection.channel_mutex);
966         hv_process_channel_removal(channel);
967         mutex_unlock(&vmbus_connection.channel_mutex);
968         kfree(hv_dev);
969 }
970
971 /*
972  * Note: we must use SET_NOIRQ_SYSTEM_SLEEP_PM_OPS rather than
973  * SET_SYSTEM_SLEEP_PM_OPS: see the comment before vmbus_bus_pm.
974  */
975 static const struct dev_pm_ops vmbus_pm = {
976         SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(vmbus_suspend, vmbus_resume)
977 };
978
979 /* The one and only one */
980 static struct bus_type  hv_bus = {
981         .name =         "vmbus",
982         .match =                vmbus_match,
983         .shutdown =             vmbus_shutdown,
984         .remove =               vmbus_remove,
985         .probe =                vmbus_probe,
986         .uevent =               vmbus_uevent,
987         .dev_groups =           vmbus_dev_groups,
988         .drv_groups =           vmbus_drv_groups,
989         .pm =                   &vmbus_pm,
990 };
991
992 struct onmessage_work_context {
993         struct work_struct work;
994         struct hv_message msg;
995 };
996
997 static void vmbus_onmessage_work(struct work_struct *work)
998 {
999         struct onmessage_work_context *ctx;
1000
1001         /* Do not process messages if we're in DISCONNECTED state */
1002         if (vmbus_connection.conn_state == DISCONNECTED)
1003                 return;
1004
1005         ctx = container_of(work, struct onmessage_work_context,
1006                            work);
1007         vmbus_onmessage(&ctx->msg);
1008         kfree(ctx);
1009 }
1010
1011 void vmbus_on_msg_dpc(unsigned long data)
1012 {
1013         struct hv_per_cpu_context *hv_cpu = (void *)data;
1014         void *page_addr = hv_cpu->synic_message_page;
1015         struct hv_message *msg = (struct hv_message *)page_addr +
1016                                   VMBUS_MESSAGE_SINT;
1017         struct vmbus_channel_message_header *hdr;
1018         const struct vmbus_channel_message_table_entry *entry;
1019         struct onmessage_work_context *ctx;
1020         u32 message_type = msg->header.message_type;
1021
1022         if (message_type == HVMSG_NONE)
1023                 /* no msg */
1024                 return;
1025
1026         hdr = (struct vmbus_channel_message_header *)msg->u.payload;
1027
1028         trace_vmbus_on_msg_dpc(hdr);
1029
1030         if (hdr->msgtype >= CHANNELMSG_COUNT) {
1031                 WARN_ONCE(1, "unknown msgtype=%d\n", hdr->msgtype);
1032                 goto msg_handled;
1033         }
1034
1035         entry = &channel_message_table[hdr->msgtype];
1036
1037         if (!entry->message_handler)
1038                 goto msg_handled;
1039
1040         if (entry->handler_type == VMHT_BLOCKING) {
1041                 ctx = kmalloc(sizeof(*ctx), GFP_ATOMIC);
1042                 if (ctx == NULL)
1043                         return;
1044
1045                 INIT_WORK(&ctx->work, vmbus_onmessage_work);
1046                 memcpy(&ctx->msg, msg, sizeof(*msg));
1047
1048                 /*
1049                  * The host can generate a rescind message while we
1050                  * may still be handling the original offer. We deal with
1051                  * this condition by ensuring the processing is done on the
1052                  * same CPU.
1053                  */
1054                 switch (hdr->msgtype) {
1055                 case CHANNELMSG_RESCIND_CHANNELOFFER:
1056                         /*
1057                          * If we are handling the rescind message;
1058                          * schedule the work on the global work queue.
1059                          */
1060                         schedule_work_on(vmbus_connection.connect_cpu,
1061                                          &ctx->work);
1062                         break;
1063
1064                 case CHANNELMSG_OFFERCHANNEL:
1065                         atomic_inc(&vmbus_connection.offer_in_progress);
1066                         queue_work_on(vmbus_connection.connect_cpu,
1067                                       vmbus_connection.work_queue,
1068                                       &ctx->work);
1069                         break;
1070
1071                 default:
1072                         queue_work(vmbus_connection.work_queue, &ctx->work);
1073                 }
1074         } else
1075                 entry->message_handler(hdr);
1076
1077 msg_handled:
1078         vmbus_signal_eom(msg, message_type);
1079 }
1080
1081 #ifdef CONFIG_PM_SLEEP
1082 /*
1083  * Fake RESCIND_CHANNEL messages to clean up hv_sock channels by force for
1084  * hibernation, because hv_sock connections can not persist across hibernation.
1085  */
1086 static void vmbus_force_channel_rescinded(struct vmbus_channel *channel)
1087 {
1088         struct onmessage_work_context *ctx;
1089         struct vmbus_channel_rescind_offer *rescind;
1090
1091         WARN_ON(!is_hvsock_channel(channel));
1092
1093         /*
1094          * sizeof(*ctx) is small and the allocation should really not fail,
1095          * otherwise the state of the hv_sock connections ends up in limbo.
1096          */
1097         ctx = kzalloc(sizeof(*ctx), GFP_KERNEL | __GFP_NOFAIL);
1098
1099         /*
1100          * So far, these are not really used by Linux. Just set them to the
1101          * reasonable values conforming to the definitions of the fields.
1102          */
1103         ctx->msg.header.message_type = 1;
1104         ctx->msg.header.payload_size = sizeof(*rescind);
1105
1106         /* These values are actually used by Linux. */
1107         rescind = (struct vmbus_channel_rescind_offer *)ctx->msg.u.payload;
1108         rescind->header.msgtype = CHANNELMSG_RESCIND_CHANNELOFFER;
1109         rescind->child_relid = channel->offermsg.child_relid;
1110
1111         INIT_WORK(&ctx->work, vmbus_onmessage_work);
1112
1113         queue_work_on(vmbus_connection.connect_cpu,
1114                       vmbus_connection.work_queue,
1115                       &ctx->work);
1116 }
1117 #endif /* CONFIG_PM_SLEEP */
1118
1119 /*
1120  * Direct callback for channels using other deferred processing
1121  */
1122 static void vmbus_channel_isr(struct vmbus_channel *channel)
1123 {
1124         void (*callback_fn)(void *);
1125
1126         callback_fn = READ_ONCE(channel->onchannel_callback);
1127         if (likely(callback_fn != NULL))
1128                 (*callback_fn)(channel->channel_callback_context);
1129 }
1130
1131 /*
1132  * Schedule all channels with events pending
1133  */
1134 static void vmbus_chan_sched(struct hv_per_cpu_context *hv_cpu)
1135 {
1136         unsigned long *recv_int_page;
1137         u32 maxbits, relid;
1138
1139         if (vmbus_proto_version < VERSION_WIN8) {
1140                 maxbits = MAX_NUM_CHANNELS_SUPPORTED;
1141                 recv_int_page = vmbus_connection.recv_int_page;
1142         } else {
1143                 /*
1144                  * When the host is win8 and beyond, the event page
1145                  * can be directly checked to get the id of the channel
1146                  * that has the interrupt pending.
1147                  */
1148                 void *page_addr = hv_cpu->synic_event_page;
1149                 union hv_synic_event_flags *event
1150                         = (union hv_synic_event_flags *)page_addr +
1151                                                  VMBUS_MESSAGE_SINT;
1152
1153                 maxbits = HV_EVENT_FLAGS_COUNT;
1154                 recv_int_page = event->flags;
1155         }
1156
1157         if (unlikely(!recv_int_page))
1158                 return;
1159
1160         for_each_set_bit(relid, recv_int_page, maxbits) {
1161                 struct vmbus_channel *channel;
1162
1163                 if (!sync_test_and_clear_bit(relid, recv_int_page))
1164                         continue;
1165
1166                 /* Special case - vmbus channel protocol msg */
1167                 if (relid == 0)
1168                         continue;
1169
1170                 rcu_read_lock();
1171
1172                 /* Find channel based on relid */
1173                 list_for_each_entry_rcu(channel, &hv_cpu->chan_list, percpu_list) {
1174                         if (channel->offermsg.child_relid != relid)
1175                                 continue;
1176
1177                         if (channel->rescind)
1178                                 continue;
1179
1180                         trace_vmbus_chan_sched(channel);
1181
1182                         ++channel->interrupts;
1183
1184                         switch (channel->callback_mode) {
1185                         case HV_CALL_ISR:
1186                                 vmbus_channel_isr(channel);
1187                                 break;
1188
1189                         case HV_CALL_BATCHED:
1190                                 hv_begin_read(&channel->inbound);
1191                                 /* fallthrough */
1192                         case HV_CALL_DIRECT:
1193                                 tasklet_schedule(&channel->callback_event);
1194                         }
1195                 }
1196
1197                 rcu_read_unlock();
1198         }
1199 }
1200
1201 static void vmbus_isr(void)
1202 {
1203         struct hv_per_cpu_context *hv_cpu
1204                 = this_cpu_ptr(hv_context.cpu_context);
1205         void *page_addr = hv_cpu->synic_event_page;
1206         struct hv_message *msg;
1207         union hv_synic_event_flags *event;
1208         bool handled = false;
1209
1210         if (unlikely(page_addr == NULL))
1211                 return;
1212
1213         event = (union hv_synic_event_flags *)page_addr +
1214                                          VMBUS_MESSAGE_SINT;
1215         /*
1216          * Check for events before checking for messages. This is the order
1217          * in which events and messages are checked in Windows guests on
1218          * Hyper-V, and the Windows team suggested we do the same.
1219          */
1220
1221         if ((vmbus_proto_version == VERSION_WS2008) ||
1222                 (vmbus_proto_version == VERSION_WIN7)) {
1223
1224                 /* Since we are a child, we only need to check bit 0 */
1225                 if (sync_test_and_clear_bit(0, event->flags))
1226                         handled = true;
1227         } else {
1228                 /*
1229                  * Our host is win8 or above. The signaling mechanism
1230                  * has changed and we can directly look at the event page.
1231                  * If bit n is set then we have an interrup on the channel
1232                  * whose id is n.
1233                  */
1234                 handled = true;
1235         }
1236
1237         if (handled)
1238                 vmbus_chan_sched(hv_cpu);
1239
1240         page_addr = hv_cpu->synic_message_page;
1241         msg = (struct hv_message *)page_addr + VMBUS_MESSAGE_SINT;
1242
1243         /* Check if there are actual msgs to be processed */
1244         if (msg->header.message_type != HVMSG_NONE) {
1245                 if (msg->header.message_type == HVMSG_TIMER_EXPIRED) {
1246                         hv_stimer0_isr();
1247                         vmbus_signal_eom(msg, HVMSG_TIMER_EXPIRED);
1248                 } else
1249                         tasklet_schedule(&hv_cpu->msg_dpc);
1250         }
1251
1252         add_interrupt_randomness(HYPERVISOR_CALLBACK_VECTOR, 0);
1253 }
1254
1255 /*
1256  * Boolean to control whether to report panic messages over Hyper-V.
1257  *
1258  * It can be set via /proc/sys/kernel/hyperv/record_panic_msg
1259  */
1260 static int sysctl_record_panic_msg = 1;
1261
1262 /*
1263  * Callback from kmsg_dump. Grab as much as possible from the end of the kmsg
1264  * buffer and call into Hyper-V to transfer the data.
1265  */
1266 static void hv_kmsg_dump(struct kmsg_dumper *dumper,
1267                          enum kmsg_dump_reason reason)
1268 {
1269         size_t bytes_written;
1270         phys_addr_t panic_pa;
1271
1272         /* We are only interested in panics. */
1273         if ((reason != KMSG_DUMP_PANIC) || (!sysctl_record_panic_msg))
1274                 return;
1275
1276         panic_pa = virt_to_phys(hv_panic_page);
1277
1278         /*
1279          * Write dump contents to the page. No need to synchronize; panic should
1280          * be single-threaded.
1281          */
1282         kmsg_dump_get_buffer(dumper, true, hv_panic_page, HV_HYP_PAGE_SIZE,
1283                              &bytes_written);
1284         if (bytes_written)
1285                 hyperv_report_panic_msg(panic_pa, bytes_written);
1286 }
1287
1288 static struct kmsg_dumper hv_kmsg_dumper = {
1289         .dump = hv_kmsg_dump,
1290 };
1291
1292 static struct ctl_table_header *hv_ctl_table_hdr;
1293
1294 /*
1295  * sysctl option to allow the user to control whether kmsg data should be
1296  * reported to Hyper-V on panic.
1297  */
1298 static struct ctl_table hv_ctl_table[] = {
1299         {
1300                 .procname       = "hyperv_record_panic_msg",
1301                 .data           = &sysctl_record_panic_msg,
1302                 .maxlen         = sizeof(int),
1303                 .mode           = 0644,
1304                 .proc_handler   = proc_dointvec_minmax,
1305                 .extra1         = SYSCTL_ZERO,
1306                 .extra2         = SYSCTL_ONE
1307         },
1308         {}
1309 };
1310
1311 static struct ctl_table hv_root_table[] = {
1312         {
1313                 .procname       = "kernel",
1314                 .mode           = 0555,
1315                 .child          = hv_ctl_table
1316         },
1317         {}
1318 };
1319
1320 /*
1321  * vmbus_bus_init -Main vmbus driver initialization routine.
1322  *
1323  * Here, we
1324  *      - initialize the vmbus driver context
1325  *      - invoke the vmbus hv main init routine
1326  *      - retrieve the channel offers
1327  */
1328 static int vmbus_bus_init(void)
1329 {
1330         int ret;
1331
1332         /* Hypervisor initialization...setup hypercall page..etc */
1333         ret = hv_init();
1334         if (ret != 0) {
1335                 pr_err("Unable to initialize the hypervisor - 0x%x\n", ret);
1336                 return ret;
1337         }
1338
1339         ret = bus_register(&hv_bus);
1340         if (ret)
1341                 return ret;
1342
1343         hv_setup_vmbus_irq(vmbus_isr);
1344
1345         ret = hv_synic_alloc();
1346         if (ret)
1347                 goto err_alloc;
1348
1349         /*
1350          * Initialize the per-cpu interrupt state and stimer state.
1351          * Then connect to the host.
1352          */
1353         ret = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "hyperv/vmbus:online",
1354                                 hv_synic_init, hv_synic_cleanup);
1355         if (ret < 0)
1356                 goto err_cpuhp;
1357         hyperv_cpuhp_online = ret;
1358
1359         ret = vmbus_connect();
1360         if (ret)
1361                 goto err_connect;
1362
1363         /*
1364          * Only register if the crash MSRs are available
1365          */
1366         if (ms_hyperv.misc_features & HV_FEATURE_GUEST_CRASH_MSR_AVAILABLE) {
1367                 u64 hyperv_crash_ctl;
1368                 /*
1369                  * Sysctl registration is not fatal, since by default
1370                  * reporting is enabled.
1371                  */
1372                 hv_ctl_table_hdr = register_sysctl_table(hv_root_table);
1373                 if (!hv_ctl_table_hdr)
1374                         pr_err("Hyper-V: sysctl table register error");
1375
1376                 /*
1377                  * Register for panic kmsg callback only if the right
1378                  * capability is supported by the hypervisor.
1379                  */
1380                 hv_get_crash_ctl(hyperv_crash_ctl);
1381                 if (hyperv_crash_ctl & HV_CRASH_CTL_CRASH_NOTIFY_MSG) {
1382                         hv_panic_page = (void *)hv_alloc_hyperv_zeroed_page();
1383                         if (hv_panic_page) {
1384                                 ret = kmsg_dump_register(&hv_kmsg_dumper);
1385                                 if (ret)
1386                                         pr_err("Hyper-V: kmsg dump register "
1387                                                 "error 0x%x\n", ret);
1388                         } else
1389                                 pr_err("Hyper-V: panic message page memory "
1390                                         "allocation failed");
1391                 }
1392
1393                 register_die_notifier(&hyperv_die_block);
1394                 atomic_notifier_chain_register(&panic_notifier_list,
1395                                                &hyperv_panic_block);
1396         }
1397
1398         vmbus_request_offers();
1399
1400         return 0;
1401
1402 err_connect:
1403         cpuhp_remove_state(hyperv_cpuhp_online);
1404 err_cpuhp:
1405         hv_synic_free();
1406 err_alloc:
1407         hv_remove_vmbus_irq();
1408
1409         bus_unregister(&hv_bus);
1410         hv_free_hyperv_page((unsigned long)hv_panic_page);
1411         unregister_sysctl_table(hv_ctl_table_hdr);
1412         hv_ctl_table_hdr = NULL;
1413         return ret;
1414 }
1415
1416 /**
1417  * __vmbus_child_driver_register() - Register a vmbus's driver
1418  * @hv_driver: Pointer to driver structure you want to register
1419  * @owner: owner module of the drv
1420  * @mod_name: module name string
1421  *
1422  * Registers the given driver with Linux through the 'driver_register()' call
1423  * and sets up the hyper-v vmbus handling for this driver.
1424  * It will return the state of the 'driver_register()' call.
1425  *
1426  */
1427 int __vmbus_driver_register(struct hv_driver *hv_driver, struct module *owner, const char *mod_name)
1428 {
1429         int ret;
1430
1431         pr_info("registering driver %s\n", hv_driver->name);
1432
1433         ret = vmbus_exists();
1434         if (ret < 0)
1435                 return ret;
1436
1437         hv_driver->driver.name = hv_driver->name;
1438         hv_driver->driver.owner = owner;
1439         hv_driver->driver.mod_name = mod_name;
1440         hv_driver->driver.bus = &hv_bus;
1441
1442         spin_lock_init(&hv_driver->dynids.lock);
1443         INIT_LIST_HEAD(&hv_driver->dynids.list);
1444
1445         ret = driver_register(&hv_driver->driver);
1446
1447         return ret;
1448 }
1449 EXPORT_SYMBOL_GPL(__vmbus_driver_register);
1450
1451 /**
1452  * vmbus_driver_unregister() - Unregister a vmbus's driver
1453  * @hv_driver: Pointer to driver structure you want to
1454  *             un-register
1455  *
1456  * Un-register the given driver that was previous registered with a call to
1457  * vmbus_driver_register()
1458  */
1459 void vmbus_driver_unregister(struct hv_driver *hv_driver)
1460 {
1461         pr_info("unregistering driver %s\n", hv_driver->name);
1462
1463         if (!vmbus_exists()) {
1464                 driver_unregister(&hv_driver->driver);
1465                 vmbus_free_dynids(hv_driver);
1466         }
1467 }
1468 EXPORT_SYMBOL_GPL(vmbus_driver_unregister);
1469
1470
1471 /*
1472  * Called when last reference to channel is gone.
1473  */
1474 static void vmbus_chan_release(struct kobject *kobj)
1475 {
1476         struct vmbus_channel *channel
1477                 = container_of(kobj, struct vmbus_channel, kobj);
1478
1479         kfree_rcu(channel, rcu);
1480 }
1481
1482 struct vmbus_chan_attribute {
1483         struct attribute attr;
1484         ssize_t (*show)(struct vmbus_channel *chan, char *buf);
1485         ssize_t (*store)(struct vmbus_channel *chan,
1486                          const char *buf, size_t count);
1487 };
1488 #define VMBUS_CHAN_ATTR(_name, _mode, _show, _store) \
1489         struct vmbus_chan_attribute chan_attr_##_name \
1490                 = __ATTR(_name, _mode, _show, _store)
1491 #define VMBUS_CHAN_ATTR_RW(_name) \
1492         struct vmbus_chan_attribute chan_attr_##_name = __ATTR_RW(_name)
1493 #define VMBUS_CHAN_ATTR_RO(_name) \
1494         struct vmbus_chan_attribute chan_attr_##_name = __ATTR_RO(_name)
1495 #define VMBUS_CHAN_ATTR_WO(_name) \
1496         struct vmbus_chan_attribute chan_attr_##_name = __ATTR_WO(_name)
1497
1498 static ssize_t vmbus_chan_attr_show(struct kobject *kobj,
1499                                     struct attribute *attr, char *buf)
1500 {
1501         const struct vmbus_chan_attribute *attribute
1502                 = container_of(attr, struct vmbus_chan_attribute, attr);
1503         struct vmbus_channel *chan
1504                 = container_of(kobj, struct vmbus_channel, kobj);
1505
1506         if (!attribute->show)
1507                 return -EIO;
1508
1509         return attribute->show(chan, buf);
1510 }
1511
1512 static const struct sysfs_ops vmbus_chan_sysfs_ops = {
1513         .show = vmbus_chan_attr_show,
1514 };
1515
1516 static ssize_t out_mask_show(struct vmbus_channel *channel, char *buf)
1517 {
1518         struct hv_ring_buffer_info *rbi = &channel->outbound;
1519         ssize_t ret;
1520
1521         mutex_lock(&rbi->ring_buffer_mutex);
1522         if (!rbi->ring_buffer) {
1523                 mutex_unlock(&rbi->ring_buffer_mutex);
1524                 return -EINVAL;
1525         }
1526
1527         ret = sprintf(buf, "%u\n", rbi->ring_buffer->interrupt_mask);
1528         mutex_unlock(&rbi->ring_buffer_mutex);
1529         return ret;
1530 }
1531 static VMBUS_CHAN_ATTR_RO(out_mask);
1532
1533 static ssize_t in_mask_show(struct vmbus_channel *channel, char *buf)
1534 {
1535         struct hv_ring_buffer_info *rbi = &channel->inbound;
1536         ssize_t ret;
1537
1538         mutex_lock(&rbi->ring_buffer_mutex);
1539         if (!rbi->ring_buffer) {
1540                 mutex_unlock(&rbi->ring_buffer_mutex);
1541                 return -EINVAL;
1542         }
1543
1544         ret = sprintf(buf, "%u\n", rbi->ring_buffer->interrupt_mask);
1545         mutex_unlock(&rbi->ring_buffer_mutex);
1546         return ret;
1547 }
1548 static VMBUS_CHAN_ATTR_RO(in_mask);
1549
1550 static ssize_t read_avail_show(struct vmbus_channel *channel, char *buf)
1551 {
1552         struct hv_ring_buffer_info *rbi = &channel->inbound;
1553         ssize_t ret;
1554
1555         mutex_lock(&rbi->ring_buffer_mutex);
1556         if (!rbi->ring_buffer) {
1557                 mutex_unlock(&rbi->ring_buffer_mutex);
1558                 return -EINVAL;
1559         }
1560
1561         ret = sprintf(buf, "%u\n", hv_get_bytes_to_read(rbi));
1562         mutex_unlock(&rbi->ring_buffer_mutex);
1563         return ret;
1564 }
1565 static VMBUS_CHAN_ATTR_RO(read_avail);
1566
1567 static ssize_t write_avail_show(struct vmbus_channel *channel, char *buf)
1568 {
1569         struct hv_ring_buffer_info *rbi = &channel->outbound;
1570         ssize_t ret;
1571
1572         mutex_lock(&rbi->ring_buffer_mutex);
1573         if (!rbi->ring_buffer) {
1574                 mutex_unlock(&rbi->ring_buffer_mutex);
1575                 return -EINVAL;
1576         }
1577
1578         ret = sprintf(buf, "%u\n", hv_get_bytes_to_write(rbi));
1579         mutex_unlock(&rbi->ring_buffer_mutex);
1580         return ret;
1581 }
1582 static VMBUS_CHAN_ATTR_RO(write_avail);
1583
1584 static ssize_t show_target_cpu(struct vmbus_channel *channel, char *buf)
1585 {
1586         return sprintf(buf, "%u\n", channel->target_cpu);
1587 }
1588 static VMBUS_CHAN_ATTR(cpu, S_IRUGO, show_target_cpu, NULL);
1589
1590 static ssize_t channel_pending_show(struct vmbus_channel *channel,
1591                                     char *buf)
1592 {
1593         return sprintf(buf, "%d\n",
1594                        channel_pending(channel,
1595                                        vmbus_connection.monitor_pages[1]));
1596 }
1597 static VMBUS_CHAN_ATTR(pending, S_IRUGO, channel_pending_show, NULL);
1598
1599 static ssize_t channel_latency_show(struct vmbus_channel *channel,
1600                                     char *buf)
1601 {
1602         return sprintf(buf, "%d\n",
1603                        channel_latency(channel,
1604                                        vmbus_connection.monitor_pages[1]));
1605 }
1606 static VMBUS_CHAN_ATTR(latency, S_IRUGO, channel_latency_show, NULL);
1607
1608 static ssize_t channel_interrupts_show(struct vmbus_channel *channel, char *buf)
1609 {
1610         return sprintf(buf, "%llu\n", channel->interrupts);
1611 }
1612 static VMBUS_CHAN_ATTR(interrupts, S_IRUGO, channel_interrupts_show, NULL);
1613
1614 static ssize_t channel_events_show(struct vmbus_channel *channel, char *buf)
1615 {
1616         return sprintf(buf, "%llu\n", channel->sig_events);
1617 }
1618 static VMBUS_CHAN_ATTR(events, S_IRUGO, channel_events_show, NULL);
1619
1620 static ssize_t channel_intr_in_full_show(struct vmbus_channel *channel,
1621                                          char *buf)
1622 {
1623         return sprintf(buf, "%llu\n",
1624                        (unsigned long long)channel->intr_in_full);
1625 }
1626 static VMBUS_CHAN_ATTR(intr_in_full, 0444, channel_intr_in_full_show, NULL);
1627
1628 static ssize_t channel_intr_out_empty_show(struct vmbus_channel *channel,
1629                                            char *buf)
1630 {
1631         return sprintf(buf, "%llu\n",
1632                        (unsigned long long)channel->intr_out_empty);
1633 }
1634 static VMBUS_CHAN_ATTR(intr_out_empty, 0444, channel_intr_out_empty_show, NULL);
1635
1636 static ssize_t channel_out_full_first_show(struct vmbus_channel *channel,
1637                                            char *buf)
1638 {
1639         return sprintf(buf, "%llu\n",
1640                        (unsigned long long)channel->out_full_first);
1641 }
1642 static VMBUS_CHAN_ATTR(out_full_first, 0444, channel_out_full_first_show, NULL);
1643
1644 static ssize_t channel_out_full_total_show(struct vmbus_channel *channel,
1645                                            char *buf)
1646 {
1647         return sprintf(buf, "%llu\n",
1648                        (unsigned long long)channel->out_full_total);
1649 }
1650 static VMBUS_CHAN_ATTR(out_full_total, 0444, channel_out_full_total_show, NULL);
1651
1652 static ssize_t subchannel_monitor_id_show(struct vmbus_channel *channel,
1653                                           char *buf)
1654 {
1655         return sprintf(buf, "%u\n", channel->offermsg.monitorid);
1656 }
1657 static VMBUS_CHAN_ATTR(monitor_id, S_IRUGO, subchannel_monitor_id_show, NULL);
1658
1659 static ssize_t subchannel_id_show(struct vmbus_channel *channel,
1660                                   char *buf)
1661 {
1662         return sprintf(buf, "%u\n",
1663                        channel->offermsg.offer.sub_channel_index);
1664 }
1665 static VMBUS_CHAN_ATTR_RO(subchannel_id);
1666
1667 static struct attribute *vmbus_chan_attrs[] = {
1668         &chan_attr_out_mask.attr,
1669         &chan_attr_in_mask.attr,
1670         &chan_attr_read_avail.attr,
1671         &chan_attr_write_avail.attr,
1672         &chan_attr_cpu.attr,
1673         &chan_attr_pending.attr,
1674         &chan_attr_latency.attr,
1675         &chan_attr_interrupts.attr,
1676         &chan_attr_events.attr,
1677         &chan_attr_intr_in_full.attr,
1678         &chan_attr_intr_out_empty.attr,
1679         &chan_attr_out_full_first.attr,
1680         &chan_attr_out_full_total.attr,
1681         &chan_attr_monitor_id.attr,
1682         &chan_attr_subchannel_id.attr,
1683         NULL
1684 };
1685
1686 /*
1687  * Channel-level attribute_group callback function. Returns the permission for
1688  * each attribute, and returns 0 if an attribute is not visible.
1689  */
1690 static umode_t vmbus_chan_attr_is_visible(struct kobject *kobj,
1691                                           struct attribute *attr, int idx)
1692 {
1693         const struct vmbus_channel *channel =
1694                 container_of(kobj, struct vmbus_channel, kobj);
1695
1696         /* Hide the monitor attributes if the monitor mechanism is not used. */
1697         if (!channel->offermsg.monitor_allocated &&
1698             (attr == &chan_attr_pending.attr ||
1699              attr == &chan_attr_latency.attr ||
1700              attr == &chan_attr_monitor_id.attr))
1701                 return 0;
1702
1703         return attr->mode;
1704 }
1705
1706 static struct attribute_group vmbus_chan_group = {
1707         .attrs = vmbus_chan_attrs,
1708         .is_visible = vmbus_chan_attr_is_visible
1709 };
1710
1711 static struct kobj_type vmbus_chan_ktype = {
1712         .sysfs_ops = &vmbus_chan_sysfs_ops,
1713         .release = vmbus_chan_release,
1714 };
1715
1716 /*
1717  * vmbus_add_channel_kobj - setup a sub-directory under device/channels
1718  */
1719 int vmbus_add_channel_kobj(struct hv_device *dev, struct vmbus_channel *channel)
1720 {
1721         const struct device *device = &dev->device;
1722         struct kobject *kobj = &channel->kobj;
1723         u32 relid = channel->offermsg.child_relid;
1724         int ret;
1725
1726         kobj->kset = dev->channels_kset;
1727         ret = kobject_init_and_add(kobj, &vmbus_chan_ktype, NULL,
1728                                    "%u", relid);
1729         if (ret)
1730                 return ret;
1731
1732         ret = sysfs_create_group(kobj, &vmbus_chan_group);
1733
1734         if (ret) {
1735                 /*
1736                  * The calling functions' error handling paths will cleanup the
1737                  * empty channel directory.
1738                  */
1739                 dev_err(device, "Unable to set up channel sysfs files\n");
1740                 return ret;
1741         }
1742
1743         kobject_uevent(kobj, KOBJ_ADD);
1744
1745         return 0;
1746 }
1747
1748 /*
1749  * vmbus_remove_channel_attr_group - remove the channel's attribute group
1750  */
1751 void vmbus_remove_channel_attr_group(struct vmbus_channel *channel)
1752 {
1753         sysfs_remove_group(&channel->kobj, &vmbus_chan_group);
1754 }
1755
1756 /*
1757  * vmbus_device_create - Creates and registers a new child device
1758  * on the vmbus.
1759  */
1760 struct hv_device *vmbus_device_create(const guid_t *type,
1761                                       const guid_t *instance,
1762                                       struct vmbus_channel *channel)
1763 {
1764         struct hv_device *child_device_obj;
1765
1766         child_device_obj = kzalloc(sizeof(struct hv_device), GFP_KERNEL);
1767         if (!child_device_obj) {
1768                 pr_err("Unable to allocate device object for child device\n");
1769                 return NULL;
1770         }
1771
1772         child_device_obj->channel = channel;
1773         guid_copy(&child_device_obj->dev_type, type);
1774         guid_copy(&child_device_obj->dev_instance, instance);
1775         child_device_obj->vendor_id = 0x1414; /* MSFT vendor ID */
1776
1777         return child_device_obj;
1778 }
1779
1780 /*
1781  * vmbus_device_register - Register the child device
1782  */
1783 int vmbus_device_register(struct hv_device *child_device_obj)
1784 {
1785         struct kobject *kobj = &child_device_obj->device.kobj;
1786         int ret;
1787
1788         dev_set_name(&child_device_obj->device, "%pUl",
1789                      child_device_obj->channel->offermsg.offer.if_instance.b);
1790
1791         child_device_obj->device.bus = &hv_bus;
1792         child_device_obj->device.parent = &hv_acpi_dev->dev;
1793         child_device_obj->device.release = vmbus_device_release;
1794
1795         /*
1796          * Register with the LDM. This will kick off the driver/device
1797          * binding...which will eventually call vmbus_match() and vmbus_probe()
1798          */
1799         ret = device_register(&child_device_obj->device);
1800         if (ret) {
1801                 pr_err("Unable to register child device\n");
1802                 return ret;
1803         }
1804
1805         child_device_obj->channels_kset = kset_create_and_add("channels",
1806                                                               NULL, kobj);
1807         if (!child_device_obj->channels_kset) {
1808                 ret = -ENOMEM;
1809                 goto err_dev_unregister;
1810         }
1811
1812         ret = vmbus_add_channel_kobj(child_device_obj,
1813                                      child_device_obj->channel);
1814         if (ret) {
1815                 pr_err("Unable to register primary channeln");
1816                 goto err_kset_unregister;
1817         }
1818         hv_debug_add_dev_dir(child_device_obj);
1819
1820         return 0;
1821
1822 err_kset_unregister:
1823         kset_unregister(child_device_obj->channels_kset);
1824
1825 err_dev_unregister:
1826         device_unregister(&child_device_obj->device);
1827         return ret;
1828 }
1829
1830 /*
1831  * vmbus_device_unregister - Remove the specified child device
1832  * from the vmbus.
1833  */
1834 void vmbus_device_unregister(struct hv_device *device_obj)
1835 {
1836         pr_debug("child device %s unregistered\n",
1837                 dev_name(&device_obj->device));
1838
1839         kset_unregister(device_obj->channels_kset);
1840
1841         /*
1842          * Kick off the process of unregistering the device.
1843          * This will call vmbus_remove() and eventually vmbus_device_release()
1844          */
1845         device_unregister(&device_obj->device);
1846 }
1847
1848
1849 /*
1850  * VMBUS is an acpi enumerated device. Get the information we
1851  * need from DSDT.
1852  */
1853 #define VTPM_BASE_ADDRESS 0xfed40000
1854 static acpi_status vmbus_walk_resources(struct acpi_resource *res, void *ctx)
1855 {
1856         resource_size_t start = 0;
1857         resource_size_t end = 0;
1858         struct resource *new_res;
1859         struct resource **old_res = &hyperv_mmio;
1860         struct resource **prev_res = NULL;
1861
1862         switch (res->type) {
1863
1864         /*
1865          * "Address" descriptors are for bus windows. Ignore
1866          * "memory" descriptors, which are for registers on
1867          * devices.
1868          */
1869         case ACPI_RESOURCE_TYPE_ADDRESS32:
1870                 start = res->data.address32.address.minimum;
1871                 end = res->data.address32.address.maximum;
1872                 break;
1873
1874         case ACPI_RESOURCE_TYPE_ADDRESS64:
1875                 start = res->data.address64.address.minimum;
1876                 end = res->data.address64.address.maximum;
1877                 break;
1878
1879         default:
1880                 /* Unused resource type */
1881                 return AE_OK;
1882
1883         }
1884         /*
1885          * Ignore ranges that are below 1MB, as they're not
1886          * necessary or useful here.
1887          */
1888         if (end < 0x100000)
1889                 return AE_OK;
1890
1891         new_res = kzalloc(sizeof(*new_res), GFP_ATOMIC);
1892         if (!new_res)
1893                 return AE_NO_MEMORY;
1894
1895         /* If this range overlaps the virtual TPM, truncate it. */
1896         if (end > VTPM_BASE_ADDRESS && start < VTPM_BASE_ADDRESS)
1897                 end = VTPM_BASE_ADDRESS;
1898
1899         new_res->name = "hyperv mmio";
1900         new_res->flags = IORESOURCE_MEM;
1901         new_res->start = start;
1902         new_res->end = end;
1903
1904         /*
1905          * If two ranges are adjacent, merge them.
1906          */
1907         do {
1908                 if (!*old_res) {
1909                         *old_res = new_res;
1910                         break;
1911                 }
1912
1913                 if (((*old_res)->end + 1) == new_res->start) {
1914                         (*old_res)->end = new_res->end;
1915                         kfree(new_res);
1916                         break;
1917                 }
1918
1919                 if ((*old_res)->start == new_res->end + 1) {
1920                         (*old_res)->start = new_res->start;
1921                         kfree(new_res);
1922                         break;
1923                 }
1924
1925                 if ((*old_res)->start > new_res->end) {
1926                         new_res->sibling = *old_res;
1927                         if (prev_res)
1928                                 (*prev_res)->sibling = new_res;
1929                         *old_res = new_res;
1930                         break;
1931                 }
1932
1933                 prev_res = old_res;
1934                 old_res = &(*old_res)->sibling;
1935
1936         } while (1);
1937
1938         return AE_OK;
1939 }
1940
1941 static int vmbus_acpi_remove(struct acpi_device *device)
1942 {
1943         struct resource *cur_res;
1944         struct resource *next_res;
1945
1946         if (hyperv_mmio) {
1947                 if (fb_mmio) {
1948                         __release_region(hyperv_mmio, fb_mmio->start,
1949                                          resource_size(fb_mmio));
1950                         fb_mmio = NULL;
1951                 }
1952
1953                 for (cur_res = hyperv_mmio; cur_res; cur_res = next_res) {
1954                         next_res = cur_res->sibling;
1955                         kfree(cur_res);
1956                 }
1957         }
1958
1959         return 0;
1960 }
1961
1962 static void vmbus_reserve_fb(void)
1963 {
1964         int size;
1965         /*
1966          * Make a claim for the frame buffer in the resource tree under the
1967          * first node, which will be the one below 4GB.  The length seems to
1968          * be underreported, particularly in a Generation 1 VM.  So start out
1969          * reserving a larger area and make it smaller until it succeeds.
1970          */
1971
1972         if (screen_info.lfb_base) {
1973                 if (efi_enabled(EFI_BOOT))
1974                         size = max_t(__u32, screen_info.lfb_size, 0x800000);
1975                 else
1976                         size = max_t(__u32, screen_info.lfb_size, 0x4000000);
1977
1978                 for (; !fb_mmio && (size >= 0x100000); size >>= 1) {
1979                         fb_mmio = __request_region(hyperv_mmio,
1980                                                    screen_info.lfb_base, size,
1981                                                    fb_mmio_name, 0);
1982                 }
1983         }
1984 }
1985
1986 /**
1987  * vmbus_allocate_mmio() - Pick a memory-mapped I/O range.
1988  * @new:                If successful, supplied a pointer to the
1989  *                      allocated MMIO space.
1990  * @device_obj:         Identifies the caller
1991  * @min:                Minimum guest physical address of the
1992  *                      allocation
1993  * @max:                Maximum guest physical address
1994  * @size:               Size of the range to be allocated
1995  * @align:              Alignment of the range to be allocated
1996  * @fb_overlap_ok:      Whether this allocation can be allowed
1997  *                      to overlap the video frame buffer.
1998  *
1999  * This function walks the resources granted to VMBus by the
2000  * _CRS object in the ACPI namespace underneath the parent
2001  * "bridge" whether that's a root PCI bus in the Generation 1
2002  * case or a Module Device in the Generation 2 case.  It then
2003  * attempts to allocate from the global MMIO pool in a way that
2004  * matches the constraints supplied in these parameters and by
2005  * that _CRS.
2006  *
2007  * Return: 0 on success, -errno on failure
2008  */
2009 int vmbus_allocate_mmio(struct resource **new, struct hv_device *device_obj,
2010                         resource_size_t min, resource_size_t max,
2011                         resource_size_t size, resource_size_t align,
2012                         bool fb_overlap_ok)
2013 {
2014         struct resource *iter, *shadow;
2015         resource_size_t range_min, range_max, start;
2016         const char *dev_n = dev_name(&device_obj->device);
2017         int retval;
2018
2019         retval = -ENXIO;
2020         mutex_lock(&hyperv_mmio_lock);
2021
2022         /*
2023          * If overlaps with frame buffers are allowed, then first attempt to
2024          * make the allocation from within the reserved region.  Because it
2025          * is already reserved, no shadow allocation is necessary.
2026          */
2027         if (fb_overlap_ok && fb_mmio && !(min > fb_mmio->end) &&
2028             !(max < fb_mmio->start)) {
2029
2030                 range_min = fb_mmio->start;
2031                 range_max = fb_mmio->end;
2032                 start = (range_min + align - 1) & ~(align - 1);
2033                 for (; start + size - 1 <= range_max; start += align) {
2034                         *new = request_mem_region_exclusive(start, size, dev_n);
2035                         if (*new) {
2036                                 retval = 0;
2037                                 goto exit;
2038                         }
2039                 }
2040         }
2041
2042         for (iter = hyperv_mmio; iter; iter = iter->sibling) {
2043                 if ((iter->start >= max) || (iter->end <= min))
2044                         continue;
2045
2046                 range_min = iter->start;
2047                 range_max = iter->end;
2048                 start = (range_min + align - 1) & ~(align - 1);
2049                 for (; start + size - 1 <= range_max; start += align) {
2050                         shadow = __request_region(iter, start, size, NULL,
2051                                                   IORESOURCE_BUSY);
2052                         if (!shadow)
2053                                 continue;
2054
2055                         *new = request_mem_region_exclusive(start, size, dev_n);
2056                         if (*new) {
2057                                 shadow->name = (char *)*new;
2058                                 retval = 0;
2059                                 goto exit;
2060                         }
2061
2062                         __release_region(iter, start, size);
2063                 }
2064         }
2065
2066 exit:
2067         mutex_unlock(&hyperv_mmio_lock);
2068         return retval;
2069 }
2070 EXPORT_SYMBOL_GPL(vmbus_allocate_mmio);
2071
2072 /**
2073  * vmbus_free_mmio() - Free a memory-mapped I/O range.
2074  * @start:              Base address of region to release.
2075  * @size:               Size of the range to be allocated
2076  *
2077  * This function releases anything requested by
2078  * vmbus_mmio_allocate().
2079  */
2080 void vmbus_free_mmio(resource_size_t start, resource_size_t size)
2081 {
2082         struct resource *iter;
2083
2084         mutex_lock(&hyperv_mmio_lock);
2085         for (iter = hyperv_mmio; iter; iter = iter->sibling) {
2086                 if ((iter->start >= start + size) || (iter->end <= start))
2087                         continue;
2088
2089                 __release_region(iter, start, size);
2090         }
2091         release_mem_region(start, size);
2092         mutex_unlock(&hyperv_mmio_lock);
2093
2094 }
2095 EXPORT_SYMBOL_GPL(vmbus_free_mmio);
2096
2097 static int vmbus_acpi_add(struct acpi_device *device)
2098 {
2099         acpi_status result;
2100         int ret_val = -ENODEV;
2101         struct acpi_device *ancestor;
2102
2103         hv_acpi_dev = device;
2104
2105         result = acpi_walk_resources(device->handle, METHOD_NAME__CRS,
2106                                         vmbus_walk_resources, NULL);
2107
2108         if (ACPI_FAILURE(result))
2109                 goto acpi_walk_err;
2110         /*
2111          * Some ancestor of the vmbus acpi device (Gen1 or Gen2
2112          * firmware) is the VMOD that has the mmio ranges. Get that.
2113          */
2114         for (ancestor = device->parent; ancestor; ancestor = ancestor->parent) {
2115                 result = acpi_walk_resources(ancestor->handle, METHOD_NAME__CRS,
2116                                              vmbus_walk_resources, NULL);
2117
2118                 if (ACPI_FAILURE(result))
2119                         continue;
2120                 if (hyperv_mmio) {
2121                         vmbus_reserve_fb();
2122                         break;
2123                 }
2124         }
2125         ret_val = 0;
2126
2127 acpi_walk_err:
2128         complete(&probe_event);
2129         if (ret_val)
2130                 vmbus_acpi_remove(device);
2131         return ret_val;
2132 }
2133
2134 #ifdef CONFIG_PM_SLEEP
2135 static int vmbus_bus_suspend(struct device *dev)
2136 {
2137         struct vmbus_channel *channel, *sc;
2138         unsigned long flags;
2139
2140         while (atomic_read(&vmbus_connection.offer_in_progress) != 0) {
2141                 /*
2142                  * We wait here until the completion of any channel
2143                  * offers that are currently in progress.
2144                  */
2145                 msleep(1);
2146         }
2147
2148         mutex_lock(&vmbus_connection.channel_mutex);
2149         list_for_each_entry(channel, &vmbus_connection.chn_list, listentry) {
2150                 if (!is_hvsock_channel(channel))
2151                         continue;
2152
2153                 vmbus_force_channel_rescinded(channel);
2154         }
2155         mutex_unlock(&vmbus_connection.channel_mutex);
2156
2157         /*
2158          * Wait until all the sub-channels and hv_sock channels have been
2159          * cleaned up. Sub-channels should be destroyed upon suspend, otherwise
2160          * they would conflict with the new sub-channels that will be created
2161          * in the resume path. hv_sock channels should also be destroyed, but
2162          * a hv_sock channel of an established hv_sock connection can not be
2163          * really destroyed since it may still be referenced by the userspace
2164          * application, so we just force the hv_sock channel to be rescinded
2165          * by vmbus_force_channel_rescinded(), and the userspace application
2166          * will thoroughly destroy the channel after hibernation.
2167          *
2168          * Note: the counter nr_chan_close_on_suspend may never go above 0 if
2169          * the VM has no sub-channel and hv_sock channel, e.g. a 1-vCPU VM.
2170          */
2171         if (atomic_read(&vmbus_connection.nr_chan_close_on_suspend) > 0)
2172                 wait_for_completion(&vmbus_connection.ready_for_suspend_event);
2173
2174         WARN_ON(atomic_read(&vmbus_connection.nr_chan_fixup_on_resume) != 0);
2175
2176         mutex_lock(&vmbus_connection.channel_mutex);
2177
2178         list_for_each_entry(channel, &vmbus_connection.chn_list, listentry) {
2179                 /*
2180                  * Invalidate the field. Upon resume, vmbus_onoffer() will fix
2181                  * up the field, and the other fields (if necessary).
2182                  */
2183                 channel->offermsg.child_relid = INVALID_RELID;
2184
2185                 if (is_hvsock_channel(channel)) {
2186                         if (!channel->rescind) {
2187                                 pr_err("hv_sock channel not rescinded!\n");
2188                                 WARN_ON_ONCE(1);
2189                         }
2190                         continue;
2191                 }
2192
2193                 spin_lock_irqsave(&channel->lock, flags);
2194                 list_for_each_entry(sc, &channel->sc_list, sc_list) {
2195                         pr_err("Sub-channel not deleted!\n");
2196                         WARN_ON_ONCE(1);
2197                 }
2198                 spin_unlock_irqrestore(&channel->lock, flags);
2199
2200                 atomic_inc(&vmbus_connection.nr_chan_fixup_on_resume);
2201         }
2202
2203         mutex_unlock(&vmbus_connection.channel_mutex);
2204
2205         vmbus_initiate_unload(false);
2206
2207         vmbus_connection.conn_state = DISCONNECTED;
2208
2209         /* Reset the event for the next resume. */
2210         reinit_completion(&vmbus_connection.ready_for_resume_event);
2211
2212         return 0;
2213 }
2214
2215 static int vmbus_bus_resume(struct device *dev)
2216 {
2217         struct vmbus_channel_msginfo *msginfo;
2218         size_t msgsize;
2219         int ret;
2220
2221         /*
2222          * We only use the 'vmbus_proto_version', which was in use before
2223          * hibernation, to re-negotiate with the host.
2224          */
2225         if (!vmbus_proto_version) {
2226                 pr_err("Invalid proto version = 0x%x\n", vmbus_proto_version);
2227                 return -EINVAL;
2228         }
2229
2230         msgsize = sizeof(*msginfo) +
2231                   sizeof(struct vmbus_channel_initiate_contact);
2232
2233         msginfo = kzalloc(msgsize, GFP_KERNEL);
2234
2235         if (msginfo == NULL)
2236                 return -ENOMEM;
2237
2238         ret = vmbus_negotiate_version(msginfo, vmbus_proto_version);
2239
2240         kfree(msginfo);
2241
2242         if (ret != 0)
2243                 return ret;
2244
2245         WARN_ON(atomic_read(&vmbus_connection.nr_chan_fixup_on_resume) == 0);
2246
2247         vmbus_request_offers();
2248
2249         wait_for_completion(&vmbus_connection.ready_for_resume_event);
2250
2251         /* Reset the event for the next suspend. */
2252         reinit_completion(&vmbus_connection.ready_for_suspend_event);
2253
2254         return 0;
2255 }
2256 #endif /* CONFIG_PM_SLEEP */
2257
2258 static const struct acpi_device_id vmbus_acpi_device_ids[] = {
2259         {"VMBUS", 0},
2260         {"VMBus", 0},
2261         {"", 0},
2262 };
2263 MODULE_DEVICE_TABLE(acpi, vmbus_acpi_device_ids);
2264
2265 /*
2266  * Note: we must use SET_NOIRQ_SYSTEM_SLEEP_PM_OPS rather than
2267  * SET_SYSTEM_SLEEP_PM_OPS, otherwise NIC SR-IOV can not work, because the
2268  * "pci_dev_pm_ops" uses the "noirq" callbacks: in the resume path, the
2269  * pci "noirq" restore callback runs before "non-noirq" callbacks (see
2270  * resume_target_kernel() -> dpm_resume_start(), and hibernation_restore() ->
2271  * dpm_resume_end()). This means vmbus_bus_resume() and the pci-hyperv's
2272  * resume callback must also run via the "noirq" callbacks.
2273  */
2274 static const struct dev_pm_ops vmbus_bus_pm = {
2275         SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(vmbus_bus_suspend, vmbus_bus_resume)
2276 };
2277
2278 static struct acpi_driver vmbus_acpi_driver = {
2279         .name = "vmbus",
2280         .ids = vmbus_acpi_device_ids,
2281         .ops = {
2282                 .add = vmbus_acpi_add,
2283                 .remove = vmbus_acpi_remove,
2284         },
2285         .drv.pm = &vmbus_bus_pm,
2286 };
2287
2288 static void hv_kexec_handler(void)
2289 {
2290         hv_stimer_global_cleanup();
2291         vmbus_initiate_unload(false);
2292         vmbus_connection.conn_state = DISCONNECTED;
2293         /* Make sure conn_state is set as hv_synic_cleanup checks for it */
2294         mb();
2295         cpuhp_remove_state(hyperv_cpuhp_online);
2296         hyperv_cleanup();
2297 };
2298
2299 static void hv_crash_handler(struct pt_regs *regs)
2300 {
2301         int cpu;
2302
2303         vmbus_initiate_unload(true);
2304         /*
2305          * In crash handler we can't schedule synic cleanup for all CPUs,
2306          * doing the cleanup for current CPU only. This should be sufficient
2307          * for kdump.
2308          */
2309         vmbus_connection.conn_state = DISCONNECTED;
2310         cpu = smp_processor_id();
2311         hv_stimer_cleanup(cpu);
2312         hv_synic_disable_regs(cpu);
2313         hyperv_cleanup();
2314 };
2315
2316 static int hv_synic_suspend(void)
2317 {
2318         /*
2319          * When we reach here, all the non-boot CPUs have been offlined.
2320          * If we're in a legacy configuration where stimer Direct Mode is
2321          * not enabled, the stimers on the non-boot CPUs have been unbound
2322          * in hv_synic_cleanup() -> hv_stimer_legacy_cleanup() ->
2323          * hv_stimer_cleanup() -> clockevents_unbind_device().
2324          *
2325          * hv_synic_suspend() only runs on CPU0 with interrupts disabled.
2326          * Here we do not call hv_stimer_legacy_cleanup() on CPU0 because:
2327          * 1) it's unnecessary as interrupts remain disabled between
2328          * syscore_suspend() and syscore_resume(): see create_image() and
2329          * resume_target_kernel()
2330          * 2) the stimer on CPU0 is automatically disabled later by
2331          * syscore_suspend() -> timekeeping_suspend() -> tick_suspend() -> ...
2332          * -> clockevents_shutdown() -> ... -> hv_ce_shutdown()
2333          * 3) a warning would be triggered if we call
2334          * clockevents_unbind_device(), which may sleep, in an
2335          * interrupts-disabled context.
2336          */
2337
2338         hv_synic_disable_regs(0);
2339
2340         return 0;
2341 }
2342
2343 static void hv_synic_resume(void)
2344 {
2345         hv_synic_enable_regs(0);
2346
2347         /*
2348          * Note: we don't need to call hv_stimer_init(0), because the timer
2349          * on CPU0 is not unbound in hv_synic_suspend(), and the timer is
2350          * automatically re-enabled in timekeeping_resume().
2351          */
2352 }
2353
2354 /* The callbacks run only on CPU0, with irqs_disabled. */
2355 static struct syscore_ops hv_synic_syscore_ops = {
2356         .suspend = hv_synic_suspend,
2357         .resume = hv_synic_resume,
2358 };
2359
2360 static int __init hv_acpi_init(void)
2361 {
2362         int ret, t;
2363
2364         if (!hv_is_hyperv_initialized())
2365                 return -ENODEV;
2366
2367         init_completion(&probe_event);
2368
2369         /*
2370          * Get ACPI resources first.
2371          */
2372         ret = acpi_bus_register_driver(&vmbus_acpi_driver);
2373
2374         if (ret)
2375                 return ret;
2376
2377         t = wait_for_completion_timeout(&probe_event, 5*HZ);
2378         if (t == 0) {
2379                 ret = -ETIMEDOUT;
2380                 goto cleanup;
2381         }
2382         hv_debug_init();
2383
2384         ret = vmbus_bus_init();
2385         if (ret)
2386                 goto cleanup;
2387
2388         hv_setup_kexec_handler(hv_kexec_handler);
2389         hv_setup_crash_handler(hv_crash_handler);
2390
2391         register_syscore_ops(&hv_synic_syscore_ops);
2392
2393         return 0;
2394
2395 cleanup:
2396         acpi_bus_unregister_driver(&vmbus_acpi_driver);
2397         hv_acpi_dev = NULL;
2398         return ret;
2399 }
2400
2401 static void __exit vmbus_exit(void)
2402 {
2403         int cpu;
2404
2405         unregister_syscore_ops(&hv_synic_syscore_ops);
2406
2407         hv_remove_kexec_handler();
2408         hv_remove_crash_handler();
2409         vmbus_connection.conn_state = DISCONNECTED;
2410         hv_stimer_global_cleanup();
2411         vmbus_disconnect();
2412         hv_remove_vmbus_irq();
2413         for_each_online_cpu(cpu) {
2414                 struct hv_per_cpu_context *hv_cpu
2415                         = per_cpu_ptr(hv_context.cpu_context, cpu);
2416
2417                 tasklet_kill(&hv_cpu->msg_dpc);
2418         }
2419         hv_debug_rm_all_dir();
2420
2421         vmbus_free_channels();
2422
2423         if (ms_hyperv.misc_features & HV_FEATURE_GUEST_CRASH_MSR_AVAILABLE) {
2424                 kmsg_dump_unregister(&hv_kmsg_dumper);
2425                 unregister_die_notifier(&hyperv_die_block);
2426                 atomic_notifier_chain_unregister(&panic_notifier_list,
2427                                                  &hyperv_panic_block);
2428         }
2429
2430         free_page((unsigned long)hv_panic_page);
2431         unregister_sysctl_table(hv_ctl_table_hdr);
2432         hv_ctl_table_hdr = NULL;
2433         bus_unregister(&hv_bus);
2434
2435         cpuhp_remove_state(hyperv_cpuhp_online);
2436         hv_synic_free();
2437         acpi_bus_unregister_driver(&vmbus_acpi_driver);
2438 }
2439
2440
2441 MODULE_LICENSE("GPL");
2442 MODULE_DESCRIPTION("Microsoft Hyper-V VMBus Driver");
2443
2444 subsys_initcall(hv_acpi_init);
2445 module_exit(vmbus_exit);