-Fix severe bug when not using square size maps (would results in completely wrong obstacle distances and coordinates)