基于BFS的最短路径搜索[C++]

基于C++实现BFS的最短路径搜索时，可以使用STL中的优先队列priority_queue，优先队列按照小顶堆，即路径短的优先取出。其中节点可以用结构体定义，结构体中存储节点的位置、路径长度、最短路径的前序节点等信息，构建结构体的时候记得重载小于号，即可直接在优先队列中使用，具体代码如下：

其中，起点为左上角，终点为右下角，障碍物通过值设置为9999，可以根据题目的要求设置为一个非常大的值

#include
using namespace std;
struct node{
  int x;
  int y;
  int prex;///前序节点x
  int prey;///前序节点y
  int val;///到该处路径的代价
  bool operator < (const node &x) const{
        return val > x.val;
  }
}S[16][16];
vector > array(16);
priority_queue q;
int M,N;
void judge(int xadd, int yadd, int val, int px, int py){
    int x = px + xadd;
    int y = py + yadd;
    if(x<0||y<0||x>=M||y>=N){
      return;
    }
   // cout<M>>N){
        ///数组读取
        for(int i=0;i>array[i][j];
               S[i][j].x = i;
               S[i][j].y = j;
               S[i][j].prex = -1;
               S[i][j].prey = -1;
               S[i][j].val = 9999;
            }
        }
        ///最短路
        while(!q.empty()) q.pop();
        S[0][0].val = 0;
        q.push(S[0][0]);
        while(!q.empty()){
          //  cout<5000){
          cout<<"-1"<