Korrektur avoidObstacle

Winkelkontrolle einprogrammiert. Scheint jetzt zu funktionieren.
Zumindest hängen die Schwarmmitglieder nicht mehr hin und her.