private static void GetCheckRay(MotionDirection side, CharacterMotorConfig config, Transform toMove, Vector3[] output, float index, float distance)
{
Vector3 sideDir = MotionUtil.ToVector(side);
Vector3 origin = toMove.position;
Vector3 direction = Vector3.zero;
GetCheckValue(ref origin, ref direction, sideDir.x, config, index, Vector3.right, Vector3.up, distance);
GetCheckValue(ref origin, ref direction, sideDir.y, config, index, Vector3.up, Vector3.right, distance);
output[0] = origin;
output[1] = origin + direction;
}
private static Vector2 getForcesDirection(CharacterMotorState state)
{
var node = state.forces.First;
var direction = Vector2.zero;
while (node != null)
{
direction = direction + (MotionUtil.ToVector(node.Value.direction) * node.Value.factor);
node = node.Next;
}
return(direction);
}
public static void Update(Transform toMove, CharacterMotorState state, CharacterMotorConfig config)
{
if (!state.isEnabled)
{
return;
}
Vector3 dir = getForcesDirection(state);
dir = dir * Time.deltaTime;
state.wasBlocked[MotionDirection.Up] = state.blocked[MotionDirection.Up];
state.wasBlocked[MotionDirection.Down] = state.blocked[MotionDirection.Down];
state.wasBlocked[MotionDirection.Left] = state.blocked[MotionDirection.Left];
state.wasBlocked[MotionDirection.Right] = state.blocked[MotionDirection.Right];
foreach (MotionDirection side in SIDES)
{
state.blocked[side] = false;
Vector3 sideDir = MotionUtil.ToVector(side);
var isMovingInSideXDir = Math.Sign(dir.x) == Math.Sign(sideDir.x);
var isMovingInSideYDir = Math.Sign(dir.y) == Math.Sign(sideDir.y);
if (!isMovingInSideXDir && !isMovingInSideYDir)
{
continue;
}
for (int i = 0; i < config.sideCheckCount; i++)
{
GetCheckRay(side, config, toMove, RAY_BUFFER, i, dir.magnitude);
Vector3 direction = (RAY_BUFFER[1] - RAY_BUFFER[0]);
float distance = GetBlockDistance(RAY_BUFFER[0], direction, config.layer);
if (distance < float.MaxValue)
{
float canMove = Mathf.Max(0, distance - .01f);
state.blocked[side] = true;
dir.x = isMovingInSideXDir ? Mathf.Sign(dir.x) * Mathf.Min(canMove, Mathf.Abs(dir.x)) : dir.x;
dir.y = isMovingInSideYDir ? Mathf.Sign(dir.y) * Mathf.Min(canMove, Mathf.Abs(dir.y)) : dir.y;
break;
}
}
}
state.lastMotion = dir;
toMove.position = toMove.position + dir;
}