106 lines
3.5 KiB
C#
106 lines
3.5 KiB
C#
using System;
|
|
using Unity.Collections;
|
|
using System.Runtime.InteropServices;
|
|
using Unity.Collections.LowLevel.Unsafe;
|
|
|
|
namespace UnityEngine.U2D
|
|
{
|
|
/// <summary>
|
|
/// Utility functions for Spline.
|
|
/// </summary>
|
|
public class SplineUtility
|
|
{
|
|
/// <summary>
|
|
/// Calculate angle between direction vectors.
|
|
/// </summary>
|
|
/// <param name="start">Start Vector</param>
|
|
/// <param name="end">End Vector</param>
|
|
/// <returns>Angle</returns>
|
|
public static float SlopeAngle(Vector2 start, Vector2 end)
|
|
{
|
|
Vector2 dir = start - end;
|
|
dir.Normalize();
|
|
Vector2 dvup = new Vector2(0, 1f);
|
|
Vector2 dvrt = new Vector2(1f, 0);
|
|
|
|
float dr = Vector2.Dot(dir, dvrt);
|
|
float du = Vector2.Dot(dir, dvup);
|
|
float cu = Mathf.Acos(du);
|
|
float sn = dr >= 0 ? 1.0f : -1.0f;
|
|
float an = cu * Mathf.Rad2Deg * sn;
|
|
|
|
// Adjust angles when direction is parallel to Up Axis.
|
|
an = (du != 1f) ? an : 0;
|
|
an = (du != -1f) ? an : -180f;
|
|
return an;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Calculate Left and Right Tangents for the given Control Point.
|
|
/// </summary>
|
|
/// <param name="point">Position of current point</param>
|
|
/// <param name="prevPoint">Position of previous point.</param>
|
|
/// <param name="nextPoint">Position of next point.</param>
|
|
/// <param name="forward">Forward vector.</param>
|
|
/// <param name="scale">Scale.</param>
|
|
/// <param name="rightTangent">Right Tangent (out Value)</param>
|
|
/// <param name="leftTangent">Left Tangent (out Value)</param>
|
|
public static void CalculateTangents(Vector3 point, Vector3 prevPoint, Vector3 nextPoint, Vector3 forward, float scale, out Vector3 rightTangent, out Vector3 leftTangent)
|
|
{
|
|
Vector3 v1 = (prevPoint - point).normalized;
|
|
Vector3 v2 = (nextPoint - point).normalized;
|
|
Vector3 v3 = v1 + v2;
|
|
Vector3 cross = forward;
|
|
|
|
if (prevPoint != nextPoint)
|
|
{
|
|
bool colinear = Mathf.Abs(v1.x * v2.y - v1.y * v2.x + v1.x * v2.z - v1.z * v2.x + v1.y * v2.z - v1.z * v2.y) < 0.01f;
|
|
|
|
if (colinear)
|
|
{
|
|
rightTangent = v2 * scale;
|
|
leftTangent = v1 * scale;
|
|
return;
|
|
}
|
|
|
|
cross = Vector3.Cross(v1, v2);
|
|
}
|
|
|
|
rightTangent = Vector3.Cross(cross, v3).normalized * scale;
|
|
leftTangent = -rightTangent;
|
|
}
|
|
|
|
public static int NextIndex(int index, int pointCount)
|
|
{
|
|
return Mod(index + 1, pointCount);
|
|
}
|
|
|
|
public static int PreviousIndex(int index, int pointCount)
|
|
{
|
|
return Mod(index - 1, pointCount);
|
|
}
|
|
|
|
private static int Mod(int x, int m)
|
|
{
|
|
int r = x % m;
|
|
return r < 0 ? r + m : r;
|
|
}
|
|
}
|
|
|
|
// Copy utility.
|
|
internal class SpriteShapeCopyUtility<T> where T : struct
|
|
{
|
|
internal static void Copy(NativeSlice<T> dst, T[] src, int length)
|
|
{
|
|
NativeSlice<T> dstSet = new NativeSlice<T>(dst, 0, length);
|
|
dstSet.CopyFrom(src);
|
|
}
|
|
|
|
internal static void Copy(T[] dst, NativeSlice<T> src, int length)
|
|
{
|
|
NativeSlice<T> dstSet = new NativeSlice<T>(src, 0, length);
|
|
dstSet.CopyTo(dst);
|
|
}
|
|
}
|
|
}
|