unity路径跟随的算法

using UnityEngine;
using System.Collections;

public class EnemyMove : MonoBehaviour
{

public Transform[] EnemyMovePoints;

private float speed = 0.5f;
private float mass = 1.0f;
public bool isLoop = true;
private float Radius = 10.0f;

private float curSpeed;
private int curPointIndex;
private int pointsLenth;
private Vector3 targetPoint;
private Vector3 velocity;
private Vector3[] points;

public float Length
{

get { return points.Length; }
}

// Use this for initialization
void Start()
{
points = new Vector3[EnemyMovePoints.Length];
for (int i = 0; i < EnemyMovePoints.Length; i++)
{
points[i] = EnemyMovePoints[i].position;
}

pointsLenth = points.Length;
curPointIndex = 0;
velocity = transform.forward;
}

// Update is called once per frame
void Update()
{
curSpeed = speed + Time.deltaTime;

targetPoint = GetPoints(curPointIndex);

if (Vector3.Distance(transform.position, targetPoint) <= Radius)
{
if (curPointIndex <= pointsLenth - 1)
curPointIndex++;
else return;
}

if (curPointIndex >= pointsLenth)
{
}
else
{
if (curPointIndex == pointsLenth)
{
velocity += Steer(targetPoint, true);
}
else
velocity += Steer(targetPoint);

transform.position += velocity;
transform.rotation = Quaternion.LookRotation(velocity);
}

}

public Vector3 GetPoints(int index)
{
return points[index];
}

public Vector3 Steer(Vector3 target, bool isFinalPoint = false)
{
Vector3 desiredVelocity = (target - transform.position);
float dist = desiredVelocity.sqrMagnitude;

desiredVelocity.Normalize();

if (isFinalPoint && dist < 10.0f) desiredVelocity *= (curSpeed * (dist / 10.0f));
else desiredVelocity *= curSpeed;

Vector3 steeringForce = desiredVelocity - velocity;
Vector3 acceleration = steeringForce / mass;

return acceleration;
}

}