implementace objíždění v testingPanelu
u6 jenom p5edhazovat správný waypointy