Smoother angle, takes 5 poses now
Changed dilation value of unknown free space