Task1.3 added, robot radius optimized!
Task 1.3 added