Cleaned out a few dependencies.
Added queue_size args, and cleaned up rviz subscribers