added reach-until-touch method to rtmros-robot-interface
support multi limbs at a same time in reach-until-touch