|  | /* | 
|  | * 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 = MEMORY_LISTENER_PRIORITY_DEV_BACKEND; | 
|  | proxy_listener->listener.name = "proxy"; | 
|  |  | 
|  | memory_listener_register(&proxy_listener->listener, | 
|  | &address_space_memory); | 
|  | } |