Fix callback queues

Replace ros::spin by private callback queues declared before adding subscriptors