Ameisenbewegung verbessert

Pseudocode für die Ameisenbewegung geschrieben
Routen optimierung eingebaut