Updated to use new /cam3d... topics, preparations for the Gazebo study