Obstacle detection for interpolation is going ok