Almost working version of pathfinding working. Diagonals are being tracked though.
Added lots of stuff. Pathfinding, more configuration parameters. New dependency as well.