Removing obstacle when setting start/goal point and fixing the indentetion