Added ROS-Hubo node and test