Fix arm controllers to use a real position to torque controller
Merge remote-tracking branch 'ubi-agni/F_ros_control' into F_ros_control