Changes for rviz visualization and test node sync running