Proper obstacle avoiding added