kleine Änderungen hier und da
Dijkstra bricht nun ab sobald er den Zielknoten markiert hat und nimmt
auch die richtigen Nachfolgeknoten