a mini floodfill argorithm implementation for micromouse, in C