Algorithmus fast fertig geschrieben

und einige Hilfsfunktionen erstellt
Einige Sonderfälle müssen noch beachtet werden, und einige Funktionen
noch implementiert.