98 lines
2.2 KiB
C++
98 lines
2.2 KiB
C++
#include <string>
|
|
#include <sys/types.h>
|
|
#include "api.h"
|
|
#include <queue>
|
|
|
|
struct mmstats {
|
|
int y;
|
|
int x;
|
|
}stats;
|
|
|
|
struct fill {
|
|
int x, y, z;
|
|
};
|
|
|
|
struct maze { /* Distancias de Manhattan */
|
|
public:
|
|
int vwalls[15][15];
|
|
int hwalls[15][15];
|
|
int mhtn[16][16];
|
|
maze(){
|
|
mhtn[7][7] = 0; /* las celdas del centro tienen */
|
|
mhtn[7][8] = 0; /* un valor de cero porque son */
|
|
mhtn[8][7] = 0; /* la meta. */
|
|
mhtn[8][8] = 0;
|
|
}
|
|
}maze;
|
|
|
|
void flood(struct maze*, struct mmstats*);
|
|
|
|
void flood(struct maze* maze, struct mmstats* mmstats) {
|
|
const int w = 15; /* X lenght*/
|
|
int i, j;
|
|
int prevNum;
|
|
int marked[16][16];
|
|
std::queue<fill> myqueue;
|
|
|
|
myqueue.push({6,7,0});
|
|
myqueue.push({6,8,0});
|
|
myqueue.push({7,6,0});
|
|
myqueue.push({8,6,0});
|
|
|
|
myqueue.push({9,7,0});
|
|
myqueue.push({9,8,0});
|
|
myqueue.push({7,9,0});
|
|
myqueue.push({8,9,0});
|
|
|
|
|
|
marked[7][7] = 1; /* las celdas del centro tienen */
|
|
marked[7][8] = 1; /* un valor de cero porque son */
|
|
marked[8][7] = 1; /* la meta. */
|
|
marked[8][8] = 1;
|
|
|
|
while (myqueue.size()) {
|
|
i = myqueue.front().x;
|
|
j = myqueue.front().y;
|
|
prevNum = myqueue.front().z;
|
|
myqueue.pop();
|
|
|
|
if (mmstats->x == i && mmstats->y == j) {
|
|
log("flood end");
|
|
break;
|
|
}
|
|
|
|
if (i < 0 || i > w || j < 0 || j > w
|
|
|| marked[i][j]==1) {
|
|
continue;
|
|
}
|
|
else {
|
|
API::setText(i, j, prevNum+1);
|
|
maze->mhtn[i][j] = prevNum+1;
|
|
marked[i][j] = 1;
|
|
myqueue.push({i+1, j, prevNum +1});
|
|
myqueue.push({i-1, j, prevNum +1});
|
|
myqueue.push({i, j+1, prevNum +1});
|
|
myqueue.push({i, j-1, prevNum +1});
|
|
}
|
|
}
|
|
}
|
|
|
|
int main(int argc, char* argv[]) {
|
|
log("Running...");
|
|
API::setColor(0, 0, 'G');
|
|
// API::setText(0, 0, "abc");
|
|
API::setWall(1, 0, 'e');
|
|
stats = {0,0};
|
|
flood(&maze, &stats);
|
|
|
|
while (false) {
|
|
if (!API::wallLeft()) {
|
|
API::turnLeft();
|
|
}
|
|
while (API::wallFront()) {
|
|
API::turnRight();
|
|
}
|
|
API::moveForward();
|
|
}
|
|
}
|