Gonna rebuild the a* pathfinding using marks as a guide

Signed-off-by: Exikle <dixondcunha@hotmail.com>