Worked on obstacle expansion