Pathfinding vollständig implementiert, allerdings noch nicht auf
Funktionsfähigkeit getestet