Improved Obstacle Removal Toolbox