LiDAR obstacle avoidance