Kollision behoben
Trajektorien generieren und in Simulation gehackt