Added Multithreading to Pathfinding

Code muss noch kommentiert werden