算法:Astar寻路算法改进

时间:2024-04-23 00:05:48

早前写了一篇《RCP:gef智能寻路算法(A star)

出现了一点问题。

在AStar算法中,默认寻路起点和终点都是N x N的方格,但如果用在路由上,就会出现问题。

如果,需要连线的终点并不在方格的四角上,就产生了斜线。于是我们可以对终点附近的点重新做一点儿处理,源码如下所示:

        int size = points.size();
if (size < 3)
return;
points.removePoint(size - 1);
Point pointN1 = points.getLastPoint();
Point pointN2 = points.getPoint(size - 3); if (pointN2.x == pointN1.x) {
points.setPoint(new Point(pointN1.x, endPoint.y), size - 2);
} else if (pointN2.y == pointN1.y) {
points.setPoint(new Point(endPoint.x, pointN1.y), size - 2);
}