1     /// 获取距离最近的路径点 <summary>
 2     /// 获取距离最近的路径点
 3     /// </summary>
 4     /// <param name="DPs">路径点集合</param>
 5     /// <param name="myPosition">当前坐标</param>
 6     /// <returns>返回最近距离的路标点</returns>
 7     private WaypointsModel GetClosestWP(List<WaypointsModel> all, Vector3 myPosition)
 8     {
 9         WaypointsModel tMin = null;
10         float minDist = Mathf.Infinity;//正无穷
11
12         for (int i = 0; i < all.Count; i++)
13         {
14             float dist = Vector3.Distance(all[i].Position, myPosition);
15             if (dist < minDist)
16             {
17                 tMin = all[i];
18                 minDist = dist;
19             }
20         }
21         return tMin;
22     }

 1     /// 重置赛车 <summary>
 2     /// 重置赛车
 3     /// </summary>
 4     private void RecoverCar()
 5     {
 6         //获取距离最近的路标点
 7         WaypointsModel ClosestWP = GetClosestWP(WaypointsModelAll, transform.position);
 8
 9         //置赛车位置
10         transform.position = ClosestWP.Position;
11
12         //置车头朝向
13         transform.rotation = Quaternion.LookRotation(ClosestWP.Rotation * Vector3.forward);
14
15         //移动速度归零
16         rigidbody.velocity = Vector3.zero;
17
18         //角速度归零
19         rigidbody.angularVelocity = Vector3.zero;
20     }

 1     /// 重置赛车 <summary>
 2     /// 重置赛车
 3     /// </summary>
 4     private void RecoverCar()
 5     {
 6         //获取距离最近的路标点
 7         WaypointsModel ClosestWP = GetClosestWP(WaypointsModelAll, transform.position);
 8
 9         //下个路标点索引
10         int nextIndex = ClosestWP.Index + 1;
11
12         //最近路标点
13         Vector3 nearestPoint;
14
15         //下一个复位点索引 小于 路标点数量 - 1
16         if (nextIndex < WaypointsModelAll.Count - 1)
17         {
18             //获取两个路标点间离赛车最近的点
19             nearestPoint = NearestPoint(
20                 ClosestWP.Position,
21                 WaypointsModelAll[nextIndex].Position,
22                 transform.position);
23         }
24         else
25         {
26             //最后一个点和起点之间时取最后一个点的位置
27             nearestPoint = WaypointsModelAll[WaypointsModelAll.Count - 1].Position;
28         }
29
30         transform.position = nearestPoint;
31         transform.rotation = Quaternion.LookRotation(ClosestWP.Rotation * Vector3.forward);
32         rigidbody.velocity = Vector3.zero;
33         rigidbody.angularVelocity = Vector3.zero;
34     }
35
36     /// 获取两点之间离赛车的最近点 <summary>
37     /// 获取两点之间离赛车的最近点
38     /// </summary>
39     /// <param name="lineStart">最近路标点</param>
40     /// <param name="lineEnd">下一个路标点</param>
41     /// <param name="point">赛车位置</param>
42     /// <returns></returns>
43     private Vector3 NearestPoint(Vector3 lineStart, Vector3 lineEnd, Vector3 point)
44     {
45         //线方向
46         Vector3 lineDirection = Vector3.Normalize(lineEnd - lineStart);
47
48         //最近点
49         float closestPoint = Vector3.Dot((point - lineStart), lineDirection);
50
51         //返回最近点
52         return lineStart + (closestPoint * lineDirection);
53     }