#include <string>
#include <sys/types.h>
#include "api.h"
#include <queue>

// floodfill

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;

    API::setText(7, 7, 0);
    API::setText(7, 8, 0);
    API::setText(8, 7, 0);
    API::setText(8, 8, 0);

    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();
   }
}