copied hrpsys_ros_bridge working copy