A bit of code cleaning and more tests

Added tests for vacuum, the visualization, and navigation logic.