336 lines
11 KiB
C++
336 lines
11 KiB
C++
// Copyright 2015 Citra Emulator Project
|
|
// Licensed under GPLv2 or any later version
|
|
// Refer to the license.txt file included.
|
|
|
|
#include <cstring>
|
|
|
|
#include "common/logging/log.h"
|
|
|
|
#include "core/hle/hle.h"
|
|
#include "core/hle/kernel/event.h"
|
|
#include "core/hle/service/y2r_u.h"
|
|
#include "core/mem_map.h"
|
|
#include "core/memory.h"
|
|
|
|
#include "video_core/utils.h"
|
|
#include "video_core/video_core.h"
|
|
|
|
////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
// Namespace Y2R_U
|
|
|
|
namespace Y2R_U {
|
|
|
|
enum class InputFormat {
|
|
/// 8-bit input, with YUV components in separate planes and using 4:2:2 subsampling.
|
|
YUV422_Indiv8 = 0,
|
|
/// 8-bit input, with YUV components in separate planes and using 4:2:0 subsampling.
|
|
YUV420_Indiv8 = 1,
|
|
|
|
YUV422_INDIV_16 = 2,
|
|
YUV420_INDIV_16 = 3,
|
|
YUV422_BATCH = 4,
|
|
};
|
|
|
|
enum class OutputFormat {
|
|
Rgb32 = 0,
|
|
Rgb24 = 1,
|
|
Rgb16_555 = 2,
|
|
Rgb16_565 = 3,
|
|
};
|
|
|
|
enum class Rotation {
|
|
None = 0,
|
|
Clockwise_90 = 1,
|
|
Clockwise_180 = 2,
|
|
Clockwise_270 = 3,
|
|
};
|
|
|
|
enum class BlockAlignment {
|
|
/// Image is output in linear format suitable for use as a framebuffer.
|
|
Linear = 0,
|
|
/// Image is output in tiled PICA format, suitable for use as a texture.
|
|
Block8x8 = 1,
|
|
};
|
|
|
|
enum class StandardCoefficient {
|
|
ITU_Rec601 = 0,
|
|
ITU_Rec709 = 1,
|
|
ITU_Rec601_Scaling = 2,
|
|
ITU_Rec709_Scaling = 3,
|
|
};
|
|
|
|
static Kernel::SharedPtr<Kernel::Event> completion_event;
|
|
|
|
struct ConversionParameters {
|
|
InputFormat input_format;
|
|
OutputFormat output_format;
|
|
Rotation rotation;
|
|
BlockAlignment alignment;
|
|
u16 input_line_width;
|
|
u16 input_lines;
|
|
|
|
// Input parameters for the Y (luma) plane
|
|
VAddr srcY_address;
|
|
u32 srcY_image_size;
|
|
u16 srcY_transfer_unit;
|
|
u16 srcY_stride;
|
|
|
|
// Output parameters for the conversion results
|
|
VAddr dst_address;
|
|
u32 dst_image_size;
|
|
u16 dst_transfer_unit;
|
|
u16 dst_stride;
|
|
};
|
|
|
|
static ConversionParameters conversion_params;
|
|
|
|
static void SetInputFormat(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
conversion_params.input_format = static_cast<InputFormat>(cmd_buff[1]);
|
|
LOG_DEBUG(Service_Y2R, "called input_format=%u", conversion_params.input_format);
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
static void SetOutputFormat(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
conversion_params.output_format = static_cast<OutputFormat>(cmd_buff[1]);
|
|
LOG_DEBUG(Service_Y2R, "called output_format=%u", conversion_params.output_format);
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
static void SetRotation(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
conversion_params.rotation = static_cast<Rotation>(cmd_buff[1]);
|
|
LOG_DEBUG(Service_Y2R, "called rotation=%u", conversion_params.rotation);
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
static void SetBlockAlignment(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
conversion_params.alignment = static_cast<BlockAlignment>(cmd_buff[1]);
|
|
LOG_DEBUG(Service_Y2R, "called alignment=%u", conversion_params.alignment);
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
/**
|
|
* Y2R_U::GetTransferEndEvent service function
|
|
* Outputs:
|
|
* 1 : Result of function, 0 on success, otherwise error code
|
|
* 3 : The handle of the completion event
|
|
*/
|
|
static void GetTransferEndEvent(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
cmd_buff[3] = Kernel::g_handle_table.Create(completion_event).MoveFrom();
|
|
LOG_DEBUG(Service_Y2R, "called");
|
|
}
|
|
|
|
static void SetSendingY(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
conversion_params.srcY_address = cmd_buff[1];
|
|
conversion_params.srcY_image_size = cmd_buff[2];
|
|
conversion_params.srcY_transfer_unit = cmd_buff[3];
|
|
conversion_params.srcY_stride = cmd_buff[4];
|
|
u32 src_process_handle = cmd_buff[6];
|
|
LOG_DEBUG(Service_Y2R, "called image_size=0x%08X, transfer_unit=%hu, transfer_stride=%hu, "
|
|
"src_process_handle=0x%08X", conversion_params.srcY_image_size,
|
|
conversion_params.srcY_transfer_unit, conversion_params.srcY_stride, src_process_handle);
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
static void SetReceiving(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
conversion_params.dst_address = cmd_buff[1];
|
|
conversion_params.dst_image_size = cmd_buff[2];
|
|
conversion_params.dst_transfer_unit = cmd_buff[3];
|
|
conversion_params.dst_stride = cmd_buff[4];
|
|
u32 dst_process_handle = cmd_buff[6];
|
|
LOG_DEBUG(Service_Y2R, "called image_size=0x%08X, transfer_unit=%hu, transfer_stride=%hu, "
|
|
"dst_process_handle=0x%08X", conversion_params.dst_image_size,
|
|
conversion_params.dst_transfer_unit, conversion_params.dst_stride,
|
|
dst_process_handle);
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
static void SetInputLineWidth(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
conversion_params.input_line_width = cmd_buff[1];
|
|
LOG_DEBUG(Service_Y2R, "input_line_width=%u", conversion_params.input_line_width);
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
static void SetInputLines(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
conversion_params.input_lines = cmd_buff[1];
|
|
LOG_DEBUG(Service_Y2R, "input_line_number=%u", conversion_params.input_lines);
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
static void StartConversion(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
const u8* srcY_buffer = Memory::GetPointer(conversion_params.srcY_address);
|
|
u8* dst_buffer = Memory::GetPointer(conversion_params.dst_address);
|
|
|
|
// TODO: support color and other kinds of conversions
|
|
ASSERT(conversion_params.input_format == InputFormat::YUV422_Indiv8
|
|
|| conversion_params.input_format == InputFormat::YUV420_Indiv8);
|
|
ASSERT(conversion_params.output_format == OutputFormat::Rgb24);
|
|
ASSERT(conversion_params.rotation == Rotation::None);
|
|
const int bpp = 3;
|
|
|
|
switch (conversion_params.alignment) {
|
|
case BlockAlignment::Linear:
|
|
{
|
|
const size_t input_lines = conversion_params.input_lines;
|
|
const size_t input_line_width = conversion_params.input_line_width;
|
|
const size_t srcY_stride = conversion_params.srcY_stride;
|
|
const size_t dst_stride = conversion_params.dst_stride;
|
|
|
|
size_t srcY_offset = 0;
|
|
size_t dst_offset = 0;
|
|
|
|
for (size_t line = 0; line < input_lines; ++line) {
|
|
for (size_t i = 0; i < input_line_width; ++i) {
|
|
u8 Y = srcY_buffer[srcY_offset];
|
|
dst_buffer[dst_offset + 0] = Y;
|
|
dst_buffer[dst_offset + 1] = Y;
|
|
dst_buffer[dst_offset + 2] = Y;
|
|
|
|
srcY_offset += 1;
|
|
dst_offset += bpp;
|
|
}
|
|
srcY_offset += srcY_stride;
|
|
dst_offset += dst_stride;
|
|
}
|
|
break;
|
|
}
|
|
case BlockAlignment::Block8x8:
|
|
{
|
|
const size_t input_lines = conversion_params.input_lines;
|
|
const size_t input_line_width = conversion_params.input_line_width;
|
|
const size_t srcY_stride = conversion_params.srcY_stride;
|
|
const size_t dst_transfer_unit = conversion_params.dst_transfer_unit;
|
|
const size_t dst_stride = conversion_params.dst_stride;
|
|
|
|
size_t srcY_offset = 0;
|
|
size_t dst_tile_line_offs = 0;
|
|
|
|
const size_t tile_size = 8 * 8 * bpp;
|
|
|
|
for (size_t line = 0; line < input_lines;) {
|
|
size_t tile_y = line / 8;
|
|
size_t max_line = line + 8;
|
|
|
|
for (; line < max_line; ++line) {
|
|
for (size_t x = 0; x < input_line_width; ++x) {
|
|
size_t tile_x = x / 8;
|
|
|
|
size_t dst_tile_offs = dst_tile_line_offs + tile_x * tile_size;
|
|
size_t tile_i = VideoCore::MortonInterleave((u32)x, (u32)line);
|
|
|
|
size_t dst_offset = dst_tile_offs + tile_i * bpp;
|
|
|
|
u8 Y = srcY_buffer[srcY_offset];
|
|
dst_buffer[dst_offset + 0] = Y;
|
|
dst_buffer[dst_offset + 1] = Y;
|
|
dst_buffer[dst_offset + 2] = Y;
|
|
|
|
srcY_offset += 1;
|
|
}
|
|
|
|
srcY_offset += srcY_stride;
|
|
}
|
|
|
|
dst_tile_line_offs += dst_transfer_unit + dst_stride;
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
// dst_image_size would seem to be perfect for this, but it doesn't include the stride :(
|
|
u32 total_output_size = conversion_params.input_lines *
|
|
(conversion_params.dst_transfer_unit + conversion_params.dst_stride);
|
|
VideoCore::g_renderer->hw_rasterizer->NotifyFlush(
|
|
Memory::VirtualToPhysicalAddress(conversion_params.dst_address), total_output_size);
|
|
|
|
LOG_DEBUG(Service_Y2R, "called");
|
|
completion_event->Signal();
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
}
|
|
|
|
/**
|
|
* Y2R_U::IsBusyConversion service function
|
|
* Outputs:
|
|
* 1 : Result of function, 0 on success, otherwise error code
|
|
* 2 : 1 if there's a conversion running, otherwise 0.
|
|
*/
|
|
static void IsBusyConversion(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
cmd_buff[2] = 0; // StartConversion always finishes immediately
|
|
LOG_DEBUG(Service_Y2R, "called");
|
|
}
|
|
|
|
static void PingProcess(Service::Interface* self) {
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
cmd_buff[2] = 0;
|
|
LOG_WARNING(Service_Y2R, "(STUBBED) called");
|
|
}
|
|
|
|
const Interface::FunctionInfo FunctionTable[] = {
|
|
{0x00010040, SetInputFormat, "SetInputFormat"},
|
|
{0x00030040, SetOutputFormat, "SetOutputFormat"},
|
|
{0x00050040, SetRotation, "SetRotation"},
|
|
{0x00070040, SetBlockAlignment, "SetBlockAlignment"},
|
|
{0x000D0040, nullptr, "SetTransferEndInterrupt"},
|
|
{0x000F0000, GetTransferEndEvent, "GetTransferEndEvent"},
|
|
{0x00100102, SetSendingY, "SetSendingY"},
|
|
{0x00110102, nullptr, "SetSendingU"},
|
|
{0x00120102, nullptr, "SetSendingV"},
|
|
{0x00180102, SetReceiving, "SetReceiving"},
|
|
{0x001A0040, SetInputLineWidth, "SetInputLineWidth"},
|
|
{0x001C0040, SetInputLines, "SetInputLines"},
|
|
{0x00200040, nullptr, "SetStandardCoefficient"},
|
|
{0x00220040, nullptr, "SetAlpha"},
|
|
{0x00260000, StartConversion, "StartConversion"},
|
|
{0x00270000, nullptr, "StopConversion"},
|
|
{0x00280000, IsBusyConversion, "IsBusyConversion"},
|
|
{0x002A0000, PingProcess, "PingProcess"},
|
|
{0x002B0000, nullptr, "DriverInitialize"},
|
|
{0x002C0000, nullptr, "DriverFinalize"},
|
|
};
|
|
|
|
////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
// Interface class
|
|
|
|
Interface::Interface() {
|
|
completion_event = Kernel::Event::Create(RESETTYPE_ONESHOT, "Y2R:Completed");
|
|
std::memset(&conversion_params, 0, sizeof(conversion_params));
|
|
|
|
Register(FunctionTable);
|
|
}
|
|
|
|
} // namespace
|