path calculator bug; after exploration robot goes back.