Added queue_size args, and cleaned up rviz subscribers