modify pr2_ethercat main loop to use the control manager of ros_control