A*算法寻路算法(最短路径???)代码文件3

最新推荐文章于 2023-08-27 03:07:15 发布

原创最新推荐文章于 2023-08-27 03:07:15 发布 · 2.1k 阅读

0 ·

CC 4.0 BY-SA版权

文章标签：

#算法 #go #class #path #null #file

此博客展示了一个用C++实现的地图寻路算法示例。代码定义了地图类，包含地图初始化、读取地图文件等功能，使用`find_pathAB`类进行寻路操作，最后打印出路径和寻路时间，还给出了使用的地图文件内容。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

// myfindgo.cpp : Defines the entry point for the console application.
//

#include "stdafx.h"
#include

#include "find_path.h"

#include "windows.h"
#include "mmsystem.h"
#pragma comment(lib, "winmm.lib")

class test_map
{
#define MAP_W_MAX 1000
#define MAP_H_MAX 1000
public:
test_map()
{
memset(map, 0, sizeof(map));
}

static bool go_test(int x, int y)
{
  if (x < 0 || y < 0
   || x >= MAP_W_MAX
   || y >= MAP_H_MAX
   ) return false;

if (0 != map[x][y]) return false;

return true;
};

static bool map[MAP_W_MAX][MAP_H_MAX];
};
bool test_map::map[MAP_W_MAX][MAP_H_MAX];

int x0 = 2;
int y0 = 2;
int x1 = 1;
int y1 = 1;

void readmap()
{
FILE *f;
f = fopen("c://tmp//map.txt","r");
if (NULL == f) return;

int x = 0;
int y = 0;
fscanf(f, "%d, %d/n", &x, &y);
for (int j = 0; j < y; j++)
{
char line[1024] = {0};
fgets(line, x + 1, f);

  for (int i = 0; i < x; i++)
  {
   if (' ' != line[i]) test_map::map[i][j] = 1;

   if ('s' == line[i])
   {
    x0 = i;
    y0 = j;
    test_map::map[i][j] = 0;
   }

   if ('e' == line[i])
   {
    x1 = i;
    y1 = j;
    test_map::map[i][j] = 0;
   }
  }
}
fclose(f);
}

int main(int argc, char* argv[])
{
test_map map;
//--初始化地图
//--不可到达的点
//map.map[0][0] = 1;
map.map[2][1] = 1;
map.map[3][1] = 1;
map.map[1][2] = 1;
map.map[3][2] = 1;
map.map[0][2] = 1;

readmap();

find_pathAB fp;
fp.init(100, 25, test_map::go_test);

int z;

DWORD t1 = timeGetTime();
//--寻路
{
for (int i = 0; i < 1000; i++)
z = fp.go(x0, y0, x1, y1);
}
DWORD t2 = timeGetTime();
DWORD t = t2 - t1;

//--打印路径
for (int i = 0; i <= fp.path_t; i++)
{
  printf("x=%d y=%d/r/n"
   , fp.path_p[i].x
   , fp.path_p[i].y);
}
printf("path_t=%d time_t=%d(ms)/r/n", fp.path_t, t);

getch();
return 0;
}

使用到的文件c://tmp//map.txt内容如下
80,24
ooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooo
o                                                                             o
o                                                                             o
o   s                        oooooooooooooo                                   o
o                                         o                                   o
ooooooooooo                               o                                   o
o         o      ooooooo     oooooooooooooo       oooooooo                    o
o    oooooo      o     oooo                       o      o                    o
o                o        o                       ooo ooo                    o
o                oooo oooo                                                   o
o                                oooooooooooooooooooooooooooooooooooooooooooooo
o                                                                             o
o                                                                             o
o                                                                             o
oooooooooooooooooooooooooooooooooooooooooooo                                  o
o       o                                                           ooooooooooo
o       o   ooooooo                                      oooooooo             o
o       o         o                                      o      o             o
o       ooooooooooo        oooooooooo                    o      o             o
o                          oe       ooo                  o      o             o
o                          ooooo      o                  o      o             o
o                                     o                  o                    o
o                              o      o                  o                    o
ooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooo