mirror of
https://github.com/cathery/sys-con.git
synced 2024-10-06 06:19:43 +00:00
169 lines
4.9 KiB
C++
169 lines
4.9 KiB
C++
#include "SwitchAbstractedPadHandler.h"
|
|
#include <cmath>
|
|
#include <array>
|
|
#include "../../source/log.h"
|
|
|
|
SwitchAbstractedPadHandler::SwitchAbstractedPadHandler(std::unique_ptr<IController> &&controller)
|
|
: SwitchVirtualGamepadHandler(std::move(controller))
|
|
{
|
|
}
|
|
|
|
SwitchAbstractedPadHandler::~SwitchAbstractedPadHandler()
|
|
{
|
|
Exit();
|
|
}
|
|
|
|
Result SwitchAbstractedPadHandler::Initialize()
|
|
{
|
|
Result rc = m_controllerHandler.Initialize();
|
|
if (R_FAILED(rc))
|
|
return rc;
|
|
|
|
hidScanInput();
|
|
HidControllerID lastOfflineID;
|
|
for (int i = 0; i != 8; ++i)
|
|
{
|
|
if (!hidIsControllerConnected(static_cast<HidControllerID>(i)))
|
|
{
|
|
lastOfflineID = static_cast<HidControllerID>(i);
|
|
break;
|
|
}
|
|
}
|
|
WriteToLog("Found last offline ID: ", lastOfflineID);
|
|
|
|
rc = InitAbstractedPadState();
|
|
if (R_FAILED(rc))
|
|
return rc;
|
|
|
|
svcSleepThread(1e+7L);
|
|
hidScanInput();
|
|
|
|
WriteToLog("Is last offline id connected? ", hidIsControllerConnected(lastOfflineID));
|
|
WriteToLog("Last offline id type: ", hidGetControllerType(lastOfflineID));
|
|
|
|
Result rc2 = hidInitializeVibrationDevices(&m_vibrationDeviceHandle, 1, lastOfflineID, hidGetControllerType(lastOfflineID));
|
|
if (R_SUCCEEDED(rc2))
|
|
{
|
|
WriteToLog("Initializing vibration device with handle ", m_vibrationDeviceHandle);
|
|
InitOutputThread();
|
|
}
|
|
else
|
|
WriteToLog("Failed to iniitalize vibration with error ", rc2);
|
|
|
|
InitInputThread();
|
|
return rc;
|
|
}
|
|
|
|
void SwitchAbstractedPadHandler::Exit()
|
|
{
|
|
ExitAbstractedPadState();
|
|
m_controllerHandler.Exit();
|
|
ExitInputThread();
|
|
ExitOutputThread();
|
|
}
|
|
|
|
//Used to give out unique ids to abstracted pads
|
|
static std::array<bool, 8> uniqueIDs{false};
|
|
|
|
static s8 getUniqueId()
|
|
{
|
|
for (s8 i = 0; i != 8; ++i)
|
|
{
|
|
if (uniqueIDs[i] == false)
|
|
{
|
|
uniqueIDs[i] = true;
|
|
return i;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void freeUniqueId(s8 id)
|
|
{
|
|
uniqueIDs[id] = false;
|
|
}
|
|
|
|
Result SwitchAbstractedPadHandler::InitAbstractedPadState()
|
|
{
|
|
Result rc;
|
|
m_state = {0};
|
|
m_abstractedPadID = getUniqueId();
|
|
m_state.type = BIT(0);
|
|
m_state.npadInterfaceType = NpadInterfaceType_USB;
|
|
m_state.flags = 0xff;
|
|
m_state.state.batteryCharge = 4;
|
|
m_state.singleColorBody = RGBA8_MAXALPHA(107, 107, 107);
|
|
m_state.singleColorButtons = RGBA8_MAXALPHA(0, 0, 0);
|
|
|
|
rc = hiddbgSetAutoPilotVirtualPadState(m_abstractedPadID, &m_state);
|
|
if (R_FAILED(rc))
|
|
return rc;
|
|
|
|
return rc;
|
|
}
|
|
|
|
Result SwitchAbstractedPadHandler::ExitAbstractedPadState()
|
|
{
|
|
freeUniqueId(m_abstractedPadID);
|
|
return hiddbgUnsetAutoPilotVirtualPadState(m_abstractedPadID);
|
|
}
|
|
|
|
void SwitchAbstractedPadHandler::FillAbstractedState(const NormalizedButtonData &data)
|
|
{
|
|
m_state.state.buttons = 0;
|
|
m_state.state.buttons |= (data.right_action ? KEY_A : 0);
|
|
m_state.state.buttons |= (data.bottom_action ? KEY_B : 0);
|
|
m_state.state.buttons |= (data.top_action ? KEY_X : 0);
|
|
m_state.state.buttons |= (data.left_action ? KEY_Y : 0);
|
|
|
|
m_state.state.buttons |= (data.left_stick_click ? KEY_LSTICK : 0);
|
|
m_state.state.buttons |= (data.right_stick_click ? KEY_RSTICK : 0);
|
|
|
|
m_state.state.buttons |= (data.left_bumper ? KEY_L : 0);
|
|
m_state.state.buttons |= (data.right_bumper ? KEY_R : 0);
|
|
|
|
m_state.state.buttons |= ((data.left_trigger > 0.0f) ? KEY_ZL : 0);
|
|
m_state.state.buttons |= ((data.right_trigger > 0.0f) ? KEY_ZR : 0);
|
|
|
|
m_state.state.buttons |= (data.start ? KEY_PLUS : 0);
|
|
m_state.state.buttons |= (data.back ? KEY_MINUS : 0);
|
|
|
|
m_state.state.buttons |= (data.dpad_left ? KEY_DLEFT : 0);
|
|
m_state.state.buttons |= (data.dpad_up ? KEY_DUP : 0);
|
|
m_state.state.buttons |= (data.dpad_right ? KEY_DRIGHT : 0);
|
|
m_state.state.buttons |= (data.dpad_down ? KEY_DDOWN : 0);
|
|
|
|
m_controllerHandler.ConvertAxisToSwitchAxis(data.left_stick_x, data.left_stick_y, 0, &m_state.state.joysticks[JOYSTICK_LEFT].dx, &m_state.state.joysticks[JOYSTICK_LEFT].dy);
|
|
m_controllerHandler.ConvertAxisToSwitchAxis(data.right_stick_x, data.right_stick_y, 0, &m_state.state.joysticks[JOYSTICK_RIGHT].dx, &m_state.state.joysticks[JOYSTICK_RIGHT].dy);
|
|
}
|
|
|
|
Result SwitchAbstractedPadHandler::UpdateAbstractedState()
|
|
{
|
|
return hiddbgSetAutoPilotVirtualPadState(m_abstractedPadID, &m_state);
|
|
}
|
|
|
|
void SwitchAbstractedPadHandler::UpdateInput()
|
|
{
|
|
Result rc;
|
|
rc = GetController()->GetInput();
|
|
if (R_FAILED(rc))
|
|
return;
|
|
|
|
FillAbstractedState(GetController()->GetNormalizedButtonData());
|
|
rc = UpdateAbstractedState();
|
|
if (R_FAILED(rc))
|
|
return;
|
|
}
|
|
|
|
void SwitchAbstractedPadHandler::UpdateOutput()
|
|
{
|
|
Result rc;
|
|
HidVibrationValue value;
|
|
rc = hidGetActualVibrationValue(&m_vibrationDeviceHandle, &value);
|
|
if (R_FAILED(rc))
|
|
return;
|
|
|
|
rc = GetController()->SetRumble(static_cast<uint8_t>(value.amp_high * 255.0f), static_cast<uint8_t>(value.amp_low * 255.0f));
|
|
|
|
svcSleepThread(1e+7L);
|
|
} |