add logging to nav_test launch file
CURRENTLY NOT WORKING, please adapt according to comments in code