only interpolate move into unoccupied cells
Merge branch 'dev' of https://github.com/robeat101/HRI into dev