Obstacle detection upgrade

HR130011 HEA020 HR130013