todo: 
1. Abstand richtig implementieren. Funktion nur OK solange Abstand =1
2. Kurven nur OK solange Urspung in [0,0,0]