1103 lines
39 KiB
C++
1103 lines
39 KiB
C++
// Copyright 2015 Citra Emulator Project
|
|
// Licensed under GPLv2 or any later version
|
|
// Refer to the license.txt file included.
|
|
|
|
#include <algorithm>
|
|
#include <array>
|
|
#include <future>
|
|
#include <memory>
|
|
#include <vector>
|
|
#include "common/bit_set.h"
|
|
#include "common/logging/log.h"
|
|
#include "core/core_timing.h"
|
|
#include "core/frontend/camera/factory.h"
|
|
#include "core/hle/kernel/event.h"
|
|
#include "core/hle/service/cam/cam.h"
|
|
#include "core/hle/service/cam/cam_c.h"
|
|
#include "core/hle/service/cam/cam_q.h"
|
|
#include "core/hle/service/cam/cam_s.h"
|
|
#include "core/hle/service/cam/cam_u.h"
|
|
#include "core/hle/service/service.h"
|
|
#include "core/settings.h"
|
|
|
|
namespace Service {
|
|
namespace CAM {
|
|
|
|
namespace {
|
|
|
|
struct ContextConfig {
|
|
Flip flip;
|
|
Effect effect;
|
|
OutputFormat format;
|
|
Resolution resolution;
|
|
};
|
|
|
|
struct CameraConfig {
|
|
std::unique_ptr<Camera::CameraInterface> impl;
|
|
std::array<ContextConfig, 2> contexts;
|
|
int current_context;
|
|
FrameRate frame_rate;
|
|
};
|
|
|
|
struct PortConfig {
|
|
int camera_id;
|
|
|
|
bool is_active; // set when the port is activated by an Activate call.
|
|
bool is_pending_receiving; // set if SetReceiving is called when is_busy = false. When
|
|
// StartCapture is called then, this will trigger a receiving
|
|
// process and reset itself.
|
|
bool is_busy; // set when StartCapture is called and reset when StopCapture is called.
|
|
bool is_receiving; // set when there is an ongoing receiving process.
|
|
|
|
bool is_trimming;
|
|
u16 x0; // x-coordinate of starting position for trimming
|
|
u16 y0; // y-coordinate of starting position for trimming
|
|
u16 x1; // x-coordinate of ending position for trimming
|
|
u16 y1; // y-coordinate of ending position for trimming
|
|
|
|
u16 transfer_bytes;
|
|
|
|
Kernel::SharedPtr<Kernel::Event> completion_event;
|
|
Kernel::SharedPtr<Kernel::Event> buffer_error_interrupt_event;
|
|
Kernel::SharedPtr<Kernel::Event> vsync_interrupt_event;
|
|
|
|
std::future<std::vector<u16>> capture_result; // will hold the received frame.
|
|
VAddr dest; // the destination address of a receiving process
|
|
u32 dest_size; // the destination size of a receiving process
|
|
|
|
void Clear() {
|
|
completion_event->Clear();
|
|
buffer_error_interrupt_event->Clear();
|
|
vsync_interrupt_event->Clear();
|
|
is_receiving = false;
|
|
is_active = false;
|
|
is_pending_receiving = false;
|
|
is_busy = false;
|
|
is_trimming = false;
|
|
x0 = 0;
|
|
y0 = 0;
|
|
x1 = 0;
|
|
y1 = 0;
|
|
transfer_bytes = 256;
|
|
}
|
|
};
|
|
|
|
// built-in resolution parameters
|
|
constexpr std::array<Resolution, 8> PRESET_RESOLUTION{{
|
|
{640, 480, 0, 0, 639, 479}, // VGA
|
|
{320, 240, 0, 0, 639, 479}, // QVGA
|
|
{160, 120, 0, 0, 639, 479}, // QQVGA
|
|
{352, 288, 26, 0, 613, 479}, // CIF
|
|
{176, 144, 26, 0, 613, 479}, // QCIF
|
|
{256, 192, 0, 0, 639, 479}, // DS_LCD
|
|
{512, 384, 0, 0, 639, 479}, // DS_LCDx4
|
|
{400, 240, 0, 48, 639, 431}, // CTR_TOP_LCD
|
|
}};
|
|
|
|
// latency in ms for each frame rate option
|
|
constexpr std::array<int, 13> LATENCY_BY_FRAME_RATE{{
|
|
67, // Rate_15
|
|
67, // Rate_15_To_5
|
|
67, // Rate_15_To_2
|
|
100, // Rate_10
|
|
118, // Rate_8_5
|
|
200, // Rate_5
|
|
50, // Rate_20
|
|
50, // Rate_20_To_5
|
|
33, // Rate_30
|
|
33, // Rate_30_To_5
|
|
67, // Rate_15_To_10
|
|
50, // Rate_20_To_10
|
|
33, // Rate_30_To_10
|
|
}};
|
|
|
|
std::array<CameraConfig, NumCameras> cameras;
|
|
std::array<PortConfig, 2> ports;
|
|
int completion_event_callback;
|
|
|
|
const ResultCode ERROR_INVALID_ENUM_VALUE(ErrorDescription::InvalidEnumValue, ErrorModule::CAM,
|
|
ErrorSummary::InvalidArgument, ErrorLevel::Usage);
|
|
const ResultCode ERROR_OUT_OF_RANGE(ErrorDescription::OutOfRange, ErrorModule::CAM,
|
|
ErrorSummary::InvalidArgument, ErrorLevel::Usage);
|
|
|
|
void CompletionEventCallBack(u64 port_id, int) {
|
|
PortConfig& port = ports[port_id];
|
|
const CameraConfig& camera = cameras[port.camera_id];
|
|
const auto buffer = port.capture_result.get();
|
|
|
|
if (port.is_trimming) {
|
|
u32 trim_width;
|
|
u32 trim_height;
|
|
const int original_width = camera.contexts[camera.current_context].resolution.width;
|
|
const int original_height = camera.contexts[camera.current_context].resolution.height;
|
|
if (port.x1 <= port.x0 || port.y1 <= port.y0 || port.x1 > original_width ||
|
|
port.y1 > original_height) {
|
|
LOG_ERROR(Service_CAM, "Invalid trimming coordinates x0=%u, y0=%u, x1=%u, y1=%u",
|
|
port.x0, port.y0, port.x1, port.y1);
|
|
trim_width = 0;
|
|
trim_height = 0;
|
|
} else {
|
|
trim_width = port.x1 - port.x0;
|
|
trim_height = port.y1 - port.y0;
|
|
}
|
|
|
|
u32 trim_size = (port.x1 - port.x0) * (port.y1 - port.y0) * 2;
|
|
if (port.dest_size != trim_size) {
|
|
LOG_ERROR(Service_CAM, "The destination size (%u) doesn't match the source (%u)!",
|
|
port.dest_size, trim_size);
|
|
}
|
|
|
|
const u32 src_offset = port.y0 * original_width + port.x0;
|
|
const u16* src_ptr = buffer.data() + src_offset;
|
|
// Note: src_size_left is int because it can be negative if the buffer size doesn't match.
|
|
int src_size_left = static_cast<int>((buffer.size() - src_offset) * sizeof(u16));
|
|
VAddr dest_ptr = port.dest;
|
|
// Note: dest_size_left and line_bytes are int to match the type of src_size_left.
|
|
int dest_size_left = static_cast<int>(port.dest_size);
|
|
const int line_bytes = static_cast<int>(trim_width * sizeof(u16));
|
|
|
|
for (u32 y = 0; y < trim_height; ++y) {
|
|
int copy_length = std::min({line_bytes, dest_size_left, src_size_left});
|
|
if (copy_length <= 0) {
|
|
break;
|
|
}
|
|
Memory::WriteBlock(dest_ptr, src_ptr, copy_length);
|
|
dest_ptr += copy_length;
|
|
dest_size_left -= copy_length;
|
|
src_ptr += original_width;
|
|
src_size_left -= original_width * sizeof(u16);
|
|
}
|
|
} else {
|
|
std::size_t buffer_size = buffer.size() * sizeof(u16);
|
|
if (port.dest_size != buffer_size) {
|
|
LOG_ERROR(Service_CAM, "The destination size (%u) doesn't match the source (%zu)!",
|
|
port.dest_size, buffer_size);
|
|
}
|
|
Memory::WriteBlock(port.dest, buffer.data(), std::min<u32>(port.dest_size, buffer_size));
|
|
}
|
|
|
|
port.is_receiving = false;
|
|
port.completion_event->Signal();
|
|
}
|
|
|
|
// Starts a receiving process on the specified port. This can only be called when is_busy = true and
|
|
// is_receiving = false.
|
|
void StartReceiving(int port_id) {
|
|
PortConfig& port = ports[port_id];
|
|
port.is_receiving = true;
|
|
|
|
// launches a capture task asynchronously
|
|
const CameraConfig& camera = cameras[port.camera_id];
|
|
port.capture_result =
|
|
std::async(std::launch::async, &Camera::CameraInterface::ReceiveFrame, camera.impl.get());
|
|
|
|
// schedules a completion event according to the frame rate. The event will block on the
|
|
// capture task if it is not finished within the expected time
|
|
CoreTiming::ScheduleEvent(
|
|
msToCycles(LATENCY_BY_FRAME_RATE[static_cast<int>(camera.frame_rate)]),
|
|
completion_event_callback, port_id);
|
|
}
|
|
|
|
// Cancels any ongoing receiving processes at the specified port. This is used by functions that
|
|
// stop capturing.
|
|
// TODO: what is the exact behaviour on real 3DS when stopping capture during an ongoing process?
|
|
// Will the completion event still be signaled?
|
|
void CancelReceiving(int port_id) {
|
|
if (!ports[port_id].is_receiving)
|
|
return;
|
|
LOG_WARNING(Service_CAM, "tries to cancel an ongoing receiving process.");
|
|
CoreTiming::UnscheduleEvent(completion_event_callback, port_id);
|
|
ports[port_id].capture_result.wait();
|
|
ports[port_id].is_receiving = false;
|
|
}
|
|
|
|
// Activates the specified port with the specfied camera.
|
|
static void ActivatePort(int port_id, int camera_id) {
|
|
if (ports[port_id].is_busy && ports[port_id].camera_id != camera_id) {
|
|
CancelReceiving(port_id);
|
|
cameras[ports[port_id].camera_id].impl->StopCapture();
|
|
ports[port_id].is_busy = false;
|
|
}
|
|
ports[port_id].is_active = true;
|
|
ports[port_id].camera_id = camera_id;
|
|
}
|
|
|
|
template <int max_index>
|
|
class CommandParamBitSet : public BitSet8 {
|
|
public:
|
|
explicit CommandParamBitSet(u8 command_param) : BitSet8(command_param) {}
|
|
|
|
bool IsValid() const {
|
|
return m_val < (1 << max_index);
|
|
}
|
|
|
|
bool IsSingle() const {
|
|
return IsValid() && Count() == 1;
|
|
}
|
|
};
|
|
|
|
using PortSet = CommandParamBitSet<2>;
|
|
using ContextSet = CommandParamBitSet<2>;
|
|
using CameraSet = CommandParamBitSet<3>;
|
|
|
|
} // namespace
|
|
|
|
void StartCapture(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x01, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
|
|
if (port_select.IsValid()) {
|
|
for (int i : port_select) {
|
|
if (!ports[i].is_busy) {
|
|
if (!ports[i].is_active) {
|
|
// This doesn't return an error, but seems to put the camera in an undefined
|
|
// state
|
|
LOG_ERROR(Service_CAM, "port %u hasn't been activated", i);
|
|
} else {
|
|
cameras[ports[i].camera_id].impl->StartCapture();
|
|
ports[i].is_busy = true;
|
|
if (ports[i].is_pending_receiving) {
|
|
ports[i].is_pending_receiving = false;
|
|
StartReceiving(i);
|
|
}
|
|
}
|
|
} else {
|
|
LOG_WARNING(Service_CAM, "port %u already started", i);
|
|
}
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void StopCapture(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x02, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
|
|
if (port_select.IsValid()) {
|
|
for (int i : port_select) {
|
|
if (ports[i].is_busy) {
|
|
CancelReceiving(i);
|
|
cameras[ports[i].camera_id].impl->StopCapture();
|
|
ports[i].is_busy = false;
|
|
} else {
|
|
LOG_WARNING(Service_CAM, "port %u already stopped", i);
|
|
}
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void IsBusy(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x03, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(2, 0);
|
|
|
|
if (port_select.IsValid()) {
|
|
bool is_busy = true;
|
|
// Note: the behaviour on no or both ports selected are verified against real 3DS.
|
|
for (int i : port_select) {
|
|
is_busy &= ports[i].is_busy;
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.Push(is_busy);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
rb.Skip(1, false);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void ClearBuffer(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x04, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
rb.Push(RESULT_SUCCESS);
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void GetVsyncInterruptEvent(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x05, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 2);
|
|
if (port_select.IsSingle()) {
|
|
int port = *port_select.begin();
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.PushCopyHandles(
|
|
Kernel::g_handle_table.Create(ports[port].vsync_interrupt_event).MoveFrom());
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
rb.PushCopyHandles(0);
|
|
}
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void GetBufferErrorInterruptEvent(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x06, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 2);
|
|
if (port_select.IsSingle()) {
|
|
int port = *port_select.begin();
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.PushCopyHandles(
|
|
Kernel::g_handle_table.Create(ports[port].buffer_error_interrupt_event).MoveFrom());
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
rb.PushCopyHandles(0);
|
|
}
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void SetReceiving(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x07, 4, 2);
|
|
const VAddr dest = rp.Pop<u32>();
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
const u32 image_size = rp.Pop<u32>();
|
|
const u16 trans_unit = rp.Pop<u16>();
|
|
rp.PopHandle(); // Handle to destination process. not used
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 2);
|
|
if (port_select.IsSingle()) {
|
|
int port_id = *port_select.begin();
|
|
PortConfig& port = ports[port_id];
|
|
CancelReceiving(port_id);
|
|
port.completion_event->Clear();
|
|
port.dest = dest;
|
|
port.dest_size = image_size;
|
|
|
|
if (port.is_busy) {
|
|
StartReceiving(port_id);
|
|
} else {
|
|
port.is_pending_receiving = true;
|
|
}
|
|
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.PushCopyHandles(Kernel::g_handle_table.Create(port.completion_event).MoveFrom());
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
rb.PushCopyHandles(0);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, addr=0x%X, port_select=%u, image_size=%u, trans_unit=%u", dest,
|
|
port_select.m_val, image_size, trans_unit);
|
|
}
|
|
|
|
void IsFinishedReceiving(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x08, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(2, 0);
|
|
if (port_select.IsSingle()) {
|
|
int port = *port_select.begin();
|
|
bool is_busy = ports[port].is_receiving || ports[port].is_pending_receiving;
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.Push(!is_busy);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
rb.Skip(1, false);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void SetTransferLines(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x09, 4, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
const u16 transfer_lines = rp.Pop<u16>();
|
|
const u16 width = rp.Pop<u16>();
|
|
const u16 height = rp.Pop<u16>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (port_select.IsValid()) {
|
|
for (int i : port_select) {
|
|
ports[i].transfer_bytes = transfer_lines * width * 2;
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called, port_select=%u, lines=%u, width=%u, height=%u",
|
|
port_select.m_val, transfer_lines, width, height);
|
|
}
|
|
|
|
void GetMaxLines(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x0A, 2, 0);
|
|
const u16 width = rp.Pop<u16>();
|
|
const u16 height = rp.Pop<u16>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(2, 0);
|
|
|
|
// Note: the result of the algorithm below are hwtested with width < 640 and with height < 480
|
|
constexpr u32 MIN_TRANSFER_UNIT = 256;
|
|
constexpr u32 MAX_BUFFER_SIZE = 2560;
|
|
if (width * height * 2 % MIN_TRANSFER_UNIT != 0) {
|
|
rb.Push(ERROR_OUT_OF_RANGE);
|
|
rb.Skip(1, false);
|
|
} else {
|
|
u32 lines = MAX_BUFFER_SIZE / width;
|
|
if (lines > height) {
|
|
lines = height;
|
|
}
|
|
ResultCode result = RESULT_SUCCESS;
|
|
while (height % lines != 0 || (lines * width * 2 % MIN_TRANSFER_UNIT != 0)) {
|
|
--lines;
|
|
if (lines == 0) {
|
|
result = ERROR_OUT_OF_RANGE;
|
|
break;
|
|
}
|
|
}
|
|
rb.Push(result);
|
|
rb.Push(lines);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, width=%u, height=%u", width, height);
|
|
}
|
|
|
|
void SetTransferBytes(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x0B, 4, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
const u16 transfer_bytes = rp.Pop<u16>();
|
|
const u16 width = rp.Pop<u16>();
|
|
const u16 height = rp.Pop<u16>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (port_select.IsValid()) {
|
|
for (int i : port_select) {
|
|
ports[i].transfer_bytes = transfer_bytes;
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED)called, port_select=%u, bytes=%u, width=%u, height=%u",
|
|
port_select.m_val, transfer_bytes, width, height);
|
|
}
|
|
|
|
void GetTransferBytes(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x0C, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(2, 0);
|
|
if (port_select.IsSingle()) {
|
|
int port = *port_select.begin();
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.Push(ports[port].transfer_bytes);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
rb.Skip(1, false);
|
|
}
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED)called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void GetMaxBytes(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x0D, 2, 0);
|
|
const u16 width = rp.Pop<u16>();
|
|
const u16 height = rp.Pop<u16>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(2, 0);
|
|
|
|
// Note: the result of the algorithm below are hwtested with width < 640 and with height < 480
|
|
constexpr u32 MIN_TRANSFER_UNIT = 256;
|
|
constexpr u32 MAX_BUFFER_SIZE = 2560;
|
|
if (width * height * 2 % MIN_TRANSFER_UNIT != 0) {
|
|
rb.Push(ERROR_OUT_OF_RANGE);
|
|
rb.Skip(1, false);
|
|
} else {
|
|
u32 bytes = MAX_BUFFER_SIZE;
|
|
|
|
while (width * height * 2 % bytes != 0) {
|
|
bytes -= MIN_TRANSFER_UNIT;
|
|
}
|
|
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.Push(bytes);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, width=%u, height=%u", width, height);
|
|
}
|
|
|
|
void SetTrimming(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x0E, 2, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
const bool trim = rp.Pop<bool>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (port_select.IsValid()) {
|
|
for (int i : port_select) {
|
|
ports[i].is_trimming = trim;
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u, trim=%d", port_select.m_val, trim);
|
|
}
|
|
|
|
void IsTrimming(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x0F, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(2, 0);
|
|
if (port_select.IsSingle()) {
|
|
int port = *port_select.begin();
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.Push(ports[port].is_trimming);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
rb.Skip(1, false);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void SetTrimmingParams(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x10, 5, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
const u16 x0 = rp.Pop<u16>();
|
|
const u16 y0 = rp.Pop<u16>();
|
|
const u16 x1 = rp.Pop<u16>();
|
|
const u16 y1 = rp.Pop<u16>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (port_select.IsValid()) {
|
|
for (int i : port_select) {
|
|
ports[i].x0 = x0;
|
|
ports[i].y0 = y0;
|
|
ports[i].x1 = x1;
|
|
ports[i].y1 = y1;
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u, x0=%u, y0=%u, x1=%u, y1=%u", port_select.m_val,
|
|
x0, y0, x1, y1);
|
|
}
|
|
|
|
void GetTrimmingParams(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x11, 1, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(5, 0);
|
|
if (port_select.IsSingle()) {
|
|
int port = *port_select.begin();
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.Push(ports[port].x0);
|
|
rb.Push(ports[port].y0);
|
|
rb.Push(ports[port].x1);
|
|
rb.Push(ports[port].y1);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
rb.Skip(4, false);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u", port_select.m_val);
|
|
}
|
|
|
|
void SetTrimmingParamsCenter(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x12, 5, 0);
|
|
const PortSet port_select(rp.Pop<u8>());
|
|
const u16 trim_w = rp.Pop<u16>();
|
|
const u16 trim_h = rp.Pop<u16>();
|
|
const u16 cam_w = rp.Pop<u16>();
|
|
const u16 cam_h = rp.Pop<u16>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (port_select.IsValid()) {
|
|
for (int i : port_select) {
|
|
ports[i].x0 = (cam_w - trim_w) / 2;
|
|
ports[i].y0 = (cam_h - trim_h) / 2;
|
|
ports[i].x1 = ports[i].x0 + trim_w;
|
|
ports[i].y1 = ports[i].y0 + trim_h;
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid port_select=%u", port_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, port_select=%u, trim_w=%u, trim_h=%u, cam_w=%u, cam_h=%u",
|
|
port_select.m_val, trim_w, trim_h, cam_w, cam_h);
|
|
}
|
|
|
|
void Activate(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x13, 1, 0);
|
|
const CameraSet camera_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (camera_select.IsValid()) {
|
|
if (camera_select.m_val == 0) { // deactive all
|
|
for (int i = 0; i < 2; ++i) {
|
|
if (ports[i].is_busy) {
|
|
CancelReceiving(i);
|
|
cameras[ports[i].camera_id].impl->StopCapture();
|
|
ports[i].is_busy = false;
|
|
}
|
|
ports[i].is_active = false;
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else if (camera_select[0] && camera_select[1]) {
|
|
LOG_ERROR(Service_CAM, "camera 0 and 1 can't be both activated");
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
} else {
|
|
if (camera_select[0]) {
|
|
ActivatePort(0, 0);
|
|
} else if (camera_select[1]) {
|
|
ActivatePort(0, 1);
|
|
}
|
|
|
|
if (camera_select[2]) {
|
|
ActivatePort(1, 2);
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
}
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u", camera_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, camera_select=%u", camera_select.m_val);
|
|
}
|
|
|
|
void SwitchContext(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x14, 2, 0);
|
|
const CameraSet camera_select(rp.Pop<u8>());
|
|
const ContextSet context_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (camera_select.IsValid() && context_select.IsSingle()) {
|
|
int context = *context_select.begin();
|
|
for (int camera : camera_select) {
|
|
cameras[camera].current_context = context;
|
|
const ContextConfig& context_config = cameras[camera].contexts[context];
|
|
cameras[camera].impl->SetFlip(context_config.flip);
|
|
cameras[camera].impl->SetEffect(context_config.effect);
|
|
cameras[camera].impl->SetFormat(context_config.format);
|
|
cameras[camera].impl->SetResolution(context_config.resolution);
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u, context_select=%u", camera_select.m_val,
|
|
context_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, camera_select=%u, context_select=%u", camera_select.m_val,
|
|
context_select.m_val);
|
|
}
|
|
|
|
void FlipImage(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x1D, 3, 0);
|
|
const CameraSet camera_select(rp.Pop<u8>());
|
|
const Flip flip = static_cast<Flip>(rp.Pop<u8>());
|
|
const ContextSet context_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (camera_select.IsValid() && context_select.IsValid()) {
|
|
for (int camera : camera_select) {
|
|
for (int context : context_select) {
|
|
cameras[camera].contexts[context].flip = flip;
|
|
if (cameras[camera].current_context == context) {
|
|
cameras[camera].impl->SetFlip(flip);
|
|
}
|
|
}
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u, context_select=%u", camera_select.m_val,
|
|
context_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, camera_select=%u, flip=%d, context_select=%u",
|
|
camera_select.m_val, static_cast<int>(flip), context_select.m_val);
|
|
}
|
|
|
|
void SetDetailSize(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x1E, 8, 0);
|
|
const CameraSet camera_select(rp.Pop<u8>());
|
|
Resolution resolution;
|
|
resolution.width = rp.Pop<u16>();
|
|
resolution.height = rp.Pop<u16>();
|
|
resolution.crop_x0 = rp.Pop<u16>();
|
|
resolution.crop_y0 = rp.Pop<u16>();
|
|
resolution.crop_x1 = rp.Pop<u16>();
|
|
resolution.crop_y1 = rp.Pop<u16>();
|
|
const ContextSet context_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (camera_select.IsValid() && context_select.IsValid()) {
|
|
for (int camera : camera_select) {
|
|
for (int context : context_select) {
|
|
cameras[camera].contexts[context].resolution = resolution;
|
|
if (cameras[camera].current_context == context) {
|
|
cameras[camera].impl->SetResolution(resolution);
|
|
}
|
|
}
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u, context_select=%u", camera_select.m_val,
|
|
context_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, camera_select=%u, width=%u, height=%u, crop_x0=%u, crop_y0=%u, "
|
|
"crop_x1=%u, crop_y1=%u, context_select=%u",
|
|
camera_select.m_val, resolution.width, resolution.height, resolution.crop_x0,
|
|
resolution.crop_y0, resolution.crop_x1, resolution.crop_y1, context_select.m_val);
|
|
}
|
|
|
|
void SetSize(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x1F, 3, 0);
|
|
const CameraSet camera_select(rp.Pop<u8>());
|
|
const u8 size = rp.Pop<u8>();
|
|
const ContextSet context_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (camera_select.IsValid() && context_select.IsValid()) {
|
|
for (int camera : camera_select) {
|
|
for (int context : context_select) {
|
|
cameras[camera].contexts[context].resolution = PRESET_RESOLUTION[size];
|
|
if (cameras[camera].current_context == context) {
|
|
cameras[camera].impl->SetResolution(PRESET_RESOLUTION[size]);
|
|
}
|
|
}
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u, context_select=%u", camera_select.m_val,
|
|
context_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, camera_select=%u, size=%u, context_select=%u",
|
|
camera_select.m_val, size, context_select.m_val);
|
|
}
|
|
|
|
void SetFrameRate(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x20, 2, 0);
|
|
const CameraSet camera_select(rp.Pop<u8>());
|
|
const FrameRate frame_rate = static_cast<FrameRate>(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (camera_select.IsValid()) {
|
|
for (int camera : camera_select) {
|
|
cameras[camera].frame_rate = frame_rate;
|
|
// TODO(wwylele): consider hinting the actual camera with the expected frame rate
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u", camera_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called, camera_select=%u, frame_rate=%d",
|
|
camera_select.m_val, static_cast<int>(frame_rate));
|
|
}
|
|
|
|
void SetEffect(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x22, 3, 0);
|
|
const CameraSet camera_select(rp.Pop<u8>());
|
|
const Effect effect = static_cast<Effect>(rp.Pop<u8>());
|
|
const ContextSet context_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (camera_select.IsValid() && context_select.IsValid()) {
|
|
for (int camera : camera_select) {
|
|
for (int context : context_select) {
|
|
cameras[camera].contexts[context].effect = effect;
|
|
if (cameras[camera].current_context == context) {
|
|
cameras[camera].impl->SetEffect(effect);
|
|
}
|
|
}
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u, context_select=%u", camera_select.m_val,
|
|
context_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, camera_select=%u, effect=%d, context_select=%u",
|
|
camera_select.m_val, static_cast<int>(effect), context_select.m_val);
|
|
}
|
|
|
|
void SetOutputFormat(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x25, 3, 0);
|
|
const CameraSet camera_select(rp.Pop<u8>());
|
|
const OutputFormat format = static_cast<OutputFormat>(rp.Pop<u8>());
|
|
const ContextSet context_select(rp.Pop<u8>());
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
if (camera_select.IsValid() && context_select.IsValid()) {
|
|
for (int camera : camera_select) {
|
|
for (int context : context_select) {
|
|
cameras[camera].contexts[context].format = format;
|
|
if (cameras[camera].current_context == context) {
|
|
cameras[camera].impl->SetFormat(format);
|
|
}
|
|
}
|
|
}
|
|
rb.Push(RESULT_SUCCESS);
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u, context_select=%u", camera_select.m_val,
|
|
context_select.m_val);
|
|
rb.Push(ERROR_INVALID_ENUM_VALUE);
|
|
}
|
|
|
|
LOG_DEBUG(Service_CAM, "called, camera_select=%u, format=%d, context_select=%u",
|
|
camera_select.m_val, static_cast<int>(format), context_select.m_val);
|
|
}
|
|
|
|
void SynchronizeVsyncTiming(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x29, 2, 0);
|
|
const u8 camera_select1 = rp.Pop<u8>();
|
|
const u8 camera_select2 = rp.Pop<u8>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
rb.Push(RESULT_SUCCESS);
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called, camera_select1=%u, camera_select2=%u",
|
|
camera_select1, camera_select2);
|
|
}
|
|
|
|
void GetStereoCameraCalibrationData(Service::Interface* self) {
|
|
IPC::RequestBuilder rb =
|
|
IPC::RequestParser(Kernel::GetCommandBuffer(), 0x2B, 0, 0).MakeBuilder(17, 0);
|
|
|
|
// Default values taken from yuriks' 3DS. Valid data is required here or games using the
|
|
// calibration get stuck in an infinite CPU loop.
|
|
StereoCameraCalibrationData data = {};
|
|
data.isValidRotationXY = 0;
|
|
data.scale = 1.001776f;
|
|
data.rotationZ = 0.008322907f;
|
|
data.translationX = -87.70484f;
|
|
data.translationY = -7.640977f;
|
|
data.rotationX = 0.0f;
|
|
data.rotationY = 0.0f;
|
|
data.angleOfViewRight = 64.66875f;
|
|
data.angleOfViewLeft = 64.76067f;
|
|
data.distanceToChart = 250.0f;
|
|
data.distanceCameras = 35.0f;
|
|
data.imageWidth = 640;
|
|
data.imageHeight = 480;
|
|
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.PushRaw(data);
|
|
|
|
LOG_TRACE(Service_CAM, "called");
|
|
}
|
|
|
|
void SetPackageParameterWithoutContext(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x33, 11, 0);
|
|
|
|
PackageParameterWithoutContext package;
|
|
rp.PopRaw(package);
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
rb.Push(RESULT_SUCCESS);
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called");
|
|
}
|
|
|
|
template <typename PackageParameterType>
|
|
static ResultCode SetPackageParameter(const PackageParameterType& package) {
|
|
const CameraSet camera_select(package.camera_select);
|
|
const ContextSet context_select(package.context_select);
|
|
|
|
if (camera_select.IsValid() && context_select.IsValid()) {
|
|
for (int camera_id : camera_select) {
|
|
CameraConfig& camera = cameras[camera_id];
|
|
for (int context_id : context_select) {
|
|
ContextConfig& context = camera.contexts[context_id];
|
|
context.effect = package.effect;
|
|
context.flip = package.flip;
|
|
context.resolution = package.GetResolution();
|
|
if (context_id == camera.current_context) {
|
|
camera.impl->SetEffect(context.effect);
|
|
camera.impl->SetFlip(context.flip);
|
|
camera.impl->SetResolution(context.resolution);
|
|
}
|
|
}
|
|
}
|
|
return RESULT_SUCCESS;
|
|
} else {
|
|
LOG_ERROR(Service_CAM, "invalid camera_select=%u, context_select=%u", package.camera_select,
|
|
package.context_select);
|
|
return ERROR_INVALID_ENUM_VALUE;
|
|
}
|
|
}
|
|
|
|
Resolution PackageParameterWithContext::GetResolution() const {
|
|
return PRESET_RESOLUTION[static_cast<int>(size)];
|
|
}
|
|
|
|
void SetPackageParameterWithContext(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x34, 5, 0);
|
|
|
|
PackageParameterWithContext package;
|
|
rp.PopRaw(package);
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
ResultCode result = SetPackageParameter(package);
|
|
rb.Push(result);
|
|
|
|
LOG_DEBUG(Service_CAM, "called");
|
|
}
|
|
|
|
void SetPackageParameterWithContextDetail(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x35, 7, 0);
|
|
|
|
PackageParameterWithContextDetail package;
|
|
rp.PopRaw(package);
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
ResultCode result = SetPackageParameter(package);
|
|
rb.Push(result);
|
|
|
|
LOG_DEBUG(Service_CAM, "called");
|
|
}
|
|
|
|
void GetSuitableY2rStandardCoefficient(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x36, 0, 0);
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(2, 0);
|
|
rb.Push(RESULT_SUCCESS);
|
|
rb.Push<u32>(0);
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called");
|
|
}
|
|
|
|
void PlayShutterSound(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x38, 1, 0);
|
|
u8 sound_id = rp.Pop<u8>();
|
|
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
rb.Push(RESULT_SUCCESS);
|
|
|
|
LOG_WARNING(Service_CAM, "(STUBBED) called, sound_id=%d", sound_id);
|
|
}
|
|
|
|
void DriverInitialize(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x39, 0, 0);
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
|
|
for (int camera_id = 0; camera_id < NumCameras; ++camera_id) {
|
|
CameraConfig& camera = cameras[camera_id];
|
|
camera.current_context = 0;
|
|
for (int context_id = 0; context_id < 2; ++context_id) {
|
|
// Note: the following default values are verified against real 3DS
|
|
ContextConfig& context = camera.contexts[context_id];
|
|
context.flip = camera_id == 1 ? Flip::Horizontal : Flip::None;
|
|
context.effect = Effect::None;
|
|
context.format = OutputFormat::YUV422;
|
|
context.resolution =
|
|
context_id == 0 ? PRESET_RESOLUTION[5 /*DS_LCD*/] : PRESET_RESOLUTION[0 /*VGA*/];
|
|
}
|
|
camera.impl = Camera::CreateCamera(Settings::values.camera_name[camera_id],
|
|
Settings::values.camera_config[camera_id]);
|
|
camera.impl->SetFlip(camera.contexts[0].flip);
|
|
camera.impl->SetEffect(camera.contexts[0].effect);
|
|
camera.impl->SetFormat(camera.contexts[0].format);
|
|
camera.impl->SetResolution(camera.contexts[0].resolution);
|
|
}
|
|
|
|
for (PortConfig& port : ports) {
|
|
port.Clear();
|
|
}
|
|
|
|
rb.Push(RESULT_SUCCESS);
|
|
|
|
LOG_DEBUG(Service_CAM, "called");
|
|
}
|
|
|
|
void DriverFinalize(Service::Interface* self) {
|
|
IPC::RequestParser rp(Kernel::GetCommandBuffer(), 0x3A, 0, 0);
|
|
IPC::RequestBuilder rb = rp.MakeBuilder(1, 0);
|
|
|
|
CancelReceiving(0);
|
|
CancelReceiving(1);
|
|
|
|
for (CameraConfig& camera : cameras) {
|
|
camera.impl = nullptr;
|
|
}
|
|
|
|
rb.Push(RESULT_SUCCESS);
|
|
|
|
LOG_DEBUG(Service_CAM, "called");
|
|
}
|
|
|
|
void Init() {
|
|
using namespace Kernel;
|
|
|
|
AddService(new CAM_C_Interface);
|
|
AddService(new CAM_Q_Interface);
|
|
AddService(new CAM_S_Interface);
|
|
AddService(new CAM_U_Interface);
|
|
|
|
for (PortConfig& port : ports) {
|
|
port.completion_event = Event::Create(ResetType::Sticky, "CAM_U::completion_event");
|
|
port.buffer_error_interrupt_event =
|
|
Event::Create(ResetType::OneShot, "CAM_U::buffer_error_interrupt_event");
|
|
port.vsync_interrupt_event =
|
|
Event::Create(ResetType::OneShot, "CAM_U::vsync_interrupt_event");
|
|
}
|
|
completion_event_callback =
|
|
CoreTiming::RegisterEvent("CAM_U::CompletionEventCallBack", CompletionEventCallBack);
|
|
}
|
|
|
|
void Shutdown() {
|
|
CancelReceiving(0);
|
|
CancelReceiving(1);
|
|
for (PortConfig& port : ports) {
|
|
port.completion_event = nullptr;
|
|
port.buffer_error_interrupt_event = nullptr;
|
|
port.vsync_interrupt_event = nullptr;
|
|
}
|
|
for (CameraConfig& camera : cameras) {
|
|
camera.impl = nullptr;
|
|
}
|
|
}
|
|
|
|
} // namespace CAM
|
|
|
|
} // namespace Service
|