public override void HandleMessage(Message msg)
{
SolidObjectPayload payload = JsonUtility.FromJson <SolidObjectPayload>(msg.payload);
InitParameters(msg.payload);
side = payload.side;
float t = Mathf.InverseLerp(0, maxPenetration, penetration) * growthFactor;
// Offset
// Alwways stimulate wrist
int widthWrist = (int)Mathf.Lerp(
offsetWrist,
maxWidthWrist,
t);
ArmStimulation.StimulateArm(
Part.Wrist,
side,
widthWrist,
currentWrist
);
float angle = Vector3.Angle(payload.cameraDirection, payload.handPosition);
if (Mathf.Abs(Mathf.Sin(angle * Mathf.PI / 180)) > .5f)
{
// close to orthogonal => pushing sideways
// Shoulder
int widthShoulder = (int)Mathf.Lerp(
offsetShoulder,
maxWidthShoulder,
t);
ArmStimulation.StimulateArm(
Part.Shoulder,
side,
widthShoulder,
currentShoulder
);
}
else
{
// pushing from the "front"
// Biceps
int widthBiceps = (int)Mathf.Lerp(
offsetBiceps,
maxWidthBiceps,
t);
ArmStimulation.StimulateArm(
Part.Biceps,
side,
widthBiceps,
currentBiceps
);
}
}
public override void HandleMessage(Message msg)
{
SolidObjectPayload payload = JsonUtility.FromJson <SolidObjectPayload>(msg.payload);
InitParameters(msg.payload);
side = payload.side;
// higher cos => more aligned
float rightCos = Mathf.Cos(
Vector3.Angle(
payload.cameraDirections[0],
payload.handDirection)
* Mathf.PI / 180)
;
float upCos = Mathf.Cos(
Vector3.Angle(
payload.cameraDirections[1],
payload.handDirection)
* Mathf.PI / 180)
;
float frontCos = Mathf.Cos(
Vector3.Angle(
payload.cameraDirections[1],
payload.handDirection)
* Mathf.PI / 180)
;
float max = Mathf.Max(
Mathf.Abs(rightCos),
Mathf.Abs(upCos),
Mathf.Abs(frontCos)
);
// Check relative direction
bool useWrist = false;
bool useBiceps = false;
bool useShoulder = false;
if (max == Mathf.Abs(rightCos))
{
// From the side
useWrist = true;
useShoulder = true;
}
else if (max == Mathf.Abs(upCos))
{
// Top or bottom
useWrist = true;
useBiceps = upCos > 0;
}
else
{
// Front or back
useWrist = true;
useBiceps = frontCos > 0;
}
// Apply stimulation
float t = Mathf.InverseLerp(0, maxPenetration, penetration) * growthFactor;
// Wrist
if (useWrist)
{
// Alwways stimulate wrist
int widthWrist = (int)Mathf.Lerp(
offsetWrist,
maxWidthWrist,
t);
if (penetration <= 0)
{
widthWrist = 0;
}
ArmStimulation.StimulateArm(
Part.Wrist,
side,
widthWrist,
currentWrist
);
}
// Biceps
if (useBiceps)
{
int widthBiceps = (int)Mathf.Lerp(
offsetBiceps,
maxWidthBiceps,
t);
if (penetration <= 0)
{
widthBiceps = 0;
}
ArmStimulation.StimulateArm(
Part.Biceps,
side,
widthBiceps,
currentBiceps
);
}
// Shoulder
if (useShoulder)
{
// Shoulder
int widthShoulder = (int)Mathf.Lerp(
offsetShoulder,
maxWidthShoulder,
t);
if (penetration <= 0)
{
widthShoulder = 0;
}
ArmStimulation.StimulateArm(
Part.Shoulder,
side,
widthShoulder,
currentShoulder
);
}
}
