|
@@ -7,14 +7,20 @@
|
|
|
|
|
|
|
|
#include "common/assert.h"
|
|
#include "common/assert.h"
|
|
|
#include "common/logging/log.h"
|
|
#include "common/logging/log.h"
|
|
|
|
|
+#include "core/core.h"
|
|
|
|
|
+#include "core/hle/kernel/readable_event.h"
|
|
|
|
|
+#include "core/hle/kernel/writable_event.h"
|
|
|
#include "core/hle/service/nvdrv/devices/nvhost_ctrl.h"
|
|
#include "core/hle/service/nvdrv/devices/nvhost_ctrl.h"
|
|
|
|
|
+#include "video_core/gpu.h"
|
|
|
|
|
|
|
|
namespace Service::Nvidia::Devices {
|
|
namespace Service::Nvidia::Devices {
|
|
|
|
|
|
|
|
-nvhost_ctrl::nvhost_ctrl() = default;
|
|
|
|
|
|
|
+nvhost_ctrl::nvhost_ctrl(Core::System& system, EventInterface& events_interface)
|
|
|
|
|
+ : nvdevice(system), events_interface{events_interface} {}
|
|
|
nvhost_ctrl::~nvhost_ctrl() = default;
|
|
nvhost_ctrl::~nvhost_ctrl() = default;
|
|
|
|
|
|
|
|
-u32 nvhost_ctrl::ioctl(Ioctl command, const std::vector<u8>& input, std::vector<u8>& output) {
|
|
|
|
|
|
|
+u32 nvhost_ctrl::ioctl(Ioctl command, const std::vector<u8>& input, std::vector<u8>& output,
|
|
|
|
|
+ IoctlCtrl& ctrl) {
|
|
|
LOG_DEBUG(Service_NVDRV, "called, command=0x{:08X}, input_size=0x{:X}, output_size=0x{:X}",
|
|
LOG_DEBUG(Service_NVDRV, "called, command=0x{:08X}, input_size=0x{:X}, output_size=0x{:X}",
|
|
|
command.raw, input.size(), output.size());
|
|
command.raw, input.size(), output.size());
|
|
|
|
|
|
|
@@ -22,11 +28,15 @@ u32 nvhost_ctrl::ioctl(Ioctl command, const std::vector<u8>& input, std::vector<
|
|
|
case IoctlCommand::IocGetConfigCommand:
|
|
case IoctlCommand::IocGetConfigCommand:
|
|
|
return NvOsGetConfigU32(input, output);
|
|
return NvOsGetConfigU32(input, output);
|
|
|
case IoctlCommand::IocCtrlEventWaitCommand:
|
|
case IoctlCommand::IocCtrlEventWaitCommand:
|
|
|
- return IocCtrlEventWait(input, output, false);
|
|
|
|
|
|
|
+ return IocCtrlEventWait(input, output, false, ctrl);
|
|
|
case IoctlCommand::IocCtrlEventWaitAsyncCommand:
|
|
case IoctlCommand::IocCtrlEventWaitAsyncCommand:
|
|
|
- return IocCtrlEventWait(input, output, true);
|
|
|
|
|
|
|
+ return IocCtrlEventWait(input, output, true, ctrl);
|
|
|
case IoctlCommand::IocCtrlEventRegisterCommand:
|
|
case IoctlCommand::IocCtrlEventRegisterCommand:
|
|
|
return IocCtrlEventRegister(input, output);
|
|
return IocCtrlEventRegister(input, output);
|
|
|
|
|
+ case IoctlCommand::IocCtrlEventUnregisterCommand:
|
|
|
|
|
+ return IocCtrlEventUnregister(input, output);
|
|
|
|
|
+ case IoctlCommand::IocCtrlEventSignalCommand:
|
|
|
|
|
+ return IocCtrlEventSignal(input, output);
|
|
|
}
|
|
}
|
|
|
UNIMPLEMENTED_MSG("Unimplemented ioctl");
|
|
UNIMPLEMENTED_MSG("Unimplemented ioctl");
|
|
|
return 0;
|
|
return 0;
|
|
@@ -41,23 +51,137 @@ u32 nvhost_ctrl::NvOsGetConfigU32(const std::vector<u8>& input, std::vector<u8>&
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
u32 nvhost_ctrl::IocCtrlEventWait(const std::vector<u8>& input, std::vector<u8>& output,
|
|
u32 nvhost_ctrl::IocCtrlEventWait(const std::vector<u8>& input, std::vector<u8>& output,
|
|
|
- bool is_async) {
|
|
|
|
|
|
|
+ bool is_async, IoctlCtrl& ctrl) {
|
|
|
IocCtrlEventWaitParams params{};
|
|
IocCtrlEventWaitParams params{};
|
|
|
std::memcpy(¶ms, input.data(), sizeof(params));
|
|
std::memcpy(¶ms, input.data(), sizeof(params));
|
|
|
- LOG_WARNING(Service_NVDRV,
|
|
|
|
|
- "(STUBBED) called, syncpt_id={}, threshold={}, timeout={}, is_async={}",
|
|
|
|
|
- params.syncpt_id, params.threshold, params.timeout, is_async);
|
|
|
|
|
|
|
+ LOG_DEBUG(Service_NVDRV, "syncpt_id={}, threshold={}, timeout={}, is_async={}",
|
|
|
|
|
+ params.syncpt_id, params.threshold, params.timeout, is_async);
|
|
|
|
|
|
|
|
- // TODO(Subv): Implement actual syncpt waiting.
|
|
|
|
|
- params.value = 0;
|
|
|
|
|
|
|
+ if (params.syncpt_id >= MaxSyncPoints) {
|
|
|
|
|
+ return NvResult::BadParameter;
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ auto& gpu = system.GPU();
|
|
|
|
|
+ // This is mostly to take into account unimplemented features. As synced
|
|
|
|
|
+ // gpu is always synced.
|
|
|
|
|
+ if (!gpu.IsAsync()) {
|
|
|
|
|
+ return NvResult::Success;
|
|
|
|
|
+ }
|
|
|
|
|
+ auto lock = gpu.LockSync();
|
|
|
|
|
+ const u32 current_syncpoint_value = gpu.GetSyncpointValue(params.syncpt_id);
|
|
|
|
|
+ const s32 diff = current_syncpoint_value - params.threshold;
|
|
|
|
|
+ if (diff >= 0) {
|
|
|
|
|
+ params.value = current_syncpoint_value;
|
|
|
|
|
+ std::memcpy(output.data(), ¶ms, sizeof(params));
|
|
|
|
|
+ return NvResult::Success;
|
|
|
|
|
+ }
|
|
|
|
|
+ const u32 target_value = current_syncpoint_value - diff;
|
|
|
|
|
+
|
|
|
|
|
+ if (!is_async) {
|
|
|
|
|
+ params.value = 0;
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ if (params.timeout == 0) {
|
|
|
|
|
+ std::memcpy(output.data(), ¶ms, sizeof(params));
|
|
|
|
|
+ return NvResult::Timeout;
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ u32 event_id;
|
|
|
|
|
+ if (is_async) {
|
|
|
|
|
+ event_id = params.value & 0x00FF;
|
|
|
|
|
+ if (event_id >= MaxNvEvents) {
|
|
|
|
|
+ std::memcpy(output.data(), ¶ms, sizeof(params));
|
|
|
|
|
+ return NvResult::BadParameter;
|
|
|
|
|
+ }
|
|
|
|
|
+ } else {
|
|
|
|
|
+ if (ctrl.fresh_call) {
|
|
|
|
|
+ const auto result = events_interface.GetFreeEvent();
|
|
|
|
|
+ if (result) {
|
|
|
|
|
+ event_id = *result;
|
|
|
|
|
+ } else {
|
|
|
|
|
+ LOG_CRITICAL(Service_NVDRV, "No Free Events available!");
|
|
|
|
|
+ event_id = params.value & 0x00FF;
|
|
|
|
|
+ }
|
|
|
|
|
+ } else {
|
|
|
|
|
+ event_id = ctrl.event_id;
|
|
|
|
|
+ }
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ EventState status = events_interface.status[event_id];
|
|
|
|
|
+ if (event_id < MaxNvEvents || status == EventState::Free || status == EventState::Registered) {
|
|
|
|
|
+ events_interface.SetEventStatus(event_id, EventState::Waiting);
|
|
|
|
|
+ events_interface.assigned_syncpt[event_id] = params.syncpt_id;
|
|
|
|
|
+ events_interface.assigned_value[event_id] = target_value;
|
|
|
|
|
+ if (is_async) {
|
|
|
|
|
+ params.value = params.syncpt_id << 4;
|
|
|
|
|
+ } else {
|
|
|
|
|
+ params.value = ((params.syncpt_id & 0xfff) << 16) | 0x10000000;
|
|
|
|
|
+ }
|
|
|
|
|
+ params.value |= event_id;
|
|
|
|
|
+ events_interface.events[event_id].writable->Clear();
|
|
|
|
|
+ gpu.RegisterSyncptInterrupt(params.syncpt_id, target_value);
|
|
|
|
|
+ if (!is_async && ctrl.fresh_call) {
|
|
|
|
|
+ ctrl.must_delay = true;
|
|
|
|
|
+ ctrl.timeout = params.timeout;
|
|
|
|
|
+ ctrl.event_id = event_id;
|
|
|
|
|
+ return NvResult::Timeout;
|
|
|
|
|
+ }
|
|
|
|
|
+ std::memcpy(output.data(), ¶ms, sizeof(params));
|
|
|
|
|
+ return NvResult::Timeout;
|
|
|
|
|
+ }
|
|
|
std::memcpy(output.data(), ¶ms, sizeof(params));
|
|
std::memcpy(output.data(), ¶ms, sizeof(params));
|
|
|
- return 0;
|
|
|
|
|
|
|
+ return NvResult::BadParameter;
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
u32 nvhost_ctrl::IocCtrlEventRegister(const std::vector<u8>& input, std::vector<u8>& output) {
|
|
u32 nvhost_ctrl::IocCtrlEventRegister(const std::vector<u8>& input, std::vector<u8>& output) {
|
|
|
- LOG_WARNING(Service_NVDRV, "(STUBBED) called");
|
|
|
|
|
- // TODO(bunnei): Implement this.
|
|
|
|
|
- return 0;
|
|
|
|
|
|
|
+ IocCtrlEventRegisterParams params{};
|
|
|
|
|
+ std::memcpy(¶ms, input.data(), sizeof(params));
|
|
|
|
|
+ const u32 event_id = params.user_event_id & 0x00FF;
|
|
|
|
|
+ LOG_DEBUG(Service_NVDRV, " called, user_event_id: {:X}", event_id);
|
|
|
|
|
+ if (event_id >= MaxNvEvents) {
|
|
|
|
|
+ return NvResult::BadParameter;
|
|
|
|
|
+ }
|
|
|
|
|
+ if (events_interface.registered[event_id]) {
|
|
|
|
|
+ return NvResult::BadParameter;
|
|
|
|
|
+ }
|
|
|
|
|
+ events_interface.RegisterEvent(event_id);
|
|
|
|
|
+ return NvResult::Success;
|
|
|
|
|
+}
|
|
|
|
|
+
|
|
|
|
|
+u32 nvhost_ctrl::IocCtrlEventUnregister(const std::vector<u8>& input, std::vector<u8>& output) {
|
|
|
|
|
+ IocCtrlEventUnregisterParams params{};
|
|
|
|
|
+ std::memcpy(¶ms, input.data(), sizeof(params));
|
|
|
|
|
+ const u32 event_id = params.user_event_id & 0x00FF;
|
|
|
|
|
+ LOG_DEBUG(Service_NVDRV, " called, user_event_id: {:X}", event_id);
|
|
|
|
|
+ if (event_id >= MaxNvEvents) {
|
|
|
|
|
+ return NvResult::BadParameter;
|
|
|
|
|
+ }
|
|
|
|
|
+ if (!events_interface.registered[event_id]) {
|
|
|
|
|
+ return NvResult::BadParameter;
|
|
|
|
|
+ }
|
|
|
|
|
+ events_interface.UnregisterEvent(event_id);
|
|
|
|
|
+ return NvResult::Success;
|
|
|
|
|
+}
|
|
|
|
|
+
|
|
|
|
|
+u32 nvhost_ctrl::IocCtrlEventSignal(const std::vector<u8>& input, std::vector<u8>& output) {
|
|
|
|
|
+ IocCtrlEventSignalParams params{};
|
|
|
|
|
+ std::memcpy(¶ms, input.data(), sizeof(params));
|
|
|
|
|
+ // TODO(Blinkhawk): This is normally called when an NvEvents timeout on WaitSynchronization
|
|
|
|
|
+ // It is believed from RE to cancel the GPU Event. However, better research is required
|
|
|
|
|
+ u32 event_id = params.user_event_id & 0x00FF;
|
|
|
|
|
+ LOG_WARNING(Service_NVDRV, "(STUBBED) called, user_event_id: {:X}", event_id);
|
|
|
|
|
+ if (event_id >= MaxNvEvents) {
|
|
|
|
|
+ return NvResult::BadParameter;
|
|
|
|
|
+ }
|
|
|
|
|
+ if (events_interface.status[event_id] == EventState::Waiting) {
|
|
|
|
|
+ auto& gpu = system.GPU();
|
|
|
|
|
+ if (gpu.CancelSyncptInterrupt(events_interface.assigned_syncpt[event_id],
|
|
|
|
|
+ events_interface.assigned_value[event_id])) {
|
|
|
|
|
+ events_interface.LiberateEvent(event_id);
|
|
|
|
|
+ events_interface.events[event_id].writable->Signal();
|
|
|
|
|
+ }
|
|
|
|
|
+ }
|
|
|
|
|
+ return NvResult::Success;
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
} // namespace Service::Nvidia::Devices
|
|
} // namespace Service::Nvidia::Devices
|