C++ 基于BFS算法的走迷宮自動尋路的實現(xiàn)
1.效果圖
其中正方形代表障礙物,實心菱形代表移動者(人),空心菱形代表目標(biāo)位置(都是可以在代碼中修改的)
本例使用隊列(鏈表實現(xiàn)),以廣度優(yōu)先進(jìn)行自動尋路。
2.實現(xiàn)代碼
1.隊列方法類
coolQueue.h
#pragma once #include <iostream> using namespace std; //隊列 //坐標(biāo)結(jié)構(gòu)體 struct Point { int x; int y; Point() { x = 0; y = 0; } Point(int in_x, int in_y) { x = in_x; y = in_y; } Point& operator=(const Point& right_p) { this->x = right_p.x; this->y = right_p.y; return *this; } }; //隊列結(jié)構(gòu)體 struct coolQueue { int data; Point cool_p; coolQueue* next_p; coolQueue(int in_data) { data = in_data; next_p = NULL; } coolQueue(int in_x, int in_y, int in_data = 0) { cool_p.x = in_x; cool_p.y = in_y; data = in_data; next_p = NULL; } }; //隊列方法類,限制訪問方式 class queueClass { protected: coolQueue* Head_p = NULL; coolQueue* End_p = NULL; public: queueClass() {} void push(int data); //入隊 void push(int in_x, int in_y, int in_data = 0); bool pop(int& re_data); //出隊 bool pop(coolQueue& in_coolQueue); void reverse_order(); //翻轉(zhuǎn) void clear() { for (int data; pop(data);); } ~queueClass() { clear(); } };
coolQueue.cpp
#include "coolQueue.h" /*入隊函數(shù) * 傳參: * in_data:入隊的數(shù)據(jù) */ void queueClass::push(int in_data) { if (Head_p == NULL) //隊列為空 { Head_p = new coolQueue(in_data); End_p = Head_p; } else if(Head_p == End_p) //隊列只有一個元素 { End_p = new coolQueue(in_data); Head_p->next_p = End_p; } else { coolQueue* temp_p = new coolQueue(in_data); End_p->next_p = temp_p; End_p = temp_p; } } /*出隊 * 傳參: * re_data:接收出隊返回值 * 返回值: * 成功返回true,隊列為空返回false * * 把值寫入re_data中返回 */ bool queueClass::pop(int& re_data) { if (Head_p == NULL) //隊列為空 return false; re_data = Head_p->data; coolQueue* temp_p = Head_p; if (Head_p == End_p) //隊列只有一個元素 { Head_p = NULL; End_p = NULL; } else Head_p = Head_p->next_p; delete temp_p; return true; } /*同鏈表采用以尾指針為頭的頭插法實現(xiàn)倒序 */ void queueClass::reverse_order() { if (Head_p == NULL || Head_p == End_p) return; coolQueue* p = Head_p, * temp_p; do { temp_p = p; p = p->next_p; temp_p->next_p = End_p->next_p; End_p->next_p = temp_p; } while (p != End_p); p = Head_p; Head_p = End_p; End_p = p; } //以下重載用于輔助自動尋路實現(xiàn) //in_data = 0 void queueClass::push(int in_x, int in_y, int in_data) { if (Head_p == NULL) { Head_p = new coolQueue(in_x, in_y, in_data); End_p = Head_p; } else if (Head_p == End_p) { End_p = new coolQueue(in_x, in_y, in_data); Head_p->next_p = End_p; } else { coolQueue* temp_p = new coolQueue(in_x, in_y, in_data); End_p->next_p = temp_p; End_p = temp_p; } } bool queueClass::pop(coolQueue& in_coolQueue) { if (Head_p == NULL) return false; in_coolQueue.data = Head_p->data; //不直接使用復(fù)制是因為可能把Head_p的next_p也復(fù)制出去導(dǎo)致限制訪問權(quán)限失效 in_coolQueue.cool_p = Head_p->cool_p; coolQueue* temp_p = Head_p; if (Head_p == End_p) { Head_p = NULL; End_p = NULL; } else Head_p = Head_p->next_p; delete temp_p; return true; }
2.地圖方法類
mapClass.h
#pragma once #include "coolQueue.h" #include "windows.h" #include <cmath> using namespace std; #ifndef PI #define PI 3.14159265358979323846 #endif // !PI #ifndef Sleep_num #define Sleep_num 500 #endif // !打印輸出地圖時的暫停時間 #ifndef Map_size #define Map_size 10 #endif // !地圖大小 /*地圖操作類 * 保護(hù)繼承隊列,防止外部調(diào)用隊列的函數(shù) */ class mapClass : protected queueClass { protected: int map[Map_size][Map_size]; //地圖 Point persion_p; //起點位置坐標(biāo) void new_map(); void reflash_map(); bool auto_find_way(Point& target_p); void auto_move(int in_x, int in_y); public: mapClass(const Point& in_p); bool auto_main(); void into_map(int in_data, int num = 1); bool into_map(int in_x, int in_y, int in_data); void show_map(); void clear_map(const Point& in_p); };
mapClass.cpp
#include "mapClass.h" /*初始化地圖 * * 把map置零后設(shè)置邊界 */ void mapClass::new_map() { memset(map, 0, Map_size * Map_size);//清零 for (int num = Map_size; num--;) //設(shè)置邊緣障礙物 { map[num][0] = 1; map[0][num] = 1; map[num][Map_size - 1] = 1; map[Map_size - 1][num] = 1; } } /*刷新地圖 * * 由于在auto_find_way()中會修改地圖中的值作為方向標(biāo)記 * 移動后會殘留一些標(biāo)記,此函數(shù)將會把這些標(biāo)記清理(即把標(biāo)記置回0) */ void mapClass::reflash_map() { for (int x = Map_size - 1; --x;) for (int y = Map_size - 1; --y;) map[x][y] = map[x][y] % 1000; /*方向標(biāo)記為1000,2000,3000 和 4000,故 %1000 即可保留其他東西并清理標(biāo)記*/ } /*自動尋路 * * 傳參: * &target_p:傳出參數(shù),找到路徑后寫入目標(biāo)的坐標(biāo) * 返回值: * 有路徑返回true,沒有返回false * * 基于隊列尋找到達(dá)目標(biāo)的最優(yōu)路徑,會在地圖上留下方向標(biāo)記 * 如果找到,在其他函數(shù)可以 以目標(biāo)位置開始,通過方向標(biāo)記倒推回起點,即為路徑 */ bool mapClass::auto_find_way(Point& target_p) { coolQueue out_queue(0, 0, 0); for (int push_num = 1; push_num;) { push_num = 0; //如果push_num在while循環(huán)后仍然為0,說明隊列空且無路可走了 while (this->pop(out_queue)) { for (int i = 1, temp_x, temp_y; i <= 4; ++i)//判斷它的旁邊4個位置 { //此處使用sin()是為了在不同i時(temp_x, temp_y)指向以out_queue為中心的不同方向 //效果同auto_move()中的switch()的使用 temp_x = out_queue.cool_p.x + int(sin(PI / 2 * (i - 2.0))); temp_y = out_queue.cool_p.y + int(sin(PI / 2 * (i - 3.0))); switch (map[temp_x][temp_y]) { case 0: //可走 { map[temp_x][temp_y] = i * 1000; //寫入方向標(biāo)記 this->push(temp_x, temp_y, 0); //入隊 ++push_num; }break; case 10: //抵達(dá)目標(biāo)位置 { map[temp_x][temp_y] += i * 1000; target_p.x = temp_x; //寫入目標(biāo)位置 target_p.y = temp_y; this->clear(); //清空隊列 return true; }break; } } if (out_queue.data == -1) //每一輪隊列的最后一個的data標(biāo)記為-1 break; //以起點位置往外一步為一輪 } if (this->End_p != NULL) this->End_p->data = -1; } this->clear(); return false; } /*自動移動(遞歸函數(shù)) * 傳參: * * 后序遞歸:先調(diào)用遞歸,再移動地點 * 因此此函數(shù)目的是一開始傳入目標(biāo)位置, * 再以地圖上的方向標(biāo)記倒推上一個位置, * 直到回到起點位置則開始移動,每次移動調(diào)用show()刷新地圖顯示 * 即可實現(xiàn)從起點到終點移動的效果 */ void mapClass::auto_move(int in_x, int in_y) { /*switch ()可替換為 * temp_x = in_x + int(sin(PI / 2 * (map[in_x][in_y] / 1000)); * temp_y = in_y + int(sin(PI / 2 * (map[in_x][in_y] / 1000 - 1.0)); */ int temp_x = in_x, temp_y = in_y; switch (map[in_x][in_y] / 1000) //解析地圖標(biāo)記 { case 0:return; break; case 1:++temp_x; break; case 2:++temp_y; break; case 3:--temp_x; break; case 4:--temp_y; break; } /*由于函數(shù)是從終點位置遞歸回起點的,所以上一個調(diào)用此函數(shù)的應(yīng)該是更接近終點的 * 因此此函數(shù)接受的傳入值(in_x, in_y)是下一個移動點 * (temp_x,temp_y)為本次的移動點 */ auto_move(temp_x, temp_y); //遞歸調(diào)用,讓起點移動到本位置(即temp_x, temp_y) map[temp_x][temp_y] = 0; //把現(xiàn)在的位置清零 map[in_x][in_y] = 100; //把下一個移動點置100,即可實現(xiàn)從現(xiàn)在的位置移動到下一個位置的效果 show_map(); //顯示打印 Sleep(Sleep_num); return; } /*構(gòu)造函數(shù) * 傳參: * in_p:起點位置 */ mapClass::mapClass(const Point& in_p) { new_map(); persion_p = in_p; } /*自動尋路主導(dǎo)函數(shù) */ bool mapClass::auto_main() { show_map(); //顯示地圖 Sleep(Sleep_num); this->clear(); //清空隊列 this->push(persion_p.x, persion_p.y, -1);//把起點入隊 Point target_p; //目標(biāo)坐標(biāo) if (auto_find_way(target_p) == false) //調(diào)用自動尋路 { reflash_map(); return false; } auto_move(target_p.x, target_p.y); //移動 reflash_map(); //清理地圖殘留標(biāo)記 persion_p = target_p; //重置起點位置,抵達(dá)終點后起點即為終點 return true; } /*對地圖寫入數(shù)據(jù)標(biāo)記 * * 傳參: * in_data:寫入的數(shù)據(jù)值 * num: 次數(shù) * * 在地圖的隨機(jī)空位置上寫入 num 次 in_data 標(biāo)記 * * 存在bug: * 如果地圖坐標(biāo)已滿,寫入次數(shù)不夠會陷入死循環(huán) * 可考慮加入循環(huán)次數(shù)限制解決 */ void mapClass::into_map(int in_data, int num) { if (num <= 0) return; for (int i = 0, j = 0; num--;) { i = rand() % Map_size; j = rand() % Map_size; if (map[i][j] == 0) map[i][j] = in_data; else ++num; } } /*對地圖寫入數(shù)據(jù)標(biāo)記 * * 傳參: * in_x,in_y:寫入的地圖位置 * in_data: 寫入的數(shù)據(jù)值 * * 返回值: * 如果(in_x, in_y)位置為空則寫入成功返回true,否則返回false * * 在地圖的(in_x, in_y)位置寫入 in_data */ bool mapClass::into_map(int in_x, int in_y, int in_data) { if (map[in_x][in_y] == 0) { map[in_x][in_y] = in_data; return true; } return false; } /*打印顯示地圖 */ void mapClass::show_map() { system("cls"); //清空控制臺輸出 for (int i = 0; i < Map_size; ++i) { for (int j = 0; j < Map_size; ++j) switch (map[i][j] % 1000) { case 0: cout << " "; break;//空白位置 case 1: cout << "□"; break;//障礙物 case 10: cout << "◇"; break;//目標(biāo) case 100: cout << "◆"; break;//自己 default: cout << " "; break; } cout << endl; } } /*重置地圖 * 傳參: * in_p:起點位置 * * 清空地圖,僅保留 起點 和 邊界 標(biāo)記 * 用于輔助循環(huán)刷新障礙物尋路的實現(xiàn) */ void mapClass::clear_map(const Point& in_p) { for (int x = Map_size - 1; --x;) //把地圖中的所有位置置零 for (int y = Map_size - 1; --y;) map[x][y] = 0; persion_p = in_p; //重新設(shè)置起點 map[in_p.x][in_p.y] = 100; }
3.main函數(shù)
main.cpp
#include <iostream> #include <time.h> #include <cmath> #include "mapClass.h" using namespace std; int main() { srand(int(time(0))); Point persion_p(1, 1), target_p(1, 1); mapClass test_map(persion_p); test_map.into_map(1, 1, 100); //寫入起點 test_map.into_map(1, 20); //寫入障礙物 while (1) { //重置障礙物位置, 取消下面兩句的注釋即可啟用 //test_map.clear_map(target_p); //清空地圖 //test_map.into_map(1, 20); //生成障礙物 do { target_p.x = rand() % (Map_size - 2) + 1; target_p.y = rand() % (Map_size - 2) + 1; } while (test_map.into_map(target_p.x, target_p.y, 10) == false); if (test_map.auto_main() == false) { cout << endl << "<< 走不了!" << endl; Sleep(1500); } } return 0; }
3.思路
總體和數(shù)據(jù)結(jié)構(gòu)的教科書上的大差不差:以起點為中心,每向外一步作為一輪循環(huán),循環(huán)中把可走的位置入隊,下一輪循環(huán)把上一輪入隊的位置出隊并再以這些位置為中心往外走一步,把可走位置入隊,一直這樣循環(huán),直到遇到終點位置或者隊列中為空(因為每一個方向都走不了則隊列循環(huán)后為空)。
(想象一下在沒有障礙物的地圖中,以起點為中心向外擴(kuò)散)
在上述過程中,把可走位置入隊的同時留下方向標(biāo)記(上一個位置走到此位置的方向),在循環(huán)結(jié)束后從終點位置倒推即可找到一條回到起點的路徑。
此路徑為最優(yōu)解(最優(yōu)解可能不止一條),因為算法中是從起點往外每一步進(jìn)行一輪判斷,因此如果找到了終點,那么就是在最少的步數(shù)內(nèi)找到了終點,此時即可結(jié)束循環(huán),此為最優(yōu)解。如果不結(jié)束,繼續(xù)找下去可能可以找到用更多步數(shù)的路徑。
本例與書中的不同:
1.在找到路徑后利用system("cls")清屏重新輸出,來實現(xiàn)逐步走向終點的效果。
2.在一些細(xì)節(jié)的實現(xiàn)上使用不同的嘗試(例如 mapClass::auto_find_way()中使用sin(),直接使用地圖做方向標(biāo)記等)
3.支持循環(huán)多次尋路,支持重置障礙物位置
到此這篇關(guān)于C++ 基于BFS算法的走迷宮自動尋路的實現(xiàn)的文章就介紹到這了,更多相關(guān)C++ 內(nèi)容請搜索腳本之家以前的文章或繼續(xù)瀏覽下面的相關(guān)文章希望大家以后多多支持腳本之家!
相關(guān)文章
C/C++之long int與long long的區(qū)別及說明
這篇文章主要介紹了C/C++之long int與long long的區(qū)別及說明,具有很好的參考價值,希望對大家有所幫助,如有錯誤或未考慮完全的地方,望不吝賜教2023-08-08C語言詳細(xì)講解strcpy strcat strcmp函數(shù)的模擬實現(xiàn)
這篇文章主要介紹了怎樣用C語言模擬實現(xiàn)strcpy與strcat和strcmp函數(shù),strcpy()函數(shù)是C語言中的一個復(fù)制字符串的庫函數(shù),strcat()函數(shù)的功能是實現(xiàn)字符串的拼接,strcmp()函數(shù)作用是比較字符串str1和str2是否相同2022-05-05C語言數(shù)組學(xué)習(xí)之特殊矩陣的壓縮存儲
矩陣在計算機(jī)圖形學(xué)、工程計算中都占有舉足輕重的地位,本文將討論如何將矩陣更有效地存儲在內(nèi)存中,并且能夠方便地提取矩陣中的元素。感興趣的同學(xué)可以了解一下2021-12-12VisualStudio類文件的管理(類文件的分離)的實現(xiàn)
在使用?Visual?Studio?開發(fā)項目的時候,學(xué)會進(jìn)行“類文件的分離”十分重要,本文主要介紹了VisualStudio類文件的管理(類文件的分離)的實現(xiàn),感興趣的可以了解一下2024-03-03