Obstacle deteciton function