Modified radius of obstacles
Removed println calls