Erster Prototyp des Wegfindungsalgorithmus