/// <summary>
/// 斜角走的情况下，如果一个方向挡住，自动调整到另外一个方向
/// </summary>
/// <param name="dir"></param>
/// <param name="x"></param>
/// <param name="y"></param>
/// <returns></returns>
private eFace8Type adjustDir(PathGridMap grid_map, eFace8Type dir, float x, float y)
{
PathGrid cur_tile = grid_map.getNodeByPostion(x, y);
if (cur_tile == null || !cur_tile.walkable)
{
return(eFace8Type.NONE);
}
m_collide_rect.x = x - m_collide_rect.width * 0.5f;
m_collide_rect.y = y - m_collide_rect.height * 0.5f;
int grid_row = cur_tile.row;
int grid_col = cur_tile.col;
switch (dir)
{ //地图{0,0}在左下角
case eFace8Type.RIGHT_DOWN:
{
PathGrid right_tile = grid_map.getNode(grid_row, grid_col + 1);
PathGrid down_tile = grid_map.getNode(grid_row - 1, grid_col);
bool can_right = checkCanMove(right_tile, m_collide_rect);
bool can_down = checkCanMove(down_tile, m_collide_rect);
if (!can_right && !can_down)
{
return(eFace8Type.NONE);
}
else if (!can_right)
{
return(eFace8Type.DOWN);
}
else if (!can_down)
{
return(eFace8Type.RIGHT);
}
}
break;
case eFace8Type.RIGHT_UP:
{
PathGrid right_tile = grid_map.getNode(grid_row, grid_col + 1);
PathGrid up_tile = grid_map.getNode(grid_row + 1, grid_col);
bool can_right = checkCanMove(right_tile, m_collide_rect);
bool can_up = checkCanMove(up_tile, m_collide_rect);
if (!can_right && !can_up)
{
return(eFace8Type.NONE);
}
else if (!can_right)
{
return(eFace8Type.UP);
}
else if (!can_up)
{
return(eFace8Type.RIGHT);
}
}
break;
case eFace8Type.LEFT_DOWN:
{
PathGrid left_tile = grid_map.getNode(grid_row, grid_col - 1);
PathGrid down_tile = grid_map.getNode(grid_row - 1, grid_col);
bool can_left = checkCanMove(left_tile, m_collide_rect);
bool can_down = checkCanMove(down_tile, m_collide_rect);
if (!can_left && !can_down)
{
return(eFace8Type.NONE);
}
else if (!can_left)
{
return(eFace8Type.DOWN);
}
else if (!can_down)
{
return(eFace8Type.LEFT);
}
}
break;
case eFace8Type.LEFT_UP:
{
PathGrid left_tile = grid_map.getNode(grid_row, grid_col - 1);
PathGrid up_tile = grid_map.getNode(grid_row + 1, grid_col);
bool can_left = checkCanMove(left_tile, m_collide_rect);
bool can_up = checkCanMove(up_tile, m_collide_rect);
if (!can_left && !can_up)
{
return(eFace8Type.NONE);
}
else if (!can_left)
{
return(eFace8Type.UP);
}
else if (!can_up)
{
return(eFace8Type.LEFT);
}
}
break;
}
return(dir);
}
/// <summary>
/// 寻路接口
/// </summary>
/// <param name="start_x"></param>
/// <param name="start_y"></param>
/// <param name="target_x"></param>
/// <param name="target_y"></param>
/// <param name="width"></param>
/// <param name="height"></param>
/// <returns></returns>
public eFinderResult search(PathGridMap grid_map, float start_x, float start_y, float target_x, float target_y, float width, float height)
{
if (grid_map == null)
{
return(eFinderResult.FAILED);
}
eFace8Type walk_dir = eFace8Type.NONE;
m_cur_grid = null;
m_collide_rect.width = width;
m_collide_rect.height = height;
//上一步的位置
m_last_pos_x = start_x;
m_last_pos_y = start_y;
//步长增长方向
Vector2 pt_step = Math2DUtils.normalPoint(start_x, start_y, target_x, target_y, STEP_LENGTH);
float x_step_inc = pt_step.x;
float y_step_inc = pt_step.y;
//步长个数
int stepCount = (int)Mathf.Ceil(Math2DUtils.distance(start_x, start_y, target_x, target_y) / STEP_LENGTH);
//确定移动方向
float angle = MathUtils.ToDegree(Math2DUtils.LineRadians(start_x, start_y, target_x, target_y));
walk_dir = (eFace8Type)Math2DUtils.getFace(angle, 8);
m_cur_grid = grid_map.getNodeByPostion(start_x, start_y);
if (m_cur_grid == null)
{
return(eFinderResult.FAILED);
}
//重新调整方向：判断下一步是否可走
walk_dir = adjustDir(grid_map, walk_dir, start_x + x_step_inc, start_y + y_step_inc);
switch (walk_dir)
{
case eFace8Type.LEFT:
case eFace8Type.RIGHT:
y_step_inc = 0;
break;
case eFace8Type.UP:
case eFace8Type.DOWN:
x_step_inc = 0;
break;
case eFace8Type.NONE:
return(eFinderResult.FAILED);
}
//开始寻路，每次移动一个步长
eFinderResult result = eFinderResult.FAILED;
int i = 1;
for (i = 1; i <= stepCount; i++) //从1开始，当前位置不判断
{
if (isWalkableRect(grid_map, walk_dir, start_x + x_step_inc * i, start_y + y_step_inc * i))
{
m_last_pos_x = start_x + x_step_inc * i;
m_last_pos_y = start_y + y_step_inc * i;
result = eFinderResult.SUCCEEDED;
}
else
{
//如果第一步都不能走，设置查询失败
if (i == 1)
{
result = eFinderResult.FAILED;
}
else
{
result = eFinderResult.SUCCEEDED_NEAREST;
}
break;
}
}
m_target_pos_x = m_last_pos_x;
m_target_pos_y = m_last_pos_y;
return(result);
}
/// <summary>
/// 是否可行走
/// </summary>
/// <param name="x"></param>
/// <param name="y"></param>
/// <returns></returns>
private bool isWalkableRect(PathGridMap grid_map, eFace8Type dir, float x, float y)
{
m_collide_rect.x = x - m_collide_rect.width * 0.5f;
m_collide_rect.y = y - m_collide_rect.height * 0.5f;
PathGrid grid = grid_map.getNodeByPostion(x, y);
//在障碍里面
if (grid == null || !grid.walkable)
{
return(false);
}
int grid_row = grid.row;
int grid_col = grid.col;
PathGrid tempTile = null;
switch (dir)
{
case eFace8Type.RIGHT: //校验相邻格子
tempTile = grid_map.getNode(grid_row, grid_col + 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
return(true);
case eFace8Type.DOWN:
tempTile = grid_map.getNode(grid_row - 1, grid_col);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
return(true);
case eFace8Type.LEFT:
tempTile = grid_map.getNode(grid_row, grid_col - 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
return(true);
case eFace8Type.UP:
tempTile = grid_map.getNode(grid_row + 1, grid_col);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
return(true);
case eFace8Type.RIGHT_DOWN:
tempTile = grid_map.getNode(grid_row, grid_col + 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
tempTile = grid_map.getNode(grid_row - 1, grid_col);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
tempTile = grid_map.getNode(grid_row - 1, grid_col + 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
return(true);
case eFace8Type.RIGHT_UP:
tempTile = grid_map.getNode(grid_row, grid_col + 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
tempTile = grid_map.getNode(grid_row + 1, grid_col);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
tempTile = grid_map.getNode(grid_row + 1, grid_col + 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
return(true);
case eFace8Type.LEFT_DOWN:
tempTile = grid_map.getNode(grid_row, grid_col - 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
tempTile = grid_map.getNode(grid_row - 1, grid_col);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
tempTile = grid_map.getNode(grid_row - 1, grid_col - 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
return(true);
case eFace8Type.LEFT_UP:
tempTile = grid_map.getNode(grid_row, grid_col - 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
tempTile = grid_map.getNode(grid_row + 1, grid_col);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
tempTile = grid_map.getNode(grid_row + 1, grid_col - 1);
if (!checkCanMove(tempTile, m_collide_rect))
{
return(false);
}
return(true);
}
return(false);
}
