A* Path finding algorithm running extremely slow [duplicate]

久未见 提交于 2019-12-13 02:43:46

问题


I am currently working on my first game for android, and my first time creating an a* path finding algorithm. It is a 2d game. I have created one enemy containing this algorithm (ie. It is being ran once every frame) and it slows down performance from 60fps to 1-2 fps. Obviously something is horribly wrong, I have tried looking online for solutions but have yet to find an answer. Here are my pathfinding classes:

package com.frog8fly.nunca;

import com.badlogic.gdx.utils.Array;

import java.util.Comparator;

public class Pathfinding {

private static Node[][] grid;

private static NodeComparator nodeComparator;

static{
    nodeComparator = new NodeComparator();
}

public static class NodeComparator implements Comparator<Node> {

    @Override
    public int compare(Node node1, Node node2) {

        if(node1.F > node2.F){
            return 1;
        }
        else if(node1.F < node2.F){
            return -1;
        }
        else{
            return 0;
        }

    }
}

public static Array<Node> findPath(Node start, Node finish, Node[][] _grid) {
    Array<Node> path = new Array<Node>();
    Array<Node> openList = new Array<Node>();
    Array<Node> closedList = new Array<Node>();

    grid = _grid;

    Node currentNode = start;
    currentNode.parent = null;
    currentNode.G = 0;
    currentNode.H = getHeuristic(currentNode, finish);
    openList.add(currentNode);

    System.out.println("PATHFINDING STARTED ||| startPos : " + start.position + " finishPos : " + finish.position);

    while (openList.size > 0) {

        //Sorts open nodes lowest F value to heighest
        openList.sort(nodeComparator);

        currentNode = openList.first();

        //If path is found, return
        if (currentNode == finish) {
            System.out.println("PATH FOUND...RETURNING -gat5");

            return constructPath(currentNode);
        }

        openList.removeValue(currentNode, true);
        closedList.add(currentNode);

        int counter = 0;
        for (Node neighbor : getNeighbors(currentNode)) {
            if (!closedList.contains(neighbor, true)) { //If neighbor not in closed list
                if(neighbor != null) { //If neighbor not wall

                    if(counter == 4){
                        counter++;
                    }

                    int movementCost = checkMovementCost(counter);

                    if (openList.contains(neighbor, true)) {
                        if (currentNode.G + movementCost < neighbor.G) {
                            neighbor.parent = currentNode;
                        }
                    } else {
                        openList.add(neighbor);
                        neighbor.parent = currentNode;
                        neighbor.H = getHeuristic(currentNode, finish);
                        neighbor.G = neighbor.parent.G + movementCost;
                    }
                    counter++;
                }
            }
        }

    }

    System.out.println("NO PATH FOUND RETURNING...");
    path.add(start);
    return path;

}

private static int checkMovementCost(int neighbor) {
    int movementCost = 0;
    switch (neighbor) {
        //Diagonal
        case 0:
        case 2:
        case 6:
        case 8:
            movementCost = 16;
            break;
        //Not Diagonal
        case 1:
        case 3:
        case 5:
        case 7:
            movementCost = 10;
            break;
    }

    return movementCost;
}

public static Array<Node> constructPath(Node finish) {
    Array<Node> pathNodes = new Array<Node>();

    Node currentNode = finish;
    pathNodes.add(currentNode);

    while (currentNode.parent != null) {
        currentNode = currentNode.parent;
        pathNodes.add(currentNode);
        System.out.println("Anotha");
    }

    pathNodes.reverse();

    return pathNodes;
}

private static float getHeuristic(Node start, Node finish){
    int H = 0;

    System.out.println(start.position);
    System.out.println(finish.position);

    H += Math.abs(start.position.x - finish.position.x);
    H += Math.abs(start.position.y - finish.position.y);

    return H;
}

private static Array<Node> getNeighbors(Node node){
    Array<Node> neighbors = new Array<Node>();

    int x = (int)node.position.x;
    int y = (int)node.position.y;

    if(x - 1 > 0 && x - 1 < grid.length && y + 1 < grid.length && y + 1 > 0){
        neighbors.add(grid[x - 1][y + 1]);
    }
    else{
        neighbors.add(null);
    }
    if(x > 0 && x < grid.length && y + 1 < grid.length && y + 1 > 0){
        neighbors.add(grid[x][y + 1]);
    }
    else{
        neighbors.add(null);
    }
    if(x + 1 > 0 && x + 1 < grid.length && y + 1 < grid.length && y + 1 > 0){
        neighbors.add(grid[x + 1][y + 1]);
    }
    else{
        neighbors.add(null);
    }


    if(x - 1 > 0 && x - 1 < grid.length && y < grid.length && y > 0){
        neighbors.add(grid[x - 1][y]);
    }
    else{
        neighbors.add(null);
    }
    if(x > 0 && x < grid.length && y < grid.length && y > 0){
        neighbors.add(grid[x][y]);
    }
    else{
        neighbors.add(null);
    }
    if(x + 1 > 0 && x + 1 < grid.length && y < grid.length && y > 0){
        neighbors.add(grid[x + 1][y]);
    }
    else{
        neighbors.add(null);
    }


    if(x - 1 > 0 &&  x - 1 < grid.length && y - 1 < grid.length && y - 1> 0){
        neighbors.add(grid[x - 1][y - 1]);
    }
    else{
        neighbors.add(null);
    }
    if(x > 0 && x < grid.length && y - 1 < grid.length && y - 1 > 0){
        neighbors.add(grid[x][y - 1]);
    }
    else{
        neighbors.add(null);
    }
    if(x + 1 > 0 && x + 1 < grid.length && y - 1 < grid.length && y - 1 > 0){
        neighbors.add(grid[x + 1][y - 1]);
    }
    else{
        neighbors.add(null);
    }

    for(Node nodee : neighbors){
        if(node.position != null){

        }
    }

    return neighbors;

}

}

And my Node class:

package com.frog8fly.nunca;

import com.badlogic.gdx.math.Vector2;

public class Node{

    public Node parent;
    public Vector2 position;

    public float G, H, F;

    public Node(Vector2 position){
        this.position = position;
        this.position.x = (int)Math.floor(this.position.x);
        this.position.y = (int)Math.floor(this.position.y);
    }
}

回答1:


You're heuristic function is wrong. I believe you want:

H += Math.abs(start.position.x - finish.position.x);
H += Math.abs(start.position.y - finish.position.y);

Having an incorrect heuristic could definitely slow down A* search to a crawl since it basically reduces it to breadth first search.



来源:https://stackoverflow.com/questions/36142951/a-path-finding-algorithm-running-extremely-slow

易学教程内所有资源均来自网络或用户发布的内容,如有违反法律规定的内容欢迎反馈
该文章没有解决你所遇到的问题?点击提问,说说你的问题,让更多的人一起探讨吧!