public float GetCustomPinchDistance(Hand h)
{
Vector3 c0, c1;
var pinchDistance = PinchSegment2SegmentDisplacement(h, out c0, out c1).magnitude;
pinchDistance -= 0.01f;
pinchDistance = pinchDistance.Clamped01();
// if (Input.GetKeyDown(KeyCode.C)) {
// Debug.Log(pinchDistance);
// }
if (drawDebugPinchDistance)
{
DebugPing.Line("RH pinch", c0, c1, LeapColor.blue);
DebugPing.Label("RH pinch",
labelText: pinchDistance.ToString("F3"),
labeledPosition: ((c1 + c0) / 2f),
color: LeapColor.blue);
}
return(pinchDistance);
}
private void Update()
{
// Current facing.
var curFacing = this.transform.forward.xz();
// Movement input.
float moveVecMag;
var moveVec = getInputMovementVector(out moveVecMag);
var moveVecDir = (moveVecMag > 0.01f ? moveVec / moveVecMag : curFacing);
var isMovingIntended = moveVecMag > 0.01f;
if (cameraTransform != null && isMovingIntended)
{
var camXZToPlayer
= this.transform.position.ProjectedOnPlane(this.transform.up)
- cameraTransform.position.ProjectedOnPlane(this.transform.up);
var camXZAngle = Vector3.SignedAngle(camXZToPlayer, Vector3.forward, Vector3.up);
var camRotation = Quaternion.AngleAxis(-camXZAngle, Vector3.up);
moveVec = (camRotation * moveVec.AsXZ()).xz();
moveVecDir = (camRotation * moveVecDir.AsXZ()).xz();
}
if (drawDebug)
{
DebugPing.Line("moveVec", this.transform.position,
this.transform.position + moveVec.AsXZ(), LeapColor.red);
}
// Movement.
if (!_lastPosMem.HasValue)
{
_lastPosMem = this.transform.position;
}
var curVelXZ = ((this.transform.position - _lastPosMem.Value) / Time.deltaTime).xz();
if (isMovingIntended)
{
curVelXZ = curVelXZ.RotatedTowards(moveVecDir, turnSpeed * Time.deltaTime);
curVelXZ += speed * moveVec * Time.deltaTime;
}
curVelXZ *= 1 - (movementDecay * Time.deltaTime).Clamped01();
_lastPosMem = this.transform.position;
this.transform.position += curVelXZ.AsXZ() * Time.deltaTime;
var curSpdXZ = curVelXZ.magnitude;
// Facing.
var facingIntent = _lastFacingIntentMem.ValueOr(moveVecDir);
if (isMovingIntended)
{
var facingErrAngle
= Vector3.SignedAngle(curFacing.AsXZ(), moveVecDir.AsXZ(), Vector3.up);
if (facingErrAngle.Abs() > 179.1f)
{
curFacing = (Quaternion.AngleAxis(1f, Vector3.up) * curFacing.AsXZ()).xz();
}
facingIntent = moveVecDir;
_lastFacingIntentMem = moveVecDir;
}
curFacing = curFacing.SlerpedTo(facingIntent, turnSpeed * Time.deltaTime);
this.transform.SetForward(curFacing.AsXZ());
// Animation.
if (curSpdXZ > 0.5f)
{
poser.curPoseIdx = poseIdx_dash;
}
else
{
poser.curPoseIdx = poseIdx_stand;
}
}
