added pathfinding method, currently a bit.. unfinished
added pathfinding method, currently a bit.. unfinished