欢迎来到雄杰鑫电商资讯网
技术教程

C++如何实现一个简单的A*寻路算法_C++游戏AI开发中的路径规划实战

穿越時空 次阅读
A*算法通过评估函数f=g+h结合Dijkstra的完备性和贪心搜索的高效性，在二维网格中寻最优路径；使用优先队列扩展节点，曼哈顿距离作启发函数，记录g、h、f值及父节点回溯路径，最终实现从起点到终点的完整路径规划。

在C++游戏AI开发中，A*（A星）寻路算法是路径规划的核心技术之一。它结合了Dijkstra算法的完备性和贪心搜索的高效性，通过评估函数快速找到从起点到终点的最优路径。下面用简洁的方式实现一个基础但可用的A*算法，适用于二维网格地图。

1. 定义地图与节点结构

假设地图是一个二维网格，0表示可通过，1表示障碍物。每个节点记录坐标、代价信息以及父节点用于回溯路径。

#include 
#include 
#include 
#include 

struct Node {
int x, y;
float g, h; // g: 实际代价，h: 启发值
float f() const { return g + h; }
Node* parent;
Node(int x, int y) : x(x), y(y), g(0), h(0), parent(nullptr) {}

bool operatorzuojiankuohaophpcn(const Node& other) const {
    return f() youjiankuohaophpcn other.f(); // 优先队列需要最小堆
}
};
2. 启发函数与邻居生成


使用曼哈顿距离作为启发函数，适合四方向移动。若支持八方向，可改用对角线距离或欧几里得距离。


float heuristic(int x1, int y1, int x2, int y2) {
    return abs(x1 - x2) + abs(y1 - y2); // 曼哈顿距离
}

std::vector> getNeighbors(int x, int y) {
return {{x+1,y}, {x-1,y}, {x,y+1}, {x,y-1}};
// 若允许斜向移动，可加入 {x+1,y+1}, {x+1,y-1} 等
}
3. A* 核心算法实现


使用优先队列管理待处理节点，集合记录已访问位置，避免重复扩展。


std::vector aStar(const std::vector>& grid,
                           Node* start, Node* end) {
    int rows = grid.size();
    int cols = grid[0].size();

auto isValid = [&](int x, int y) {
    return x youjiankuohaophpcn= 0 && x zuojiankuohaophpcn rows && y youjiankuohaophpcn= 0 && y zuojiankuohaophpcn cols && grid[x][y] == 0;
};

std::priority_queuezuojiankuohaophpcnNodeyoujiankuohaophpcn openList;
std::vectorzuojiankuohaophpcnstd::vectorzuojiankuohaophpcnboolyoujiankuohaophpcnyoujiankuohaophpcn closedList(rows, std::vectorzuojiankuohaophpcnboolyoujiankuohaophpcn(cols, false));
std::vectorzuojiankuohaophpcnstd::vectorzuojiankuohaophpcnNode*youjiankuohaophpcnyoujiankuohaophpcn nodeMap(rows, std::vectorzuojiankuohaophpcnNode*youjiankuohaophpcn(cols, nullptr));

for (int i = 0; i zuojiankuohaophpcn rows; ++i)
    for (int j = 0; j zuojiankuohaophpcn cols; ++j)
        if (grid[i][j] == 0)
            nodeMap[i][j] = new Node(i, j);

start = nodeMap[start-youjiankuohaophpcnx][start-youjiankuohaophpcny];
end = nodeMap[end-youjiankuohaophpcnx][end-youjiankuohaophpcny];
start-youjiankuohaophpcnh = heuristic(start-youjiankuohaophpcnx, start-youjiankuohaophpcny, end-youjiankuohaophpcnx, end-youjiankuohaophpcny);

openList.push(*start);

while (!openList.empty()) {
    Node current = openList.top(); openList.pop();

    if (closedList[current.x][current.y]) continue;
    closedList[current.x][current.y] = true;

    if (current.x == end-youjiankuohaophpcnx && current.y == end-youjiankuohaophpcny) {
        // 回溯路径
        std::vectorzuojiankuohaophpcnNode*youjiankuohaophpcn path;
        Node* p = end;
        while (p != nullptr) {
            path.push_back(p);
            p = p-youjiankuohaophpcnparent;
        }
        return path;
    }

    for (auto& [nx, ny] : getNeighbors(current.x, current.y)) {
        if (!isValid(nx, ny) || closedList[nx][ny]) continue;

        Node* neighbor = nodeMap[nx][ny];
        float tentativeG = current.g + 1; // 假设每步代价为1

        if (tentativeG zuojiankuohaophpcn neighbor-youjiankuohaophpcng || !closedList[nx][ny]) {
            neighbor-youjiankuohaophpcnparent = &const_castzuojiankuohaophpcnNode&youjiankuohaophpcn(current);
            neighbor-youjiankuohaophpcng = tentativeG;
            neighbor-youjiankuohaophpcnh = heuristic(nx, ny, end-youjiankuohaophpcnx, end-youjiankuohaophpcny);
            openList.push(*neighbor);
        }
    }
}

return {}; // 无路径
}
4. 使用示例与清理资源


演示如何调用并输出结果。注意实际项目中建议使用智能指针或对象池管理内存。


int main() {
    std::vector> grid = {
        {0, 0, 0, 1, 0},
        {0, 1, 0, 1, 0},
        {0, 1, 0, 0, 0},
        {0, 0, 0, 1, 0},
        {0, 0, 0, 0, 0}
    };

Node* start = new Node(0, 0);
Node* end = new Node(4, 4);

auto path = aStar(grid, start, end);

if (!path.empty()) {
    std::cout zuojiankuohaophpcnzuojiankuohaophpcn "Found path:\n";
    for (auto it = path.rbegin(); it != path.rend(); ++it) {
        std::cout zuojiankuohaophpcnzuojiankuohaophpcn "(" zuojiankuohaophpcnzuojiankuohaophpcn (*it)-youjiankuohaophpcnx zuojiankuohaophpcnzuojiankuohaophpcn "," zuojiankuohaophpcnzuojiankuohaophpcn (*it)-youjiankuohaophpcny zuojiankuohaophpcnzuojiankuohaophpcn ") ";
    }
    std::cout zuojiankuohaophpcnzuojiankuohaophpcn "\n";
} else {
    std::cout zuojiankuohaophpcnzuojiankuohaophpcn "No path found.\n";
}

// 简单释放（实际应遍历所有创建的节点）
for (auto& row : grid)
    for (auto val : row)
        if (val == 0) /* 伪代码 */ delete /* 对应节点 */;
delete start; delete end;

return 0;
}
基本上就这些。这个实现虽然简单，但展示了A*在C++中的核心逻辑：代价评估、优先扩展、路径回溯。在真实游戏中，你可以进一步优化数据结构（如使用索引代替指针）、支持动态障碍、多单位协同避让等。不复杂但容易忽略细节，比如防止重复入队和正确更新g值。掌握基础后，扩展性强。






            
 ai 数据结构 算法 你可以 是一个 适用于 可通过 最优 对象 stream ios node 曼哈顿 c++ 指针 遍历 欧几里得 点到

相关文章

按ESC键退出。