Merge pull request #12 from JohanJohansson/master

Updates from Johan
Merge pull request #2 from RoboGroup3/master

merge to haso
now navigate to closes unexplored space
Merge pull request #13 from hasofanten/master

Now possible to navigate to closest unexplored space
Added goal finding node and modified cmake and package files to run it
merge changes
Merge branch 'valeRB-master'
Merge pull request #14 from valeRB/master

Added goal finding node and modified cmake and package files to run it
Merge pull request #15 from JohanJohansson/master

Updates from Robot
Publish cell positions of objects
Merge pull request #16 from valeRB/master

Publish cell positions of objects
Merge pull request #2 from RoboGroup3/master

Updates from Robot