Ausweichwinkel-Berechnung hinzugefügt

Abhängig von gemessenen Abständen wird ein Ausweichwinkel für Roll und
ein Ausweichwinkel für Pitch berechnet.