自动寻路方案

using UnityEngine;
using System.Collections;
using System.Collections.Generic;

class Point //代表人
{
public int X { get; set; }
public int Y { get; set; }

public Point Parent { get; set; }

public Point(int x, int y)
{
X = x;
Y = y;
}
}

public class ANavition : MonoBehaviour
{

List<Point> nowList; //正在访问的集合 讲台
List<Point> visitendList; //已经访问过的集合 ，白板

//玩家和目标
GameObject player;
GameObject target;

bool canReach; //能否到达目标点

bool[,] maps; //地图 二维数组

int[,] dir = new int[,] { { 0, 1 }/*up*/, { 0, -1 }/*down*/, { -1, 0 }/*left*/, { 1, 0 }/*right*/ };

Vector3 moveDir; //玩家自动寻路的方向

// Use this for initialization
void Start()
{
LoadGameMap();
InitGameMap();
FindTarget();

}

void OnGUI()
{
if (GUILayout.Button("刷新"))
{
Application.LoadLevel("03ANav");
}
}

// Update is called once per frame
void Update()
{
if (canReach)
{
AntoMove();
}
}

/// <summary>
/// 角色自动导航
/// </summary>
private void AntoMove()
{
if (ways.Count > 0)
{
moveDir = (ways.Peek() - player.transform.position).normalized;

player.transform.Translate(moveDir * Time.deltaTime);

//
if (Vector3.Distance(ways.Peek(), player.transform.position) < 0.1f)
{
ways.Pop();//弹出栈顶元素
}
}
}

/// <summary>
/// 找目标
/// </summary>
void FindTarget()
{
//初始化集合
nowList = new List<Point>();
visitendList = new List<Point>();

Point yangbo = new Point(0, 0);
//yangbo.X = 0;
//yangbo.Y = 0;

nowList.Add(yangbo);
visitendList.Add(yangbo);

Point first;
int x, y;
//只要有人，游戏一直继续玩下去
while (nowList.Count > 0)
{
first = nowList[0];

//dir-> 前 (0,1) 后(0,-1)
for (int i = 0; i < 4; i++)
{
x = first.X + dir[i, 0]; //第i个方向的x
y = first.Y + dir[i, 1]; //第i个方向的y

if (IsOk(x, y))
{
Point person = new Point(x, y);
person.Parent = first;

nowList.Add(person);//上讲台
visitendList.Add(person); //写上名字
}

//找到了目标点
if (IsFindTarGet(first))
{
break;
}
}

nowList.Remove(first); //移除上了讲台的人
}
}
Stack<Vector3> ways; //栈，存路径
bool IsFindTarGet(Point person)
{
if (person.X == 5 && person.Y == 5)
{
ways = new Stack<Vector3>();
while (person.Parent != null) //链表查找父亲
{
Vector3 pos = new Vector3(person.X, 1, person.Y);

ways.Push(pos);

person = person.Parent;
}
canReach = true;
return canReach;
}
return false;
}

bool IsOk(int x, int y)
{
//数组越界
if (x < 0 || y < 0 || x > 5 || y > 5) return false;

//访问过的节点不能再次访问
foreach (Point p in visitendList)
{
if (p.X == x && p.Y == y) return false;
}

return maps[x, y];
}

/// <summary>
/// 生成游戏地图数组
/// </summary>
public void LoadGameMap()
{
maps = new bool[6, 6]; //6行6列的游戏地图

for (int i = 0; i < maps.GetLength(0); i++)
{
for (int j = 0; j < maps.GetLength(1); j++)
{
//70% true  30% false
maps[i, j] = Random.Range(1, 11) <= 7 ? true : false;
}
}

//都必须是绿色 即为true
maps[0, 0] = true; //玩家起点位置
maps[5, 5] = true; //目标点位置
}

/// <summary>
/// 初始化地图
/// </summary>
void InitGameMap()
{
for (int i = 0; i < 6; i++)
{
for (int j = 0; j < 6; j++)
{
GameObject cube = GameObject.CreatePrimitive(PrimitiveType.Cube);
//cube.transform.position = new Vector3(j, i, 0);

cube.transform.position = new Vector3(i, 0, j); //从顶部看  xz平面上

//true为绿色。即可以走。false为红色。即不可以走
cube.transform.renderer.material.color = maps[i, j] ? Color.green : Color.red;

cube.transform.localScale = Vector3.one * 0.8f; //缩放cube

cube.transform.SetParent(transform); //设置父对象，便于管理
}
}

//玩家和目标
player = GameObject.CreatePrimitive(PrimitiveType.Capsule);

target = GameObject.CreatePrimitive(PrimitiveType.Sphere);

player.transform.position = new Vector3(0, 1, 0); //玩家的初始位置

player.transform.localScale = Vector3.one * 0.5f; //缩放玩家

target.transform.position = new Vector3(5, 1, 5); //目标点的位置

}

}