一种多机械臂协同打磨力柔顺控制方法和系统

摘要

本发明提供了一种多机械臂协同打磨力柔顺控制方法和多机械臂协同打磨力柔顺控制系统，控制方法包括1)给定目标物体的参考位置、期望抓取内力和期望打磨力；2)对两个抓取机械臂协作所形成的闭链进行位置分解，建立闭链动力学位置约束方程；3)通过力传感器获取两个抓取机械臂末端对目标物体的作用力信号，对该作用力信号进行卡尔曼滤波处理；4)建立动态自适应阻抗控制方程，根据真实内力和期望内力得到两个抓取机械臂末端的位置补偿，根据打磨机械臂末端对目标物体的作用力信号和期望打磨力得到打磨机械臂末端的位置补偿。本发明能够在确保多机械臂协同操作的同时，将机械臂末端夹持力控制在期望值的范围，并且实现恒定的打磨力控制。