adjust rviz config
fix diagnostics in simulation