585 lines
20 KiB
C++
585 lines
20 KiB
C++
/**
|
|
* @file
|
|
*
|
|
* @author Mamadou Babaei <mamadou@senseglove.com>
|
|
*
|
|
* @section LICENSE
|
|
*
|
|
* (The MIT License)
|
|
*
|
|
* Copyright (c) 2020 - 2024 NovaGlove
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in all
|
|
* copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
* SOFTWARE.
|
|
*
|
|
* @section DESCRIPTION
|
|
*
|
|
*
|
|
*/
|
|
|
|
|
|
#include "SGCoreImpl/SGNovaGloveImpl.h"
|
|
|
|
#include <memory>
|
|
#include <vector>
|
|
|
|
#include "Containers/StringConv.h"
|
|
#include "Misc/AssertionMacros.h"
|
|
|
|
#include "SGBuildHacks/SGInclude_Core_BasicHandModel.h"
|
|
#include "SGBuildHacks/SGInclude_Core_CustomWaveform.h"
|
|
#include "SGBuildHacks/SGInclude_Core_HandInterpolator.h"
|
|
#include "SGBuildHacks/SGInclude_Core_HandPose.h"
|
|
#include "SGBuildHacks/SGInclude_Core_HapticGlove.h"
|
|
#include "SGBuildHacks/SGInclude_Core_NovaGlove.h"
|
|
#include "SGBuildHacks/SGInclude_Core_NovaGloveInfo.h"
|
|
#include "SGBuildHacks/SGInclude_Core_NovaGloveSensorData.h"
|
|
#include "SGBuildHacks/SGInclude_Core_Quat.h"
|
|
#include "SGBuildHacks/SGInclude_Core_SensorNormalization.h"
|
|
#include "SGBuildHacks/SGInclude_Core_ThresholdCommand.h"
|
|
#include "SGBuildHacks/SGInclude_Core_Vect3D.h"
|
|
#include "SGCoreImpl/SGBasicHandModelImpl.h"
|
|
#include "SGCoreImpl/SGCoreEnumCast.h"
|
|
#include "SGCoreImpl/SGCustomWaveformImpl.h"
|
|
#include "SGCoreImpl/SGHandInterpolatorImpl.h"
|
|
#include "SGCoreImpl/SGHandPoseImpl.h"
|
|
#include "SGCoreImpl/SGNovaGloveInfoImpl.h"
|
|
#include "SGCoreImpl/SGNovaGloveSensorDataImpl.h"
|
|
#include "SGCoreImpl/SGQuatImpl.h"
|
|
#include "SGCoreImpl/SGSensorNormalizationImpl.h"
|
|
#include "SGCoreImpl/SGThresholdCommandImpl.h"
|
|
#include "SGCoreImpl/SGVect3DImpl.h"
|
|
#include "SGUtils/SGArrayUtils.h"
|
|
|
|
struct FSGNovaGloveImpl::FImpl
|
|
{
|
|
/************************
|
|
* Owner object
|
|
************************/
|
|
|
|
FSGNovaGloveImpl* Owner;
|
|
|
|
/************************
|
|
* Constructor / Destructor
|
|
************************/
|
|
|
|
explicit FImpl(FSGNovaGloveImpl* InOwner);
|
|
~FImpl();
|
|
|
|
/************************
|
|
* Default copy constructor & copy assignment operator
|
|
************************/
|
|
|
|
FImpl(const FImpl& Rhs) = default;
|
|
FImpl& operator=(const FImpl& Rhs) = default;
|
|
};
|
|
|
|
TSharedRef<FSGDeviceImpl> FSGNovaGloveImpl::Parse(const FString& ConstantsString)
|
|
{
|
|
std::string ConstantsStdString{TCHAR_TO_UTF8(*ConstantsString)};
|
|
FSGDevicePtrType SGDevicePtr{FNovaGloveType::Parse(MoveTemp(ConstantsStdString))};
|
|
ensureAlwaysMsgf(SGDevicePtr, TEXT("Invalid SGDevice!"));
|
|
const TSharedRef<FSGNovaGloveImpl> NovaGloveImpl{MakeShared<FSGNovaGloveImpl>(
|
|
std::dynamic_pointer_cast<FNovaGloveType>(MoveTemp(SGDevicePtr)))};
|
|
return NovaGloveImpl;
|
|
}
|
|
|
|
TArray<FSGNovaGloveImpl> FSGNovaGloveImpl::GetNovaGloves()
|
|
{
|
|
const TArray<FSGNovaGloveImpl> Gloves{
|
|
FSGArrayUtils::FromStdVector<FNovaGloveType, FSGNovaGloveImpl>(FNovaGloveType::GetNovaGloves())
|
|
};
|
|
return Gloves;
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::GetNovaGlove(FSGNovaGloveImpl& OutGlove)
|
|
{
|
|
FNovaGloveType Glove;
|
|
const bool bResult = FNovaGloveType::GetNovaGlove(Glove);
|
|
OutGlove = FSGNovaGloveImpl{MoveTemp(Glove)};
|
|
return bResult;
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::GetNovaGlove(const bool bRightHanded, FSGNovaGloveImpl& OutGlove)
|
|
{
|
|
FNovaGloveType Glove;
|
|
const bool bResult = FNovaGloveType::GetNovaGlove(bRightHanded, Glove);
|
|
OutGlove = FSGNovaGloveImpl{MoveTemp(Glove)};
|
|
return bResult;
|
|
}
|
|
|
|
void FSGNovaGloveImpl::CalculateGloveLocation(
|
|
const FVector& ReferencePosition, const FQuat& ReferenceRotation,
|
|
const ESGPositionalTrackingHardware TrackingHardware, const bool bRightHanded,
|
|
FVector& OutGlovePosition, FQuat& OutGloveRotation)
|
|
{
|
|
FSGVect3DImpl::FVect3DType GlovePosition;
|
|
FSGQuatImpl::FQuatType GloveRotation;
|
|
|
|
FNovaGloveType::CalculateGloveLocation(
|
|
FSGUnits::CentimetersToMillimeters<FSGVect3DImpl::FVect3DType, FSGVect3DImpl>(ReferencePosition),
|
|
FSGQuatImpl{ReferenceRotation}.ToQuat(),
|
|
FSGCoreEnumCast::ToEPositionalTrackingHardware(TrackingHardware), bRightHanded,
|
|
GlovePosition, GloveRotation);
|
|
|
|
OutGlovePosition = FSGUnits::MillimetersToCentimeters<FSGVect3DImpl::FVect3DType, FSGVect3DImpl>(
|
|
MoveTemp(GlovePosition));;
|
|
OutGloveRotation = FSGQuatImpl{MoveTemp(GloveRotation)}.ToFQuat();
|
|
}
|
|
|
|
void FSGNovaGloveImpl::CalculateWristLocation(
|
|
const FVector& ReferencePosition, const FQuat& ReferenceRotation,
|
|
const ESGPositionalTrackingHardware TrackingHardware, const bool bRightHanded,
|
|
FVector& OutWristPosition, FQuat& OutWristRotation)
|
|
{
|
|
FSGVect3DImpl::FVect3DType WristPosition;
|
|
FSGQuatImpl::FQuatType WristRotation;
|
|
|
|
FNovaGloveType::CalculateWristLocation(
|
|
FSGUnits::CentimetersToMillimeters<FSGVect3DImpl::FVect3DType, FSGVect3DImpl>(ReferencePosition),
|
|
FSGQuatImpl{ReferenceRotation}.ToQuat(),
|
|
FSGCoreEnumCast::ToEPositionalTrackingHardware(TrackingHardware), bRightHanded,
|
|
WristPosition, WristRotation);
|
|
|
|
OutWristPosition = FSGUnits::MillimetersToCentimeters<FSGVect3DImpl::FVect3DType, FSGVect3DImpl>(
|
|
MoveTemp(WristPosition));
|
|
OutWristRotation = FSGQuatImpl{MoveTemp(WristRotation)}.ToFQuat();
|
|
}
|
|
|
|
ANSICHAR FSGNovaGloveImpl::GetHapticsByte()
|
|
{
|
|
static const ANSICHAR Byte = FNovaGloveType::GetHapticsByte();
|
|
return Byte;
|
|
}
|
|
|
|
ANSICHAR FSGNovaGloveImpl::GetThresholdsByte()
|
|
{
|
|
static const ANSICHAR Byte = FNovaGloveType::GetThresholdsByte();
|
|
return Byte;
|
|
}
|
|
|
|
ANSICHAR FSGNovaGloveImpl::GetIgnoreThresholdsByte()
|
|
{
|
|
static const ANSICHAR Byte = FNovaGloveType::GetIgnoreThresholdsByte();
|
|
return Byte;
|
|
}
|
|
|
|
const TArray<float>& FSGNovaGloveImpl::GetNovaSensorRanges()
|
|
{
|
|
static const TArray<float> Ranges{FSGArrayUtils::FromStdVector(FNovaGloveType::GetNovaSensorRanges())};
|
|
return Ranges;
|
|
}
|
|
|
|
TArray<float> FSGNovaGloveImpl::ToNormalizedValues(const FSGNovaGloveSensorDataImpl& SensorData)
|
|
{
|
|
const TArray<float> NormalizedValues{
|
|
FSGArrayUtils::FromStdVector(
|
|
FNovaGloveType::ToNormalizedValues(SensorData.ToNovaGloveSensorData()))
|
|
};
|
|
return NormalizedValues;
|
|
}
|
|
|
|
TArray<float> FSGNovaGloveImpl::ToNormalizedValues(const FSGNovaGloveSensorDataImpl& SensorData,
|
|
FSGSensorNormalizationImpl& OutSensorNormalizer)
|
|
{
|
|
const TArray<float> NormalizedValues{
|
|
FSGArrayUtils::FromStdVector(
|
|
FNovaGloveType::ToNormalizedValues(SensorData.ToNovaGloveSensorData(),
|
|
OutSensorNormalizer.ToSensorNormalization()))
|
|
};
|
|
return NormalizedValues;
|
|
}
|
|
|
|
TArray<TArray<FVector>> FSGNovaGloveImpl::CalculateHandAngles(
|
|
const TArray<float>& NormalizedValues, const FSGHandInterpolatorImpl& Interpolator)
|
|
{
|
|
std::vector<float> NormalizedValuesVector{FSGArrayUtils::ToStdVector(NormalizedValues)};
|
|
|
|
const TArray<TArray<FVector>> Angles{
|
|
FSGArrayUtils::FromSenseGloveAngles<FSGVect3DImpl::FVect3DType>(
|
|
FNovaGloveType::CalculateHandAngles(MoveTemp(NormalizedValuesVector), Interpolator.ToHandInterpolator()))
|
|
};
|
|
|
|
return Angles;
|
|
}
|
|
|
|
FString FSGNovaGloveImpl::ToNovaCommandAsFlexion(const FSGThresholdCommandImpl& Thresholds)
|
|
{
|
|
const FString Flexion{
|
|
UTF8_TO_TCHAR(FNovaGloveType::ToNovaCommandAsFlexion(Thresholds.ToThresholdCommand()).c_str())
|
|
};
|
|
return Flexion;
|
|
}
|
|
|
|
FString FSGNovaGloveImpl::ToNovaCommandAsRaw(
|
|
const FSGThresholdCommandImpl& Thresholds, const FSGSensorNormalizationImpl& Interpolator)
|
|
{
|
|
const FString Raw{
|
|
UTF8_TO_TCHAR(FNovaGloveType::ToNovaCommandAsRaw(Thresholds.ToThresholdCommand(),
|
|
Interpolator.ToSensorNormalization()).c_str())
|
|
};
|
|
return Raw;
|
|
}
|
|
|
|
FSGNovaGloveImpl::FSGNovaGloveImpl()
|
|
: FSGHapticGloveImpl(),
|
|
Pimpl(TUniquePtr<FImpl, FImplDeleter>(new FImpl{this}, PimplDeleter))
|
|
{
|
|
}
|
|
|
|
FSGNovaGloveImpl::FSGNovaGloveImpl(const FSGNovaGloveInfoImpl& DeviceInfo)
|
|
: FSGHapticGloveImpl(FSGNovaGloveImpl(std::make_shared<FNovaGloveType>((DeviceInfo.ToNovaGloveInfo())))),
|
|
Pimpl(TUniquePtr<FImpl, FImplDeleter>(new FImpl{this}, PimplDeleter))
|
|
{
|
|
}
|
|
|
|
FSGNovaGloveImpl::FSGNovaGloveImpl(const FNovaGloveType NovaGlove)
|
|
: FSGHapticGloveImpl(std::make_shared<FNovaGloveType>(NovaGlove)),
|
|
Pimpl(TUniquePtr<FImpl, FImplDeleter>(new FImpl{this}, PimplDeleter))
|
|
{
|
|
}
|
|
|
|
FSGNovaGloveImpl::FSGNovaGloveImpl(const FNovaGlovePtrType NovaGlove)
|
|
: FSGHapticGloveImpl(NovaGlove),
|
|
Pimpl(TUniquePtr<FImpl, FImplDeleter>(new FImpl{this}, PimplDeleter))
|
|
{
|
|
}
|
|
|
|
FSGNovaGloveImpl::FSGNovaGloveImpl(const FSGNovaGloveImpl& Rhs)
|
|
: FSGHapticGloveImpl(Rhs),
|
|
Pimpl(TUniquePtr<FImpl, FImplDeleter>(new FImpl{*Rhs.Pimpl}, PimplDeleter))
|
|
{
|
|
Pimpl->Owner = this;
|
|
}
|
|
|
|
FSGNovaGloveImpl::FSGNovaGloveImpl(FSGNovaGloveImpl&& Rhs) SG_NOEXCEPT = default;
|
|
|
|
FSGNovaGloveImpl::~FSGNovaGloveImpl() = default;
|
|
|
|
FSGNovaGloveImpl& FSGNovaGloveImpl::operator=(const FSGNovaGloveImpl& Rhs)
|
|
{
|
|
FSGHapticGloveImpl::operator=(Rhs);
|
|
*Pimpl = *Rhs.Pimpl;
|
|
Pimpl->Owner = this;
|
|
return *this;
|
|
}
|
|
|
|
FSGNovaGloveImpl& FSGNovaGloveImpl::operator=(FSGNovaGloveImpl&& Rhs) SG_NOEXCEPT = default;
|
|
|
|
const FSGNovaGloveImpl::FNovaGloveType& FSGNovaGloveImpl::ToNovaGlove() const
|
|
{
|
|
return *ToNovaGlovePtrChecked();
|
|
}
|
|
|
|
FSGNovaGloveImpl::FNovaGlovePtrType FSGNovaGloveImpl::ToNovaGlovePtr() const
|
|
{
|
|
return std::dynamic_pointer_cast<FNovaGloveType>(ToSGDevicePtr());
|
|
}
|
|
|
|
FSGNovaGloveImpl::FNovaGlovePtrType FSGNovaGloveImpl::ToNovaGlovePtrChecked() const
|
|
{
|
|
FNovaGlovePtrType NovaGlove{std::dynamic_pointer_cast<FNovaGloveType>(ToSGDevicePtr())};
|
|
ensureAlwaysMsgf(NovaGlove.get(), TEXT("Invalid NovaGlove"));
|
|
return NovaGlove;
|
|
}
|
|
|
|
ESGDeviceType FSGNovaGloveImpl::GetDeviceType() const
|
|
{
|
|
return FSGCoreEnumCast::ToESGDeviceType(ToNovaGlovePtrChecked()->GetDeviceType());
|
|
}
|
|
|
|
FString FSGNovaGloveImpl::GetDeviceId() const
|
|
{
|
|
const FString Id{UTF8_TO_TCHAR(ToNovaGlovePtrChecked()->GetDeviceId().c_str())};
|
|
return Id;
|
|
}
|
|
|
|
FString FSGNovaGloveImpl::GetHardwareVersion() const
|
|
{
|
|
const FString Version{UTF8_TO_TCHAR(ToNovaGlovePtrChecked()->GetHardwareVersion().c_str())};
|
|
return Version;
|
|
}
|
|
|
|
int32 FSGNovaGloveImpl::GetFirmwareVersion() const
|
|
{
|
|
return ToNovaGlovePtrChecked()->GetFirmwareVersion();
|
|
}
|
|
|
|
int32 FSGNovaGloveImpl::GetSubFirmwareVersion() const
|
|
{
|
|
return ToNovaGlovePtrChecked()->GetSubFirmwareVersion();
|
|
}
|
|
|
|
void FSGNovaGloveImpl::SetDeviceIndex(const int32 NewIndex)
|
|
{
|
|
ToNovaGlovePtrChecked()->SetDeviceIndex(NewIndex);
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::HasBattery() const
|
|
{
|
|
return ToNovaGlovePtrChecked()->HasBattery();
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::IsCharging()
|
|
{
|
|
return ToNovaGlovePtrChecked()->IsCharging();
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::GetBatteryLevel(float& OutBatteryLevel)
|
|
{
|
|
return ToNovaGlovePtrChecked()->GetBatteryLevel(OutBatteryLevel);
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::IsRight() const
|
|
{
|
|
return ToNovaGlovePtrChecked()->IsRight();
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::GetImuRotation(FQuat& OutImu)
|
|
{
|
|
FSGQuatImpl::FQuatType Imu;
|
|
const bool bResult = ToNovaGlovePtrChecked()->GetImuRotation(Imu);
|
|
OutImu = FSGQuatImpl{MoveTemp(Imu)}.ToFQuat();
|
|
return bResult;
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::GetHandPose(const FSGBasicHandModelImpl& HandGeometry, FSGHandPoseImpl& OutHandPose) const
|
|
{
|
|
FSGHandPoseImpl::FHandPoseType HandPose;
|
|
const bool bResult = ToNovaGlovePtrChecked()->GetHandPose(HandGeometry.ToBasicHandModel(), HandPose);
|
|
OutHandPose = FSGHandPoseImpl{MoveTemp(HandPose)};
|
|
return bResult;
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::GetHandAngles(TArray<TArray<FVector>>& OutHandAngles) const
|
|
{
|
|
std::vector<std::vector<FSGVect3DImpl::FVect3DType>> HandAngles;
|
|
const bool bResult = ToNovaGlovePtrChecked()->GetHandAngles(HandAngles);
|
|
OutHandAngles = FSGArrayUtils::FromSenseGloveAngles<FSGVect3DImpl::FVect3DType>(MoveTemp(HandAngles));
|
|
return bResult;
|
|
}
|
|
|
|
ESGHapticGloveCalibrationState FSGNovaGloveImpl::GetCalibrationState() const
|
|
{
|
|
return FSGCoreEnumCast::ToESGHapticGloveCalibrationState(ToNovaGlovePtrChecked()->GetCalibrationState());
|
|
}
|
|
|
|
void FSGNovaGloveImpl::EndCalibration()
|
|
{
|
|
ToNovaGlovePtrChecked()->EndCalibration();
|
|
}
|
|
|
|
void FSGNovaGloveImpl::ResetCalibration()
|
|
{
|
|
ToNovaGlovePtrChecked()->ResetCalibration();
|
|
}
|
|
|
|
void FSGNovaGloveImpl::StopHaptics()
|
|
{
|
|
ToNovaGlovePtrChecked()->StopHaptics();
|
|
}
|
|
|
|
void FSGNovaGloveImpl::StopVibrations()
|
|
{
|
|
ToNovaGlovePtrChecked()->StopVibrations();
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::SendHaptics()
|
|
{
|
|
return ToNovaGlovePtrChecked()->SendHaptics();
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::SupportsCustomWaveform(const ESGHapticLocation AtLocation) const
|
|
{
|
|
return ToNovaGlovePtrChecked()->SupportsCustomWaveform(FSGCoreEnumCast::ToEHapticLocation(AtLocation));
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::SendCustomWaveform(FSGCustomWaveformImpl& OutWaveform, ESGHapticLocation Location)
|
|
{
|
|
return ToNovaGlovePtrChecked()->SendCustomWaveform(OutWaveform.ToCustomWaveform(),
|
|
FSGCoreEnumCast::ToEHapticLocation(Location));
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::QueueForceFeedbackLevels(const TArray<float>& Levels01)
|
|
{
|
|
std::vector<float> Levels01Vector{FSGArrayUtils::ToStdVector(Levels01)};
|
|
return ToNovaGlovePtrChecked()->QueueForceFeedbackLevels(MoveTemp(Levels01Vector));
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::QueueForceFeedbackLevel(const int32 Finger, const float Level01)
|
|
{
|
|
return ToNovaGlovePtrChecked()->QueueForceFeedbackLevel(Finger, Level01);
|
|
}
|
|
|
|
void FSGNovaGloveImpl::GetGloveLocation(const FVector& ReferencePosition, const FQuat& ReferenceRotation,
|
|
const ESGPositionalTrackingHardware TrackingHardware,
|
|
FVector& OutGlovePosition, FQuat& OutGloveRotation) const
|
|
{
|
|
FSGVect3DImpl::FVect3DType GlovePosition;
|
|
FSGQuatImpl::FQuatType GloveRotation;
|
|
|
|
ToNovaGlovePtrChecked()->GetGloveLocation(
|
|
FSGUnits::CentimetersToMillimeters<FSGVect3DImpl::FVect3DType, FSGVect3DImpl>(ReferencePosition),
|
|
FSGQuatImpl{ReferenceRotation}.ToQuat(),
|
|
FSGCoreEnumCast::ToEPositionalTrackingHardware(TrackingHardware),
|
|
GlovePosition, GloveRotation);
|
|
|
|
OutGlovePosition = FSGUnits::MillimetersToCentimeters<FSGVect3DImpl::FVect3DType, FSGVect3DImpl>(
|
|
MoveTemp(GlovePosition));
|
|
OutGloveRotation = FSGQuatImpl{MoveTemp(GloveRotation)}.ToFQuat();
|
|
}
|
|
|
|
void FSGNovaGloveImpl::GetWristLocation(const FVector& ReferencePosition, const FQuat& ReferenceRotation,
|
|
const ESGPositionalTrackingHardware TrackingHardware,
|
|
FVector& OutWristPosition, FQuat& OutWristRotation) const
|
|
{
|
|
FSGVect3DImpl::FVect3DType WristPosition;
|
|
FSGQuatImpl::FQuatType WristRotation;
|
|
|
|
ToNovaGlovePtrChecked()->GetWristLocation(
|
|
FSGUnits::CentimetersToMillimeters<FSGVect3DImpl::FVect3DType, FSGVect3DImpl>(ReferencePosition),
|
|
FSGQuatImpl{ReferenceRotation}.ToQuat(),
|
|
FSGCoreEnumCast::ToEPositionalTrackingHardware(TrackingHardware),
|
|
WristPosition, WristRotation);
|
|
|
|
OutWristPosition = FSGUnits::MillimetersToCentimeters<FSGVect3DImpl::FVect3DType, FSGVect3DImpl>(
|
|
MoveTemp(WristPosition));
|
|
OutWristRotation = FSGQuatImpl{MoveTemp(WristRotation)}.ToFQuat();
|
|
}
|
|
|
|
FSGNovaGloveInfoImpl FSGNovaGloveImpl::GetGloveInfo() const
|
|
{
|
|
const FSGNovaGloveInfoImpl GloveInfo{ToNovaGlovePtrChecked()->GetGloveInfo()};
|
|
return GloveInfo;
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::SupportsThresholds() const
|
|
{
|
|
return ToNovaGlovePtrChecked()->SupportsThresholds();
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::SupportsCustomWaveforms() const
|
|
{
|
|
return ToNovaGlovePtrChecked()->SupportsCustomWaveforms();
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::SupportsOnBoardNormalization() const
|
|
{
|
|
return ToNovaGlovePtrChecked()->SupportsOnBoardNormalization();
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::GetSensorData(FSGNovaGloveSensorDataImpl& OutSensorData) const
|
|
{
|
|
FSGNovaGloveSensorDataImpl::FNovaGloveSensorDataType SensorData;
|
|
const bool bResult = ToNovaGlovePtrChecked()->GetSensorData(SensorData);
|
|
OutSensorData = FSGNovaGloveSensorDataImpl{MoveTemp(SensorData)};
|
|
return bResult;
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::GetNormalizedInput(TArray<float>& OutNormalizedValues) const
|
|
{
|
|
std::vector<float> NormalizedValues;
|
|
const bool bResult = ToNovaGlovePtrChecked()->GetNormalizedInput(NormalizedValues);
|
|
OutNormalizedValues = FSGArrayUtils::FromStdVector(MoveTemp(NormalizedValues));
|
|
return bResult;
|
|
}
|
|
|
|
FString FSGNovaGloveImpl::ToNovaCommand(
|
|
const TArray<float>& ForceFeedbackLevels, const TArray<float>& BuzzLevels, const float WristLevel) const
|
|
{
|
|
std::vector<float> ForceFeedbackLevelsVector{FSGArrayUtils::ToStdVector(ForceFeedbackLevels)};
|
|
std::vector<float> BuzzLevelsVector{FSGArrayUtils::ToStdVector(BuzzLevels)};
|
|
const FString Command{
|
|
UTF8_TO_TCHAR(ToNovaGlovePtrChecked()->ToNovaCommand(
|
|
MoveTemp(ForceFeedbackLevelsVector), MoveTemp(BuzzLevelsVector), WristLevel).c_str())
|
|
};
|
|
return Command;
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::QueueVibroLevels(const TArray<float>& Amplitudes)
|
|
{
|
|
std::vector<float> AmplitudesVector{FSGArrayUtils::ToStdVector(Amplitudes)};
|
|
return ToNovaGlovePtrChecked()->QueueVibroLevels(MoveTemp(AmplitudesVector));
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::QueueVibroLevel(const ESGHapticLocation Location, const float Level01)
|
|
{
|
|
return ToNovaGlovePtrChecked()->QueueVibroLevel(FSGCoreEnumCast::ToEHapticLocation(Location), Level01);
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::QueueVibroLevel(const int32 Finger, const float Amplitude)
|
|
{
|
|
return ToNovaGlovePtrChecked()->QueueVibroLevel(Finger, Amplitude);
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::QueueWristLevel(const float Amplitude)
|
|
{
|
|
return ToNovaGlovePtrChecked()->QueueWristLevel(Amplitude);
|
|
}
|
|
|
|
ESGNovaVibroMotor FSGNovaGloveImpl::ToNovaMotor(const ESGHapticLocation Location) const
|
|
{
|
|
return FSGCoreEnumCast::ToESGNovaVibroMotor(
|
|
ToNovaGlovePtrChecked()->ToNovaMotor(FSGCoreEnumCast::ToEHapticLocation(Location)));
|
|
}
|
|
|
|
int32 FSGNovaGloveImpl::ChannelIndex(const ESGNovaVibroMotor Motor) const
|
|
{
|
|
return ToNovaGlovePtrChecked()->ChannelIndex(FSGCoreEnumCast::ToENovaVibroMotor(Motor));
|
|
}
|
|
|
|
void FSGNovaGloveImpl::ValidateWaveform(FSGCustomWaveformImpl& OutWaveform, const ESGNovaVibroMotor Motor) const
|
|
{
|
|
return ToNovaGlovePtrChecked()->ValidateWaveform(OutWaveform.ToCustomWaveform(),
|
|
FSGCoreEnumCast::ToENovaVibroMotor(Motor));
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::SendCustomWaveform_Nova(FSGCustomWaveformImpl& OutWaveform,
|
|
const ESGNovaVibroMotor Motor, const bool bValidateWaveform)
|
|
{
|
|
return ToNovaGlovePtrChecked()->SendCustomWaveform_Nova(
|
|
OutWaveform.ToCustomWaveform(), FSGCoreEnumCast::ToENovaVibroMotor(Motor), bValidateWaveform);
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::QueueThresholdCommand_Flexion(const int32 Finger, const float FlexionThreshold)
|
|
{
|
|
return ToNovaGlovePtrChecked()->QueueThresholdCommand_Flexion(Finger, FlexionThreshold);
|
|
}
|
|
|
|
bool FSGNovaGloveImpl::QueueClearThreshold(const int32 Finger)
|
|
{
|
|
return ToNovaGlovePtrChecked()->QueueClearThreshold(Finger);
|
|
}
|
|
|
|
FString FSGNovaGloveImpl::ToString() const
|
|
{
|
|
const FString String{UTF8_TO_TCHAR(ToNovaGlovePtrChecked()->ToString().c_str())};
|
|
return String;
|
|
}
|
|
|
|
FSGNovaGloveImpl::FImpl::FImpl(FSGNovaGloveImpl* InOwner)
|
|
: Owner(InOwner)
|
|
{
|
|
}
|
|
|
|
FSGNovaGloveImpl::FImpl::~FImpl() = default;
|
|
|
|
void FSGNovaGloveImpl::FImplDeleter::operator()(const FImpl* P) const
|
|
{
|
|
delete P;
|
|
} |