公开(公告)号：CN111941421A

公开(公告)日：2020-11-17

申请号：CN202010571483.6

申请日：2020-06-22

Applicant: 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院)

Inventor： 李兵 ,  李志森 ,  黄海林 ,  肖斐

IPC: B25J9/16

Abstract: 本发明提供了一种基于多机器人协同操作的自适应模糊力跟踪控制方法，包括：第一步通过目标操作物的位置信息，根据闭链形成的位置约束分别求取每一机器人末端协调位置的约束方程，以得到每一机器人的末端期望位姿；第二步根据每一机器人进行逆运动学求解，求取执行每一机器人协调操作所需的各关节转角控制指令，得到每一机器人自身当前各关节的期望角度；第三步建立导纳控制模型，进行多机器人的力跟踪控制；第四步在所建立的导纳控制模型中引入学习率η，通过模糊控制器根据目标操作物的动态变化对η进行自适应调节，进行多机器人的力跟踪控制。本发明的多机器人进行闭链约束下的协同操作时，能够实现机器人及时补偿跟踪误差，提高力跟踪精度。

公开(公告)号：CN111941421B

公开(公告)日：2022-02-18

申请号：CN202010571483.6

申请日：2020-06-22

Applicant: 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院)

Inventor： 李兵 ,  李志森 ,  黄海林 ,  肖斐

IPC: B25J9/16

Abstract: 本发明提供了一种基于多机器人协同操作的自适应模糊力跟踪控制方法，包括：第一步通过目标操作物的位置信息，根据闭链形成的位置约束分别求取每一机器人末端协调位置的约束方程，以得到每一机器人的末端期望位姿；第二步根据每一机器人进行逆运动学求解，求取执行每一机器人协调操作所需的各关节转角控制指令，得到每一机器人自身当前各关节的期望角度；第三步建立导纳控制模型，进行多机器人的力跟踪控制；第四步在所建立的导纳控制模型中引入学习率η，通过模糊控制器根据目标操作物的动态变化对η进行自适应调节，进行多机器人的力跟踪控制。本发明的多机器人进行闭链约束下的协同操作时，能够实现机器人及时补偿跟踪误差，提高力跟踪精度。