该怎么把自己的控制的算法用在ros机械臂上呢?比如在gazebo中加入柔顺控制