diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/core/hle/service/hid/irs.cpp | 588 | ||||
| -rw-r--r-- | src/core/hle/service/hid/irs.h | 84 | ||||
| -rw-r--r-- | src/hid_core/irsensor/image_transfer_processor.cpp | 5 | ||||
| -rw-r--r-- | src/hid_core/irsensor/image_transfer_processor.h | 4 |
4 files changed, 267 insertions, 414 deletions
diff --git a/src/core/hle/service/hid/irs.cpp b/src/core/hle/service/hid/irs.cpp index 18e544f2f..7d7368ff9 100644 --- a/src/core/hle/service/hid/irs.cpp +++ b/src/core/hle/service/hid/irs.cpp | |||
| @@ -9,6 +9,7 @@ | |||
| 9 | #include "core/hle/kernel/k_shared_memory.h" | 9 | #include "core/hle/kernel/k_shared_memory.h" |
| 10 | #include "core/hle/kernel/k_transfer_memory.h" | 10 | #include "core/hle/kernel/k_transfer_memory.h" |
| 11 | #include "core/hle/kernel/kernel.h" | 11 | #include "core/hle/kernel/kernel.h" |
| 12 | #include "core/hle/service/cmif_serialization.h" | ||
| 12 | #include "core/hle/service/hid/irs.h" | 13 | #include "core/hle/service/hid/irs.h" |
| 13 | #include "core/hle/service/ipc_helpers.h" | 14 | #include "core/hle/service/ipc_helpers.h" |
| 14 | #include "core/memory.h" | 15 | #include "core/memory.h" |
| @@ -28,24 +29,24 @@ namespace Service::IRS { | |||
| 28 | IRS::IRS(Core::System& system_) : ServiceFramework{system_, "irs"} { | 29 | IRS::IRS(Core::System& system_) : ServiceFramework{system_, "irs"} { |
| 29 | // clang-format off | 30 | // clang-format off |
| 30 | static const FunctionInfo functions[] = { | 31 | static const FunctionInfo functions[] = { |
| 31 | {302, &IRS::ActivateIrsensor, "ActivateIrsensor"}, | 32 | {302, C<&IRS::ActivateIrsensor>, "ActivateIrsensor"}, |
| 32 | {303, &IRS::DeactivateIrsensor, "DeactivateIrsensor"}, | 33 | {303, C<&IRS::DeactivateIrsensor>, "DeactivateIrsensor"}, |
| 33 | {304, &IRS::GetIrsensorSharedMemoryHandle, "GetIrsensorSharedMemoryHandle"}, | 34 | {304, C<&IRS::GetIrsensorSharedMemoryHandle>, "GetIrsensorSharedMemoryHandle"}, |
| 34 | {305, &IRS::StopImageProcessor, "StopImageProcessor"}, | 35 | {305, C<&IRS::StopImageProcessor>, "StopImageProcessor"}, |
| 35 | {306, &IRS::RunMomentProcessor, "RunMomentProcessor"}, | 36 | {306, C<&IRS::RunMomentProcessor>, "RunMomentProcessor"}, |
| 36 | {307, &IRS::RunClusteringProcessor, "RunClusteringProcessor"}, | 37 | {307, C<&IRS::RunClusteringProcessor>, "RunClusteringProcessor"}, |
| 37 | {308, &IRS::RunImageTransferProcessor, "RunImageTransferProcessor"}, | 38 | {308, C<&IRS::RunImageTransferProcessor>, "RunImageTransferProcessor"}, |
| 38 | {309, &IRS::GetImageTransferProcessorState, "GetImageTransferProcessorState"}, | 39 | {309, C<&IRS::GetImageTransferProcessorState>, "GetImageTransferProcessorState"}, |
| 39 | {310, &IRS::RunTeraPluginProcessor, "RunTeraPluginProcessor"}, | 40 | {310, C<&IRS::RunTeraPluginProcessor>, "RunTeraPluginProcessor"}, |
| 40 | {311, &IRS::GetNpadIrCameraHandle, "GetNpadIrCameraHandle"}, | 41 | {311, C<&IRS::GetNpadIrCameraHandle>, "GetNpadIrCameraHandle"}, |
| 41 | {312, &IRS::RunPointingProcessor, "RunPointingProcessor"}, | 42 | {312, C<&IRS::RunPointingProcessor>, "RunPointingProcessor"}, |
| 42 | {313, &IRS::SuspendImageProcessor, "SuspendImageProcessor"}, | 43 | {313, C<&IRS::SuspendImageProcessor>, "SuspendImageProcessor"}, |
| 43 | {314, &IRS::CheckFirmwareVersion, "CheckFirmwareVersion"}, | 44 | {314, C<&IRS::CheckFirmwareVersion>, "CheckFirmwareVersion"}, |
| 44 | {315, &IRS::SetFunctionLevel, "SetFunctionLevel"}, | 45 | {315, C<&IRS::SetFunctionLevel>, "SetFunctionLevel"}, |
| 45 | {316, &IRS::RunImageTransferExProcessor, "RunImageTransferExProcessor"}, | 46 | {316, C<&IRS::RunImageTransferExProcessor>, "RunImageTransferExProcessor"}, |
| 46 | {317, &IRS::RunIrLedProcessor, "RunIrLedProcessor"}, | 47 | {317, C<&IRS::RunIrLedProcessor>, "RunIrLedProcessor"}, |
| 47 | {318, &IRS::StopImageProcessorAsync, "StopImageProcessorAsync"}, | 48 | {318, C<&IRS::StopImageProcessorAsync>, "StopImageProcessorAsync"}, |
| 48 | {319, &IRS::ActivateIrsensorWithFunctionLevel, "ActivateIrsensorWithFunctionLevel"}, | 49 | {319, C<&IRS::ActivateIrsensorWithFunctionLevel>, "ActivateIrsensorWithFunctionLevel"}, |
| 49 | }; | 50 | }; |
| 50 | // clang-format on | 51 | // clang-format on |
| 51 | 52 | ||
| @@ -57,489 +58,292 @@ IRS::IRS(Core::System& system_) : ServiceFramework{system_, "irs"} { | |||
| 57 | } | 58 | } |
| 58 | IRS::~IRS() = default; | 59 | IRS::~IRS() = default; |
| 59 | 60 | ||
| 60 | void IRS::ActivateIrsensor(HLERequestContext& ctx) { | 61 | Result IRS::ActivateIrsensor(ClientAppletResourceUserId aruid) { |
| 61 | IPC::RequestParser rp{ctx}; | 62 | LOG_WARNING(Service_IRS, "(STUBBED) called, applet_resource_user_id={}", aruid.pid); |
| 62 | const auto applet_resource_user_id{rp.Pop<u64>()}; | 63 | R_SUCCEED(); |
| 63 | |||
| 64 | LOG_WARNING(Service_IRS, "(STUBBED) called, applet_resource_user_id={}", | ||
| 65 | applet_resource_user_id); | ||
| 66 | |||
| 67 | IPC::ResponseBuilder rb{ctx, 2}; | ||
| 68 | rb.Push(ResultSuccess); | ||
| 69 | } | 64 | } |
| 70 | 65 | ||
| 71 | void IRS::DeactivateIrsensor(HLERequestContext& ctx) { | 66 | Result IRS::DeactivateIrsensor(ClientAppletResourceUserId aruid) { |
| 72 | IPC::RequestParser rp{ctx}; | 67 | LOG_WARNING(Service_IRS, "(STUBBED) called, applet_resource_user_id={}", aruid.pid); |
| 73 | const auto applet_resource_user_id{rp.Pop<u64>()}; | 68 | R_SUCCEED(); |
| 74 | |||
| 75 | LOG_WARNING(Service_IRS, "(STUBBED) called, applet_resource_user_id={}", | ||
| 76 | applet_resource_user_id); | ||
| 77 | |||
| 78 | IPC::ResponseBuilder rb{ctx, 2}; | ||
| 79 | rb.Push(ResultSuccess); | ||
| 80 | } | 69 | } |
| 81 | 70 | ||
| 82 | void IRS::GetIrsensorSharedMemoryHandle(HLERequestContext& ctx) { | 71 | Result IRS::GetIrsensorSharedMemoryHandle(OutCopyHandle<Kernel::KSharedMemory> out_shared_memory, |
| 83 | IPC::RequestParser rp{ctx}; | 72 | ClientAppletResourceUserId aruid) { |
| 84 | const auto applet_resource_user_id{rp.Pop<u64>()}; | 73 | LOG_DEBUG(Service_IRS, "called, applet_resource_user_id={}", aruid.pid); |
| 85 | |||
| 86 | LOG_DEBUG(Service_IRS, "called, applet_resource_user_id={}", applet_resource_user_id); | ||
| 87 | 74 | ||
| 88 | IPC::ResponseBuilder rb{ctx, 2, 1}; | 75 | *out_shared_memory = &system.Kernel().GetIrsSharedMem(); |
| 89 | rb.Push(ResultSuccess); | 76 | R_SUCCEED(); |
| 90 | rb.PushCopyObjects(&system.Kernel().GetIrsSharedMem()); | ||
| 91 | } | 77 | } |
| 92 | 78 | ||
| 93 | void IRS::StopImageProcessor(HLERequestContext& ctx) { | 79 | Result IRS::StopImageProcessor(Core::IrSensor::IrCameraHandle camera_handle, |
| 94 | IPC::RequestParser rp{ctx}; | 80 | ClientAppletResourceUserId aruid) { |
| 95 | struct Parameters { | ||
| 96 | Core::IrSensor::IrCameraHandle camera_handle; | ||
| 97 | INSERT_PADDING_WORDS_NOINIT(1); | ||
| 98 | u64 applet_resource_user_id; | ||
| 99 | }; | ||
| 100 | static_assert(sizeof(Parameters) == 0x10, "Parameters has incorrect size."); | ||
| 101 | |||
| 102 | const auto parameters{rp.PopRaw<Parameters>()}; | ||
| 103 | |||
| 104 | LOG_WARNING(Service_IRS, | 81 | LOG_WARNING(Service_IRS, |
| 105 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", | 82 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", |
| 106 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 83 | camera_handle.npad_type, camera_handle.npad_id, aruid.pid); |
| 107 | parameters.applet_resource_user_id); | ||
| 108 | |||
| 109 | auto result = IsIrCameraHandleValid(parameters.camera_handle); | ||
| 110 | if (result.IsSuccess()) { | ||
| 111 | // TODO: Stop Image processor | ||
| 112 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 113 | Common::Input::PollingMode::Active); | ||
| 114 | result = ResultSuccess; | ||
| 115 | } | ||
| 116 | 84 | ||
| 117 | IPC::ResponseBuilder rb{ctx, 2}; | 85 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 118 | rb.Push(result); | ||
| 119 | } | ||
| 120 | |||
| 121 | void IRS::RunMomentProcessor(HLERequestContext& ctx) { | ||
| 122 | IPC::RequestParser rp{ctx}; | ||
| 123 | struct Parameters { | ||
| 124 | Core::IrSensor::IrCameraHandle camera_handle; | ||
| 125 | INSERT_PADDING_WORDS_NOINIT(1); | ||
| 126 | u64 applet_resource_user_id; | ||
| 127 | Core::IrSensor::PackedMomentProcessorConfig processor_config; | ||
| 128 | }; | ||
| 129 | static_assert(sizeof(Parameters) == 0x30, "Parameters has incorrect size."); | ||
| 130 | 86 | ||
| 131 | const auto parameters{rp.PopRaw<Parameters>()}; | 87 | // TODO: Stop Image processor |
| 88 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 89 | Common::Input::PollingMode::Active); | ||
| 90 | R_SUCCEED(); | ||
| 91 | } | ||
| 132 | 92 | ||
| 93 | Result IRS::RunMomentProcessor( | ||
| 94 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, | ||
| 95 | const Core::IrSensor::PackedMomentProcessorConfig& processor_config) { | ||
| 133 | LOG_WARNING(Service_IRS, | 96 | LOG_WARNING(Service_IRS, |
| 134 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", | 97 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", |
| 135 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 98 | camera_handle.npad_type, camera_handle.npad_id, aruid.pid); |
| 136 | parameters.applet_resource_user_id); | ||
| 137 | |||
| 138 | const auto result = IsIrCameraHandleValid(parameters.camera_handle); | ||
| 139 | |||
| 140 | if (result.IsSuccess()) { | ||
| 141 | auto& device = GetIrCameraSharedMemoryDeviceEntry(parameters.camera_handle); | ||
| 142 | MakeProcessorWithCoreContext<MomentProcessor>(parameters.camera_handle, device); | ||
| 143 | auto& image_transfer_processor = GetProcessor<MomentProcessor>(parameters.camera_handle); | ||
| 144 | image_transfer_processor.SetConfig(parameters.processor_config); | ||
| 145 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 146 | Common::Input::PollingMode::IR); | ||
| 147 | } | ||
| 148 | 99 | ||
| 149 | IPC::ResponseBuilder rb{ctx, 2}; | 100 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 150 | rb.Push(result); | ||
| 151 | } | ||
| 152 | 101 | ||
| 153 | void IRS::RunClusteringProcessor(HLERequestContext& ctx) { | 102 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); |
| 154 | IPC::RequestParser rp{ctx}; | 103 | MakeProcessorWithCoreContext<MomentProcessor>(camera_handle, device); |
| 155 | struct Parameters { | 104 | auto& image_transfer_processor = GetProcessor<MomentProcessor>(camera_handle); |
| 156 | Core::IrSensor::IrCameraHandle camera_handle; | 105 | image_transfer_processor.SetConfig(processor_config); |
| 157 | INSERT_PADDING_WORDS_NOINIT(1); | 106 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, |
| 158 | u64 applet_resource_user_id; | 107 | Common::Input::PollingMode::IR); |
| 159 | Core::IrSensor::PackedClusteringProcessorConfig processor_config; | ||
| 160 | }; | ||
| 161 | static_assert(sizeof(Parameters) == 0x38, "Parameters has incorrect size."); | ||
| 162 | 108 | ||
| 163 | const auto parameters{rp.PopRaw<Parameters>()}; | 109 | R_SUCCEED(); |
| 110 | } | ||
| 164 | 111 | ||
| 112 | Result IRS::RunClusteringProcessor( | ||
| 113 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, | ||
| 114 | const Core::IrSensor::PackedClusteringProcessorConfig& processor_config) { | ||
| 165 | LOG_WARNING(Service_IRS, | 115 | LOG_WARNING(Service_IRS, |
| 166 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", | 116 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", |
| 167 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 117 | camera_handle.npad_type, camera_handle.npad_id, aruid.pid); |
| 168 | parameters.applet_resource_user_id); | ||
| 169 | |||
| 170 | auto result = IsIrCameraHandleValid(parameters.camera_handle); | ||
| 171 | |||
| 172 | if (result.IsSuccess()) { | ||
| 173 | auto& device = GetIrCameraSharedMemoryDeviceEntry(parameters.camera_handle); | ||
| 174 | MakeProcessorWithCoreContext<ClusteringProcessor>(parameters.camera_handle, device); | ||
| 175 | auto& image_transfer_processor = | ||
| 176 | GetProcessor<ClusteringProcessor>(parameters.camera_handle); | ||
| 177 | image_transfer_processor.SetConfig(parameters.processor_config); | ||
| 178 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 179 | Common::Input::PollingMode::IR); | ||
| 180 | } | ||
| 181 | 118 | ||
| 182 | IPC::ResponseBuilder rb{ctx, 2}; | 119 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 183 | rb.Push(result); | ||
| 184 | } | ||
| 185 | 120 | ||
| 186 | void IRS::RunImageTransferProcessor(HLERequestContext& ctx) { | 121 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); |
| 187 | IPC::RequestParser rp{ctx}; | 122 | MakeProcessorWithCoreContext<ClusteringProcessor>(camera_handle, device); |
| 188 | struct Parameters { | 123 | auto& image_transfer_processor = GetProcessor<ClusteringProcessor>(camera_handle); |
| 189 | Core::IrSensor::IrCameraHandle camera_handle; | 124 | image_transfer_processor.SetConfig(processor_config); |
| 190 | INSERT_PADDING_WORDS_NOINIT(1); | 125 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, |
| 191 | u64 applet_resource_user_id; | 126 | Common::Input::PollingMode::IR); |
| 192 | Core::IrSensor::PackedImageTransferProcessorConfig processor_config; | ||
| 193 | u32 transfer_memory_size; | ||
| 194 | }; | ||
| 195 | static_assert(sizeof(Parameters) == 0x30, "Parameters has incorrect size."); | ||
| 196 | 127 | ||
| 197 | const auto parameters{rp.PopRaw<Parameters>()}; | 128 | R_SUCCEED(); |
| 198 | const auto t_mem_handle{ctx.GetCopyHandle(0)}; | 129 | } |
| 199 | 130 | ||
| 200 | auto t_mem = ctx.GetObjectFromHandle<Kernel::KTransferMemory>(t_mem_handle); | 131 | Result IRS::RunImageTransferProcessor( |
| 132 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, | ||
| 133 | const Core::IrSensor::PackedImageTransferProcessorConfig& processor_config, | ||
| 134 | u64 transfer_memory_size, InCopyHandle<Kernel::KTransferMemory> t_mem) { | ||
| 201 | 135 | ||
| 202 | if (t_mem.IsNull()) { | 136 | ASSERT_MSG(t_mem->GetSize() == transfer_memory_size, "t_mem has incorrect size"); |
| 203 | LOG_ERROR(Service_IRS, "t_mem is a nullptr for handle=0x{:08X}", t_mem_handle); | ||
| 204 | IPC::ResponseBuilder rb{ctx, 2}; | ||
| 205 | rb.Push(ResultUnknown); | ||
| 206 | return; | ||
| 207 | } | ||
| 208 | |||
| 209 | ASSERT_MSG(t_mem->GetSize() == parameters.transfer_memory_size, "t_mem has incorrect size"); | ||
| 210 | 137 | ||
| 211 | LOG_INFO(Service_IRS, | 138 | LOG_INFO(Service_IRS, |
| 212 | "called, npad_type={}, npad_id={}, transfer_memory_size={}, transfer_memory_size={}, " | 139 | "called, npad_type={}, npad_id={}, transfer_memory_size={}, transfer_memory_size={}, " |
| 213 | "applet_resource_user_id={}", | 140 | "applet_resource_user_id={}", |
| 214 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 141 | camera_handle.npad_type, camera_handle.npad_id, transfer_memory_size, t_mem->GetSize(), |
| 215 | parameters.transfer_memory_size, t_mem->GetSize(), parameters.applet_resource_user_id); | 142 | aruid.pid); |
| 216 | |||
| 217 | const auto result = IsIrCameraHandleValid(parameters.camera_handle); | ||
| 218 | |||
| 219 | if (result.IsSuccess()) { | ||
| 220 | auto& device = GetIrCameraSharedMemoryDeviceEntry(parameters.camera_handle); | ||
| 221 | MakeProcessorWithCoreContext<ImageTransferProcessor>(parameters.camera_handle, device); | ||
| 222 | auto& image_transfer_processor = | ||
| 223 | GetProcessor<ImageTransferProcessor>(parameters.camera_handle); | ||
| 224 | image_transfer_processor.SetConfig(parameters.processor_config); | ||
| 225 | image_transfer_processor.SetTransferMemoryAddress(t_mem->GetSourceAddress()); | ||
| 226 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 227 | Common::Input::PollingMode::IR); | ||
| 228 | } | ||
| 229 | 143 | ||
| 230 | IPC::ResponseBuilder rb{ctx, 2}; | 144 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 231 | rb.Push(result); | ||
| 232 | } | ||
| 233 | 145 | ||
| 234 | void IRS::GetImageTransferProcessorState(HLERequestContext& ctx) { | 146 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); |
| 235 | IPC::RequestParser rp{ctx}; | 147 | MakeProcessorWithCoreContext<ImageTransferProcessor>(camera_handle, device); |
| 236 | struct Parameters { | 148 | auto& image_transfer_processor = GetProcessor<ImageTransferProcessor>(camera_handle); |
| 237 | Core::IrSensor::IrCameraHandle camera_handle; | 149 | image_transfer_processor.SetConfig(processor_config); |
| 238 | INSERT_PADDING_WORDS_NOINIT(1); | 150 | image_transfer_processor.SetTransferMemoryAddress(t_mem->GetSourceAddress()); |
| 239 | u64 applet_resource_user_id; | 151 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, |
| 240 | }; | 152 | Common::Input::PollingMode::IR); |
| 241 | static_assert(sizeof(Parameters) == 0x10, "Parameters has incorrect size."); | ||
| 242 | 153 | ||
| 243 | const auto parameters{rp.PopRaw<Parameters>()}; | 154 | R_SUCCEED(); |
| 155 | } | ||
| 244 | 156 | ||
| 157 | Result IRS::GetImageTransferProcessorState( | ||
| 158 | Out<Core::IrSensor::ImageTransferProcessorState> out_state, | ||
| 159 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, | ||
| 160 | OutBuffer<BufferAttr_HipcMapAlias> out_buffer_data) { | ||
| 245 | LOG_DEBUG(Service_IRS, "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", | 161 | LOG_DEBUG(Service_IRS, "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", |
| 246 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 162 | camera_handle.npad_type, camera_handle.npad_id, aruid.pid); |
| 247 | parameters.applet_resource_user_id); | ||
| 248 | |||
| 249 | const auto result = IsIrCameraHandleValid(parameters.camera_handle); | ||
| 250 | if (result.IsError()) { | ||
| 251 | IPC::ResponseBuilder rb{ctx, 2}; | ||
| 252 | rb.Push(result); | ||
| 253 | return; | ||
| 254 | } | ||
| 255 | 163 | ||
| 256 | const auto& device = GetIrCameraSharedMemoryDeviceEntry(parameters.camera_handle); | 164 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 257 | 165 | ||
| 258 | if (device.mode != Core::IrSensor::IrSensorMode::ImageTransferProcessor) { | 166 | const auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); |
| 259 | IPC::ResponseBuilder rb{ctx, 2}; | 167 | |
| 260 | rb.Push(InvalidProcessorState); | 168 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 261 | return; | 169 | R_UNLESS(device.mode == Core::IrSensor::IrSensorMode::ImageTransferProcessor, |
| 262 | } | 170 | InvalidProcessorState); |
| 263 | 171 | ||
| 264 | std::vector<u8> data{}; | 172 | *out_state = GetProcessor<ImageTransferProcessor>(camera_handle).GetState(out_buffer_data); |
| 265 | const auto& image_transfer_processor = | ||
| 266 | GetProcessor<ImageTransferProcessor>(parameters.camera_handle); | ||
| 267 | const auto& state = image_transfer_processor.GetState(data); | ||
| 268 | 173 | ||
| 269 | ctx.WriteBuffer(data); | 174 | R_SUCCEED(); |
| 270 | IPC::ResponseBuilder rb{ctx, 6}; | ||
| 271 | rb.Push(ResultSuccess); | ||
| 272 | rb.PushRaw(state); | ||
| 273 | } | 175 | } |
| 274 | 176 | ||
| 275 | void IRS::RunTeraPluginProcessor(HLERequestContext& ctx) { | 177 | Result IRS::RunTeraPluginProcessor(Core::IrSensor::IrCameraHandle camera_handle, |
| 276 | IPC::RequestParser rp{ctx}; | 178 | Core::IrSensor::PackedTeraPluginProcessorConfig processor_config, |
| 277 | struct Parameters { | 179 | ClientAppletResourceUserId aruid) { |
| 278 | Core::IrSensor::IrCameraHandle camera_handle; | 180 | LOG_WARNING(Service_IRS, |
| 279 | Core::IrSensor::PackedTeraPluginProcessorConfig processor_config; | 181 | "(STUBBED) called, npad_type={}, npad_id={}, mode={}, mcu_version={}.{}, " |
| 280 | INSERT_PADDING_WORDS_NOINIT(1); | 182 | "applet_resource_user_id={}", |
| 281 | u64 applet_resource_user_id; | 183 | camera_handle.npad_type, camera_handle.npad_id, processor_config.mode, |
| 282 | }; | 184 | processor_config.required_mcu_version.major, |
| 283 | static_assert(sizeof(Parameters) == 0x18, "Parameters has incorrect size."); | 185 | processor_config.required_mcu_version.minor, aruid.pid); |
| 284 | 186 | ||
| 285 | const auto parameters{rp.PopRaw<Parameters>()}; | 187 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 286 | 188 | ||
| 287 | LOG_WARNING( | 189 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); |
| 288 | Service_IRS, | 190 | MakeProcessor<TeraPluginProcessor>(camera_handle, device); |
| 289 | "(STUBBED) called, npad_type={}, npad_id={}, mode={}, mcu_version={}.{}, " | 191 | auto& image_transfer_processor = GetProcessor<TeraPluginProcessor>(camera_handle); |
| 290 | "applet_resource_user_id={}", | 192 | image_transfer_processor.SetConfig(processor_config); |
| 291 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 193 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, |
| 292 | parameters.processor_config.mode, parameters.processor_config.required_mcu_version.major, | 194 | Common::Input::PollingMode::IR); |
| 293 | parameters.processor_config.required_mcu_version.minor, parameters.applet_resource_user_id); | ||
| 294 | |||
| 295 | const auto result = IsIrCameraHandleValid(parameters.camera_handle); | ||
| 296 | |||
| 297 | if (result.IsSuccess()) { | ||
| 298 | auto& device = GetIrCameraSharedMemoryDeviceEntry(parameters.camera_handle); | ||
| 299 | MakeProcessor<TeraPluginProcessor>(parameters.camera_handle, device); | ||
| 300 | auto& image_transfer_processor = | ||
| 301 | GetProcessor<TeraPluginProcessor>(parameters.camera_handle); | ||
| 302 | image_transfer_processor.SetConfig(parameters.processor_config); | ||
| 303 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 304 | Common::Input::PollingMode::IR); | ||
| 305 | } | ||
| 306 | 195 | ||
| 307 | IPC::ResponseBuilder rb{ctx, 2}; | 196 | R_SUCCEED(); |
| 308 | rb.Push(result); | ||
| 309 | } | 197 | } |
| 310 | 198 | ||
| 311 | void IRS::GetNpadIrCameraHandle(HLERequestContext& ctx) { | 199 | Result IRS::GetNpadIrCameraHandle(Out<Core::IrSensor::IrCameraHandle> out_camera_handle, |
| 312 | IPC::RequestParser rp{ctx}; | 200 | Core::HID::NpadIdType npad_id) { |
| 313 | const auto npad_id{rp.PopEnum<Core::HID::NpadIdType>()}; | 201 | R_UNLESS(HID::IsNpadIdValid(npad_id), HID::ResultInvalidNpadId); |
| 314 | |||
| 315 | if (npad_id > Core::HID::NpadIdType::Player8 && npad_id != Core::HID::NpadIdType::Invalid && | ||
| 316 | npad_id != Core::HID::NpadIdType::Handheld) { | ||
| 317 | IPC::ResponseBuilder rb{ctx, 2}; | ||
| 318 | rb.Push(Service::HID::ResultInvalidNpadId); | ||
| 319 | return; | ||
| 320 | } | ||
| 321 | 202 | ||
| 322 | Core::IrSensor::IrCameraHandle camera_handle{ | 203 | *out_camera_handle = { |
| 323 | .npad_id = static_cast<u8>(HID::NpadIdTypeToIndex(npad_id)), | 204 | .npad_id = static_cast<u8>(HID::NpadIdTypeToIndex(npad_id)), |
| 324 | .npad_type = Core::HID::NpadStyleIndex::None, | 205 | .npad_type = Core::HID::NpadStyleIndex::None, |
| 325 | }; | 206 | }; |
| 326 | 207 | ||
| 327 | LOG_INFO(Service_IRS, "called, npad_id={}, camera_npad_id={}, camera_npad_type={}", npad_id, | 208 | LOG_INFO(Service_IRS, "called, npad_id={}, camera_npad_id={}, camera_npad_type={}", npad_id, |
| 328 | camera_handle.npad_id, camera_handle.npad_type); | 209 | out_camera_handle->npad_id, out_camera_handle->npad_type); |
| 329 | 210 | ||
| 330 | IPC::ResponseBuilder rb{ctx, 3}; | 211 | R_SUCCEED(); |
| 331 | rb.Push(ResultSuccess); | ||
| 332 | rb.PushRaw(camera_handle); | ||
| 333 | } | 212 | } |
| 334 | 213 | ||
| 335 | void IRS::RunPointingProcessor(HLERequestContext& ctx) { | 214 | Result IRS::RunPointingProcessor( |
| 336 | IPC::RequestParser rp{ctx}; | 215 | Core::IrSensor::IrCameraHandle camera_handle, |
| 337 | const auto camera_handle{rp.PopRaw<Core::IrSensor::IrCameraHandle>()}; | 216 | const Core::IrSensor::PackedPointingProcessorConfig& processor_config, |
| 338 | const auto processor_config{rp.PopRaw<Core::IrSensor::PackedPointingProcessorConfig>()}; | 217 | ClientAppletResourceUserId aruid) { |
| 339 | const auto applet_resource_user_id{rp.Pop<u64>()}; | ||
| 340 | |||
| 341 | LOG_WARNING( | 218 | LOG_WARNING( |
| 342 | Service_IRS, | 219 | Service_IRS, |
| 343 | "(STUBBED) called, npad_type={}, npad_id={}, mcu_version={}.{}, applet_resource_user_id={}", | 220 | "(STUBBED) called, npad_type={}, npad_id={}, mcu_version={}.{}, applet_resource_user_id={}", |
| 344 | camera_handle.npad_type, camera_handle.npad_id, processor_config.required_mcu_version.major, | 221 | camera_handle.npad_type, camera_handle.npad_id, processor_config.required_mcu_version.major, |
| 345 | processor_config.required_mcu_version.minor, applet_resource_user_id); | 222 | processor_config.required_mcu_version.minor, aruid.pid); |
| 346 | 223 | ||
| 347 | auto result = IsIrCameraHandleValid(camera_handle); | 224 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 348 | 225 | ||
| 349 | if (result.IsSuccess()) { | 226 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); |
| 350 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); | 227 | MakeProcessor<PointingProcessor>(camera_handle, device); |
| 351 | MakeProcessor<PointingProcessor>(camera_handle, device); | 228 | auto& image_transfer_processor = GetProcessor<PointingProcessor>(camera_handle); |
| 352 | auto& image_transfer_processor = GetProcessor<PointingProcessor>(camera_handle); | 229 | image_transfer_processor.SetConfig(processor_config); |
| 353 | image_transfer_processor.SetConfig(processor_config); | 230 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, |
| 354 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | 231 | Common::Input::PollingMode::IR); |
| 355 | Common::Input::PollingMode::IR); | ||
| 356 | } | ||
| 357 | 232 | ||
| 358 | IPC::ResponseBuilder rb{ctx, 2}; | 233 | R_SUCCEED(); |
| 359 | rb.Push(result); | ||
| 360 | } | 234 | } |
| 361 | 235 | ||
| 362 | void IRS::SuspendImageProcessor(HLERequestContext& ctx) { | 236 | Result IRS::SuspendImageProcessor(Core::IrSensor::IrCameraHandle camera_handle, |
| 363 | IPC::RequestParser rp{ctx}; | 237 | ClientAppletResourceUserId aruid) { |
| 364 | struct Parameters { | ||
| 365 | Core::IrSensor::IrCameraHandle camera_handle; | ||
| 366 | INSERT_PADDING_WORDS_NOINIT(1); | ||
| 367 | u64 applet_resource_user_id; | ||
| 368 | }; | ||
| 369 | static_assert(sizeof(Parameters) == 0x10, "Parameters has incorrect size."); | ||
| 370 | |||
| 371 | const auto parameters{rp.PopRaw<Parameters>()}; | ||
| 372 | |||
| 373 | LOG_WARNING(Service_IRS, | 238 | LOG_WARNING(Service_IRS, |
| 374 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", | 239 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", |
| 375 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 240 | camera_handle.npad_type, camera_handle.npad_id, aruid.pid); |
| 376 | parameters.applet_resource_user_id); | ||
| 377 | 241 | ||
| 378 | auto result = IsIrCameraHandleValid(parameters.camera_handle); | 242 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 379 | if (result.IsSuccess()) { | ||
| 380 | // TODO: Suspend image processor | ||
| 381 | result = ResultSuccess; | ||
| 382 | } | ||
| 383 | 243 | ||
| 384 | IPC::ResponseBuilder rb{ctx, 2}; | 244 | // TODO: Suspend image processor |
| 385 | rb.Push(result); | ||
| 386 | } | ||
| 387 | 245 | ||
| 388 | void IRS::CheckFirmwareVersion(HLERequestContext& ctx) { | 246 | R_SUCCEED(); |
| 389 | IPC::RequestParser rp{ctx}; | 247 | } |
| 390 | const auto camera_handle{rp.PopRaw<Core::IrSensor::IrCameraHandle>()}; | ||
| 391 | const auto mcu_version{rp.PopRaw<Core::IrSensor::PackedMcuVersion>()}; | ||
| 392 | const auto applet_resource_user_id{rp.Pop<u64>()}; | ||
| 393 | 248 | ||
| 249 | Result IRS::CheckFirmwareVersion(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 250 | Core::IrSensor::PackedMcuVersion mcu_version, | ||
| 251 | ClientAppletResourceUserId aruid) { | ||
| 394 | LOG_WARNING( | 252 | LOG_WARNING( |
| 395 | Service_IRS, | 253 | Service_IRS, |
| 396 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}, mcu_version={}.{}", | 254 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}, mcu_version={}.{}", |
| 397 | camera_handle.npad_type, camera_handle.npad_id, applet_resource_user_id, mcu_version.major, | 255 | camera_handle.npad_type, camera_handle.npad_id, aruid.pid, mcu_version.major, |
| 398 | mcu_version.minor); | 256 | mcu_version.minor); |
| 399 | 257 | ||
| 400 | auto result = IsIrCameraHandleValid(camera_handle); | 258 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 401 | if (result.IsSuccess()) { | ||
| 402 | // TODO: Check firmware version | ||
| 403 | result = ResultSuccess; | ||
| 404 | } | ||
| 405 | 259 | ||
| 406 | IPC::ResponseBuilder rb{ctx, 2}; | 260 | // TODO: Check firmware version |
| 407 | rb.Push(result); | ||
| 408 | } | ||
| 409 | 261 | ||
| 410 | void IRS::SetFunctionLevel(HLERequestContext& ctx) { | 262 | R_SUCCEED(); |
| 411 | IPC::RequestParser rp{ctx}; | 263 | } |
| 412 | const auto camera_handle{rp.PopRaw<Core::IrSensor::IrCameraHandle>()}; | ||
| 413 | const auto function_level{rp.PopRaw<Core::IrSensor::PackedFunctionLevel>()}; | ||
| 414 | const auto applet_resource_user_id{rp.Pop<u64>()}; | ||
| 415 | 264 | ||
| 265 | Result IRS::SetFunctionLevel(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 266 | Core::IrSensor::PackedFunctionLevel function_level, | ||
| 267 | ClientAppletResourceUserId aruid) { | ||
| 416 | LOG_WARNING( | 268 | LOG_WARNING( |
| 417 | Service_IRS, | 269 | Service_IRS, |
| 418 | "(STUBBED) called, npad_type={}, npad_id={}, function_level={}, applet_resource_user_id={}", | 270 | "(STUBBED) called, npad_type={}, npad_id={}, function_level={}, applet_resource_user_id={}", |
| 419 | camera_handle.npad_type, camera_handle.npad_id, function_level.function_level, | 271 | camera_handle.npad_type, camera_handle.npad_id, function_level.function_level, aruid.pid); |
| 420 | applet_resource_user_id); | ||
| 421 | 272 | ||
| 422 | auto result = IsIrCameraHandleValid(camera_handle); | 273 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 423 | if (result.IsSuccess()) { | ||
| 424 | // TODO: Set Function level | ||
| 425 | result = ResultSuccess; | ||
| 426 | } | ||
| 427 | 274 | ||
| 428 | IPC::ResponseBuilder rb{ctx, 2}; | 275 | // TODO: Set Function level |
| 429 | rb.Push(result); | ||
| 430 | } | ||
| 431 | 276 | ||
| 432 | void IRS::RunImageTransferExProcessor(HLERequestContext& ctx) { | 277 | R_SUCCEED(); |
| 433 | IPC::RequestParser rp{ctx}; | 278 | } |
| 434 | struct Parameters { | ||
| 435 | Core::IrSensor::IrCameraHandle camera_handle; | ||
| 436 | INSERT_PADDING_WORDS_NOINIT(1); | ||
| 437 | u64 applet_resource_user_id; | ||
| 438 | Core::IrSensor::PackedImageTransferProcessorExConfig processor_config; | ||
| 439 | u64 transfer_memory_size; | ||
| 440 | }; | ||
| 441 | static_assert(sizeof(Parameters) == 0x38, "Parameters has incorrect size."); | ||
| 442 | 279 | ||
| 443 | const auto parameters{rp.PopRaw<Parameters>()}; | 280 | Result IRS::RunImageTransferExProcessor( |
| 444 | const auto t_mem_handle{ctx.GetCopyHandle(0)}; | 281 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, |
| 282 | const Core::IrSensor::PackedImageTransferProcessorExConfig& processor_config, | ||
| 283 | u64 transfer_memory_size, InCopyHandle<Kernel::KTransferMemory> t_mem) { | ||
| 445 | 284 | ||
| 446 | auto t_mem = ctx.GetObjectFromHandle<Kernel::KTransferMemory>(t_mem_handle); | 285 | ASSERT_MSG(t_mem->GetSize() == transfer_memory_size, "t_mem has incorrect size"); |
| 447 | 286 | ||
| 448 | LOG_INFO(Service_IRS, | 287 | LOG_INFO(Service_IRS, |
| 449 | "called, npad_type={}, npad_id={}, transfer_memory_size={}, " | 288 | "called, npad_type={}, npad_id={}, transfer_memory_size={}, " |
| 450 | "applet_resource_user_id={}", | 289 | "applet_resource_user_id={}", |
| 451 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 290 | camera_handle.npad_type, camera_handle.npad_id, transfer_memory_size, aruid.pid); |
| 452 | parameters.transfer_memory_size, parameters.applet_resource_user_id); | ||
| 453 | |||
| 454 | auto result = IsIrCameraHandleValid(parameters.camera_handle); | ||
| 455 | |||
| 456 | if (result.IsSuccess()) { | ||
| 457 | auto& device = GetIrCameraSharedMemoryDeviceEntry(parameters.camera_handle); | ||
| 458 | MakeProcessorWithCoreContext<ImageTransferProcessor>(parameters.camera_handle, device); | ||
| 459 | auto& image_transfer_processor = | ||
| 460 | GetProcessor<ImageTransferProcessor>(parameters.camera_handle); | ||
| 461 | image_transfer_processor.SetConfig(parameters.processor_config); | ||
| 462 | image_transfer_processor.SetTransferMemoryAddress(t_mem->GetSourceAddress()); | ||
| 463 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 464 | Common::Input::PollingMode::IR); | ||
| 465 | } | ||
| 466 | 291 | ||
| 467 | IPC::ResponseBuilder rb{ctx, 2}; | 292 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 468 | rb.Push(result); | 293 | |
| 469 | } | 294 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); |
| 295 | MakeProcessorWithCoreContext<ImageTransferProcessor>(camera_handle, device); | ||
| 296 | auto& image_transfer_processor = GetProcessor<ImageTransferProcessor>(camera_handle); | ||
| 297 | image_transfer_processor.SetConfig(processor_config); | ||
| 298 | image_transfer_processor.SetTransferMemoryAddress(t_mem->GetSourceAddress()); | ||
| 299 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 300 | Common::Input::PollingMode::IR); | ||
| 470 | 301 | ||
| 471 | void IRS::RunIrLedProcessor(HLERequestContext& ctx) { | 302 | R_SUCCEED(); |
| 472 | IPC::RequestParser rp{ctx}; | 303 | } |
| 473 | const auto camera_handle{rp.PopRaw<Core::IrSensor::IrCameraHandle>()}; | ||
| 474 | const auto processor_config{rp.PopRaw<Core::IrSensor::PackedIrLedProcessorConfig>()}; | ||
| 475 | const auto applet_resource_user_id{rp.Pop<u64>()}; | ||
| 476 | 304 | ||
| 305 | Result IRS::RunIrLedProcessor(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 306 | Core::IrSensor::PackedIrLedProcessorConfig processor_config, | ||
| 307 | ClientAppletResourceUserId aruid) { | ||
| 477 | LOG_WARNING(Service_IRS, | 308 | LOG_WARNING(Service_IRS, |
| 478 | "(STUBBED) called, npad_type={}, npad_id={}, light_target={}, mcu_version={}.{} " | 309 | "(STUBBED) called, npad_type={}, npad_id={}, light_target={}, mcu_version={}.{} " |
| 479 | "applet_resource_user_id={}", | 310 | "applet_resource_user_id={}", |
| 480 | camera_handle.npad_type, camera_handle.npad_id, processor_config.light_target, | 311 | camera_handle.npad_type, camera_handle.npad_id, processor_config.light_target, |
| 481 | processor_config.required_mcu_version.major, | 312 | processor_config.required_mcu_version.major, |
| 482 | processor_config.required_mcu_version.minor, applet_resource_user_id); | 313 | processor_config.required_mcu_version.minor, aruid.pid); |
| 483 | 314 | ||
| 484 | auto result = IsIrCameraHandleValid(camera_handle); | 315 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 485 | 316 | ||
| 486 | if (result.IsSuccess()) { | 317 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); |
| 487 | auto& device = GetIrCameraSharedMemoryDeviceEntry(camera_handle); | 318 | MakeProcessor<IrLedProcessor>(camera_handle, device); |
| 488 | MakeProcessor<IrLedProcessor>(camera_handle, device); | 319 | auto& image_transfer_processor = GetProcessor<IrLedProcessor>(camera_handle); |
| 489 | auto& image_transfer_processor = GetProcessor<IrLedProcessor>(camera_handle); | 320 | image_transfer_processor.SetConfig(processor_config); |
| 490 | image_transfer_processor.SetConfig(processor_config); | 321 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, |
| 491 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | 322 | Common::Input::PollingMode::IR); |
| 492 | Common::Input::PollingMode::IR); | ||
| 493 | } | ||
| 494 | 323 | ||
| 495 | IPC::ResponseBuilder rb{ctx, 2}; | 324 | R_SUCCEED(); |
| 496 | rb.Push(result); | ||
| 497 | } | 325 | } |
| 498 | 326 | ||
| 499 | void IRS::StopImageProcessorAsync(HLERequestContext& ctx) { | 327 | Result IRS::StopImageProcessorAsync(Core::IrSensor::IrCameraHandle camera_handle, |
| 500 | IPC::RequestParser rp{ctx}; | 328 | ClientAppletResourceUserId aruid) { |
| 501 | struct Parameters { | ||
| 502 | Core::IrSensor::IrCameraHandle camera_handle; | ||
| 503 | INSERT_PADDING_WORDS_NOINIT(1); | ||
| 504 | u64 applet_resource_user_id; | ||
| 505 | }; | ||
| 506 | static_assert(sizeof(Parameters) == 0x10, "Parameters has incorrect size."); | ||
| 507 | |||
| 508 | const auto parameters{rp.PopRaw<Parameters>()}; | ||
| 509 | |||
| 510 | LOG_WARNING(Service_IRS, | 329 | LOG_WARNING(Service_IRS, |
| 511 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", | 330 | "(STUBBED) called, npad_type={}, npad_id={}, applet_resource_user_id={}", |
| 512 | parameters.camera_handle.npad_type, parameters.camera_handle.npad_id, | 331 | camera_handle.npad_type, camera_handle.npad_id, aruid.pid); |
| 513 | parameters.applet_resource_user_id); | ||
| 514 | |||
| 515 | auto result = IsIrCameraHandleValid(parameters.camera_handle); | ||
| 516 | if (result.IsSuccess()) { | ||
| 517 | // TODO: Stop image processor async | ||
| 518 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, | ||
| 519 | Common::Input::PollingMode::Active); | ||
| 520 | result = ResultSuccess; | ||
| 521 | } | ||
| 522 | 332 | ||
| 523 | IPC::ResponseBuilder rb{ctx, 2}; | 333 | R_TRY(IsIrCameraHandleValid(camera_handle)); |
| 524 | rb.Push(result); | ||
| 525 | } | ||
| 526 | 334 | ||
| 527 | void IRS::ActivateIrsensorWithFunctionLevel(HLERequestContext& ctx) { | 335 | // TODO: Stop image processor async |
| 528 | IPC::RequestParser rp{ctx}; | 336 | npad_device->SetPollingMode(Core::HID::EmulatedDeviceIndex::RightIndex, |
| 529 | struct Parameters { | 337 | Common::Input::PollingMode::Active); |
| 530 | Core::IrSensor::PackedFunctionLevel function_level; | ||
| 531 | INSERT_PADDING_WORDS_NOINIT(1); | ||
| 532 | u64 applet_resource_user_id; | ||
| 533 | }; | ||
| 534 | static_assert(sizeof(Parameters) == 0x10, "Parameters has incorrect size."); | ||
| 535 | 338 | ||
| 536 | const auto parameters{rp.PopRaw<Parameters>()}; | 339 | R_SUCCEED(); |
| 340 | } | ||
| 537 | 341 | ||
| 342 | Result IRS::ActivateIrsensorWithFunctionLevel(Core::IrSensor::PackedFunctionLevel function_level, | ||
| 343 | ClientAppletResourceUserId aruid) { | ||
| 538 | LOG_WARNING(Service_IRS, "(STUBBED) called, function_level={}, applet_resource_user_id={}", | 344 | LOG_WARNING(Service_IRS, "(STUBBED) called, function_level={}, applet_resource_user_id={}", |
| 539 | parameters.function_level.function_level, parameters.applet_resource_user_id); | 345 | function_level.function_level, aruid.pid); |
| 540 | 346 | R_SUCCEED(); | |
| 541 | IPC::ResponseBuilder rb{ctx, 2}; | ||
| 542 | rb.Push(ResultSuccess); | ||
| 543 | } | 347 | } |
| 544 | 348 | ||
| 545 | Result IRS::IsIrCameraHandleValid(const Core::IrSensor::IrCameraHandle& camera_handle) const { | 349 | Result IRS::IsIrCameraHandleValid(const Core::IrSensor::IrCameraHandle& camera_handle) const { |
diff --git a/src/core/hle/service/hid/irs.h b/src/core/hle/service/hid/irs.h index 06b7279ee..58dfee6c3 100644 --- a/src/core/hle/service/hid/irs.h +++ b/src/core/hle/service/hid/irs.h | |||
| @@ -4,6 +4,7 @@ | |||
| 4 | #pragma once | 4 | #pragma once |
| 5 | 5 | ||
| 6 | #include "core/core.h" | 6 | #include "core/core.h" |
| 7 | #include "core/hle/service/cmif_types.h" | ||
| 7 | #include "core/hle/service/service.h" | 8 | #include "core/hle/service/service.h" |
| 8 | #include "hid_core/hid_types.h" | 9 | #include "hid_core/hid_types.h" |
| 9 | #include "hid_core/irsensor/irs_types.h" | 10 | #include "hid_core/irsensor/irs_types.h" |
| @@ -35,26 +36,73 @@ private: | |||
| 35 | }; | 36 | }; |
| 36 | static_assert(sizeof(StatusManager) == 0x8000, "StatusManager is an invalid size"); | 37 | static_assert(sizeof(StatusManager) == 0x8000, "StatusManager is an invalid size"); |
| 37 | 38 | ||
| 38 | void ActivateIrsensor(HLERequestContext& ctx); | 39 | Result ActivateIrsensor(ClientAppletResourceUserId aruid); |
| 39 | void DeactivateIrsensor(HLERequestContext& ctx); | 40 | |
| 40 | void GetIrsensorSharedMemoryHandle(HLERequestContext& ctx); | 41 | Result DeactivateIrsensor(ClientAppletResourceUserId aruid); |
| 41 | void StopImageProcessor(HLERequestContext& ctx); | 42 | |
| 42 | void RunMomentProcessor(HLERequestContext& ctx); | 43 | Result GetIrsensorSharedMemoryHandle(OutCopyHandle<Kernel::KSharedMemory> out_shared_memory, |
| 43 | void RunClusteringProcessor(HLERequestContext& ctx); | 44 | ClientAppletResourceUserId aruid); |
| 44 | void RunImageTransferProcessor(HLERequestContext& ctx); | 45 | Result StopImageProcessor(Core::IrSensor::IrCameraHandle camera_handle, |
| 45 | void GetImageTransferProcessorState(HLERequestContext& ctx); | 46 | ClientAppletResourceUserId aruid); |
| 46 | void RunTeraPluginProcessor(HLERequestContext& ctx); | 47 | |
| 47 | void GetNpadIrCameraHandle(HLERequestContext& ctx); | 48 | Result RunMomentProcessor(Core::IrSensor::IrCameraHandle camera_handle, |
| 48 | void RunPointingProcessor(HLERequestContext& ctx); | 49 | ClientAppletResourceUserId aruid, |
| 49 | void SuspendImageProcessor(HLERequestContext& ctx); | 50 | const Core::IrSensor::PackedMomentProcessorConfig& processor_config); |
| 50 | void CheckFirmwareVersion(HLERequestContext& ctx); | 51 | |
| 51 | void SetFunctionLevel(HLERequestContext& ctx); | 52 | Result RunClusteringProcessor( |
| 52 | void RunImageTransferExProcessor(HLERequestContext& ctx); | 53 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, |
| 53 | void RunIrLedProcessor(HLERequestContext& ctx); | 54 | const Core::IrSensor::PackedClusteringProcessorConfig& processor_config); |
| 54 | void StopImageProcessorAsync(HLERequestContext& ctx); | 55 | |
| 55 | void ActivateIrsensorWithFunctionLevel(HLERequestContext& ctx); | 56 | Result RunImageTransferProcessor( |
| 57 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, | ||
| 58 | const Core::IrSensor::PackedImageTransferProcessorConfig& processor_config, | ||
| 59 | u64 transfer_memory_size, InCopyHandle<Kernel::KTransferMemory> t_mem); | ||
| 60 | |||
| 61 | Result GetImageTransferProcessorState( | ||
| 62 | Out<Core::IrSensor::ImageTransferProcessorState> out_state, | ||
| 63 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, | ||
| 64 | OutBuffer<BufferAttr_HipcMapAlias> out_buffer_data); | ||
| 65 | |||
| 66 | Result RunTeraPluginProcessor(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 67 | Core::IrSensor::PackedTeraPluginProcessorConfig processor_config, | ||
| 68 | ClientAppletResourceUserId aruid); | ||
| 69 | |||
| 70 | Result GetNpadIrCameraHandle(Out<Core::IrSensor::IrCameraHandle> out_camera_handle, | ||
| 71 | Core::HID::NpadIdType npad_id); | ||
| 72 | |||
| 73 | Result RunPointingProcessor( | ||
| 74 | Core::IrSensor::IrCameraHandle camera_handle, | ||
| 75 | const Core::IrSensor::PackedPointingProcessorConfig& processor_config, | ||
| 76 | ClientAppletResourceUserId aruid); | ||
| 77 | |||
| 78 | Result SuspendImageProcessor(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 79 | ClientAppletResourceUserId aruid); | ||
| 80 | |||
| 81 | Result CheckFirmwareVersion(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 82 | Core::IrSensor::PackedMcuVersion mcu_version, | ||
| 83 | ClientAppletResourceUserId aruid); | ||
| 84 | |||
| 85 | Result SetFunctionLevel(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 86 | Core::IrSensor::PackedFunctionLevel function_level, | ||
| 87 | ClientAppletResourceUserId aruid); | ||
| 88 | |||
| 89 | Result RunImageTransferExProcessor( | ||
| 90 | Core::IrSensor::IrCameraHandle camera_handle, ClientAppletResourceUserId aruid, | ||
| 91 | const Core::IrSensor::PackedImageTransferProcessorExConfig& processor_config, | ||
| 92 | u64 transfer_memory_size, InCopyHandle<Kernel::KTransferMemory> t_mem); | ||
| 93 | |||
| 94 | Result RunIrLedProcessor(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 95 | Core::IrSensor::PackedIrLedProcessorConfig processor_config, | ||
| 96 | ClientAppletResourceUserId aruid); | ||
| 97 | |||
| 98 | Result StopImageProcessorAsync(Core::IrSensor::IrCameraHandle camera_handle, | ||
| 99 | ClientAppletResourceUserId aruid); | ||
| 100 | |||
| 101 | Result ActivateIrsensorWithFunctionLevel(Core::IrSensor::PackedFunctionLevel function_level, | ||
| 102 | ClientAppletResourceUserId aruid); | ||
| 56 | 103 | ||
| 57 | Result IsIrCameraHandleValid(const Core::IrSensor::IrCameraHandle& camera_handle) const; | 104 | Result IsIrCameraHandleValid(const Core::IrSensor::IrCameraHandle& camera_handle) const; |
| 105 | |||
| 58 | Core::IrSensor::DeviceFormat& GetIrCameraSharedMemoryDeviceEntry( | 106 | Core::IrSensor::DeviceFormat& GetIrCameraSharedMemoryDeviceEntry( |
| 59 | const Core::IrSensor::IrCameraHandle& camera_handle); | 107 | const Core::IrSensor::IrCameraHandle& camera_handle); |
| 60 | 108 | ||
diff --git a/src/hid_core/irsensor/image_transfer_processor.cpp b/src/hid_core/irsensor/image_transfer_processor.cpp index d6573f8dc..2b5a50ef6 100644 --- a/src/hid_core/irsensor/image_transfer_processor.cpp +++ b/src/hid_core/irsensor/image_transfer_processor.cpp | |||
| @@ -145,9 +145,8 @@ void ImageTransferProcessor::SetTransferMemoryAddress(Common::ProcessAddress t_m | |||
| 145 | } | 145 | } |
| 146 | 146 | ||
| 147 | Core::IrSensor::ImageTransferProcessorState ImageTransferProcessor::GetState( | 147 | Core::IrSensor::ImageTransferProcessorState ImageTransferProcessor::GetState( |
| 148 | std::vector<u8>& data) const { | 148 | std::span<u8> data) const { |
| 149 | const auto size = GetDataSize(current_config.trimming_format); | 149 | const auto size = std::min(GetDataSize(current_config.trimming_format), data.size()); |
| 150 | data.resize(size); | ||
| 151 | system.ApplicationMemory().ReadBlock(transfer_memory, data.data(), size); | 150 | system.ApplicationMemory().ReadBlock(transfer_memory, data.data(), size); |
| 152 | return processor_state; | 151 | return processor_state; |
| 153 | } | 152 | } |
diff --git a/src/hid_core/irsensor/image_transfer_processor.h b/src/hid_core/irsensor/image_transfer_processor.h index 4e0117084..df1c9d920 100644 --- a/src/hid_core/irsensor/image_transfer_processor.h +++ b/src/hid_core/irsensor/image_transfer_processor.h | |||
| @@ -3,6 +3,8 @@ | |||
| 3 | 3 | ||
| 4 | #pragma once | 4 | #pragma once |
| 5 | 5 | ||
| 6 | #include <span> | ||
| 7 | |||
| 6 | #include "common/typed_address.h" | 8 | #include "common/typed_address.h" |
| 7 | #include "hid_core/irsensor/irs_types.h" | 9 | #include "hid_core/irsensor/irs_types.h" |
| 8 | #include "hid_core/irsensor/processor_base.h" | 10 | #include "hid_core/irsensor/processor_base.h" |
| @@ -39,7 +41,7 @@ public: | |||
| 39 | // Transfer memory where the image data will be stored | 41 | // Transfer memory where the image data will be stored |
| 40 | void SetTransferMemoryAddress(Common::ProcessAddress t_mem); | 42 | void SetTransferMemoryAddress(Common::ProcessAddress t_mem); |
| 41 | 43 | ||
| 42 | Core::IrSensor::ImageTransferProcessorState GetState(std::vector<u8>& data) const; | 44 | Core::IrSensor::ImageTransferProcessorState GetState(std::span<u8> data) const; |
| 43 | 45 | ||
| 44 | private: | 46 | private: |
| 45 | // This is nn::irsensor::ImageTransferProcessorConfig | 47 | // This is nn::irsensor::ImageTransferProcessorConfig |