| /* | 
 |  * Copyright © 2018, 2021 Oracle and/or its affiliates. | 
 |  * | 
 |  * This work is licensed under the terms of the GNU GPL, version 2 or later. | 
 |  * See the COPYING file in the top-level directory. | 
 |  * | 
 |  */ | 
 |  | 
 | #include "qemu/osdep.h" | 
 |  | 
 | #include "qemu/int128.h" | 
 | #include "qemu/range.h" | 
 | #include "exec/memory.h" | 
 | #include "exec/cpu-common.h" | 
 | #include "exec/ram_addr.h" | 
 | #include "qapi/error.h" | 
 | #include "qemu/error-report.h" | 
 | #include "hw/remote/mpqemu-link.h" | 
 | #include "hw/remote/proxy-memory-listener.h" | 
 |  | 
 | /* | 
 |  * TODO: get_fd_from_hostaddr(), proxy_mrs_can_merge() and | 
 |  * proxy_memory_listener_commit() defined below perform tasks similar to the | 
 |  * functions defined in vhost-user.c. These functions are good candidates | 
 |  * for refactoring. | 
 |  * | 
 |  */ | 
 |  | 
 | static void proxy_memory_listener_reset(MemoryListener *listener) | 
 | { | 
 |     ProxyMemoryListener *proxy_listener = container_of(listener, | 
 |                                                        ProxyMemoryListener, | 
 |                                                        listener); | 
 |     int mrs; | 
 |  | 
 |     for (mrs = 0; mrs < proxy_listener->n_mr_sections; mrs++) { | 
 |         memory_region_unref(proxy_listener->mr_sections[mrs].mr); | 
 |     } | 
 |  | 
 |     g_free(proxy_listener->mr_sections); | 
 |     proxy_listener->mr_sections = NULL; | 
 |     proxy_listener->n_mr_sections = 0; | 
 | } | 
 |  | 
 | static int get_fd_from_hostaddr(uint64_t host, ram_addr_t *offset) | 
 | { | 
 |     MemoryRegion *mr; | 
 |     ram_addr_t off; | 
 |  | 
 |     /** | 
 |      * Assumes that the host address is a valid address as it's | 
 |      * coming from the MemoryListener system. In the case host | 
 |      * address is not valid, the following call would return | 
 |      * the default subregion of "system_memory" region, and | 
 |      * not NULL. So it's not possible to check for NULL here. | 
 |      */ | 
 |     mr = memory_region_from_host((void *)(uintptr_t)host, &off); | 
 |  | 
 |     if (offset) { | 
 |         *offset = off; | 
 |     } | 
 |  | 
 |     return memory_region_get_fd(mr); | 
 | } | 
 |  | 
 | static bool proxy_mrs_can_merge(uint64_t host, uint64_t prev_host, size_t size) | 
 | { | 
 |     if (((prev_host + size) != host)) { | 
 |         return false; | 
 |     } | 
 |  | 
 |     if (get_fd_from_hostaddr(host, NULL) != | 
 |             get_fd_from_hostaddr(prev_host, NULL)) { | 
 |         return false; | 
 |     } | 
 |  | 
 |     return true; | 
 | } | 
 |  | 
 | static bool try_merge(ProxyMemoryListener *proxy_listener, | 
 |                       MemoryRegionSection *section) | 
 | { | 
 |     uint64_t mrs_size, mrs_gpa, mrs_page; | 
 |     MemoryRegionSection *prev_sec; | 
 |     bool merged = false; | 
 |     uintptr_t mrs_host; | 
 |     RAMBlock *mrs_rb; | 
 |  | 
 |     if (!proxy_listener->n_mr_sections) { | 
 |         return false; | 
 |     } | 
 |  | 
 |     mrs_rb = section->mr->ram_block; | 
 |     mrs_page = (uint64_t)qemu_ram_pagesize(mrs_rb); | 
 |     mrs_size = int128_get64(section->size); | 
 |     mrs_gpa = section->offset_within_address_space; | 
 |     mrs_host = (uintptr_t)memory_region_get_ram_ptr(section->mr) + | 
 |                section->offset_within_region; | 
 |  | 
 |     if (get_fd_from_hostaddr(mrs_host, NULL) < 0) { | 
 |         return true; | 
 |     } | 
 |  | 
 |     mrs_host = mrs_host & ~(mrs_page - 1); | 
 |     mrs_gpa = mrs_gpa & ~(mrs_page - 1); | 
 |     mrs_size = ROUND_UP(mrs_size, mrs_page); | 
 |  | 
 |     prev_sec = proxy_listener->mr_sections + | 
 |                (proxy_listener->n_mr_sections - 1); | 
 |     uint64_t prev_gpa_start = prev_sec->offset_within_address_space; | 
 |     uint64_t prev_size = int128_get64(prev_sec->size); | 
 |     uint64_t prev_gpa_end   = range_get_last(prev_gpa_start, prev_size); | 
 |     uint64_t prev_host_start = | 
 |         (uintptr_t)memory_region_get_ram_ptr(prev_sec->mr) + | 
 |         prev_sec->offset_within_region; | 
 |     uint64_t prev_host_end = range_get_last(prev_host_start, prev_size); | 
 |  | 
 |     if (mrs_gpa <= (prev_gpa_end + 1)) { | 
 |         g_assert(mrs_gpa > prev_gpa_start); | 
 |  | 
 |         if ((section->mr == prev_sec->mr) && | 
 |             proxy_mrs_can_merge(mrs_host, prev_host_start, | 
 |                                 (mrs_gpa - prev_gpa_start))) { | 
 |             uint64_t max_end = MAX(prev_host_end, mrs_host + mrs_size); | 
 |             merged = true; | 
 |             prev_sec->offset_within_address_space = | 
 |                 MIN(prev_gpa_start, mrs_gpa); | 
 |             prev_sec->offset_within_region = | 
 |                 MIN(prev_host_start, mrs_host) - | 
 |                 (uintptr_t)memory_region_get_ram_ptr(prev_sec->mr); | 
 |             prev_sec->size = int128_make64(max_end - MIN(prev_host_start, | 
 |                                                          mrs_host)); | 
 |         } | 
 |     } | 
 |  | 
 |     return merged; | 
 | } | 
 |  | 
 | static void proxy_memory_listener_region_addnop(MemoryListener *listener, | 
 |                                                 MemoryRegionSection *section) | 
 | { | 
 |     ProxyMemoryListener *proxy_listener = container_of(listener, | 
 |                                                        ProxyMemoryListener, | 
 |                                                        listener); | 
 |  | 
 |     if (!memory_region_is_ram(section->mr) || | 
 |             memory_region_is_rom(section->mr)) { | 
 |         return; | 
 |     } | 
 |  | 
 |     if (try_merge(proxy_listener, section)) { | 
 |         return; | 
 |     } | 
 |  | 
 |     ++proxy_listener->n_mr_sections; | 
 |     proxy_listener->mr_sections = g_renew(MemoryRegionSection, | 
 |                                           proxy_listener->mr_sections, | 
 |                                           proxy_listener->n_mr_sections); | 
 |     proxy_listener->mr_sections[proxy_listener->n_mr_sections - 1] = *section; | 
 |     proxy_listener->mr_sections[proxy_listener->n_mr_sections - 1].fv = NULL; | 
 |     memory_region_ref(section->mr); | 
 | } | 
 |  | 
 | static void proxy_memory_listener_commit(MemoryListener *listener) | 
 | { | 
 |     ProxyMemoryListener *proxy_listener = container_of(listener, | 
 |                                                        ProxyMemoryListener, | 
 |                                                        listener); | 
 |     MPQemuMsg msg; | 
 |     MemoryRegionSection *section; | 
 |     ram_addr_t offset; | 
 |     uintptr_t host_addr; | 
 |     int region; | 
 |     Error *local_err = NULL; | 
 |  | 
 |     memset(&msg, 0, sizeof(MPQemuMsg)); | 
 |  | 
 |     msg.cmd = MPQEMU_CMD_SYNC_SYSMEM; | 
 |     msg.num_fds = proxy_listener->n_mr_sections; | 
 |     msg.size = sizeof(SyncSysmemMsg); | 
 |     if (msg.num_fds > REMOTE_MAX_FDS) { | 
 |         error_report("Number of fds is more than %d", REMOTE_MAX_FDS); | 
 |         return; | 
 |     } | 
 |  | 
 |     for (region = 0; region < proxy_listener->n_mr_sections; region++) { | 
 |         section = &proxy_listener->mr_sections[region]; | 
 |         msg.data.sync_sysmem.gpas[region] = | 
 |             section->offset_within_address_space; | 
 |         msg.data.sync_sysmem.sizes[region] = int128_get64(section->size); | 
 |         host_addr = (uintptr_t)memory_region_get_ram_ptr(section->mr) + | 
 |                     section->offset_within_region; | 
 |         msg.fds[region] = get_fd_from_hostaddr(host_addr, &offset); | 
 |         msg.data.sync_sysmem.offsets[region] = offset; | 
 |     } | 
 |     if (!mpqemu_msg_send(&msg, proxy_listener->ioc, &local_err)) { | 
 |         error_report_err(local_err); | 
 |     } | 
 | } | 
 |  | 
 | void proxy_memory_listener_deconfigure(ProxyMemoryListener *proxy_listener) | 
 | { | 
 |     memory_listener_unregister(&proxy_listener->listener); | 
 |  | 
 |     proxy_memory_listener_reset(&proxy_listener->listener); | 
 | } | 
 |  | 
 | void proxy_memory_listener_configure(ProxyMemoryListener *proxy_listener, | 
 |                                      QIOChannel *ioc) | 
 | { | 
 |     proxy_listener->n_mr_sections = 0; | 
 |     proxy_listener->mr_sections = NULL; | 
 |  | 
 |     proxy_listener->ioc = ioc; | 
 |  | 
 |     proxy_listener->listener.begin = proxy_memory_listener_reset; | 
 |     proxy_listener->listener.commit = proxy_memory_listener_commit; | 
 |     proxy_listener->listener.region_add = proxy_memory_listener_region_addnop; | 
 |     proxy_listener->listener.region_nop = proxy_memory_listener_region_addnop; | 
 |     proxy_listener->listener.priority = 10; | 
 |     proxy_listener->listener.name = "proxy"; | 
 |  | 
 |     memory_listener_register(&proxy_listener->listener, | 
 |                              &address_space_memory); | 
 | } |