This is the code, basically the idea is, that if the robot collides with the wall/objects it stops, independently from the position of the small circles. Somehow i cant past
