-Use rtt_rosclock for getting time
-Add thread for ROS subscribers