service: hid: Improve CreateAppletResource implementation and free resources
This commit is contained in:
parent
875568bb3e
commit
abfebe5cc4
6 changed files with 149 additions and 13 deletions
|
@ -112,6 +112,19 @@ void AppletResource::UnregisterAppletResourceUserId(u64 aruid) {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void AppletResource::FreeAppletResourceId(u64 aruid) {
|
||||||
|
u64 index = GetIndexFromAruid(aruid);
|
||||||
|
if (index >= AruidIndexMax) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
auto& aruid_data = data[index];
|
||||||
|
if (aruid_data.flag.is_assigned) {
|
||||||
|
aruid_data.shared_memory_handle = nullptr;
|
||||||
|
aruid_data.flag.is_assigned.Assign(false);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
u64 AppletResource::GetActiveAruid() {
|
u64 AppletResource::GetActiveAruid() {
|
||||||
return active_aruid;
|
return active_aruid;
|
||||||
}
|
}
|
||||||
|
@ -196,4 +209,80 @@ void AppletResource::EnablePalmaBoostMode(u64 aruid, bool is_enabled) {
|
||||||
data[index].flag.enable_palma_boost_mode.Assign(is_enabled);
|
data[index].flag.enable_palma_boost_mode.Assign(is_enabled);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Result AppletResource::RegisterCoreAppletResource() {
|
||||||
|
if (ref_counter == std::numeric_limits<s32>::max() - 1) {
|
||||||
|
return ResultAppletResourceOverflow;
|
||||||
|
}
|
||||||
|
if (ref_counter == 0) {
|
||||||
|
const u64 index = GetIndexFromAruid(0);
|
||||||
|
if (index < AruidIndexMax) {
|
||||||
|
return ResultAruidAlreadyRegistered;
|
||||||
|
}
|
||||||
|
|
||||||
|
std::size_t data_index = AruidIndexMax;
|
||||||
|
for (std::size_t i = 0; i < AruidIndexMax; i++) {
|
||||||
|
if (!data[i].flag.is_initialized) {
|
||||||
|
data_index = i;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (data_index == AruidIndexMax) {
|
||||||
|
return ResultAruidNoAvailableEntries;
|
||||||
|
}
|
||||||
|
|
||||||
|
AruidData& aruid_data = data[data_index];
|
||||||
|
|
||||||
|
aruid_data.aruid = 0;
|
||||||
|
aruid_data.flag.is_initialized.Assign(true);
|
||||||
|
aruid_data.flag.enable_pad_input.Assign(true);
|
||||||
|
aruid_data.flag.enable_six_axis_sensor.Assign(true);
|
||||||
|
aruid_data.flag.bit_18.Assign(true);
|
||||||
|
aruid_data.flag.enable_touchscreen.Assign(true);
|
||||||
|
|
||||||
|
data_index = AruidIndexMax;
|
||||||
|
for (std::size_t i = 0; i < AruidIndexMax; i++) {
|
||||||
|
if (registration_list.flag[i] == RegistrationStatus::Initialized) {
|
||||||
|
if (registration_list.aruid[i] != 0) {
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
data_index = i;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (registration_list.flag[i] == RegistrationStatus::None) {
|
||||||
|
data_index = i;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
Result result = ResultSuccess;
|
||||||
|
|
||||||
|
if (data_index == AruidIndexMax) {
|
||||||
|
result = CreateAppletResource(0);
|
||||||
|
} else {
|
||||||
|
registration_list.flag[data_index] = RegistrationStatus::Initialized;
|
||||||
|
registration_list.aruid[data_index] = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (result.IsError()) {
|
||||||
|
UnregisterAppletResourceUserId(0);
|
||||||
|
return result;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
ref_counter++;
|
||||||
|
return ResultSuccess;
|
||||||
|
}
|
||||||
|
|
||||||
|
Result AppletResource::UnregisterCoreAppletResource() {
|
||||||
|
if (ref_counter == 0) {
|
||||||
|
return ResultAppletResourceNotInitialized;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (--ref_counter == 0) {
|
||||||
|
UnregisterAppletResourceUserId(0);
|
||||||
|
}
|
||||||
|
|
||||||
|
return ResultSuccess;
|
||||||
|
}
|
||||||
|
|
||||||
} // namespace Service::HID
|
} // namespace Service::HID
|
||||||
|
|
|
@ -28,6 +28,8 @@ public:
|
||||||
Result RegisterAppletResourceUserId(u64 aruid, bool enable_input);
|
Result RegisterAppletResourceUserId(u64 aruid, bool enable_input);
|
||||||
void UnregisterAppletResourceUserId(u64 aruid);
|
void UnregisterAppletResourceUserId(u64 aruid);
|
||||||
|
|
||||||
|
void FreeAppletResourceId(u64 aruid);
|
||||||
|
|
||||||
u64 GetActiveAruid();
|
u64 GetActiveAruid();
|
||||||
Result GetSharedMemoryHandle(Kernel::KSharedMemory** out_handle, u64 aruid);
|
Result GetSharedMemoryHandle(Kernel::KSharedMemory** out_handle, u64 aruid);
|
||||||
|
|
||||||
|
@ -42,6 +44,9 @@ public:
|
||||||
void SetIsPalmaConnectable(u64 aruid, bool is_connectable);
|
void SetIsPalmaConnectable(u64 aruid, bool is_connectable);
|
||||||
void EnablePalmaBoostMode(u64 aruid, bool is_enabled);
|
void EnablePalmaBoostMode(u64 aruid, bool is_enabled);
|
||||||
|
|
||||||
|
Result RegisterCoreAppletResource();
|
||||||
|
Result UnregisterCoreAppletResource();
|
||||||
|
|
||||||
private:
|
private:
|
||||||
static constexpr std::size_t AruidIndexMax = 0x20;
|
static constexpr std::size_t AruidIndexMax = 0x20;
|
||||||
|
|
||||||
|
@ -81,6 +86,7 @@ private:
|
||||||
u64 active_aruid{};
|
u64 active_aruid{};
|
||||||
AruidRegisterList registration_list{};
|
AruidRegisterList registration_list{};
|
||||||
std::array<AruidData, AruidIndexMax> data{};
|
std::array<AruidData, AruidIndexMax> data{};
|
||||||
|
s32 ref_counter{};
|
||||||
|
|
||||||
Core::System& system;
|
Core::System& system;
|
||||||
};
|
};
|
||||||
|
|
|
@ -20,6 +20,9 @@ constexpr Result InvalidNpadId{ErrorModule::HID, 709};
|
||||||
constexpr Result NpadNotConnected{ErrorModule::HID, 710};
|
constexpr Result NpadNotConnected{ErrorModule::HID, 710};
|
||||||
constexpr Result InvalidArraySize{ErrorModule::HID, 715};
|
constexpr Result InvalidArraySize{ErrorModule::HID, 715};
|
||||||
|
|
||||||
|
constexpr Result ResultAppletResourceOverflow{ErrorModule::HID, 1041};
|
||||||
|
constexpr Result ResultAppletResourceNotInitialized{ErrorModule::HID, 1042};
|
||||||
|
constexpr Result ResultSharedMemoryNotInitialized{ErrorModule::HID, 1043};
|
||||||
constexpr Result ResultAruidNoAvailableEntries{ErrorModule::HID, 1044};
|
constexpr Result ResultAruidNoAvailableEntries{ErrorModule::HID, 1044};
|
||||||
constexpr Result ResultAruidAlreadyRegistered{ErrorModule::HID, 1046};
|
constexpr Result ResultAruidAlreadyRegistered{ErrorModule::HID, 1046};
|
||||||
constexpr Result ResultAruidNotRegistered{ErrorModule::HID, 1047};
|
constexpr Result ResultAruidNotRegistered{ErrorModule::HID, 1047};
|
||||||
|
|
|
@ -222,16 +222,14 @@ void IHidServer::CreateAppletResource(HLERequestContext& ctx) {
|
||||||
IPC::RequestParser rp{ctx};
|
IPC::RequestParser rp{ctx};
|
||||||
const auto applet_resource_user_id{rp.Pop<u64>()};
|
const auto applet_resource_user_id{rp.Pop<u64>()};
|
||||||
|
|
||||||
LOG_DEBUG(Service_HID, "called, applet_resource_user_id={}", applet_resource_user_id);
|
|
||||||
|
|
||||||
Result result = GetResourceManager()->CreateAppletResource(applet_resource_user_id);
|
Result result = GetResourceManager()->CreateAppletResource(applet_resource_user_id);
|
||||||
if (result.IsSuccess()) {
|
|
||||||
result = GetResourceManager()->GetNpad()->Activate(applet_resource_user_id);
|
LOG_DEBUG(Service_HID, "called, applet_resource_user_id={}, result=0x{:X}",
|
||||||
}
|
applet_resource_user_id, result.raw);
|
||||||
|
|
||||||
IPC::ResponseBuilder rb{ctx, 2, 0, 1};
|
IPC::ResponseBuilder rb{ctx, 2, 0, 1};
|
||||||
rb.Push(result);
|
rb.Push(result);
|
||||||
rb.PushIpcInterface<IAppletResource>(system, resource_manager);
|
rb.PushIpcInterface<IAppletResource>(system, resource_manager, applet_resource_user_id);
|
||||||
}
|
}
|
||||||
|
|
||||||
void IHidServer::ActivateDebugPad(HLERequestContext& ctx) {
|
void IHidServer::ActivateDebugPad(HLERequestContext& ctx) {
|
||||||
|
|
|
@ -146,10 +146,36 @@ std::shared_ptr<UniquePad> ResourceManager::GetUniquePad() const {
|
||||||
}
|
}
|
||||||
|
|
||||||
Result ResourceManager::CreateAppletResource(u64 aruid) {
|
Result ResourceManager::CreateAppletResource(u64 aruid) {
|
||||||
|
if (aruid == 0) {
|
||||||
|
const auto result = RegisterCoreAppletResource();
|
||||||
|
if (result.IsError()) {
|
||||||
|
return result;
|
||||||
|
}
|
||||||
|
return GetNpad()->Activate();
|
||||||
|
}
|
||||||
|
|
||||||
|
const auto result = CreateAppletResourceImpl(aruid);
|
||||||
|
if (result.IsError()) {
|
||||||
|
return result;
|
||||||
|
}
|
||||||
|
return GetNpad()->Activate(aruid);
|
||||||
|
}
|
||||||
|
|
||||||
|
Result ResourceManager::CreateAppletResourceImpl(u64 aruid) {
|
||||||
std::scoped_lock lock{shared_mutex};
|
std::scoped_lock lock{shared_mutex};
|
||||||
return applet_resource->CreateAppletResource(aruid);
|
return applet_resource->CreateAppletResource(aruid);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Result ResourceManager::RegisterCoreAppletResource() {
|
||||||
|
std::scoped_lock lock{shared_mutex};
|
||||||
|
return applet_resource->RegisterCoreAppletResource();
|
||||||
|
}
|
||||||
|
|
||||||
|
Result ResourceManager::UnregisterCoreAppletResource() {
|
||||||
|
std::scoped_lock lock{shared_mutex};
|
||||||
|
return applet_resource->UnregisterCoreAppletResource();
|
||||||
|
}
|
||||||
|
|
||||||
Result ResourceManager::RegisterAppletResourceUserId(u64 aruid, bool bool_value) {
|
Result ResourceManager::RegisterAppletResourceUserId(u64 aruid, bool bool_value) {
|
||||||
std::scoped_lock lock{shared_mutex};
|
std::scoped_lock lock{shared_mutex};
|
||||||
return applet_resource->RegisterAppletResourceUserId(aruid, bool_value);
|
return applet_resource->RegisterAppletResourceUserId(aruid, bool_value);
|
||||||
|
@ -165,6 +191,11 @@ Result ResourceManager::GetSharedMemoryHandle(Kernel::KSharedMemory** out_handle
|
||||||
return applet_resource->GetSharedMemoryHandle(out_handle, aruid);
|
return applet_resource->GetSharedMemoryHandle(out_handle, aruid);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void ResourceManager::FreeAppletResourceId(u64 aruid) {
|
||||||
|
std::scoped_lock lock{shared_mutex};
|
||||||
|
applet_resource->FreeAppletResourceId(aruid);
|
||||||
|
}
|
||||||
|
|
||||||
void ResourceManager::EnableInput(u64 aruid, bool is_enabled) {
|
void ResourceManager::EnableInput(u64 aruid, bool is_enabled) {
|
||||||
std::scoped_lock lock{shared_mutex};
|
std::scoped_lock lock{shared_mutex};
|
||||||
applet_resource->EnableInput(aruid, is_enabled);
|
applet_resource->EnableInput(aruid, is_enabled);
|
||||||
|
@ -219,8 +250,10 @@ void ResourceManager::UpdateMotion(std::uintptr_t user_data, std::chrono::nanose
|
||||||
console_six_axis->OnUpdate(core_timing);
|
console_six_axis->OnUpdate(core_timing);
|
||||||
}
|
}
|
||||||
|
|
||||||
IAppletResource::IAppletResource(Core::System& system_, std::shared_ptr<ResourceManager> resource)
|
IAppletResource::IAppletResource(Core::System& system_, std::shared_ptr<ResourceManager> resource,
|
||||||
: ServiceFramework{system_, "IAppletResource"}, resource_manager{resource} {
|
u64 applet_resource_user_id)
|
||||||
|
: ServiceFramework{system_, "IAppletResource"}, aruid{applet_resource_user_id},
|
||||||
|
resource_manager{resource} {
|
||||||
static const FunctionInfo functions[] = {
|
static const FunctionInfo functions[] = {
|
||||||
{0, &IAppletResource::GetSharedMemoryHandle, "GetSharedMemoryHandle"},
|
{0, &IAppletResource::GetSharedMemoryHandle, "GetSharedMemoryHandle"},
|
||||||
};
|
};
|
||||||
|
@ -274,14 +307,14 @@ IAppletResource::~IAppletResource() {
|
||||||
system.CoreTiming().UnscheduleEvent(default_update_event, 0);
|
system.CoreTiming().UnscheduleEvent(default_update_event, 0);
|
||||||
system.CoreTiming().UnscheduleEvent(mouse_keyboard_update_event, 0);
|
system.CoreTiming().UnscheduleEvent(mouse_keyboard_update_event, 0);
|
||||||
system.CoreTiming().UnscheduleEvent(motion_update_event, 0);
|
system.CoreTiming().UnscheduleEvent(motion_update_event, 0);
|
||||||
|
resource_manager->FreeAppletResourceId(aruid);
|
||||||
}
|
}
|
||||||
|
|
||||||
void IAppletResource::GetSharedMemoryHandle(HLERequestContext& ctx) {
|
void IAppletResource::GetSharedMemoryHandle(HLERequestContext& ctx) {
|
||||||
LOG_DEBUG(Service_HID, "called");
|
|
||||||
|
|
||||||
Kernel::KSharedMemory* handle;
|
Kernel::KSharedMemory* handle;
|
||||||
const u64 applet_resource_user_id = resource_manager->GetAppletResource()->GetActiveAruid();
|
const auto result = resource_manager->GetSharedMemoryHandle(&handle, aruid);
|
||||||
const auto result = resource_manager->GetSharedMemoryHandle(&handle, applet_resource_user_id);
|
|
||||||
|
LOG_DEBUG(Service_HID, "called, applet_resource_user_id={}, result=0x{:X}", aruid, result.raw);
|
||||||
|
|
||||||
IPC::ResponseBuilder rb{ctx, 2, 1};
|
IPC::ResponseBuilder rb{ctx, 2, 1};
|
||||||
rb.Push(result);
|
rb.Push(result);
|
||||||
|
|
|
@ -66,10 +66,13 @@ public:
|
||||||
|
|
||||||
Result CreateAppletResource(u64 aruid);
|
Result CreateAppletResource(u64 aruid);
|
||||||
|
|
||||||
|
Result RegisterCoreAppletResource();
|
||||||
|
Result UnregisterCoreAppletResource();
|
||||||
Result RegisterAppletResourceUserId(u64 aruid, bool bool_value);
|
Result RegisterAppletResourceUserId(u64 aruid, bool bool_value);
|
||||||
void UnregisterAppletResourceUserId(u64 aruid);
|
void UnregisterAppletResourceUserId(u64 aruid);
|
||||||
|
|
||||||
Result GetSharedMemoryHandle(Kernel::KSharedMemory** out_handle, u64 aruid);
|
Result GetSharedMemoryHandle(Kernel::KSharedMemory** out_handle, u64 aruid);
|
||||||
|
void FreeAppletResourceId(u64 aruid);
|
||||||
|
|
||||||
void EnableInput(u64 aruid, bool is_enabled);
|
void EnableInput(u64 aruid, bool is_enabled);
|
||||||
void EnableSixAxisSensor(u64 aruid, bool is_enabled);
|
void EnableSixAxisSensor(u64 aruid, bool is_enabled);
|
||||||
|
@ -82,6 +85,8 @@ public:
|
||||||
void UpdateMotion(std::uintptr_t user_data, std::chrono::nanoseconds ns_late);
|
void UpdateMotion(std::uintptr_t user_data, std::chrono::nanoseconds ns_late);
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
Result CreateAppletResourceImpl(u64 aruid);
|
||||||
|
|
||||||
bool is_initialized{false};
|
bool is_initialized{false};
|
||||||
|
|
||||||
mutable std::mutex shared_mutex;
|
mutable std::mutex shared_mutex;
|
||||||
|
@ -121,7 +126,8 @@ private:
|
||||||
|
|
||||||
class IAppletResource final : public ServiceFramework<IAppletResource> {
|
class IAppletResource final : public ServiceFramework<IAppletResource> {
|
||||||
public:
|
public:
|
||||||
explicit IAppletResource(Core::System& system_, std::shared_ptr<ResourceManager> resource);
|
explicit IAppletResource(Core::System& system_, std::shared_ptr<ResourceManager> resource,
|
||||||
|
u64 applet_resource_user_id);
|
||||||
~IAppletResource() override;
|
~IAppletResource() override;
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
@ -132,6 +138,7 @@ private:
|
||||||
std::shared_ptr<Core::Timing::EventType> mouse_keyboard_update_event;
|
std::shared_ptr<Core::Timing::EventType> mouse_keyboard_update_event;
|
||||||
std::shared_ptr<Core::Timing::EventType> motion_update_event;
|
std::shared_ptr<Core::Timing::EventType> motion_update_event;
|
||||||
|
|
||||||
|
u64 aruid;
|
||||||
std::shared_ptr<ResourceManager> resource_manager;
|
std::shared_ptr<ResourceManager> resource_manager;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue