Added test code for communication via ROS