基于关节外力估计的操作臂自适应力跟踪方法  

Adaptive Force Tracking Method of Manipulator Arm Based on Joint External Force Estimation

作　　者：叶鹏程 毛世鑫 张一超 YE Pengcheng;MAO Shixin;ZHANG Yichao(School of Mechanical and Electrical Engineering,Guangdong University of Technology,Guangzhou 510006,China;Nine Days Innovation(Guangdong)Intelligent Technology Co.,Ltd.,Foshan 528299,China;Fifth Electronics Research Institute,Ministry of Industry and Information Technology,Guangzhou 511370,China)

机构地区：[1]广东工业大学机电工程学院,广东广州510006 [2]九天创新(广东)智能科技有限公司,广东佛山528299 [3]工业和信息化部电子第五研究所,广东广州511370

出　　处：《自动化与信息工程》2025年第1期41-46,共6页Automation & Information Engineering

基　　金：国家自然科学基金面上项目(52275011);广东省科技创新战略专项资金(pdjh2022a0148);佛山市科技创新团队专项(FS0AA-KJ919-4402-0098)。

摘　　要：传统的操作臂力跟踪控制主要通过末端六维力传感器和力位混合控制方法实现,难以适应不确定环境,易产生力跟踪误差、超调等问题。为此,提出一种基于关节外力估计的操作臂自适应力跟踪方法。首先,设计一种结合广义动量和卡尔曼滤波器的扰动卡尔曼外力观测器(DKF),用于估计接触力;然后,提出自适应变导纳力跟踪方法,根据力误差自动调节导纳参数,减小力跟踪误差,提高系统的稳定性。经仿真实验验证:该文提出的DKF相较于广义动量观测器,估计误差降低约20%;自适应变导纳力跟踪方法降低了超调力,力跟踪误差降低约27%,对不确定环境有较强的适应性。Traditional manipulator arm force tracking control is mainly achieved through end six axis force sensors and force position hybrid control methods,which are difficult to adapt to uncertain environments and prone to problems such as force tracking errors and overshoot.Therefore,a method for tracking the adaptive force of a manipulator arm based on joint external force estimation is proposed.Firstly,design a disturbance Kalman force observer(DKF)that combines generalized momentum and Kalman filter for estimating contact force;Then,an adaptive variable admittance force tracking method is proposed,which automatically adjusts the admittance parameters based on the force error,reduces the force tracking error,and improves the stability of the system.Through simulation experiments,it has been verified that the DKF proposed in this paper reduces the estimation error by about 20%compared to the generalized momentum observer;The adaptive variable admittance force tracking method reduces overshoot force,reduces force tracking error by about 27%,and has strong adaptability to uncertain environments.

关 键 词：操作臂 外力估计 力跟踪控制 扰动卡尔曼外力观测器 导纳控制 

分 类 号：TP242.2[自动化与计算机技术—检测技术与自动化装置]