1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Virtio-mem device driver. 4 * 5 * Copyright Red Hat, Inc. 2020 6 * 7 * Author(s): David Hildenbrand <david@redhat.com> 8 */ 9 10 #include <linux/virtio.h> 11 #include <linux/virtio_mem.h> 12 #include <linux/workqueue.h> 13 #include <linux/slab.h> 14 #include <linux/module.h> 15 #include <linux/mm.h> 16 #include <linux/memory_hotplug.h> 17 #include <linux/memory.h> 18 #include <linux/hrtimer.h> 19 #include <linux/crash_dump.h> 20 #include <linux/mutex.h> 21 #include <linux/bitmap.h> 22 #include <linux/lockdep.h> 23 #include <linux/log2.h> 24 25 #include <acpi/acpi_numa.h> 26 27 static bool unplug_online = true; 28 module_param(unplug_online, bool, 0644); 29 MODULE_PARM_DESC(unplug_online, "Try to unplug online memory"); 30 31 static bool force_bbm; 32 module_param(force_bbm, bool, 0444); 33 MODULE_PARM_DESC(force_bbm, 34 "Force Big Block Mode. Default is 0 (auto-selection)"); 35 36 static unsigned long bbm_block_size; 37 module_param(bbm_block_size, ulong, 0444); 38 MODULE_PARM_DESC(bbm_block_size, 39 "Big Block size in bytes. Default is 0 (auto-detection)."); 40 41 /* 42 * virtio-mem currently supports the following modes of operation: 43 * 44 * * Sub Block Mode (SBM): A Linux memory block spans 2..X subblocks (SB). The 45 * size of a Sub Block (SB) is determined based on the device block size, the 46 * pageblock size, and the maximum allocation granularity of the buddy. 47 * Subblocks within a Linux memory block might either be plugged or unplugged. 48 * Memory is added/removed to Linux MM in Linux memory block granularity. 49 * 50 * * Big Block Mode (BBM): A Big Block (BB) spans 1..X Linux memory blocks. 51 * Memory is added/removed to Linux MM in Big Block granularity. 52 * 53 * The mode is determined automatically based on the Linux memory block size 54 * and the device block size. 55 * 56 * User space / core MM (auto onlining) is responsible for onlining added 57 * Linux memory blocks - and for selecting a zone. Linux Memory Blocks are 58 * always onlined separately, and all memory within a Linux memory block is 59 * onlined to the same zone - virtio-mem relies on this behavior. 60 */ 61 62 /* 63 * State of a Linux memory block in SBM. 64 */ 65 enum virtio_mem_sbm_mb_state { 66 /* Unplugged, not added to Linux. Can be reused later. */ 67 VIRTIO_MEM_SBM_MB_UNUSED = 0, 68 /* (Partially) plugged, not added to Linux. Error on add_memory(). */ 69 VIRTIO_MEM_SBM_MB_PLUGGED, 70 /* Fully plugged, fully added to Linux, offline. */ 71 VIRTIO_MEM_SBM_MB_OFFLINE, 72 /* Partially plugged, fully added to Linux, offline. */ 73 VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL, 74 /* Fully plugged, fully added to Linux, onlined to a kernel zone. */ 75 VIRTIO_MEM_SBM_MB_KERNEL, 76 /* Partially plugged, fully added to Linux, online to a kernel zone */ 77 VIRTIO_MEM_SBM_MB_KERNEL_PARTIAL, 78 /* Fully plugged, fully added to Linux, onlined to ZONE_MOVABLE. */ 79 VIRTIO_MEM_SBM_MB_MOVABLE, 80 /* Partially plugged, fully added to Linux, onlined to ZONE_MOVABLE. */ 81 VIRTIO_MEM_SBM_MB_MOVABLE_PARTIAL, 82 VIRTIO_MEM_SBM_MB_COUNT 83 }; 84 85 /* 86 * State of a Big Block (BB) in BBM, covering 1..X Linux memory blocks. 87 */ 88 enum virtio_mem_bbm_bb_state { 89 /* Unplugged, not added to Linux. Can be reused later. */ 90 VIRTIO_MEM_BBM_BB_UNUSED = 0, 91 /* Plugged, not added to Linux. Error on add_memory(). */ 92 VIRTIO_MEM_BBM_BB_PLUGGED, 93 /* Plugged and added to Linux. */ 94 VIRTIO_MEM_BBM_BB_ADDED, 95 /* All online parts are fake-offline, ready to remove. */ 96 VIRTIO_MEM_BBM_BB_FAKE_OFFLINE, 97 VIRTIO_MEM_BBM_BB_COUNT 98 }; 99 100 struct virtio_mem { 101 struct virtio_device *vdev; 102 103 /* We might first have to unplug all memory when starting up. */ 104 bool unplug_all_required; 105 106 /* Workqueue that processes the plug/unplug requests. */ 107 struct work_struct wq; 108 atomic_t wq_active; 109 atomic_t config_changed; 110 111 /* Virtqueue for guest->host requests. */ 112 struct virtqueue *vq; 113 114 /* Wait for a host response to a guest request. */ 115 wait_queue_head_t host_resp; 116 117 /* Space for one guest request and the host response. */ 118 struct virtio_mem_req req; 119 struct virtio_mem_resp resp; 120 121 /* The current size of the device. */ 122 uint64_t plugged_size; 123 /* The requested size of the device. */ 124 uint64_t requested_size; 125 126 /* The device block size (for communicating with the device). */ 127 uint64_t device_block_size; 128 /* The determined node id for all memory of the device. */ 129 int nid; 130 /* Physical start address of the memory region. */ 131 uint64_t addr; 132 /* Maximum region size in bytes. */ 133 uint64_t region_size; 134 135 /* The parent resource for all memory added via this device. */ 136 struct resource *parent_resource; 137 /* 138 * Copy of "System RAM (virtio_mem)" to be used for 139 * add_memory_driver_managed(). 140 */ 141 const char *resource_name; 142 /* Memory group identification. */ 143 int mgid; 144 145 /* 146 * We don't want to add too much memory if it's not getting onlined, 147 * to avoid running OOM. Besides this threshold, we allow to have at 148 * least two offline blocks at a time (whatever is bigger). 149 */ 150 #define VIRTIO_MEM_DEFAULT_OFFLINE_THRESHOLD (1024 * 1024 * 1024) 151 atomic64_t offline_size; 152 uint64_t offline_threshold; 153 154 /* If set, the driver is in SBM, otherwise in BBM. */ 155 bool in_sbm; 156 157 union { 158 struct { 159 /* Id of the first memory block of this device. */ 160 unsigned long first_mb_id; 161 /* Id of the last usable memory block of this device. */ 162 unsigned long last_usable_mb_id; 163 /* Id of the next memory bock to prepare when needed. */ 164 unsigned long next_mb_id; 165 166 /* The subblock size. */ 167 uint64_t sb_size; 168 /* The number of subblocks per Linux memory block. */ 169 uint32_t sbs_per_mb; 170 171 /* 172 * Some of the Linux memory blocks tracked as "partially 173 * plugged" are completely unplugged and can be offlined 174 * and removed -- which previously failed. 175 */ 176 bool have_unplugged_mb; 177 178 /* Summary of all memory block states. */ 179 unsigned long mb_count[VIRTIO_MEM_SBM_MB_COUNT]; 180 181 /* 182 * One byte state per memory block. Allocated via 183 * vmalloc(). Resized (alloc+copy+free) on demand. 184 * 185 * With 128 MiB memory blocks, we have states for 512 186 * GiB of memory in one 4 KiB page. 187 */ 188 uint8_t *mb_states; 189 190 /* 191 * Bitmap: one bit per subblock. Allocated similar to 192 * sbm.mb_states. 193 * 194 * A set bit means the corresponding subblock is 195 * plugged, otherwise it's unblocked. 196 * 197 * With 4 MiB subblocks, we manage 128 GiB of memory 198 * in one 4 KiB page. 199 */ 200 unsigned long *sb_states; 201 } sbm; 202 203 struct { 204 /* Id of the first big block of this device. */ 205 unsigned long first_bb_id; 206 /* Id of the last usable big block of this device. */ 207 unsigned long last_usable_bb_id; 208 /* Id of the next device bock to prepare when needed. */ 209 unsigned long next_bb_id; 210 211 /* Summary of all big block states. */ 212 unsigned long bb_count[VIRTIO_MEM_BBM_BB_COUNT]; 213 214 /* One byte state per big block. See sbm.mb_states. */ 215 uint8_t *bb_states; 216 217 /* The block size used for plugging/adding/removing. */ 218 uint64_t bb_size; 219 } bbm; 220 }; 221 222 /* 223 * Mutex that protects the sbm.mb_count, sbm.mb_states, 224 * sbm.sb_states, bbm.bb_count, and bbm.bb_states 225 * 226 * When this lock is held the pointers can't change, ONLINE and 227 * OFFLINE blocks can't change the state and no subblocks will get 228 * plugged/unplugged. 229 * 230 * In kdump mode, used to serialize requests, last_block_addr and 231 * last_block_plugged. 232 */ 233 struct mutex hotplug_mutex; 234 bool hotplug_active; 235 236 /* An error occurred we cannot handle - stop processing requests. */ 237 bool broken; 238 239 /* Cached valued of is_kdump_kernel() when the device was probed. */ 240 bool in_kdump; 241 242 /* The driver is being removed. */ 243 spinlock_t removal_lock; 244 bool removing; 245 246 /* Timer for retrying to plug/unplug memory. */ 247 struct hrtimer retry_timer; 248 unsigned int retry_timer_ms; 249 #define VIRTIO_MEM_RETRY_TIMER_MIN_MS 50000 250 #define VIRTIO_MEM_RETRY_TIMER_MAX_MS 300000 251 252 /* Memory notifier (online/offline events). */ 253 struct notifier_block memory_notifier; 254 255 #ifdef CONFIG_PROC_VMCORE 256 /* vmcore callback for /proc/vmcore handling in kdump mode */ 257 struct vmcore_cb vmcore_cb; 258 uint64_t last_block_addr; 259 bool last_block_plugged; 260 #endif /* CONFIG_PROC_VMCORE */ 261 262 /* Next device in the list of virtio-mem devices. */ 263 struct list_head next; 264 }; 265 266 /* 267 * We have to share a single online_page callback among all virtio-mem 268 * devices. We use RCU to iterate the list in the callback. 269 */ 270 static DEFINE_MUTEX(virtio_mem_mutex); 271 static LIST_HEAD(virtio_mem_devices); 272 273 static void virtio_mem_online_page_cb(struct page *page, unsigned int order); 274 static void virtio_mem_fake_offline_going_offline(unsigned long pfn, 275 unsigned long nr_pages); 276 static void virtio_mem_fake_offline_cancel_offline(unsigned long pfn, 277 unsigned long nr_pages); 278 static void virtio_mem_retry(struct virtio_mem *vm); 279 static int virtio_mem_create_resource(struct virtio_mem *vm); 280 static void virtio_mem_delete_resource(struct virtio_mem *vm); 281 282 /* 283 * Register a virtio-mem device so it will be considered for the online_page 284 * callback. 285 */ 286 static int register_virtio_mem_device(struct virtio_mem *vm) 287 { 288 int rc = 0; 289 290 /* First device registers the callback. */ 291 mutex_lock(&virtio_mem_mutex); 292 if (list_empty(&virtio_mem_devices)) 293 rc = set_online_page_callback(&virtio_mem_online_page_cb); 294 if (!rc) 295 list_add_rcu(&vm->next, &virtio_mem_devices); 296 mutex_unlock(&virtio_mem_mutex); 297 298 return rc; 299 } 300 301 /* 302 * Unregister a virtio-mem device so it will no longer be considered for the 303 * online_page callback. 304 */ 305 static void unregister_virtio_mem_device(struct virtio_mem *vm) 306 { 307 /* Last device unregisters the callback. */ 308 mutex_lock(&virtio_mem_mutex); 309 list_del_rcu(&vm->next); 310 if (list_empty(&virtio_mem_devices)) 311 restore_online_page_callback(&virtio_mem_online_page_cb); 312 mutex_unlock(&virtio_mem_mutex); 313 314 synchronize_rcu(); 315 } 316 317 /* 318 * Calculate the memory block id of a given address. 319 */ 320 static unsigned long virtio_mem_phys_to_mb_id(unsigned long addr) 321 { 322 return addr / memory_block_size_bytes(); 323 } 324 325 /* 326 * Calculate the physical start address of a given memory block id. 327 */ 328 static unsigned long virtio_mem_mb_id_to_phys(unsigned long mb_id) 329 { 330 return mb_id * memory_block_size_bytes(); 331 } 332 333 /* 334 * Calculate the big block id of a given address. 335 */ 336 static unsigned long virtio_mem_phys_to_bb_id(struct virtio_mem *vm, 337 uint64_t addr) 338 { 339 return addr / vm->bbm.bb_size; 340 } 341 342 /* 343 * Calculate the physical start address of a given big block id. 344 */ 345 static uint64_t virtio_mem_bb_id_to_phys(struct virtio_mem *vm, 346 unsigned long bb_id) 347 { 348 return bb_id * vm->bbm.bb_size; 349 } 350 351 /* 352 * Calculate the subblock id of a given address. 353 */ 354 static unsigned long virtio_mem_phys_to_sb_id(struct virtio_mem *vm, 355 unsigned long addr) 356 { 357 const unsigned long mb_id = virtio_mem_phys_to_mb_id(addr); 358 const unsigned long mb_addr = virtio_mem_mb_id_to_phys(mb_id); 359 360 return (addr - mb_addr) / vm->sbm.sb_size; 361 } 362 363 /* 364 * Set the state of a big block, taking care of the state counter. 365 */ 366 static void virtio_mem_bbm_set_bb_state(struct virtio_mem *vm, 367 unsigned long bb_id, 368 enum virtio_mem_bbm_bb_state state) 369 { 370 const unsigned long idx = bb_id - vm->bbm.first_bb_id; 371 enum virtio_mem_bbm_bb_state old_state; 372 373 old_state = vm->bbm.bb_states[idx]; 374 vm->bbm.bb_states[idx] = state; 375 376 BUG_ON(vm->bbm.bb_count[old_state] == 0); 377 vm->bbm.bb_count[old_state]--; 378 vm->bbm.bb_count[state]++; 379 } 380 381 /* 382 * Get the state of a big block. 383 */ 384 static enum virtio_mem_bbm_bb_state virtio_mem_bbm_get_bb_state(struct virtio_mem *vm, 385 unsigned long bb_id) 386 { 387 return vm->bbm.bb_states[bb_id - vm->bbm.first_bb_id]; 388 } 389 390 /* 391 * Prepare the big block state array for the next big block. 392 */ 393 static int virtio_mem_bbm_bb_states_prepare_next_bb(struct virtio_mem *vm) 394 { 395 unsigned long old_bytes = vm->bbm.next_bb_id - vm->bbm.first_bb_id; 396 unsigned long new_bytes = old_bytes + 1; 397 int old_pages = PFN_UP(old_bytes); 398 int new_pages = PFN_UP(new_bytes); 399 uint8_t *new_array; 400 401 if (vm->bbm.bb_states && old_pages == new_pages) 402 return 0; 403 404 new_array = vzalloc(new_pages * PAGE_SIZE); 405 if (!new_array) 406 return -ENOMEM; 407 408 mutex_lock(&vm->hotplug_mutex); 409 if (vm->bbm.bb_states) 410 memcpy(new_array, vm->bbm.bb_states, old_pages * PAGE_SIZE); 411 vfree(vm->bbm.bb_states); 412 vm->bbm.bb_states = new_array; 413 mutex_unlock(&vm->hotplug_mutex); 414 415 return 0; 416 } 417 418 #define virtio_mem_bbm_for_each_bb(_vm, _bb_id, _state) \ 419 for (_bb_id = vm->bbm.first_bb_id; \ 420 _bb_id < vm->bbm.next_bb_id && _vm->bbm.bb_count[_state]; \ 421 _bb_id++) \ 422 if (virtio_mem_bbm_get_bb_state(_vm, _bb_id) == _state) 423 424 #define virtio_mem_bbm_for_each_bb_rev(_vm, _bb_id, _state) \ 425 for (_bb_id = vm->bbm.next_bb_id - 1; \ 426 _bb_id >= vm->bbm.first_bb_id && _vm->bbm.bb_count[_state]; \ 427 _bb_id--) \ 428 if (virtio_mem_bbm_get_bb_state(_vm, _bb_id) == _state) 429 430 /* 431 * Set the state of a memory block, taking care of the state counter. 432 */ 433 static void virtio_mem_sbm_set_mb_state(struct virtio_mem *vm, 434 unsigned long mb_id, uint8_t state) 435 { 436 const unsigned long idx = mb_id - vm->sbm.first_mb_id; 437 uint8_t old_state; 438 439 old_state = vm->sbm.mb_states[idx]; 440 vm->sbm.mb_states[idx] = state; 441 442 BUG_ON(vm->sbm.mb_count[old_state] == 0); 443 vm->sbm.mb_count[old_state]--; 444 vm->sbm.mb_count[state]++; 445 } 446 447 /* 448 * Get the state of a memory block. 449 */ 450 static uint8_t virtio_mem_sbm_get_mb_state(struct virtio_mem *vm, 451 unsigned long mb_id) 452 { 453 const unsigned long idx = mb_id - vm->sbm.first_mb_id; 454 455 return vm->sbm.mb_states[idx]; 456 } 457 458 /* 459 * Prepare the state array for the next memory block. 460 */ 461 static int virtio_mem_sbm_mb_states_prepare_next_mb(struct virtio_mem *vm) 462 { 463 int old_pages = PFN_UP(vm->sbm.next_mb_id - vm->sbm.first_mb_id); 464 int new_pages = PFN_UP(vm->sbm.next_mb_id - vm->sbm.first_mb_id + 1); 465 uint8_t *new_array; 466 467 if (vm->sbm.mb_states && old_pages == new_pages) 468 return 0; 469 470 new_array = vzalloc(new_pages * PAGE_SIZE); 471 if (!new_array) 472 return -ENOMEM; 473 474 mutex_lock(&vm->hotplug_mutex); 475 if (vm->sbm.mb_states) 476 memcpy(new_array, vm->sbm.mb_states, old_pages * PAGE_SIZE); 477 vfree(vm->sbm.mb_states); 478 vm->sbm.mb_states = new_array; 479 mutex_unlock(&vm->hotplug_mutex); 480 481 return 0; 482 } 483 484 #define virtio_mem_sbm_for_each_mb(_vm, _mb_id, _state) \ 485 for (_mb_id = _vm->sbm.first_mb_id; \ 486 _mb_id < _vm->sbm.next_mb_id && _vm->sbm.mb_count[_state]; \ 487 _mb_id++) \ 488 if (virtio_mem_sbm_get_mb_state(_vm, _mb_id) == _state) 489 490 #define virtio_mem_sbm_for_each_mb_rev(_vm, _mb_id, _state) \ 491 for (_mb_id = _vm->sbm.next_mb_id - 1; \ 492 _mb_id >= _vm->sbm.first_mb_id && _vm->sbm.mb_count[_state]; \ 493 _mb_id--) \ 494 if (virtio_mem_sbm_get_mb_state(_vm, _mb_id) == _state) 495 496 /* 497 * Calculate the bit number in the subblock bitmap for the given subblock 498 * inside the given memory block. 499 */ 500 static int virtio_mem_sbm_sb_state_bit_nr(struct virtio_mem *vm, 501 unsigned long mb_id, int sb_id) 502 { 503 return (mb_id - vm->sbm.first_mb_id) * vm->sbm.sbs_per_mb + sb_id; 504 } 505 506 /* 507 * Mark all selected subblocks plugged. 508 * 509 * Will not modify the state of the memory block. 510 */ 511 static void virtio_mem_sbm_set_sb_plugged(struct virtio_mem *vm, 512 unsigned long mb_id, int sb_id, 513 int count) 514 { 515 const int bit = virtio_mem_sbm_sb_state_bit_nr(vm, mb_id, sb_id); 516 517 __bitmap_set(vm->sbm.sb_states, bit, count); 518 } 519 520 /* 521 * Mark all selected subblocks unplugged. 522 * 523 * Will not modify the state of the memory block. 524 */ 525 static void virtio_mem_sbm_set_sb_unplugged(struct virtio_mem *vm, 526 unsigned long mb_id, int sb_id, 527 int count) 528 { 529 const int bit = virtio_mem_sbm_sb_state_bit_nr(vm, mb_id, sb_id); 530 531 __bitmap_clear(vm->sbm.sb_states, bit, count); 532 } 533 534 /* 535 * Test if all selected subblocks are plugged. 536 */ 537 static bool virtio_mem_sbm_test_sb_plugged(struct virtio_mem *vm, 538 unsigned long mb_id, int sb_id, 539 int count) 540 { 541 const int bit = virtio_mem_sbm_sb_state_bit_nr(vm, mb_id, sb_id); 542 543 if (count == 1) 544 return test_bit(bit, vm->sbm.sb_states); 545 546 /* TODO: Helper similar to bitmap_set() */ 547 return find_next_zero_bit(vm->sbm.sb_states, bit + count, bit) >= 548 bit + count; 549 } 550 551 /* 552 * Test if all selected subblocks are unplugged. 553 */ 554 static bool virtio_mem_sbm_test_sb_unplugged(struct virtio_mem *vm, 555 unsigned long mb_id, int sb_id, 556 int count) 557 { 558 const int bit = virtio_mem_sbm_sb_state_bit_nr(vm, mb_id, sb_id); 559 560 /* TODO: Helper similar to bitmap_set() */ 561 return find_next_bit(vm->sbm.sb_states, bit + count, bit) >= 562 bit + count; 563 } 564 565 /* 566 * Find the first unplugged subblock. Returns vm->sbm.sbs_per_mb in case there is 567 * none. 568 */ 569 static int virtio_mem_sbm_first_unplugged_sb(struct virtio_mem *vm, 570 unsigned long mb_id) 571 { 572 const int bit = virtio_mem_sbm_sb_state_bit_nr(vm, mb_id, 0); 573 574 return find_next_zero_bit(vm->sbm.sb_states, 575 bit + vm->sbm.sbs_per_mb, bit) - bit; 576 } 577 578 /* 579 * Prepare the subblock bitmap for the next memory block. 580 */ 581 static int virtio_mem_sbm_sb_states_prepare_next_mb(struct virtio_mem *vm) 582 { 583 const unsigned long old_nb_mb = vm->sbm.next_mb_id - vm->sbm.first_mb_id; 584 const unsigned long old_nb_bits = old_nb_mb * vm->sbm.sbs_per_mb; 585 const unsigned long new_nb_bits = (old_nb_mb + 1) * vm->sbm.sbs_per_mb; 586 int old_pages = PFN_UP(BITS_TO_LONGS(old_nb_bits) * sizeof(long)); 587 int new_pages = PFN_UP(BITS_TO_LONGS(new_nb_bits) * sizeof(long)); 588 unsigned long *new_bitmap, *old_bitmap; 589 590 if (vm->sbm.sb_states && old_pages == new_pages) 591 return 0; 592 593 new_bitmap = vzalloc(new_pages * PAGE_SIZE); 594 if (!new_bitmap) 595 return -ENOMEM; 596 597 mutex_lock(&vm->hotplug_mutex); 598 if (vm->sbm.sb_states) 599 memcpy(new_bitmap, vm->sbm.sb_states, old_pages * PAGE_SIZE); 600 601 old_bitmap = vm->sbm.sb_states; 602 vm->sbm.sb_states = new_bitmap; 603 mutex_unlock(&vm->hotplug_mutex); 604 605 vfree(old_bitmap); 606 return 0; 607 } 608 609 /* 610 * Test if we could add memory without creating too much offline memory - 611 * to avoid running OOM if memory is getting onlined deferred. 612 */ 613 static bool virtio_mem_could_add_memory(struct virtio_mem *vm, uint64_t size) 614 { 615 if (WARN_ON_ONCE(size > vm->offline_threshold)) 616 return false; 617 618 return atomic64_read(&vm->offline_size) + size <= vm->offline_threshold; 619 } 620 621 /* 622 * Try adding memory to Linux. Will usually only fail if out of memory. 623 * 624 * Must not be called with the vm->hotplug_mutex held (possible deadlock with 625 * onlining code). 626 * 627 * Will not modify the state of memory blocks in virtio-mem. 628 */ 629 static int virtio_mem_add_memory(struct virtio_mem *vm, uint64_t addr, 630 uint64_t size) 631 { 632 int rc; 633 634 /* 635 * When force-unloading the driver and we still have memory added to 636 * Linux, the resource name has to stay. 637 */ 638 if (!vm->resource_name) { 639 vm->resource_name = kstrdup_const("System RAM (virtio_mem)", 640 GFP_KERNEL); 641 if (!vm->resource_name) 642 return -ENOMEM; 643 } 644 645 dev_dbg(&vm->vdev->dev, "adding memory: 0x%llx - 0x%llx\n", addr, 646 addr + size - 1); 647 /* Memory might get onlined immediately. */ 648 atomic64_add(size, &vm->offline_size); 649 rc = add_memory_driver_managed(vm->mgid, addr, size, vm->resource_name, 650 MHP_MERGE_RESOURCE | MHP_NID_IS_MGID); 651 if (rc) { 652 atomic64_sub(size, &vm->offline_size); 653 dev_warn(&vm->vdev->dev, "adding memory failed: %d\n", rc); 654 /* 655 * TODO: Linux MM does not properly clean up yet in all cases 656 * where adding of memory failed - especially on -ENOMEM. 657 */ 658 } 659 return rc; 660 } 661 662 /* 663 * See virtio_mem_add_memory(): Try adding a single Linux memory block. 664 */ 665 static int virtio_mem_sbm_add_mb(struct virtio_mem *vm, unsigned long mb_id) 666 { 667 const uint64_t addr = virtio_mem_mb_id_to_phys(mb_id); 668 const uint64_t size = memory_block_size_bytes(); 669 670 return virtio_mem_add_memory(vm, addr, size); 671 } 672 673 /* 674 * See virtio_mem_add_memory(): Try adding a big block. 675 */ 676 static int virtio_mem_bbm_add_bb(struct virtio_mem *vm, unsigned long bb_id) 677 { 678 const uint64_t addr = virtio_mem_bb_id_to_phys(vm, bb_id); 679 const uint64_t size = vm->bbm.bb_size; 680 681 return virtio_mem_add_memory(vm, addr, size); 682 } 683 684 /* 685 * Try removing memory from Linux. Will only fail if memory blocks aren't 686 * offline. 687 * 688 * Must not be called with the vm->hotplug_mutex held (possible deadlock with 689 * onlining code). 690 * 691 * Will not modify the state of memory blocks in virtio-mem. 692 */ 693 static int virtio_mem_remove_memory(struct virtio_mem *vm, uint64_t addr, 694 uint64_t size) 695 { 696 int rc; 697 698 dev_dbg(&vm->vdev->dev, "removing memory: 0x%llx - 0x%llx\n", addr, 699 addr + size - 1); 700 rc = remove_memory(addr, size); 701 if (!rc) { 702 atomic64_sub(size, &vm->offline_size); 703 /* 704 * We might have freed up memory we can now unplug, retry 705 * immediately instead of waiting. 706 */ 707 virtio_mem_retry(vm); 708 } else { 709 dev_dbg(&vm->vdev->dev, "removing memory failed: %d\n", rc); 710 } 711 return rc; 712 } 713 714 /* 715 * See virtio_mem_remove_memory(): Try removing a single Linux memory block. 716 */ 717 static int virtio_mem_sbm_remove_mb(struct virtio_mem *vm, unsigned long mb_id) 718 { 719 const uint64_t addr = virtio_mem_mb_id_to_phys(mb_id); 720 const uint64_t size = memory_block_size_bytes(); 721 722 return virtio_mem_remove_memory(vm, addr, size); 723 } 724 725 /* 726 * Try offlining and removing memory from Linux. 727 * 728 * Must not be called with the vm->hotplug_mutex held (possible deadlock with 729 * onlining code). 730 * 731 * Will not modify the state of memory blocks in virtio-mem. 732 */ 733 static int virtio_mem_offline_and_remove_memory(struct virtio_mem *vm, 734 uint64_t addr, 735 uint64_t size) 736 { 737 int rc; 738 739 dev_dbg(&vm->vdev->dev, 740 "offlining and removing memory: 0x%llx - 0x%llx\n", addr, 741 addr + size - 1); 742 743 rc = offline_and_remove_memory(addr, size); 744 if (!rc) { 745 atomic64_sub(size, &vm->offline_size); 746 /* 747 * We might have freed up memory we can now unplug, retry 748 * immediately instead of waiting. 749 */ 750 virtio_mem_retry(vm); 751 return 0; 752 } 753 dev_dbg(&vm->vdev->dev, "offlining and removing memory failed: %d\n", rc); 754 /* 755 * We don't really expect this to fail, because we fake-offlined all 756 * memory already. But it could fail in corner cases. 757 */ 758 WARN_ON_ONCE(rc != -ENOMEM && rc != -EBUSY); 759 return rc == -ENOMEM ? -ENOMEM : -EBUSY; 760 } 761 762 /* 763 * See virtio_mem_offline_and_remove_memory(): Try offlining and removing 764 * a single Linux memory block. 765 */ 766 static int virtio_mem_sbm_offline_and_remove_mb(struct virtio_mem *vm, 767 unsigned long mb_id) 768 { 769 const uint64_t addr = virtio_mem_mb_id_to_phys(mb_id); 770 const uint64_t size = memory_block_size_bytes(); 771 772 return virtio_mem_offline_and_remove_memory(vm, addr, size); 773 } 774 775 /* 776 * Try (offlining and) removing memory from Linux in case all subblocks are 777 * unplugged. Can be called on online and offline memory blocks. 778 * 779 * May modify the state of memory blocks in virtio-mem. 780 */ 781 static int virtio_mem_sbm_try_remove_unplugged_mb(struct virtio_mem *vm, 782 unsigned long mb_id) 783 { 784 int rc; 785 786 /* 787 * Once all subblocks of a memory block were unplugged, offline and 788 * remove it. 789 */ 790 if (!virtio_mem_sbm_test_sb_unplugged(vm, mb_id, 0, vm->sbm.sbs_per_mb)) 791 return 0; 792 793 /* offline_and_remove_memory() works for online and offline memory. */ 794 mutex_unlock(&vm->hotplug_mutex); 795 rc = virtio_mem_sbm_offline_and_remove_mb(vm, mb_id); 796 mutex_lock(&vm->hotplug_mutex); 797 if (!rc) 798 virtio_mem_sbm_set_mb_state(vm, mb_id, 799 VIRTIO_MEM_SBM_MB_UNUSED); 800 return rc; 801 } 802 803 /* 804 * See virtio_mem_offline_and_remove_memory(): Try to offline and remove a 805 * all Linux memory blocks covered by the big block. 806 */ 807 static int virtio_mem_bbm_offline_and_remove_bb(struct virtio_mem *vm, 808 unsigned long bb_id) 809 { 810 const uint64_t addr = virtio_mem_bb_id_to_phys(vm, bb_id); 811 const uint64_t size = vm->bbm.bb_size; 812 813 return virtio_mem_offline_and_remove_memory(vm, addr, size); 814 } 815 816 /* 817 * Trigger the workqueue so the device can perform its magic. 818 */ 819 static void virtio_mem_retry(struct virtio_mem *vm) 820 { 821 unsigned long flags; 822 823 spin_lock_irqsave(&vm->removal_lock, flags); 824 if (!vm->removing) 825 queue_work(system_freezable_wq, &vm->wq); 826 spin_unlock_irqrestore(&vm->removal_lock, flags); 827 } 828 829 static int virtio_mem_translate_node_id(struct virtio_mem *vm, uint16_t node_id) 830 { 831 int node = NUMA_NO_NODE; 832 833 #if defined(CONFIG_ACPI_NUMA) 834 if (virtio_has_feature(vm->vdev, VIRTIO_MEM_F_ACPI_PXM)) 835 node = pxm_to_node(node_id); 836 #endif 837 return node; 838 } 839 840 /* 841 * Test if a virtio-mem device overlaps with the given range. Can be called 842 * from (notifier) callbacks lockless. 843 */ 844 static bool virtio_mem_overlaps_range(struct virtio_mem *vm, uint64_t start, 845 uint64_t size) 846 { 847 return start < vm->addr + vm->region_size && vm->addr < start + size; 848 } 849 850 /* 851 * Test if a virtio-mem device contains a given range. Can be called from 852 * (notifier) callbacks lockless. 853 */ 854 static bool virtio_mem_contains_range(struct virtio_mem *vm, uint64_t start, 855 uint64_t size) 856 { 857 return start >= vm->addr && start + size <= vm->addr + vm->region_size; 858 } 859 860 static int virtio_mem_sbm_notify_going_online(struct virtio_mem *vm, 861 unsigned long mb_id) 862 { 863 switch (virtio_mem_sbm_get_mb_state(vm, mb_id)) { 864 case VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL: 865 case VIRTIO_MEM_SBM_MB_OFFLINE: 866 return NOTIFY_OK; 867 default: 868 break; 869 } 870 dev_warn_ratelimited(&vm->vdev->dev, 871 "memory block onlining denied\n"); 872 return NOTIFY_BAD; 873 } 874 875 static void virtio_mem_sbm_notify_offline(struct virtio_mem *vm, 876 unsigned long mb_id) 877 { 878 switch (virtio_mem_sbm_get_mb_state(vm, mb_id)) { 879 case VIRTIO_MEM_SBM_MB_KERNEL_PARTIAL: 880 case VIRTIO_MEM_SBM_MB_MOVABLE_PARTIAL: 881 virtio_mem_sbm_set_mb_state(vm, mb_id, 882 VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL); 883 break; 884 case VIRTIO_MEM_SBM_MB_KERNEL: 885 case VIRTIO_MEM_SBM_MB_MOVABLE: 886 virtio_mem_sbm_set_mb_state(vm, mb_id, 887 VIRTIO_MEM_SBM_MB_OFFLINE); 888 break; 889 default: 890 BUG(); 891 break; 892 } 893 } 894 895 static void virtio_mem_sbm_notify_online(struct virtio_mem *vm, 896 unsigned long mb_id, 897 unsigned long start_pfn) 898 { 899 const bool is_movable = is_zone_movable_page(pfn_to_page(start_pfn)); 900 int new_state; 901 902 switch (virtio_mem_sbm_get_mb_state(vm, mb_id)) { 903 case VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL: 904 new_state = VIRTIO_MEM_SBM_MB_KERNEL_PARTIAL; 905 if (is_movable) 906 new_state = VIRTIO_MEM_SBM_MB_MOVABLE_PARTIAL; 907 break; 908 case VIRTIO_MEM_SBM_MB_OFFLINE: 909 new_state = VIRTIO_MEM_SBM_MB_KERNEL; 910 if (is_movable) 911 new_state = VIRTIO_MEM_SBM_MB_MOVABLE; 912 break; 913 default: 914 BUG(); 915 break; 916 } 917 virtio_mem_sbm_set_mb_state(vm, mb_id, new_state); 918 } 919 920 static void virtio_mem_sbm_notify_going_offline(struct virtio_mem *vm, 921 unsigned long mb_id) 922 { 923 const unsigned long nr_pages = PFN_DOWN(vm->sbm.sb_size); 924 unsigned long pfn; 925 int sb_id; 926 927 for (sb_id = 0; sb_id < vm->sbm.sbs_per_mb; sb_id++) { 928 if (virtio_mem_sbm_test_sb_plugged(vm, mb_id, sb_id, 1)) 929 continue; 930 pfn = PFN_DOWN(virtio_mem_mb_id_to_phys(mb_id) + 931 sb_id * vm->sbm.sb_size); 932 virtio_mem_fake_offline_going_offline(pfn, nr_pages); 933 } 934 } 935 936 static void virtio_mem_sbm_notify_cancel_offline(struct virtio_mem *vm, 937 unsigned long mb_id) 938 { 939 const unsigned long nr_pages = PFN_DOWN(vm->sbm.sb_size); 940 unsigned long pfn; 941 int sb_id; 942 943 for (sb_id = 0; sb_id < vm->sbm.sbs_per_mb; sb_id++) { 944 if (virtio_mem_sbm_test_sb_plugged(vm, mb_id, sb_id, 1)) 945 continue; 946 pfn = PFN_DOWN(virtio_mem_mb_id_to_phys(mb_id) + 947 sb_id * vm->sbm.sb_size); 948 virtio_mem_fake_offline_cancel_offline(pfn, nr_pages); 949 } 950 } 951 952 static void virtio_mem_bbm_notify_going_offline(struct virtio_mem *vm, 953 unsigned long bb_id, 954 unsigned long pfn, 955 unsigned long nr_pages) 956 { 957 /* 958 * When marked as "fake-offline", all online memory of this device block 959 * is allocated by us. Otherwise, we don't have any memory allocated. 960 */ 961 if (virtio_mem_bbm_get_bb_state(vm, bb_id) != 962 VIRTIO_MEM_BBM_BB_FAKE_OFFLINE) 963 return; 964 virtio_mem_fake_offline_going_offline(pfn, nr_pages); 965 } 966 967 static void virtio_mem_bbm_notify_cancel_offline(struct virtio_mem *vm, 968 unsigned long bb_id, 969 unsigned long pfn, 970 unsigned long nr_pages) 971 { 972 if (virtio_mem_bbm_get_bb_state(vm, bb_id) != 973 VIRTIO_MEM_BBM_BB_FAKE_OFFLINE) 974 return; 975 virtio_mem_fake_offline_cancel_offline(pfn, nr_pages); 976 } 977 978 /* 979 * This callback will either be called synchronously from add_memory() or 980 * asynchronously (e.g., triggered via user space). We have to be careful 981 * with locking when calling add_memory(). 982 */ 983 static int virtio_mem_memory_notifier_cb(struct notifier_block *nb, 984 unsigned long action, void *arg) 985 { 986 struct virtio_mem *vm = container_of(nb, struct virtio_mem, 987 memory_notifier); 988 struct memory_notify *mhp = arg; 989 const unsigned long start = PFN_PHYS(mhp->start_pfn); 990 const unsigned long size = PFN_PHYS(mhp->nr_pages); 991 int rc = NOTIFY_OK; 992 unsigned long id; 993 994 if (!virtio_mem_overlaps_range(vm, start, size)) 995 return NOTIFY_DONE; 996 997 if (vm->in_sbm) { 998 id = virtio_mem_phys_to_mb_id(start); 999 /* 1000 * In SBM, we add memory in separate memory blocks - we expect 1001 * it to be onlined/offlined in the same granularity. Bail out 1002 * if this ever changes. 1003 */ 1004 if (WARN_ON_ONCE(size != memory_block_size_bytes() || 1005 !IS_ALIGNED(start, memory_block_size_bytes()))) 1006 return NOTIFY_BAD; 1007 } else { 1008 id = virtio_mem_phys_to_bb_id(vm, start); 1009 /* 1010 * In BBM, we only care about onlining/offlining happening 1011 * within a single big block, we don't care about the 1012 * actual granularity as we don't track individual Linux 1013 * memory blocks. 1014 */ 1015 if (WARN_ON_ONCE(id != virtio_mem_phys_to_bb_id(vm, start + size - 1))) 1016 return NOTIFY_BAD; 1017 } 1018 1019 /* 1020 * Avoid circular locking lockdep warnings. We lock the mutex 1021 * e.g., in MEM_GOING_ONLINE and unlock it in MEM_ONLINE. The 1022 * blocking_notifier_call_chain() has it's own lock, which gets unlocked 1023 * between both notifier calls and will bail out. False positive. 1024 */ 1025 lockdep_off(); 1026 1027 switch (action) { 1028 case MEM_GOING_OFFLINE: 1029 mutex_lock(&vm->hotplug_mutex); 1030 if (vm->removing) { 1031 rc = notifier_from_errno(-EBUSY); 1032 mutex_unlock(&vm->hotplug_mutex); 1033 break; 1034 } 1035 vm->hotplug_active = true; 1036 if (vm->in_sbm) 1037 virtio_mem_sbm_notify_going_offline(vm, id); 1038 else 1039 virtio_mem_bbm_notify_going_offline(vm, id, 1040 mhp->start_pfn, 1041 mhp->nr_pages); 1042 break; 1043 case MEM_GOING_ONLINE: 1044 mutex_lock(&vm->hotplug_mutex); 1045 if (vm->removing) { 1046 rc = notifier_from_errno(-EBUSY); 1047 mutex_unlock(&vm->hotplug_mutex); 1048 break; 1049 } 1050 vm->hotplug_active = true; 1051 if (vm->in_sbm) 1052 rc = virtio_mem_sbm_notify_going_online(vm, id); 1053 break; 1054 case MEM_OFFLINE: 1055 if (vm->in_sbm) 1056 virtio_mem_sbm_notify_offline(vm, id); 1057 1058 atomic64_add(size, &vm->offline_size); 1059 /* 1060 * Trigger the workqueue. Now that we have some offline memory, 1061 * maybe we can handle pending unplug requests. 1062 */ 1063 if (!unplug_online) 1064 virtio_mem_retry(vm); 1065 1066 vm->hotplug_active = false; 1067 mutex_unlock(&vm->hotplug_mutex); 1068 break; 1069 case MEM_ONLINE: 1070 if (vm->in_sbm) 1071 virtio_mem_sbm_notify_online(vm, id, mhp->start_pfn); 1072 1073 atomic64_sub(size, &vm->offline_size); 1074 /* 1075 * Start adding more memory once we onlined half of our 1076 * threshold. Don't trigger if it's possibly due to our actipn 1077 * (e.g., us adding memory which gets onlined immediately from 1078 * the core). 1079 */ 1080 if (!atomic_read(&vm->wq_active) && 1081 virtio_mem_could_add_memory(vm, vm->offline_threshold / 2)) 1082 virtio_mem_retry(vm); 1083 1084 vm->hotplug_active = false; 1085 mutex_unlock(&vm->hotplug_mutex); 1086 break; 1087 case MEM_CANCEL_OFFLINE: 1088 if (!vm->hotplug_active) 1089 break; 1090 if (vm->in_sbm) 1091 virtio_mem_sbm_notify_cancel_offline(vm, id); 1092 else 1093 virtio_mem_bbm_notify_cancel_offline(vm, id, 1094 mhp->start_pfn, 1095 mhp->nr_pages); 1096 vm->hotplug_active = false; 1097 mutex_unlock(&vm->hotplug_mutex); 1098 break; 1099 case MEM_CANCEL_ONLINE: 1100 if (!vm->hotplug_active) 1101 break; 1102 vm->hotplug_active = false; 1103 mutex_unlock(&vm->hotplug_mutex); 1104 break; 1105 default: 1106 break; 1107 } 1108 1109 lockdep_on(); 1110 1111 return rc; 1112 } 1113 1114 /* 1115 * Set a range of pages PG_offline. Remember pages that were never onlined 1116 * (via generic_online_page()) using PageDirty(). 1117 */ 1118 static void virtio_mem_set_fake_offline(unsigned long pfn, 1119 unsigned long nr_pages, bool onlined) 1120 { 1121 page_offline_begin(); 1122 for (; nr_pages--; pfn++) { 1123 struct page *page = pfn_to_page(pfn); 1124 1125 __SetPageOffline(page); 1126 if (!onlined) { 1127 SetPageDirty(page); 1128 /* FIXME: remove after cleanups */ 1129 ClearPageReserved(page); 1130 } 1131 } 1132 page_offline_end(); 1133 } 1134 1135 /* 1136 * Clear PG_offline from a range of pages. If the pages were never onlined, 1137 * (via generic_online_page()), clear PageDirty(). 1138 */ 1139 static void virtio_mem_clear_fake_offline(unsigned long pfn, 1140 unsigned long nr_pages, bool onlined) 1141 { 1142 for (; nr_pages--; pfn++) { 1143 struct page *page = pfn_to_page(pfn); 1144 1145 __ClearPageOffline(page); 1146 if (!onlined) 1147 ClearPageDirty(page); 1148 } 1149 } 1150 1151 /* 1152 * Release a range of fake-offline pages to the buddy, effectively 1153 * fake-onlining them. 1154 */ 1155 static void virtio_mem_fake_online(unsigned long pfn, unsigned long nr_pages) 1156 { 1157 unsigned long order = MAX_PAGE_ORDER; 1158 unsigned long i; 1159 1160 /* 1161 * We might get called for ranges that don't cover properly aligned 1162 * MAX_PAGE_ORDER pages; however, we can only online properly aligned 1163 * pages with an order of MAX_PAGE_ORDER at maximum. 1164 */ 1165 while (!IS_ALIGNED(pfn | nr_pages, 1 << order)) 1166 order--; 1167 1168 for (i = 0; i < nr_pages; i += 1 << order) { 1169 struct page *page = pfn_to_page(pfn + i); 1170 1171 /* 1172 * If the page is PageDirty(), it was kept fake-offline when 1173 * onlining the memory block. Otherwise, it was allocated 1174 * using alloc_contig_range(). All pages in a subblock are 1175 * alike. 1176 */ 1177 if (PageDirty(page)) { 1178 virtio_mem_clear_fake_offline(pfn + i, 1 << order, false); 1179 generic_online_page(page, order); 1180 } else { 1181 virtio_mem_clear_fake_offline(pfn + i, 1 << order, true); 1182 free_contig_range(pfn + i, 1 << order); 1183 adjust_managed_page_count(page, 1 << order); 1184 } 1185 } 1186 } 1187 1188 /* 1189 * Try to allocate a range, marking pages fake-offline, effectively 1190 * fake-offlining them. 1191 */ 1192 static int virtio_mem_fake_offline(struct virtio_mem *vm, unsigned long pfn, 1193 unsigned long nr_pages) 1194 { 1195 const bool is_movable = is_zone_movable_page(pfn_to_page(pfn)); 1196 int rc, retry_count; 1197 1198 /* 1199 * TODO: We want an alloc_contig_range() mode that tries to allocate 1200 * harder (e.g., dealing with temporarily pinned pages, PCP), especially 1201 * with ZONE_MOVABLE. So for now, retry a couple of times with 1202 * ZONE_MOVABLE before giving up - because that zone is supposed to give 1203 * some guarantees. 1204 */ 1205 for (retry_count = 0; retry_count < 5; retry_count++) { 1206 /* 1207 * If the config changed, stop immediately and go back to the 1208 * main loop: avoid trying to keep unplugging if the device 1209 * might have decided to not remove any more memory. 1210 */ 1211 if (atomic_read(&vm->config_changed)) 1212 return -EAGAIN; 1213 1214 rc = alloc_contig_range(pfn, pfn + nr_pages, MIGRATE_MOVABLE, 1215 GFP_KERNEL); 1216 if (rc == -ENOMEM) 1217 /* whoops, out of memory */ 1218 return rc; 1219 else if (rc && !is_movable) 1220 break; 1221 else if (rc) 1222 continue; 1223 1224 virtio_mem_set_fake_offline(pfn, nr_pages, true); 1225 adjust_managed_page_count(pfn_to_page(pfn), -nr_pages); 1226 return 0; 1227 } 1228 1229 return -EBUSY; 1230 } 1231 1232 /* 1233 * Handle fake-offline pages when memory is going offline - such that the 1234 * pages can be skipped by mm-core when offlining. 1235 */ 1236 static void virtio_mem_fake_offline_going_offline(unsigned long pfn, 1237 unsigned long nr_pages) 1238 { 1239 struct page *page; 1240 unsigned long i; 1241 1242 /* 1243 * Drop our reference to the pages so the memory can get offlined 1244 * and add the unplugged pages to the managed page counters (so 1245 * offlining code can correctly subtract them again). 1246 */ 1247 adjust_managed_page_count(pfn_to_page(pfn), nr_pages); 1248 /* Drop our reference to the pages so the memory can get offlined. */ 1249 for (i = 0; i < nr_pages; i++) { 1250 page = pfn_to_page(pfn + i); 1251 if (WARN_ON(!page_ref_dec_and_test(page))) 1252 dump_page(page, "fake-offline page referenced"); 1253 } 1254 } 1255 1256 /* 1257 * Handle fake-offline pages when memory offlining is canceled - to undo 1258 * what we did in virtio_mem_fake_offline_going_offline(). 1259 */ 1260 static void virtio_mem_fake_offline_cancel_offline(unsigned long pfn, 1261 unsigned long nr_pages) 1262 { 1263 unsigned long i; 1264 1265 /* 1266 * Get the reference we dropped when going offline and subtract the 1267 * unplugged pages from the managed page counters. 1268 */ 1269 adjust_managed_page_count(pfn_to_page(pfn), -nr_pages); 1270 for (i = 0; i < nr_pages; i++) 1271 page_ref_inc(pfn_to_page(pfn + i)); 1272 } 1273 1274 static void virtio_mem_online_page(struct virtio_mem *vm, 1275 struct page *page, unsigned int order) 1276 { 1277 const unsigned long start = page_to_phys(page); 1278 const unsigned long end = start + PFN_PHYS(1 << order); 1279 unsigned long addr, next, id, sb_id, count; 1280 bool do_online; 1281 1282 /* 1283 * We can get called with any order up to MAX_PAGE_ORDER. If our subblock 1284 * size is smaller than that and we have a mixture of plugged and 1285 * unplugged subblocks within such a page, we have to process in 1286 * smaller granularity. In that case we'll adjust the order exactly once 1287 * within the loop. 1288 */ 1289 for (addr = start; addr < end; ) { 1290 next = addr + PFN_PHYS(1 << order); 1291 1292 if (vm->in_sbm) { 1293 id = virtio_mem_phys_to_mb_id(addr); 1294 sb_id = virtio_mem_phys_to_sb_id(vm, addr); 1295 count = virtio_mem_phys_to_sb_id(vm, next - 1) - sb_id + 1; 1296 1297 if (virtio_mem_sbm_test_sb_plugged(vm, id, sb_id, count)) { 1298 /* Fully plugged. */ 1299 do_online = true; 1300 } else if (count == 1 || 1301 virtio_mem_sbm_test_sb_unplugged(vm, id, sb_id, count)) { 1302 /* Fully unplugged. */ 1303 do_online = false; 1304 } else { 1305 /* 1306 * Mixture, process sub-blocks instead. This 1307 * will be at least the size of a pageblock. 1308 * We'll run into this case exactly once. 1309 */ 1310 order = ilog2(vm->sbm.sb_size) - PAGE_SHIFT; 1311 do_online = virtio_mem_sbm_test_sb_plugged(vm, id, sb_id, 1); 1312 continue; 1313 } 1314 } else { 1315 /* 1316 * If the whole block is marked fake offline, keep 1317 * everything that way. 1318 */ 1319 id = virtio_mem_phys_to_bb_id(vm, addr); 1320 do_online = virtio_mem_bbm_get_bb_state(vm, id) != 1321 VIRTIO_MEM_BBM_BB_FAKE_OFFLINE; 1322 } 1323 1324 if (do_online) 1325 generic_online_page(pfn_to_page(PFN_DOWN(addr)), order); 1326 else 1327 virtio_mem_set_fake_offline(PFN_DOWN(addr), 1 << order, 1328 false); 1329 addr = next; 1330 } 1331 } 1332 1333 static void virtio_mem_online_page_cb(struct page *page, unsigned int order) 1334 { 1335 const unsigned long addr = page_to_phys(page); 1336 struct virtio_mem *vm; 1337 1338 rcu_read_lock(); 1339 list_for_each_entry_rcu(vm, &virtio_mem_devices, next) { 1340 /* 1341 * Pages we're onlining will never cross memory blocks and, 1342 * therefore, not virtio-mem devices. 1343 */ 1344 if (!virtio_mem_contains_range(vm, addr, PFN_PHYS(1 << order))) 1345 continue; 1346 1347 /* 1348 * virtio_mem_set_fake_offline() might sleep. We can safely 1349 * drop the RCU lock at this point because the device 1350 * cannot go away. See virtio_mem_remove() how races 1351 * between memory onlining and device removal are handled. 1352 */ 1353 rcu_read_unlock(); 1354 1355 virtio_mem_online_page(vm, page, order); 1356 return; 1357 } 1358 rcu_read_unlock(); 1359 1360 /* not virtio-mem memory, but e.g., a DIMM. online it */ 1361 generic_online_page(page, order); 1362 } 1363 1364 static uint64_t virtio_mem_send_request(struct virtio_mem *vm, 1365 const struct virtio_mem_req *req) 1366 { 1367 struct scatterlist *sgs[2], sg_req, sg_resp; 1368 unsigned int len; 1369 int rc; 1370 1371 /* don't use the request residing on the stack (vaddr) */ 1372 vm->req = *req; 1373 1374 /* out: buffer for request */ 1375 sg_init_one(&sg_req, &vm->req, sizeof(vm->req)); 1376 sgs[0] = &sg_req; 1377 1378 /* in: buffer for response */ 1379 sg_init_one(&sg_resp, &vm->resp, sizeof(vm->resp)); 1380 sgs[1] = &sg_resp; 1381 1382 rc = virtqueue_add_sgs(vm->vq, sgs, 1, 1, vm, GFP_KERNEL); 1383 if (rc < 0) 1384 return rc; 1385 1386 virtqueue_kick(vm->vq); 1387 1388 /* wait for a response */ 1389 wait_event(vm->host_resp, virtqueue_get_buf(vm->vq, &len)); 1390 1391 return virtio16_to_cpu(vm->vdev, vm->resp.type); 1392 } 1393 1394 static int virtio_mem_send_plug_request(struct virtio_mem *vm, uint64_t addr, 1395 uint64_t size) 1396 { 1397 const uint64_t nb_vm_blocks = size / vm->device_block_size; 1398 const struct virtio_mem_req req = { 1399 .type = cpu_to_virtio16(vm->vdev, VIRTIO_MEM_REQ_PLUG), 1400 .u.plug.addr = cpu_to_virtio64(vm->vdev, addr), 1401 .u.plug.nb_blocks = cpu_to_virtio16(vm->vdev, nb_vm_blocks), 1402 }; 1403 int rc = -ENOMEM; 1404 1405 if (atomic_read(&vm->config_changed)) 1406 return -EAGAIN; 1407 1408 dev_dbg(&vm->vdev->dev, "plugging memory: 0x%llx - 0x%llx\n", addr, 1409 addr + size - 1); 1410 1411 switch (virtio_mem_send_request(vm, &req)) { 1412 case VIRTIO_MEM_RESP_ACK: 1413 vm->plugged_size += size; 1414 return 0; 1415 case VIRTIO_MEM_RESP_NACK: 1416 rc = -EAGAIN; 1417 break; 1418 case VIRTIO_MEM_RESP_BUSY: 1419 rc = -ETXTBSY; 1420 break; 1421 case VIRTIO_MEM_RESP_ERROR: 1422 rc = -EINVAL; 1423 break; 1424 default: 1425 break; 1426 } 1427 1428 dev_dbg(&vm->vdev->dev, "plugging memory failed: %d\n", rc); 1429 return rc; 1430 } 1431 1432 static int virtio_mem_send_unplug_request(struct virtio_mem *vm, uint64_t addr, 1433 uint64_t size) 1434 { 1435 const uint64_t nb_vm_blocks = size / vm->device_block_size; 1436 const struct virtio_mem_req req = { 1437 .type = cpu_to_virtio16(vm->vdev, VIRTIO_MEM_REQ_UNPLUG), 1438 .u.unplug.addr = cpu_to_virtio64(vm->vdev, addr), 1439 .u.unplug.nb_blocks = cpu_to_virtio16(vm->vdev, nb_vm_blocks), 1440 }; 1441 int rc = -ENOMEM; 1442 1443 if (atomic_read(&vm->config_changed)) 1444 return -EAGAIN; 1445 1446 dev_dbg(&vm->vdev->dev, "unplugging memory: 0x%llx - 0x%llx\n", addr, 1447 addr + size - 1); 1448 1449 switch (virtio_mem_send_request(vm, &req)) { 1450 case VIRTIO_MEM_RESP_ACK: 1451 vm->plugged_size -= size; 1452 return 0; 1453 case VIRTIO_MEM_RESP_BUSY: 1454 rc = -ETXTBSY; 1455 break; 1456 case VIRTIO_MEM_RESP_ERROR: 1457 rc = -EINVAL; 1458 break; 1459 default: 1460 break; 1461 } 1462 1463 dev_dbg(&vm->vdev->dev, "unplugging memory failed: %d\n", rc); 1464 return rc; 1465 } 1466 1467 static int virtio_mem_send_unplug_all_request(struct virtio_mem *vm) 1468 { 1469 const struct virtio_mem_req req = { 1470 .type = cpu_to_virtio16(vm->vdev, VIRTIO_MEM_REQ_UNPLUG_ALL), 1471 }; 1472 int rc = -ENOMEM; 1473 1474 dev_dbg(&vm->vdev->dev, "unplugging all memory"); 1475 1476 switch (virtio_mem_send_request(vm, &req)) { 1477 case VIRTIO_MEM_RESP_ACK: 1478 vm->unplug_all_required = false; 1479 vm->plugged_size = 0; 1480 /* usable region might have shrunk */ 1481 atomic_set(&vm->config_changed, 1); 1482 return 0; 1483 case VIRTIO_MEM_RESP_BUSY: 1484 rc = -ETXTBSY; 1485 break; 1486 default: 1487 break; 1488 } 1489 1490 dev_dbg(&vm->vdev->dev, "unplugging all memory failed: %d\n", rc); 1491 return rc; 1492 } 1493 1494 /* 1495 * Plug selected subblocks. Updates the plugged state, but not the state 1496 * of the memory block. 1497 */ 1498 static int virtio_mem_sbm_plug_sb(struct virtio_mem *vm, unsigned long mb_id, 1499 int sb_id, int count) 1500 { 1501 const uint64_t addr = virtio_mem_mb_id_to_phys(mb_id) + 1502 sb_id * vm->sbm.sb_size; 1503 const uint64_t size = count * vm->sbm.sb_size; 1504 int rc; 1505 1506 rc = virtio_mem_send_plug_request(vm, addr, size); 1507 if (!rc) 1508 virtio_mem_sbm_set_sb_plugged(vm, mb_id, sb_id, count); 1509 return rc; 1510 } 1511 1512 /* 1513 * Unplug selected subblocks. Updates the plugged state, but not the state 1514 * of the memory block. 1515 */ 1516 static int virtio_mem_sbm_unplug_sb(struct virtio_mem *vm, unsigned long mb_id, 1517 int sb_id, int count) 1518 { 1519 const uint64_t addr = virtio_mem_mb_id_to_phys(mb_id) + 1520 sb_id * vm->sbm.sb_size; 1521 const uint64_t size = count * vm->sbm.sb_size; 1522 int rc; 1523 1524 rc = virtio_mem_send_unplug_request(vm, addr, size); 1525 if (!rc) 1526 virtio_mem_sbm_set_sb_unplugged(vm, mb_id, sb_id, count); 1527 return rc; 1528 } 1529 1530 /* 1531 * Request to unplug a big block. 1532 * 1533 * Will not modify the state of the big block. 1534 */ 1535 static int virtio_mem_bbm_unplug_bb(struct virtio_mem *vm, unsigned long bb_id) 1536 { 1537 const uint64_t addr = virtio_mem_bb_id_to_phys(vm, bb_id); 1538 const uint64_t size = vm->bbm.bb_size; 1539 1540 return virtio_mem_send_unplug_request(vm, addr, size); 1541 } 1542 1543 /* 1544 * Request to plug a big block. 1545 * 1546 * Will not modify the state of the big block. 1547 */ 1548 static int virtio_mem_bbm_plug_bb(struct virtio_mem *vm, unsigned long bb_id) 1549 { 1550 const uint64_t addr = virtio_mem_bb_id_to_phys(vm, bb_id); 1551 const uint64_t size = vm->bbm.bb_size; 1552 1553 return virtio_mem_send_plug_request(vm, addr, size); 1554 } 1555 1556 /* 1557 * Unplug the desired number of plugged subblocks of a offline or not-added 1558 * memory block. Will fail if any subblock cannot get unplugged (instead of 1559 * skipping it). 1560 * 1561 * Will not modify the state of the memory block. 1562 * 1563 * Note: can fail after some subblocks were unplugged. 1564 */ 1565 static int virtio_mem_sbm_unplug_any_sb_raw(struct virtio_mem *vm, 1566 unsigned long mb_id, uint64_t *nb_sb) 1567 { 1568 int sb_id, count; 1569 int rc; 1570 1571 sb_id = vm->sbm.sbs_per_mb - 1; 1572 while (*nb_sb) { 1573 /* Find the next candidate subblock */ 1574 while (sb_id >= 0 && 1575 virtio_mem_sbm_test_sb_unplugged(vm, mb_id, sb_id, 1)) 1576 sb_id--; 1577 if (sb_id < 0) 1578 break; 1579 /* Try to unplug multiple subblocks at a time */ 1580 count = 1; 1581 while (count < *nb_sb && sb_id > 0 && 1582 virtio_mem_sbm_test_sb_plugged(vm, mb_id, sb_id - 1, 1)) { 1583 count++; 1584 sb_id--; 1585 } 1586 1587 rc = virtio_mem_sbm_unplug_sb(vm, mb_id, sb_id, count); 1588 if (rc) 1589 return rc; 1590 *nb_sb -= count; 1591 sb_id--; 1592 } 1593 1594 return 0; 1595 } 1596 1597 /* 1598 * Unplug all plugged subblocks of an offline or not-added memory block. 1599 * 1600 * Will not modify the state of the memory block. 1601 * 1602 * Note: can fail after some subblocks were unplugged. 1603 */ 1604 static int virtio_mem_sbm_unplug_mb(struct virtio_mem *vm, unsigned long mb_id) 1605 { 1606 uint64_t nb_sb = vm->sbm.sbs_per_mb; 1607 1608 return virtio_mem_sbm_unplug_any_sb_raw(vm, mb_id, &nb_sb); 1609 } 1610 1611 /* 1612 * Prepare tracking data for the next memory block. 1613 */ 1614 static int virtio_mem_sbm_prepare_next_mb(struct virtio_mem *vm, 1615 unsigned long *mb_id) 1616 { 1617 int rc; 1618 1619 if (vm->sbm.next_mb_id > vm->sbm.last_usable_mb_id) 1620 return -ENOSPC; 1621 1622 /* Resize the state array if required. */ 1623 rc = virtio_mem_sbm_mb_states_prepare_next_mb(vm); 1624 if (rc) 1625 return rc; 1626 1627 /* Resize the subblock bitmap if required. */ 1628 rc = virtio_mem_sbm_sb_states_prepare_next_mb(vm); 1629 if (rc) 1630 return rc; 1631 1632 vm->sbm.mb_count[VIRTIO_MEM_SBM_MB_UNUSED]++; 1633 *mb_id = vm->sbm.next_mb_id++; 1634 return 0; 1635 } 1636 1637 /* 1638 * Try to plug the desired number of subblocks and add the memory block 1639 * to Linux. 1640 * 1641 * Will modify the state of the memory block. 1642 */ 1643 static int virtio_mem_sbm_plug_and_add_mb(struct virtio_mem *vm, 1644 unsigned long mb_id, uint64_t *nb_sb) 1645 { 1646 const int count = min_t(int, *nb_sb, vm->sbm.sbs_per_mb); 1647 int rc; 1648 1649 if (WARN_ON_ONCE(!count)) 1650 return -EINVAL; 1651 1652 /* 1653 * Plug the requested number of subblocks before adding it to linux, 1654 * so that onlining will directly online all plugged subblocks. 1655 */ 1656 rc = virtio_mem_sbm_plug_sb(vm, mb_id, 0, count); 1657 if (rc) 1658 return rc; 1659 1660 /* 1661 * Mark the block properly offline before adding it to Linux, 1662 * so the memory notifiers will find the block in the right state. 1663 */ 1664 if (count == vm->sbm.sbs_per_mb) 1665 virtio_mem_sbm_set_mb_state(vm, mb_id, 1666 VIRTIO_MEM_SBM_MB_OFFLINE); 1667 else 1668 virtio_mem_sbm_set_mb_state(vm, mb_id, 1669 VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL); 1670 1671 /* Add the memory block to linux - if that fails, try to unplug. */ 1672 rc = virtio_mem_sbm_add_mb(vm, mb_id); 1673 if (rc) { 1674 int new_state = VIRTIO_MEM_SBM_MB_UNUSED; 1675 1676 if (virtio_mem_sbm_unplug_sb(vm, mb_id, 0, count)) 1677 new_state = VIRTIO_MEM_SBM_MB_PLUGGED; 1678 virtio_mem_sbm_set_mb_state(vm, mb_id, new_state); 1679 return rc; 1680 } 1681 1682 *nb_sb -= count; 1683 return 0; 1684 } 1685 1686 /* 1687 * Try to plug the desired number of subblocks of a memory block that 1688 * is already added to Linux. 1689 * 1690 * Will modify the state of the memory block. 1691 * 1692 * Note: Can fail after some subblocks were successfully plugged. 1693 */ 1694 static int virtio_mem_sbm_plug_any_sb(struct virtio_mem *vm, 1695 unsigned long mb_id, uint64_t *nb_sb) 1696 { 1697 const int old_state = virtio_mem_sbm_get_mb_state(vm, mb_id); 1698 unsigned long pfn, nr_pages; 1699 int sb_id, count; 1700 int rc; 1701 1702 if (WARN_ON_ONCE(!*nb_sb)) 1703 return -EINVAL; 1704 1705 while (*nb_sb) { 1706 sb_id = virtio_mem_sbm_first_unplugged_sb(vm, mb_id); 1707 if (sb_id >= vm->sbm.sbs_per_mb) 1708 break; 1709 count = 1; 1710 while (count < *nb_sb && 1711 sb_id + count < vm->sbm.sbs_per_mb && 1712 !virtio_mem_sbm_test_sb_plugged(vm, mb_id, sb_id + count, 1)) 1713 count++; 1714 1715 rc = virtio_mem_sbm_plug_sb(vm, mb_id, sb_id, count); 1716 if (rc) 1717 return rc; 1718 *nb_sb -= count; 1719 if (old_state == VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL) 1720 continue; 1721 1722 /* fake-online the pages if the memory block is online */ 1723 pfn = PFN_DOWN(virtio_mem_mb_id_to_phys(mb_id) + 1724 sb_id * vm->sbm.sb_size); 1725 nr_pages = PFN_DOWN(count * vm->sbm.sb_size); 1726 virtio_mem_fake_online(pfn, nr_pages); 1727 } 1728 1729 if (virtio_mem_sbm_test_sb_plugged(vm, mb_id, 0, vm->sbm.sbs_per_mb)) 1730 virtio_mem_sbm_set_mb_state(vm, mb_id, old_state - 1); 1731 1732 return 0; 1733 } 1734 1735 static int virtio_mem_sbm_plug_request(struct virtio_mem *vm, uint64_t diff) 1736 { 1737 const int mb_states[] = { 1738 VIRTIO_MEM_SBM_MB_KERNEL_PARTIAL, 1739 VIRTIO_MEM_SBM_MB_MOVABLE_PARTIAL, 1740 VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL, 1741 }; 1742 uint64_t nb_sb = diff / vm->sbm.sb_size; 1743 unsigned long mb_id; 1744 int rc, i; 1745 1746 if (!nb_sb) 1747 return 0; 1748 1749 /* Don't race with onlining/offlining */ 1750 mutex_lock(&vm->hotplug_mutex); 1751 1752 for (i = 0; i < ARRAY_SIZE(mb_states); i++) { 1753 virtio_mem_sbm_for_each_mb(vm, mb_id, mb_states[i]) { 1754 rc = virtio_mem_sbm_plug_any_sb(vm, mb_id, &nb_sb); 1755 if (rc || !nb_sb) 1756 goto out_unlock; 1757 cond_resched(); 1758 } 1759 } 1760 1761 /* 1762 * We won't be working on online/offline memory blocks from this point, 1763 * so we can't race with memory onlining/offlining. Drop the mutex. 1764 */ 1765 mutex_unlock(&vm->hotplug_mutex); 1766 1767 /* Try to plug and add unused blocks */ 1768 virtio_mem_sbm_for_each_mb(vm, mb_id, VIRTIO_MEM_SBM_MB_UNUSED) { 1769 if (!virtio_mem_could_add_memory(vm, memory_block_size_bytes())) 1770 return -ENOSPC; 1771 1772 rc = virtio_mem_sbm_plug_and_add_mb(vm, mb_id, &nb_sb); 1773 if (rc || !nb_sb) 1774 return rc; 1775 cond_resched(); 1776 } 1777 1778 /* Try to prepare, plug and add new blocks */ 1779 while (nb_sb) { 1780 if (!virtio_mem_could_add_memory(vm, memory_block_size_bytes())) 1781 return -ENOSPC; 1782 1783 rc = virtio_mem_sbm_prepare_next_mb(vm, &mb_id); 1784 if (rc) 1785 return rc; 1786 rc = virtio_mem_sbm_plug_and_add_mb(vm, mb_id, &nb_sb); 1787 if (rc) 1788 return rc; 1789 cond_resched(); 1790 } 1791 1792 return 0; 1793 out_unlock: 1794 mutex_unlock(&vm->hotplug_mutex); 1795 return rc; 1796 } 1797 1798 /* 1799 * Plug a big block and add it to Linux. 1800 * 1801 * Will modify the state of the big block. 1802 */ 1803 static int virtio_mem_bbm_plug_and_add_bb(struct virtio_mem *vm, 1804 unsigned long bb_id) 1805 { 1806 int rc; 1807 1808 if (WARN_ON_ONCE(virtio_mem_bbm_get_bb_state(vm, bb_id) != 1809 VIRTIO_MEM_BBM_BB_UNUSED)) 1810 return -EINVAL; 1811 1812 rc = virtio_mem_bbm_plug_bb(vm, bb_id); 1813 if (rc) 1814 return rc; 1815 virtio_mem_bbm_set_bb_state(vm, bb_id, VIRTIO_MEM_BBM_BB_ADDED); 1816 1817 rc = virtio_mem_bbm_add_bb(vm, bb_id); 1818 if (rc) { 1819 if (!virtio_mem_bbm_unplug_bb(vm, bb_id)) 1820 virtio_mem_bbm_set_bb_state(vm, bb_id, 1821 VIRTIO_MEM_BBM_BB_UNUSED); 1822 else 1823 /* Retry from the main loop. */ 1824 virtio_mem_bbm_set_bb_state(vm, bb_id, 1825 VIRTIO_MEM_BBM_BB_PLUGGED); 1826 return rc; 1827 } 1828 return 0; 1829 } 1830 1831 /* 1832 * Prepare tracking data for the next big block. 1833 */ 1834 static int virtio_mem_bbm_prepare_next_bb(struct virtio_mem *vm, 1835 unsigned long *bb_id) 1836 { 1837 int rc; 1838 1839 if (vm->bbm.next_bb_id > vm->bbm.last_usable_bb_id) 1840 return -ENOSPC; 1841 1842 /* Resize the big block state array if required. */ 1843 rc = virtio_mem_bbm_bb_states_prepare_next_bb(vm); 1844 if (rc) 1845 return rc; 1846 1847 vm->bbm.bb_count[VIRTIO_MEM_BBM_BB_UNUSED]++; 1848 *bb_id = vm->bbm.next_bb_id; 1849 vm->bbm.next_bb_id++; 1850 return 0; 1851 } 1852 1853 static int virtio_mem_bbm_plug_request(struct virtio_mem *vm, uint64_t diff) 1854 { 1855 uint64_t nb_bb = diff / vm->bbm.bb_size; 1856 unsigned long bb_id; 1857 int rc; 1858 1859 if (!nb_bb) 1860 return 0; 1861 1862 /* Try to plug and add unused big blocks */ 1863 virtio_mem_bbm_for_each_bb(vm, bb_id, VIRTIO_MEM_BBM_BB_UNUSED) { 1864 if (!virtio_mem_could_add_memory(vm, vm->bbm.bb_size)) 1865 return -ENOSPC; 1866 1867 rc = virtio_mem_bbm_plug_and_add_bb(vm, bb_id); 1868 if (!rc) 1869 nb_bb--; 1870 if (rc || !nb_bb) 1871 return rc; 1872 cond_resched(); 1873 } 1874 1875 /* Try to prepare, plug and add new big blocks */ 1876 while (nb_bb) { 1877 if (!virtio_mem_could_add_memory(vm, vm->bbm.bb_size)) 1878 return -ENOSPC; 1879 1880 rc = virtio_mem_bbm_prepare_next_bb(vm, &bb_id); 1881 if (rc) 1882 return rc; 1883 rc = virtio_mem_bbm_plug_and_add_bb(vm, bb_id); 1884 if (!rc) 1885 nb_bb--; 1886 if (rc) 1887 return rc; 1888 cond_resched(); 1889 } 1890 1891 return 0; 1892 } 1893 1894 /* 1895 * Try to plug the requested amount of memory. 1896 */ 1897 static int virtio_mem_plug_request(struct virtio_mem *vm, uint64_t diff) 1898 { 1899 if (vm->in_sbm) 1900 return virtio_mem_sbm_plug_request(vm, diff); 1901 return virtio_mem_bbm_plug_request(vm, diff); 1902 } 1903 1904 /* 1905 * Unplug the desired number of plugged subblocks of an offline memory block. 1906 * Will fail if any subblock cannot get unplugged (instead of skipping it). 1907 * 1908 * Will modify the state of the memory block. Might temporarily drop the 1909 * hotplug_mutex. 1910 * 1911 * Note: Can fail after some subblocks were successfully unplugged. 1912 */ 1913 static int virtio_mem_sbm_unplug_any_sb_offline(struct virtio_mem *vm, 1914 unsigned long mb_id, 1915 uint64_t *nb_sb) 1916 { 1917 int rc; 1918 1919 rc = virtio_mem_sbm_unplug_any_sb_raw(vm, mb_id, nb_sb); 1920 1921 /* some subblocks might have been unplugged even on failure */ 1922 if (!virtio_mem_sbm_test_sb_plugged(vm, mb_id, 0, vm->sbm.sbs_per_mb)) 1923 virtio_mem_sbm_set_mb_state(vm, mb_id, 1924 VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL); 1925 if (rc) 1926 return rc; 1927 1928 if (virtio_mem_sbm_test_sb_unplugged(vm, mb_id, 0, vm->sbm.sbs_per_mb)) { 1929 /* 1930 * Remove the block from Linux - this should never fail. 1931 * Hinder the block from getting onlined by marking it 1932 * unplugged. Temporarily drop the mutex, so 1933 * any pending GOING_ONLINE requests can be serviced/rejected. 1934 */ 1935 virtio_mem_sbm_set_mb_state(vm, mb_id, 1936 VIRTIO_MEM_SBM_MB_UNUSED); 1937 1938 mutex_unlock(&vm->hotplug_mutex); 1939 rc = virtio_mem_sbm_remove_mb(vm, mb_id); 1940 BUG_ON(rc); 1941 mutex_lock(&vm->hotplug_mutex); 1942 } 1943 return 0; 1944 } 1945 1946 /* 1947 * Unplug the given plugged subblocks of an online memory block. 1948 * 1949 * Will modify the state of the memory block. 1950 */ 1951 static int virtio_mem_sbm_unplug_sb_online(struct virtio_mem *vm, 1952 unsigned long mb_id, int sb_id, 1953 int count) 1954 { 1955 const unsigned long nr_pages = PFN_DOWN(vm->sbm.sb_size) * count; 1956 const int old_state = virtio_mem_sbm_get_mb_state(vm, mb_id); 1957 unsigned long start_pfn; 1958 int rc; 1959 1960 start_pfn = PFN_DOWN(virtio_mem_mb_id_to_phys(mb_id) + 1961 sb_id * vm->sbm.sb_size); 1962 1963 rc = virtio_mem_fake_offline(vm, start_pfn, nr_pages); 1964 if (rc) 1965 return rc; 1966 1967 /* Try to unplug the allocated memory */ 1968 rc = virtio_mem_sbm_unplug_sb(vm, mb_id, sb_id, count); 1969 if (rc) { 1970 /* Return the memory to the buddy. */ 1971 virtio_mem_fake_online(start_pfn, nr_pages); 1972 return rc; 1973 } 1974 1975 switch (old_state) { 1976 case VIRTIO_MEM_SBM_MB_KERNEL: 1977 virtio_mem_sbm_set_mb_state(vm, mb_id, 1978 VIRTIO_MEM_SBM_MB_KERNEL_PARTIAL); 1979 break; 1980 case VIRTIO_MEM_SBM_MB_MOVABLE: 1981 virtio_mem_sbm_set_mb_state(vm, mb_id, 1982 VIRTIO_MEM_SBM_MB_MOVABLE_PARTIAL); 1983 break; 1984 } 1985 1986 return 0; 1987 } 1988 1989 /* 1990 * Unplug the desired number of plugged subblocks of an online memory block. 1991 * Will skip subblock that are busy. 1992 * 1993 * Will modify the state of the memory block. Might temporarily drop the 1994 * hotplug_mutex. 1995 * 1996 * Note: Can fail after some subblocks were successfully unplugged. Can 1997 * return 0 even if subblocks were busy and could not get unplugged. 1998 */ 1999 static int virtio_mem_sbm_unplug_any_sb_online(struct virtio_mem *vm, 2000 unsigned long mb_id, 2001 uint64_t *nb_sb) 2002 { 2003 int rc, sb_id; 2004 2005 /* If possible, try to unplug the complete block in one shot. */ 2006 if (*nb_sb >= vm->sbm.sbs_per_mb && 2007 virtio_mem_sbm_test_sb_plugged(vm, mb_id, 0, vm->sbm.sbs_per_mb)) { 2008 rc = virtio_mem_sbm_unplug_sb_online(vm, mb_id, 0, 2009 vm->sbm.sbs_per_mb); 2010 if (!rc) { 2011 *nb_sb -= vm->sbm.sbs_per_mb; 2012 goto unplugged; 2013 } else if (rc != -EBUSY) 2014 return rc; 2015 } 2016 2017 /* Fallback to single subblocks. */ 2018 for (sb_id = vm->sbm.sbs_per_mb - 1; sb_id >= 0 && *nb_sb; sb_id--) { 2019 /* Find the next candidate subblock */ 2020 while (sb_id >= 0 && 2021 !virtio_mem_sbm_test_sb_plugged(vm, mb_id, sb_id, 1)) 2022 sb_id--; 2023 if (sb_id < 0) 2024 break; 2025 2026 rc = virtio_mem_sbm_unplug_sb_online(vm, mb_id, sb_id, 1); 2027 if (rc == -EBUSY) 2028 continue; 2029 else if (rc) 2030 return rc; 2031 *nb_sb -= 1; 2032 } 2033 2034 unplugged: 2035 rc = virtio_mem_sbm_try_remove_unplugged_mb(vm, mb_id); 2036 if (rc) 2037 vm->sbm.have_unplugged_mb = 1; 2038 /* Ignore errors, this is not critical. We'll retry later. */ 2039 return 0; 2040 } 2041 2042 /* 2043 * Unplug the desired number of plugged subblocks of a memory block that is 2044 * already added to Linux. Will skip subblock of online memory blocks that are 2045 * busy (by the OS). Will fail if any subblock that's not busy cannot get 2046 * unplugged. 2047 * 2048 * Will modify the state of the memory block. Might temporarily drop the 2049 * hotplug_mutex. 2050 * 2051 * Note: Can fail after some subblocks were successfully unplugged. Can 2052 * return 0 even if subblocks were busy and could not get unplugged. 2053 */ 2054 static int virtio_mem_sbm_unplug_any_sb(struct virtio_mem *vm, 2055 unsigned long mb_id, 2056 uint64_t *nb_sb) 2057 { 2058 const int old_state = virtio_mem_sbm_get_mb_state(vm, mb_id); 2059 2060 switch (old_state) { 2061 case VIRTIO_MEM_SBM_MB_KERNEL_PARTIAL: 2062 case VIRTIO_MEM_SBM_MB_KERNEL: 2063 case VIRTIO_MEM_SBM_MB_MOVABLE_PARTIAL: 2064 case VIRTIO_MEM_SBM_MB_MOVABLE: 2065 return virtio_mem_sbm_unplug_any_sb_online(vm, mb_id, nb_sb); 2066 case VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL: 2067 case VIRTIO_MEM_SBM_MB_OFFLINE: 2068 return virtio_mem_sbm_unplug_any_sb_offline(vm, mb_id, nb_sb); 2069 } 2070 return -EINVAL; 2071 } 2072 2073 static int virtio_mem_sbm_unplug_request(struct virtio_mem *vm, uint64_t diff) 2074 { 2075 const int mb_states[] = { 2076 VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL, 2077 VIRTIO_MEM_SBM_MB_OFFLINE, 2078 VIRTIO_MEM_SBM_MB_MOVABLE_PARTIAL, 2079 VIRTIO_MEM_SBM_MB_KERNEL_PARTIAL, 2080 VIRTIO_MEM_SBM_MB_MOVABLE, 2081 VIRTIO_MEM_SBM_MB_KERNEL, 2082 }; 2083 uint64_t nb_sb = diff / vm->sbm.sb_size; 2084 unsigned long mb_id; 2085 int rc, i; 2086 2087 if (!nb_sb) 2088 return 0; 2089 2090 /* 2091 * We'll drop the mutex a couple of times when it is safe to do so. 2092 * This might result in some blocks switching the state (online/offline) 2093 * and we could miss them in this run - we will retry again later. 2094 */ 2095 mutex_lock(&vm->hotplug_mutex); 2096 2097 /* 2098 * We try unplug from partially plugged blocks first, to try removing 2099 * whole memory blocks along with metadata. We prioritize ZONE_MOVABLE 2100 * as it's more reliable to unplug memory and remove whole memory 2101 * blocks, and we don't want to trigger a zone imbalances by 2102 * accidentially removing too much kernel memory. 2103 */ 2104 for (i = 0; i < ARRAY_SIZE(mb_states); i++) { 2105 virtio_mem_sbm_for_each_mb_rev(vm, mb_id, mb_states[i]) { 2106 rc = virtio_mem_sbm_unplug_any_sb(vm, mb_id, &nb_sb); 2107 if (rc || !nb_sb) 2108 goto out_unlock; 2109 mutex_unlock(&vm->hotplug_mutex); 2110 cond_resched(); 2111 mutex_lock(&vm->hotplug_mutex); 2112 } 2113 if (!unplug_online && i == 1) { 2114 mutex_unlock(&vm->hotplug_mutex); 2115 return 0; 2116 } 2117 } 2118 2119 mutex_unlock(&vm->hotplug_mutex); 2120 return nb_sb ? -EBUSY : 0; 2121 out_unlock: 2122 mutex_unlock(&vm->hotplug_mutex); 2123 return rc; 2124 } 2125 2126 /* 2127 * Try to offline and remove a big block from Linux and unplug it. Will fail 2128 * with -EBUSY if some memory is busy and cannot get unplugged. 2129 * 2130 * Will modify the state of the memory block. Might temporarily drop the 2131 * hotplug_mutex. 2132 */ 2133 static int virtio_mem_bbm_offline_remove_and_unplug_bb(struct virtio_mem *vm, 2134 unsigned long bb_id) 2135 { 2136 const unsigned long start_pfn = PFN_DOWN(virtio_mem_bb_id_to_phys(vm, bb_id)); 2137 const unsigned long nr_pages = PFN_DOWN(vm->bbm.bb_size); 2138 unsigned long end_pfn = start_pfn + nr_pages; 2139 unsigned long pfn; 2140 struct page *page; 2141 int rc; 2142 2143 if (WARN_ON_ONCE(virtio_mem_bbm_get_bb_state(vm, bb_id) != 2144 VIRTIO_MEM_BBM_BB_ADDED)) 2145 return -EINVAL; 2146 2147 /* 2148 * Start by fake-offlining all memory. Once we marked the device 2149 * block as fake-offline, all newly onlined memory will 2150 * automatically be kept fake-offline. Protect from concurrent 2151 * onlining/offlining until we have a consistent state. 2152 */ 2153 mutex_lock(&vm->hotplug_mutex); 2154 virtio_mem_bbm_set_bb_state(vm, bb_id, VIRTIO_MEM_BBM_BB_FAKE_OFFLINE); 2155 2156 for (pfn = start_pfn; pfn < end_pfn; pfn += PAGES_PER_SECTION) { 2157 page = pfn_to_online_page(pfn); 2158 if (!page) 2159 continue; 2160 2161 rc = virtio_mem_fake_offline(vm, pfn, PAGES_PER_SECTION); 2162 if (rc) { 2163 end_pfn = pfn; 2164 goto rollback; 2165 } 2166 } 2167 mutex_unlock(&vm->hotplug_mutex); 2168 2169 rc = virtio_mem_bbm_offline_and_remove_bb(vm, bb_id); 2170 if (rc) { 2171 mutex_lock(&vm->hotplug_mutex); 2172 goto rollback; 2173 } 2174 2175 rc = virtio_mem_bbm_unplug_bb(vm, bb_id); 2176 if (rc) 2177 virtio_mem_bbm_set_bb_state(vm, bb_id, 2178 VIRTIO_MEM_BBM_BB_PLUGGED); 2179 else 2180 virtio_mem_bbm_set_bb_state(vm, bb_id, 2181 VIRTIO_MEM_BBM_BB_UNUSED); 2182 return rc; 2183 2184 rollback: 2185 for (pfn = start_pfn; pfn < end_pfn; pfn += PAGES_PER_SECTION) { 2186 page = pfn_to_online_page(pfn); 2187 if (!page) 2188 continue; 2189 virtio_mem_fake_online(pfn, PAGES_PER_SECTION); 2190 } 2191 virtio_mem_bbm_set_bb_state(vm, bb_id, VIRTIO_MEM_BBM_BB_ADDED); 2192 mutex_unlock(&vm->hotplug_mutex); 2193 return rc; 2194 } 2195 2196 /* 2197 * Test if a big block is completely offline. 2198 */ 2199 static bool virtio_mem_bbm_bb_is_offline(struct virtio_mem *vm, 2200 unsigned long bb_id) 2201 { 2202 const unsigned long start_pfn = PFN_DOWN(virtio_mem_bb_id_to_phys(vm, bb_id)); 2203 const unsigned long nr_pages = PFN_DOWN(vm->bbm.bb_size); 2204 unsigned long pfn; 2205 2206 for (pfn = start_pfn; pfn < start_pfn + nr_pages; 2207 pfn += PAGES_PER_SECTION) { 2208 if (pfn_to_online_page(pfn)) 2209 return false; 2210 } 2211 2212 return true; 2213 } 2214 2215 /* 2216 * Test if a big block is completely onlined to ZONE_MOVABLE (or offline). 2217 */ 2218 static bool virtio_mem_bbm_bb_is_movable(struct virtio_mem *vm, 2219 unsigned long bb_id) 2220 { 2221 const unsigned long start_pfn = PFN_DOWN(virtio_mem_bb_id_to_phys(vm, bb_id)); 2222 const unsigned long nr_pages = PFN_DOWN(vm->bbm.bb_size); 2223 struct page *page; 2224 unsigned long pfn; 2225 2226 for (pfn = start_pfn; pfn < start_pfn + nr_pages; 2227 pfn += PAGES_PER_SECTION) { 2228 page = pfn_to_online_page(pfn); 2229 if (!page) 2230 continue; 2231 if (page_zonenum(page) != ZONE_MOVABLE) 2232 return false; 2233 } 2234 2235 return true; 2236 } 2237 2238 static int virtio_mem_bbm_unplug_request(struct virtio_mem *vm, uint64_t diff) 2239 { 2240 uint64_t nb_bb = diff / vm->bbm.bb_size; 2241 uint64_t bb_id; 2242 int rc, i; 2243 2244 if (!nb_bb) 2245 return 0; 2246 2247 /* 2248 * Try to unplug big blocks. Similar to SBM, start with offline 2249 * big blocks. 2250 */ 2251 for (i = 0; i < 3; i++) { 2252 virtio_mem_bbm_for_each_bb_rev(vm, bb_id, VIRTIO_MEM_BBM_BB_ADDED) { 2253 cond_resched(); 2254 2255 /* 2256 * As we're holding no locks, these checks are racy, 2257 * but we don't care. 2258 */ 2259 if (i == 0 && !virtio_mem_bbm_bb_is_offline(vm, bb_id)) 2260 continue; 2261 if (i == 1 && !virtio_mem_bbm_bb_is_movable(vm, bb_id)) 2262 continue; 2263 rc = virtio_mem_bbm_offline_remove_and_unplug_bb(vm, bb_id); 2264 if (rc == -EBUSY) 2265 continue; 2266 if (!rc) 2267 nb_bb--; 2268 if (rc || !nb_bb) 2269 return rc; 2270 } 2271 if (i == 0 && !unplug_online) 2272 return 0; 2273 } 2274 2275 return nb_bb ? -EBUSY : 0; 2276 } 2277 2278 /* 2279 * Try to unplug the requested amount of memory. 2280 */ 2281 static int virtio_mem_unplug_request(struct virtio_mem *vm, uint64_t diff) 2282 { 2283 if (vm->in_sbm) 2284 return virtio_mem_sbm_unplug_request(vm, diff); 2285 return virtio_mem_bbm_unplug_request(vm, diff); 2286 } 2287 2288 /* 2289 * Try to unplug all blocks that couldn't be unplugged before, for example, 2290 * because the hypervisor was busy. Further, offline and remove any memory 2291 * blocks where we previously failed. 2292 */ 2293 static int virtio_mem_cleanup_pending_mb(struct virtio_mem *vm) 2294 { 2295 unsigned long id; 2296 int rc = 0; 2297 2298 if (!vm->in_sbm) { 2299 virtio_mem_bbm_for_each_bb(vm, id, 2300 VIRTIO_MEM_BBM_BB_PLUGGED) { 2301 rc = virtio_mem_bbm_unplug_bb(vm, id); 2302 if (rc) 2303 return rc; 2304 virtio_mem_bbm_set_bb_state(vm, id, 2305 VIRTIO_MEM_BBM_BB_UNUSED); 2306 } 2307 return 0; 2308 } 2309 2310 virtio_mem_sbm_for_each_mb(vm, id, VIRTIO_MEM_SBM_MB_PLUGGED) { 2311 rc = virtio_mem_sbm_unplug_mb(vm, id); 2312 if (rc) 2313 return rc; 2314 virtio_mem_sbm_set_mb_state(vm, id, 2315 VIRTIO_MEM_SBM_MB_UNUSED); 2316 } 2317 2318 if (!vm->sbm.have_unplugged_mb) 2319 return 0; 2320 2321 /* 2322 * Let's retry (offlining and) removing completely unplugged Linux 2323 * memory blocks. 2324 */ 2325 vm->sbm.have_unplugged_mb = false; 2326 2327 mutex_lock(&vm->hotplug_mutex); 2328 virtio_mem_sbm_for_each_mb(vm, id, VIRTIO_MEM_SBM_MB_MOVABLE_PARTIAL) 2329 rc |= virtio_mem_sbm_try_remove_unplugged_mb(vm, id); 2330 virtio_mem_sbm_for_each_mb(vm, id, VIRTIO_MEM_SBM_MB_KERNEL_PARTIAL) 2331 rc |= virtio_mem_sbm_try_remove_unplugged_mb(vm, id); 2332 virtio_mem_sbm_for_each_mb(vm, id, VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL) 2333 rc |= virtio_mem_sbm_try_remove_unplugged_mb(vm, id); 2334 mutex_unlock(&vm->hotplug_mutex); 2335 2336 if (rc) 2337 vm->sbm.have_unplugged_mb = true; 2338 /* Ignore errors, this is not critical. We'll retry later. */ 2339 return 0; 2340 } 2341 2342 /* 2343 * Update all parts of the config that could have changed. 2344 */ 2345 static void virtio_mem_refresh_config(struct virtio_mem *vm) 2346 { 2347 const struct range pluggable_range = mhp_get_pluggable_range(true); 2348 uint64_t new_plugged_size, usable_region_size, end_addr; 2349 2350 /* the plugged_size is just a reflection of what _we_ did previously */ 2351 virtio_cread_le(vm->vdev, struct virtio_mem_config, plugged_size, 2352 &new_plugged_size); 2353 if (WARN_ON_ONCE(new_plugged_size != vm->plugged_size)) 2354 vm->plugged_size = new_plugged_size; 2355 2356 /* calculate the last usable memory block id */ 2357 virtio_cread_le(vm->vdev, struct virtio_mem_config, 2358 usable_region_size, &usable_region_size); 2359 end_addr = min(vm->addr + usable_region_size - 1, 2360 pluggable_range.end); 2361 2362 if (vm->in_sbm) { 2363 vm->sbm.last_usable_mb_id = virtio_mem_phys_to_mb_id(end_addr); 2364 if (!IS_ALIGNED(end_addr + 1, memory_block_size_bytes())) 2365 vm->sbm.last_usable_mb_id--; 2366 } else { 2367 vm->bbm.last_usable_bb_id = virtio_mem_phys_to_bb_id(vm, 2368 end_addr); 2369 if (!IS_ALIGNED(end_addr + 1, vm->bbm.bb_size)) 2370 vm->bbm.last_usable_bb_id--; 2371 } 2372 /* 2373 * If we cannot plug any of our device memory (e.g., nothing in the 2374 * usable region is addressable), the last usable memory block id will 2375 * be smaller than the first usable memory block id. We'll stop 2376 * attempting to add memory with -ENOSPC from our main loop. 2377 */ 2378 2379 /* see if there is a request to change the size */ 2380 virtio_cread_le(vm->vdev, struct virtio_mem_config, requested_size, 2381 &vm->requested_size); 2382 2383 dev_info(&vm->vdev->dev, "plugged size: 0x%llx", vm->plugged_size); 2384 dev_info(&vm->vdev->dev, "requested size: 0x%llx", vm->requested_size); 2385 } 2386 2387 /* 2388 * Workqueue function for handling plug/unplug requests and config updates. 2389 */ 2390 static void virtio_mem_run_wq(struct work_struct *work) 2391 { 2392 struct virtio_mem *vm = container_of(work, struct virtio_mem, wq); 2393 uint64_t diff; 2394 int rc; 2395 2396 if (unlikely(vm->in_kdump)) { 2397 dev_warn_once(&vm->vdev->dev, 2398 "unexpected workqueue run in kdump kernel\n"); 2399 return; 2400 } 2401 2402 hrtimer_cancel(&vm->retry_timer); 2403 2404 if (vm->broken) 2405 return; 2406 2407 atomic_set(&vm->wq_active, 1); 2408 retry: 2409 rc = 0; 2410 2411 /* Make sure we start with a clean state if there are leftovers. */ 2412 if (unlikely(vm->unplug_all_required)) 2413 rc = virtio_mem_send_unplug_all_request(vm); 2414 2415 if (atomic_read(&vm->config_changed)) { 2416 atomic_set(&vm->config_changed, 0); 2417 virtio_mem_refresh_config(vm); 2418 } 2419 2420 /* Cleanup any leftovers from previous runs */ 2421 if (!rc) 2422 rc = virtio_mem_cleanup_pending_mb(vm); 2423 2424 if (!rc && vm->requested_size != vm->plugged_size) { 2425 if (vm->requested_size > vm->plugged_size) { 2426 diff = vm->requested_size - vm->plugged_size; 2427 rc = virtio_mem_plug_request(vm, diff); 2428 } else { 2429 diff = vm->plugged_size - vm->requested_size; 2430 rc = virtio_mem_unplug_request(vm, diff); 2431 } 2432 } 2433 2434 /* 2435 * Keep retrying to offline and remove completely unplugged Linux 2436 * memory blocks. 2437 */ 2438 if (!rc && vm->in_sbm && vm->sbm.have_unplugged_mb) 2439 rc = -EBUSY; 2440 2441 switch (rc) { 2442 case 0: 2443 vm->retry_timer_ms = VIRTIO_MEM_RETRY_TIMER_MIN_MS; 2444 break; 2445 case -ENOSPC: 2446 /* 2447 * We cannot add any more memory (alignment, physical limit) 2448 * or we have too many offline memory blocks. 2449 */ 2450 break; 2451 case -ETXTBSY: 2452 /* 2453 * The hypervisor cannot process our request right now 2454 * (e.g., out of memory, migrating); 2455 */ 2456 case -EBUSY: 2457 /* 2458 * We cannot free up any memory to unplug it (all plugged memory 2459 * is busy). 2460 */ 2461 case -ENOMEM: 2462 /* Out of memory, try again later. */ 2463 hrtimer_start(&vm->retry_timer, ms_to_ktime(vm->retry_timer_ms), 2464 HRTIMER_MODE_REL); 2465 break; 2466 case -EAGAIN: 2467 /* Retry immediately (e.g., the config changed). */ 2468 goto retry; 2469 default: 2470 /* Unknown error, mark as broken */ 2471 dev_err(&vm->vdev->dev, 2472 "unknown error, marking device broken: %d\n", rc); 2473 vm->broken = true; 2474 } 2475 2476 atomic_set(&vm->wq_active, 0); 2477 } 2478 2479 static enum hrtimer_restart virtio_mem_timer_expired(struct hrtimer *timer) 2480 { 2481 struct virtio_mem *vm = container_of(timer, struct virtio_mem, 2482 retry_timer); 2483 2484 virtio_mem_retry(vm); 2485 vm->retry_timer_ms = min_t(unsigned int, vm->retry_timer_ms * 2, 2486 VIRTIO_MEM_RETRY_TIMER_MAX_MS); 2487 return HRTIMER_NORESTART; 2488 } 2489 2490 static void virtio_mem_handle_response(struct virtqueue *vq) 2491 { 2492 struct virtio_mem *vm = vq->vdev->priv; 2493 2494 wake_up(&vm->host_resp); 2495 } 2496 2497 static int virtio_mem_init_vq(struct virtio_mem *vm) 2498 { 2499 struct virtqueue *vq; 2500 2501 vq = virtio_find_single_vq(vm->vdev, virtio_mem_handle_response, 2502 "guest-request"); 2503 if (IS_ERR(vq)) 2504 return PTR_ERR(vq); 2505 vm->vq = vq; 2506 2507 return 0; 2508 } 2509 2510 static int virtio_mem_init_hotplug(struct virtio_mem *vm) 2511 { 2512 const struct range pluggable_range = mhp_get_pluggable_range(true); 2513 uint64_t unit_pages, sb_size, addr; 2514 int rc; 2515 2516 /* bad device setup - warn only */ 2517 if (!IS_ALIGNED(vm->addr, memory_block_size_bytes())) 2518 dev_warn(&vm->vdev->dev, 2519 "The alignment of the physical start address can make some memory unusable.\n"); 2520 if (!IS_ALIGNED(vm->addr + vm->region_size, memory_block_size_bytes())) 2521 dev_warn(&vm->vdev->dev, 2522 "The alignment of the physical end address can make some memory unusable.\n"); 2523 if (vm->addr < pluggable_range.start || 2524 vm->addr + vm->region_size - 1 > pluggable_range.end) 2525 dev_warn(&vm->vdev->dev, 2526 "Some device memory is not addressable/pluggable. This can make some memory unusable.\n"); 2527 2528 /* Prepare the offline threshold - make sure we can add two blocks. */ 2529 vm->offline_threshold = max_t(uint64_t, 2 * memory_block_size_bytes(), 2530 VIRTIO_MEM_DEFAULT_OFFLINE_THRESHOLD); 2531 2532 /* 2533 * alloc_contig_range() works reliably with pageblock 2534 * granularity on ZONE_NORMAL, use pageblock_nr_pages. 2535 */ 2536 sb_size = PAGE_SIZE * pageblock_nr_pages; 2537 sb_size = max_t(uint64_t, vm->device_block_size, sb_size); 2538 2539 if (sb_size < memory_block_size_bytes() && !force_bbm) { 2540 /* SBM: At least two subblocks per Linux memory block. */ 2541 vm->in_sbm = true; 2542 vm->sbm.sb_size = sb_size; 2543 vm->sbm.sbs_per_mb = memory_block_size_bytes() / 2544 vm->sbm.sb_size; 2545 2546 /* Round up to the next full memory block */ 2547 addr = max_t(uint64_t, vm->addr, pluggable_range.start) + 2548 memory_block_size_bytes() - 1; 2549 vm->sbm.first_mb_id = virtio_mem_phys_to_mb_id(addr); 2550 vm->sbm.next_mb_id = vm->sbm.first_mb_id; 2551 } else { 2552 /* BBM: At least one Linux memory block. */ 2553 vm->bbm.bb_size = max_t(uint64_t, vm->device_block_size, 2554 memory_block_size_bytes()); 2555 2556 if (bbm_block_size) { 2557 if (!is_power_of_2(bbm_block_size)) { 2558 dev_warn(&vm->vdev->dev, 2559 "bbm_block_size is not a power of 2"); 2560 } else if (bbm_block_size < vm->bbm.bb_size) { 2561 dev_warn(&vm->vdev->dev, 2562 "bbm_block_size is too small"); 2563 } else { 2564 vm->bbm.bb_size = bbm_block_size; 2565 } 2566 } 2567 2568 /* Round up to the next aligned big block */ 2569 addr = max_t(uint64_t, vm->addr, pluggable_range.start) + 2570 vm->bbm.bb_size - 1; 2571 vm->bbm.first_bb_id = virtio_mem_phys_to_bb_id(vm, addr); 2572 vm->bbm.next_bb_id = vm->bbm.first_bb_id; 2573 2574 /* Make sure we can add two big blocks. */ 2575 vm->offline_threshold = max_t(uint64_t, 2 * vm->bbm.bb_size, 2576 vm->offline_threshold); 2577 } 2578 2579 dev_info(&vm->vdev->dev, "memory block size: 0x%lx", 2580 memory_block_size_bytes()); 2581 if (vm->in_sbm) 2582 dev_info(&vm->vdev->dev, "subblock size: 0x%llx", 2583 (unsigned long long)vm->sbm.sb_size); 2584 else 2585 dev_info(&vm->vdev->dev, "big block size: 0x%llx", 2586 (unsigned long long)vm->bbm.bb_size); 2587 2588 /* create the parent resource for all memory */ 2589 rc = virtio_mem_create_resource(vm); 2590 if (rc) 2591 return rc; 2592 2593 /* use a single dynamic memory group to cover the whole memory device */ 2594 if (vm->in_sbm) 2595 unit_pages = PHYS_PFN(memory_block_size_bytes()); 2596 else 2597 unit_pages = PHYS_PFN(vm->bbm.bb_size); 2598 rc = memory_group_register_dynamic(vm->nid, unit_pages); 2599 if (rc < 0) 2600 goto out_del_resource; 2601 vm->mgid = rc; 2602 2603 /* 2604 * If we still have memory plugged, we have to unplug all memory first. 2605 * Registering our parent resource makes sure that this memory isn't 2606 * actually in use (e.g., trying to reload the driver). 2607 */ 2608 if (vm->plugged_size) { 2609 vm->unplug_all_required = true; 2610 dev_info(&vm->vdev->dev, "unplugging all memory is required\n"); 2611 } 2612 2613 /* register callbacks */ 2614 vm->memory_notifier.notifier_call = virtio_mem_memory_notifier_cb; 2615 rc = register_memory_notifier(&vm->memory_notifier); 2616 if (rc) 2617 goto out_unreg_group; 2618 rc = register_virtio_mem_device(vm); 2619 if (rc) 2620 goto out_unreg_mem; 2621 2622 return 0; 2623 out_unreg_mem: 2624 unregister_memory_notifier(&vm->memory_notifier); 2625 out_unreg_group: 2626 memory_group_unregister(vm->mgid); 2627 out_del_resource: 2628 virtio_mem_delete_resource(vm); 2629 return rc; 2630 } 2631 2632 #ifdef CONFIG_PROC_VMCORE 2633 static int virtio_mem_send_state_request(struct virtio_mem *vm, uint64_t addr, 2634 uint64_t size) 2635 { 2636 const uint64_t nb_vm_blocks = size / vm->device_block_size; 2637 const struct virtio_mem_req req = { 2638 .type = cpu_to_virtio16(vm->vdev, VIRTIO_MEM_REQ_STATE), 2639 .u.state.addr = cpu_to_virtio64(vm->vdev, addr), 2640 .u.state.nb_blocks = cpu_to_virtio16(vm->vdev, nb_vm_blocks), 2641 }; 2642 int rc = -ENOMEM; 2643 2644 dev_dbg(&vm->vdev->dev, "requesting state: 0x%llx - 0x%llx\n", addr, 2645 addr + size - 1); 2646 2647 switch (virtio_mem_send_request(vm, &req)) { 2648 case VIRTIO_MEM_RESP_ACK: 2649 return virtio16_to_cpu(vm->vdev, vm->resp.u.state.state); 2650 case VIRTIO_MEM_RESP_ERROR: 2651 rc = -EINVAL; 2652 break; 2653 default: 2654 break; 2655 } 2656 2657 dev_dbg(&vm->vdev->dev, "requesting state failed: %d\n", rc); 2658 return rc; 2659 } 2660 2661 static bool virtio_mem_vmcore_pfn_is_ram(struct vmcore_cb *cb, 2662 unsigned long pfn) 2663 { 2664 struct virtio_mem *vm = container_of(cb, struct virtio_mem, 2665 vmcore_cb); 2666 uint64_t addr = PFN_PHYS(pfn); 2667 bool is_ram; 2668 int rc; 2669 2670 if (!virtio_mem_contains_range(vm, addr, PAGE_SIZE)) 2671 return true; 2672 if (!vm->plugged_size) 2673 return false; 2674 2675 /* 2676 * We have to serialize device requests and access to the information 2677 * about the block queried last. 2678 */ 2679 mutex_lock(&vm->hotplug_mutex); 2680 2681 addr = ALIGN_DOWN(addr, vm->device_block_size); 2682 if (addr != vm->last_block_addr) { 2683 rc = virtio_mem_send_state_request(vm, addr, 2684 vm->device_block_size); 2685 /* On any kind of error, we're going to signal !ram. */ 2686 if (rc == VIRTIO_MEM_STATE_PLUGGED) 2687 vm->last_block_plugged = true; 2688 else 2689 vm->last_block_plugged = false; 2690 vm->last_block_addr = addr; 2691 } 2692 2693 is_ram = vm->last_block_plugged; 2694 mutex_unlock(&vm->hotplug_mutex); 2695 return is_ram; 2696 } 2697 #endif /* CONFIG_PROC_VMCORE */ 2698 2699 static int virtio_mem_init_kdump(struct virtio_mem *vm) 2700 { 2701 #ifdef CONFIG_PROC_VMCORE 2702 dev_info(&vm->vdev->dev, "memory hot(un)plug disabled in kdump kernel\n"); 2703 vm->vmcore_cb.pfn_is_ram = virtio_mem_vmcore_pfn_is_ram; 2704 register_vmcore_cb(&vm->vmcore_cb); 2705 return 0; 2706 #else /* CONFIG_PROC_VMCORE */ 2707 dev_warn(&vm->vdev->dev, "disabled in kdump kernel without vmcore\n"); 2708 return -EBUSY; 2709 #endif /* CONFIG_PROC_VMCORE */ 2710 } 2711 2712 static int virtio_mem_init(struct virtio_mem *vm) 2713 { 2714 uint16_t node_id; 2715 2716 if (!vm->vdev->config->get) { 2717 dev_err(&vm->vdev->dev, "config access disabled\n"); 2718 return -EINVAL; 2719 } 2720 2721 /* Fetch all properties that can't change. */ 2722 virtio_cread_le(vm->vdev, struct virtio_mem_config, plugged_size, 2723 &vm->plugged_size); 2724 virtio_cread_le(vm->vdev, struct virtio_mem_config, block_size, 2725 &vm->device_block_size); 2726 virtio_cread_le(vm->vdev, struct virtio_mem_config, node_id, 2727 &node_id); 2728 vm->nid = virtio_mem_translate_node_id(vm, node_id); 2729 virtio_cread_le(vm->vdev, struct virtio_mem_config, addr, &vm->addr); 2730 virtio_cread_le(vm->vdev, struct virtio_mem_config, region_size, 2731 &vm->region_size); 2732 2733 /* Determine the nid for the device based on the lowest address. */ 2734 if (vm->nid == NUMA_NO_NODE) 2735 vm->nid = memory_add_physaddr_to_nid(vm->addr); 2736 2737 dev_info(&vm->vdev->dev, "start address: 0x%llx", vm->addr); 2738 dev_info(&vm->vdev->dev, "region size: 0x%llx", vm->region_size); 2739 dev_info(&vm->vdev->dev, "device block size: 0x%llx", 2740 (unsigned long long)vm->device_block_size); 2741 if (vm->nid != NUMA_NO_NODE && IS_ENABLED(CONFIG_NUMA)) 2742 dev_info(&vm->vdev->dev, "nid: %d", vm->nid); 2743 2744 /* 2745 * We don't want to (un)plug or reuse any memory when in kdump. The 2746 * memory is still accessible (but not exposed to Linux). 2747 */ 2748 if (vm->in_kdump) 2749 return virtio_mem_init_kdump(vm); 2750 return virtio_mem_init_hotplug(vm); 2751 } 2752 2753 static int virtio_mem_create_resource(struct virtio_mem *vm) 2754 { 2755 /* 2756 * When force-unloading the driver and removing the device, we 2757 * could have a garbage pointer. Duplicate the string. 2758 */ 2759 const char *name = kstrdup(dev_name(&vm->vdev->dev), GFP_KERNEL); 2760 2761 if (!name) 2762 return -ENOMEM; 2763 2764 /* Disallow mapping device memory via /dev/mem completely. */ 2765 vm->parent_resource = __request_mem_region(vm->addr, vm->region_size, 2766 name, IORESOURCE_SYSTEM_RAM | 2767 IORESOURCE_EXCLUSIVE); 2768 if (!vm->parent_resource) { 2769 kfree(name); 2770 dev_warn(&vm->vdev->dev, "could not reserve device region\n"); 2771 dev_info(&vm->vdev->dev, 2772 "reloading the driver is not supported\n"); 2773 return -EBUSY; 2774 } 2775 2776 /* The memory is not actually busy - make add_memory() work. */ 2777 vm->parent_resource->flags &= ~IORESOURCE_BUSY; 2778 return 0; 2779 } 2780 2781 static void virtio_mem_delete_resource(struct virtio_mem *vm) 2782 { 2783 const char *name; 2784 2785 if (!vm->parent_resource) 2786 return; 2787 2788 name = vm->parent_resource->name; 2789 release_resource(vm->parent_resource); 2790 kfree(vm->parent_resource); 2791 kfree(name); 2792 vm->parent_resource = NULL; 2793 } 2794 2795 static int virtio_mem_range_has_system_ram(struct resource *res, void *arg) 2796 { 2797 return 1; 2798 } 2799 2800 static bool virtio_mem_has_memory_added(struct virtio_mem *vm) 2801 { 2802 const unsigned long flags = IORESOURCE_SYSTEM_RAM | IORESOURCE_BUSY; 2803 2804 return walk_iomem_res_desc(IORES_DESC_NONE, flags, vm->addr, 2805 vm->addr + vm->region_size, NULL, 2806 virtio_mem_range_has_system_ram) == 1; 2807 } 2808 2809 static int virtio_mem_probe(struct virtio_device *vdev) 2810 { 2811 struct virtio_mem *vm; 2812 int rc; 2813 2814 BUILD_BUG_ON(sizeof(struct virtio_mem_req) != 24); 2815 BUILD_BUG_ON(sizeof(struct virtio_mem_resp) != 10); 2816 2817 vdev->priv = vm = kzalloc(sizeof(*vm), GFP_KERNEL); 2818 if (!vm) 2819 return -ENOMEM; 2820 2821 init_waitqueue_head(&vm->host_resp); 2822 vm->vdev = vdev; 2823 INIT_WORK(&vm->wq, virtio_mem_run_wq); 2824 mutex_init(&vm->hotplug_mutex); 2825 INIT_LIST_HEAD(&vm->next); 2826 spin_lock_init(&vm->removal_lock); 2827 hrtimer_init(&vm->retry_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); 2828 vm->retry_timer.function = virtio_mem_timer_expired; 2829 vm->retry_timer_ms = VIRTIO_MEM_RETRY_TIMER_MIN_MS; 2830 vm->in_kdump = is_kdump_kernel(); 2831 2832 /* register the virtqueue */ 2833 rc = virtio_mem_init_vq(vm); 2834 if (rc) 2835 goto out_free_vm; 2836 2837 /* initialize the device by querying the config */ 2838 rc = virtio_mem_init(vm); 2839 if (rc) 2840 goto out_del_vq; 2841 2842 virtio_device_ready(vdev); 2843 2844 /* trigger a config update to start processing the requested_size */ 2845 if (!vm->in_kdump) { 2846 atomic_set(&vm->config_changed, 1); 2847 queue_work(system_freezable_wq, &vm->wq); 2848 } 2849 2850 return 0; 2851 out_del_vq: 2852 vdev->config->del_vqs(vdev); 2853 out_free_vm: 2854 kfree(vm); 2855 vdev->priv = NULL; 2856 2857 return rc; 2858 } 2859 2860 static void virtio_mem_deinit_hotplug(struct virtio_mem *vm) 2861 { 2862 unsigned long mb_id; 2863 int rc; 2864 2865 /* 2866 * Make sure the workqueue won't be triggered anymore and no memory 2867 * blocks can be onlined/offlined until we're finished here. 2868 */ 2869 mutex_lock(&vm->hotplug_mutex); 2870 spin_lock_irq(&vm->removal_lock); 2871 vm->removing = true; 2872 spin_unlock_irq(&vm->removal_lock); 2873 mutex_unlock(&vm->hotplug_mutex); 2874 2875 /* wait until the workqueue stopped */ 2876 cancel_work_sync(&vm->wq); 2877 hrtimer_cancel(&vm->retry_timer); 2878 2879 if (vm->in_sbm) { 2880 /* 2881 * After we unregistered our callbacks, user space can online 2882 * partially plugged offline blocks. Make sure to remove them. 2883 */ 2884 virtio_mem_sbm_for_each_mb(vm, mb_id, 2885 VIRTIO_MEM_SBM_MB_OFFLINE_PARTIAL) { 2886 rc = virtio_mem_sbm_remove_mb(vm, mb_id); 2887 BUG_ON(rc); 2888 virtio_mem_sbm_set_mb_state(vm, mb_id, 2889 VIRTIO_MEM_SBM_MB_UNUSED); 2890 } 2891 /* 2892 * After we unregistered our callbacks, user space can no longer 2893 * offline partially plugged online memory blocks. No need to 2894 * worry about them. 2895 */ 2896 } 2897 2898 /* unregister callbacks */ 2899 unregister_virtio_mem_device(vm); 2900 unregister_memory_notifier(&vm->memory_notifier); 2901 2902 /* 2903 * There is no way we could reliably remove all memory we have added to 2904 * the system. And there is no way to stop the driver/device from going 2905 * away. Warn at least. 2906 */ 2907 if (virtio_mem_has_memory_added(vm)) { 2908 dev_warn(&vm->vdev->dev, 2909 "device still has system memory added\n"); 2910 } else { 2911 virtio_mem_delete_resource(vm); 2912 kfree_const(vm->resource_name); 2913 memory_group_unregister(vm->mgid); 2914 } 2915 2916 /* remove all tracking data - no locking needed */ 2917 if (vm->in_sbm) { 2918 vfree(vm->sbm.mb_states); 2919 vfree(vm->sbm.sb_states); 2920 } else { 2921 vfree(vm->bbm.bb_states); 2922 } 2923 } 2924 2925 static void virtio_mem_deinit_kdump(struct virtio_mem *vm) 2926 { 2927 #ifdef CONFIG_PROC_VMCORE 2928 unregister_vmcore_cb(&vm->vmcore_cb); 2929 #endif /* CONFIG_PROC_VMCORE */ 2930 } 2931 2932 static void virtio_mem_remove(struct virtio_device *vdev) 2933 { 2934 struct virtio_mem *vm = vdev->priv; 2935 2936 if (vm->in_kdump) 2937 virtio_mem_deinit_kdump(vm); 2938 else 2939 virtio_mem_deinit_hotplug(vm); 2940 2941 /* reset the device and cleanup the queues */ 2942 virtio_reset_device(vdev); 2943 vdev->config->del_vqs(vdev); 2944 2945 kfree(vm); 2946 vdev->priv = NULL; 2947 } 2948 2949 static void virtio_mem_config_changed(struct virtio_device *vdev) 2950 { 2951 struct virtio_mem *vm = vdev->priv; 2952 2953 if (unlikely(vm->in_kdump)) 2954 return; 2955 2956 atomic_set(&vm->config_changed, 1); 2957 virtio_mem_retry(vm); 2958 } 2959 2960 #ifdef CONFIG_PM_SLEEP 2961 static int virtio_mem_freeze(struct virtio_device *vdev) 2962 { 2963 /* 2964 * When restarting the VM, all memory is usually unplugged. Don't 2965 * allow to suspend/hibernate. 2966 */ 2967 dev_err(&vdev->dev, "save/restore not supported.\n"); 2968 return -EPERM; 2969 } 2970 2971 static int virtio_mem_restore(struct virtio_device *vdev) 2972 { 2973 return -EPERM; 2974 } 2975 #endif 2976 2977 static unsigned int virtio_mem_features[] = { 2978 #if defined(CONFIG_NUMA) && defined(CONFIG_ACPI_NUMA) 2979 VIRTIO_MEM_F_ACPI_PXM, 2980 #endif 2981 VIRTIO_MEM_F_UNPLUGGED_INACCESSIBLE, 2982 }; 2983 2984 static const struct virtio_device_id virtio_mem_id_table[] = { 2985 { VIRTIO_ID_MEM, VIRTIO_DEV_ANY_ID }, 2986 { 0 }, 2987 }; 2988 2989 static struct virtio_driver virtio_mem_driver = { 2990 .feature_table = virtio_mem_features, 2991 .feature_table_size = ARRAY_SIZE(virtio_mem_features), 2992 .driver.name = KBUILD_MODNAME, 2993 .driver.owner = THIS_MODULE, 2994 .id_table = virtio_mem_id_table, 2995 .probe = virtio_mem_probe, 2996 .remove = virtio_mem_remove, 2997 .config_changed = virtio_mem_config_changed, 2998 #ifdef CONFIG_PM_SLEEP 2999 .freeze = virtio_mem_freeze, 3000 .restore = virtio_mem_restore, 3001 #endif 3002 }; 3003 3004 module_virtio_driver(virtio_mem_driver); 3005 MODULE_DEVICE_TABLE(virtio, virtio_mem_id_table); 3006 MODULE_AUTHOR("David Hildenbrand <david@redhat.com>"); 3007 MODULE_DESCRIPTION("Virtio-mem driver"); 3008 MODULE_LICENSE("GPL"); 3009