Added GUI support to free_navigation_tester