Change VisualOdometer to use Nodes. Add output lines for debugging. Needs debugging (in the map filling part of Node::putIntoWorld?).
Change VisualOdometer to use Nodes. Add output lines for debugging. Needs debugging (in the map filling part of Node::putIntoWorld?).

sven-hoek/sp_navigation