private Vector3 GetInterpPathV3() { float t = currentPercentage - pathWeight[pathWeight.Length - 1]; if (t >= pathWeight[currentStep]) { pathWeight[pathWeight.Length - 1] += pathWeight[currentStep]; t -= pathWeight[currentStep]; ++currentStep; } t /= pathWeight[currentStep]; switch (pathType) { case PathType.Linear: return(Vector3.Lerp(pathNodes[LimitRangeInt(currentStep, pathNodes.Length - 1)], pathNodes[LimitRangeInt(currentStep + 1, pathNodes.Length - 1)], t)); // 线性插值 case PathType.CatmullRom: return(TweenMath.CatmullRomPoint(pathNodes[LimitRangeInt(currentStep - 1, pathNodes.Length - 1)], pathNodes[LimitRangeInt(currentStep, pathNodes.Length - 1)], pathNodes[LimitRangeInt(currentStep + 1, pathNodes.Length - 1)], pathNodes[LimitRangeInt(currentStep + 2, pathNodes.Length - 1)], t)); default: return(Vector3.zero); } }
void OnDrawGizmos() //画线 { #if UNITY_EDITOR Handles.color = DebugColor; Matrix4x4 mtx = GetCurveMatrix(); Vector3 oldVector3 = Vector3.zero, nowVector3 = Vector3.zero; float part = 20; for (int i = 0; i < localNodes.Count; i++) { if (i != localNodes.Count - 1 || isClosedLoop) { oldVector3 = TweenMath.CatmullRomPoint(localNodes[LimitRangeInt(i - 1, localNodes.Count - 1)], localNodes[LimitRangeInt(i, localNodes.Count - 1)], localNodes[LimitRangeInt(i + 1, localNodes.Count - 1)], localNodes[LimitRangeInt(i + 2, localNodes.Count - 1)], 0); oldVector3 = mtx * ToVec4(oldVector3); for (int j = 1; j <= part; j++) { nowVector3 = TweenMath.CatmullRomPoint(localNodes[LimitRangeInt(i - 1, localNodes.Count - 1)], localNodes[LimitRangeInt(i, localNodes.Count - 1)], localNodes[LimitRangeInt(i + 1, localNodes.Count - 1)], localNodes[LimitRangeInt(i + 2, localNodes.Count - 1)], j / part); nowVector3 = mtx * ToVec4(nowVector3); Handles.DrawLine(oldVector3, nowVector3); oldVector3 = nowVector3; } } } #endif }
private void InitPathWeight() { currentStep = 0; if (pathType == PathType.CatmullRom) { float part = 20; pathWeight = new float[pathNodes.Length]; float sum = 0; Vector3 oldVector3 = Vector3.zero, nowVector3 = Vector3.zero; for (int i = 0; i < pathNodes.Length - 1; i++) { pathWeight[i] = 0; //此时保存长度 oldVector3 = TweenMath.CatmullRomPoint(pathNodes[LimitRangeInt(i - 1, pathNodes.Length - 1)], pathNodes[LimitRangeInt(i, pathNodes.Length - 1)], pathNodes[LimitRangeInt(i + 1, pathNodes.Length - 1)], pathNodes[LimitRangeInt(i + 2, pathNodes.Length - 1)], 0); for (int j = 1; j <= part; j++) { nowVector3 = TweenMath.CatmullRomPoint(pathNodes[LimitRangeInt(i - 1, pathNodes.Length - 1)], pathNodes[LimitRangeInt(i, pathNodes.Length - 1)], pathNodes[LimitRangeInt(i + 1, pathNodes.Length - 1)], pathNodes[LimitRangeInt(i + 2, pathNodes.Length - 1)], j / part); pathWeight[i] += Vector3.Distance(oldVector3, nowVector3); oldVector3 = nowVector3; } sum += pathWeight[i]; } for (int i = 0; i < pathWeight.Length - 1; i++) { pathWeight[i] = pathWeight[i] / sum; // 插值百分比 } pathWeight[pathWeight.Length - 1] = 0; //保存已插值完成的百分比 } if (pathType == PathType.Linear) { // 根据距离分配时间 pathWeight = new float[pathNodes.Length]; float sum = 0; for (int i = 0; i < pathNodes.Length - 1; i++) { pathWeight[i] = Vector3.Distance(pathNodes[i], pathNodes[i + 1]); sum += pathWeight[i]; } for (int i = 0; i < pathWeight.Length - 1; i++) { pathWeight[i] = pathWeight[i] / sum; // 插值百分比 } pathWeight[pathWeight.Length - 1] = 0; //已插值完成的百分比 } }