z_drive: updated rviz