/* * Copyright (c) 2021, Sahan Fernando * * SPDX-License-Identifier: BSD-2-Clause */ #include #include #include namespace Kernel::Graphics { VirtIOFrameBufferDevice::VirtIOFrameBufferDevice(VirtIOGPU& virtio_gpu, VirtIOGPUScanoutID scanout) : BlockDevice(29, GraphicsManagement::the().allocate_minor_device_number()) , m_gpu(virtio_gpu) , m_scanout(scanout) { if (display_info().enabled) create_framebuffer(); } VirtIOFrameBufferDevice::~VirtIOFrameBufferDevice() { } void VirtIOFrameBufferDevice::create_framebuffer() { // First delete any existing framebuffers to free the memory first m_framebuffer = nullptr; m_framebuffer_sink_vmobject = nullptr; // Allocate frame buffer for both front and back auto& info = display_info(); m_buffer_size = calculate_framebuffer_size(info.rect.width, info.rect.height); m_framebuffer = MM.allocate_kernel_region(m_buffer_size * 2, String::formatted("VirtGPU FrameBuffer #{}", m_scanout.value()), Region::Access::Read | Region::Access::Write, AllocationStrategy::AllocateNow); auto write_sink_page = MM.allocate_user_physical_page(MemoryManager::ShouldZeroFill::No).release_nonnull(); auto num_needed_pages = m_framebuffer->vmobject().page_count(); NonnullRefPtrVector pages; for (auto i = 0u; i < num_needed_pages; ++i) { pages.append(write_sink_page); } m_framebuffer_sink_vmobject = AnonymousVMObject::try_create_with_physical_pages(move(pages)); Locker locker(m_gpu.operation_lock()); m_current_buffer = &buffer_from_index(m_last_set_buffer_index.load()); create_buffer(m_main_buffer, 0, m_buffer_size); create_buffer(m_back_buffer, m_buffer_size, m_buffer_size); } void VirtIOFrameBufferDevice::create_buffer(Buffer& buffer, size_t framebuffer_offset, size_t framebuffer_size) { buffer.framebuffer_offset = framebuffer_offset; buffer.framebuffer_data = m_framebuffer->vaddr().as_ptr() + framebuffer_offset; auto& info = display_info(); // 1. Create BUFFER using VIRTIO_GPU_CMD_RESOURCE_CREATE_2D if (buffer.resource_id.value() != 0) m_gpu.delete_resource(buffer.resource_id); buffer.resource_id = m_gpu.create_2d_resource(info.rect); // 2. Attach backing storage using VIRTIO_GPU_CMD_RESOURCE_ATTACH_BACKING m_gpu.ensure_backing_storage(*m_framebuffer, buffer.framebuffer_offset, framebuffer_size, buffer.resource_id); // 3. Use VIRTIO_GPU_CMD_SET_SCANOUT to link the framebuffer to a display scanout. if (&buffer == m_current_buffer) m_gpu.set_scanout_resource(m_scanout.value(), buffer.resource_id, info.rect); // 4. Render our test pattern draw_ntsc_test_pattern(buffer); // 5. Use VIRTIO_GPU_CMD_TRANSFER_TO_HOST_2D to update the host resource from guest memory. transfer_framebuffer_data_to_host(info.rect, buffer); // 6. Use VIRTIO_GPU_CMD_RESOURCE_FLUSH to flush the updated resource to the display. if (&buffer == m_current_buffer) flush_displayed_image(info.rect, buffer); info.enabled = 1; } VirtIOGPURespDisplayInfo::VirtIOGPUDisplayOne const& VirtIOFrameBufferDevice::display_info() const { return m_gpu.display_info(m_scanout); } VirtIOGPURespDisplayInfo::VirtIOGPUDisplayOne& VirtIOFrameBufferDevice::display_info() { return m_gpu.display_info(m_scanout); } void VirtIOFrameBufferDevice::transfer_framebuffer_data_to_host(VirtIOGPURect const& rect, Buffer& buffer) { m_gpu.transfer_framebuffer_data_to_host(m_scanout, rect, buffer.resource_id); } void VirtIOFrameBufferDevice::flush_dirty_window(VirtIOGPURect const& dirty_rect, Buffer& buffer) { m_gpu.flush_dirty_window(m_scanout, dirty_rect, buffer.resource_id); } void VirtIOFrameBufferDevice::flush_displayed_image(VirtIOGPURect const& dirty_rect, Buffer& buffer) { m_gpu.flush_displayed_image(dirty_rect, buffer.resource_id); } bool VirtIOFrameBufferDevice::try_to_set_resolution(size_t width, size_t height) { if (width > MAX_VIRTIOGPU_RESOLUTION_WIDTH || height > MAX_VIRTIOGPU_RESOLUTION_HEIGHT) return false; auto& info = display_info(); Locker locker(m_gpu.operation_lock()); info.rect = { .x = 0, .y = 0, .width = (u32)width, .height = (u32)height, }; create_framebuffer(); return true; } void VirtIOFrameBufferDevice::set_buffer(int buffer_index) { auto& buffer = buffer_index == 0 ? m_main_buffer : m_back_buffer; Locker locker(m_gpu.operation_lock()); if (&buffer == m_current_buffer) return; m_current_buffer = &buffer; m_gpu.set_scanout_resource(m_scanout.value(), buffer.resource_id, display_info().rect); m_gpu.flush_displayed_image(buffer.dirty_rect, buffer.resource_id); // QEMU SDL backend requires this (as per spec) buffer.dirty_rect = {}; } int VirtIOFrameBufferDevice::ioctl(FileDescription&, unsigned request, FlatPtr arg) { REQUIRE_PROMISE(video); switch (request) { case FB_IOCTL_GET_SIZE_IN_BYTES: { auto* out = (size_t*)arg; size_t value = m_buffer_size * 2; if (!copy_to_user(out, &value)) return -EFAULT; return 0; } case FB_IOCTL_SET_RESOLUTION: { auto* user_resolution = (FBResolution*)arg; FBResolution resolution; if (!copy_from_user(&resolution, user_resolution)) return -EFAULT; if (!try_to_set_resolution(resolution.width, resolution.height)) return -EINVAL; resolution.pitch = pitch(); if (!copy_to_user(user_resolution, &resolution)) return -EFAULT; return 0; } case FB_IOCTL_GET_RESOLUTION: { auto* user_resolution = (FBResolution*)arg; FBResolution resolution; resolution.pitch = pitch(); resolution.width = width(); resolution.height = height(); if (!copy_to_user(user_resolution, &resolution)) return -EFAULT; return 0; } case FB_IOCTL_SET_BUFFER: { auto buffer_index = (int)arg; if (!is_valid_buffer_index(buffer_index)) return -EINVAL; if (m_last_set_buffer_index.exchange(buffer_index) != buffer_index && m_are_writes_active) set_buffer(buffer_index); return 0; } case FB_IOCTL_FLUSH_BUFFERS: { FBFlushRects user_flush_rects; if (!copy_from_user(&user_flush_rects, (FBFlushRects*)arg)) return -EFAULT; if (!is_valid_buffer_index(user_flush_rects.buffer_index)) return -EINVAL; if (Checked::multiplication_would_overflow(user_flush_rects.count, sizeof(FBRect))) return -EFAULT; if (m_are_writes_active && user_flush_rects.count > 0) { auto& buffer = buffer_from_index(user_flush_rects.buffer_index); Locker locker(m_gpu.operation_lock()); for (unsigned i = 0; i < user_flush_rects.count; i++) { FBRect user_dirty_rect; if (!copy_from_user(&user_dirty_rect, &user_flush_rects.rects[i])) return -EFAULT; VirtIOGPURect dirty_rect { .x = user_dirty_rect.x, .y = user_dirty_rect.y, .width = user_dirty_rect.width, .height = user_dirty_rect.height }; transfer_framebuffer_data_to_host(dirty_rect, buffer); if (&buffer == m_current_buffer) { // Flushing directly to screen flush_displayed_image(dirty_rect, buffer); buffer.dirty_rect = {}; } else { if (buffer.dirty_rect.width == 0 || buffer.dirty_rect.height == 0) { buffer.dirty_rect = dirty_rect; } else { auto current_dirty_right = buffer.dirty_rect.x + buffer.dirty_rect.width; auto current_dirty_bottom = buffer.dirty_rect.y + buffer.dirty_rect.height; buffer.dirty_rect.x = min(buffer.dirty_rect.x, dirty_rect.x); buffer.dirty_rect.y = min(buffer.dirty_rect.y, dirty_rect.y); buffer.dirty_rect.width = max(current_dirty_right, dirty_rect.x + dirty_rect.width) - buffer.dirty_rect.x; buffer.dirty_rect.height = max(current_dirty_bottom, dirty_rect.y + dirty_rect.height) - buffer.dirty_rect.y; } } } } return 0; } case FB_IOCTL_GET_BUFFER_OFFSET: { FBBufferOffset buffer_offset; if (!copy_from_user(&buffer_offset, (FBBufferOffset*)arg)) return -EFAULT; if (!is_valid_buffer_index(buffer_offset.buffer_index)) return -EINVAL; buffer_offset.offset = (size_t)buffer_offset.buffer_index * m_buffer_size; if (!copy_to_user((FBBufferOffset*)arg, &buffer_offset)) return -EFAULT; return 0; } default: return -EINVAL; }; } KResultOr VirtIOFrameBufferDevice::mmap(Process& process, FileDescription&, const Range& range, u64 offset, int prot, bool shared) { REQUIRE_PROMISE(video); if (!shared) return ENODEV; if (offset != 0 || !m_framebuffer) return ENXIO; if (range.size() > m_framebuffer->size()) return EOVERFLOW; // We only allow one process to map the region if (m_userspace_mmap_region) return ENOMEM; auto vmobject = m_are_writes_active ? m_framebuffer->vmobject().try_clone() : m_framebuffer_sink_vmobject; if (vmobject.is_null()) return ENOMEM; auto result = process.space().allocate_region_with_vmobject( range, vmobject.release_nonnull(), 0, "VirtIOGPU Framebuffer", prot, shared); if (result.is_error()) return result; m_userspace_mmap_region = result.value(); return result; } void VirtIOFrameBufferDevice::deactivate_writes() { m_are_writes_active = false; if (m_userspace_mmap_region) { auto* region = m_userspace_mmap_region.unsafe_ptr(); auto vm_object = m_framebuffer_sink_vmobject->try_clone(); VERIFY(vm_object); region->set_vmobject(vm_object.release_nonnull()); region->remap(); } set_buffer(0); clear_to_black(buffer_from_index(0)); } void VirtIOFrameBufferDevice::activate_writes() { m_are_writes_active = true; auto last_set_buffer_index = m_last_set_buffer_index.load(); if (m_userspace_mmap_region) { auto* region = m_userspace_mmap_region.unsafe_ptr(); region->set_vmobject(m_framebuffer->vmobject()); region->remap(); } set_buffer(last_set_buffer_index); } void VirtIOFrameBufferDevice::clear_to_black(Buffer& buffer) { auto& info = display_info(); size_t width = info.rect.width; size_t height = info.rect.height; u8* data = buffer.framebuffer_data; for (size_t i = 0; i < width * height; ++i) { data[4 * i + 0] = 0x00; data[4 * i + 1] = 0x00; data[4 * i + 2] = 0x00; data[4 * i + 3] = 0xff; } } void VirtIOFrameBufferDevice::draw_ntsc_test_pattern(Buffer& buffer) { static constexpr u8 colors[12][4] = { { 0xff, 0xff, 0xff, 0xff }, // White { 0x00, 0xff, 0xff, 0xff }, // Primary + Composite colors { 0xff, 0xff, 0x00, 0xff }, { 0x00, 0xff, 0x00, 0xff }, { 0xff, 0x00, 0xff, 0xff }, { 0x00, 0x00, 0xff, 0xff }, { 0xff, 0x00, 0x00, 0xff }, { 0xba, 0x01, 0x5f, 0xff }, // Dark blue { 0x8d, 0x3d, 0x00, 0xff }, // Purple { 0x22, 0x22, 0x22, 0xff }, // Shades of gray { 0x10, 0x10, 0x10, 0xff }, { 0x00, 0x00, 0x00, 0xff }, }; auto& info = display_info(); size_t width = info.rect.width; size_t height = info.rect.height; u8* data = buffer.framebuffer_data; // Draw NTSC test card for (size_t y = 0; y < height; ++y) { for (size_t x = 0; x < width; ++x) { size_t color = 0; if (3 * y < 2 * height) { // Top 2/3 of image is 7 vertical stripes of color spectrum color = (7 * x) / width; } else if (4 * y < 3 * height) { // 2/3 mark to 3/4 mark is backwards color spectrum alternating with black auto segment = (7 * x) / width; color = segment % 2 ? 10 : 6 - segment; } else { if (28 * x < 5 * width) { color = 8; } else if (28 * x < 10 * width) { color = 0; } else if (28 * x < 15 * width) { color = 7; } else if (28 * x < 20 * width) { color = 10; } else if (7 * x < 6 * width) { // Grayscale gradient color = 26 - ((21 * x) / width); } else { // Solid black color = 10; } } u8* pixel = &data[4 * (y * width + x)]; for (int i = 0; i < 4; ++i) { pixel[i] = colors[color][i]; } } } dbgln_if(VIRTIO_DEBUG, "Finish drawing the pattern"); } u8* VirtIOFrameBufferDevice::framebuffer_data() { return m_current_buffer->framebuffer_data; } }