Changed the maximum height of obstacles added from head so that they can be cleared from chest sensor