//可视化调试
 void OnDrawGizmos()
 {
     path.DrawWaypoints();
 }