用跟踪微分器实现机器人自抗扰控制

doi:10.3969/j.issn.1000-1093.2016.09.024

摘要/Abstract

摘要： 建立基于干扰估计的机器人非线性反馈控制系统并证明其稳定性，在此基础上提出一种适用于机器人跟踪控制的新型自抗扰控制器。该控制器不需实时计算复杂的机器人动态模型，由两个跟踪微分器(TD)构成：一个用于安排系统的过渡过程；另一个用来估计速度和加速度，TD的滤波特性使其对量测噪声具有抑制作用。由被控对象的控制量与所估计加速度的反馈构成的“扩张状态”来自动检测系统模型和外扰的实时作用并实时进行动态补偿。除了和以往的自抗扰控制器一样具有很好的适应能力和很强的鲁棒性外，它还具有需整定参数少的特点。仿真结果表明，该控制器是有效的且具有很强的鲁棒性，而且系统响应快且超调小。

关键词: 控制科学与技术, 机器人, 自抗扰控制器, 加速度估计, 跟踪微分器, 扩张状态

Abstract: A disturbance estimation-based nonlinear feedback control system for robots is presented, and its stability is demonstrated. On the basis of result, a novel active disturbance rejection controller (ARDC) is proposed, which avoids the burdensome online computation of robot inverse dynamics and implement the trajectory tracking of robots. The controller comprises two tracking differentiators (TDs) , one is used to arrange the transient process of system，and the other is used to estimate velocity and acceleration. TD can attenuate measurement noise due to its filtering characteristic. “Extended state”, comprising the control input of controlled object and the feedback of estimated acceleration, is used to detect the real time effects of system model and the external disturbances, and then dynamically compensate their real-time effects. The proposed ARDC has the same good adaptability and expected robustness as previous ADRC, and it also has the characteristic of less parameters adjustment. Numerical results show that the control system has less overshoot, rapid response, and robustness.

Key words: control science and technology, robot, active disturbance rejection controller, acceleration estimation, tracking differentiator, extended state

中图分类号:

TP24

李殿起，段勇. 用跟踪微分器实现机器人自抗扰控制[J]. 兵工学报, 2016, 37(9): 1721-1729.

LI Dian-qi， DUAN Yong. Implementation of Active Disturbance Rejection Control of Robot by Tracking Differentiator[J]. Acta Armamentarii, 2016, 37(9): 1721-1729.

参考文献

［1］霍伟. 机器人动力学与控制[M]. 北京: 高等教育出版社, 2005: 123-140.
HUO Wei. Robot dynamics and control[M]. Beijing: Higher Education Press, 2005:123-140. (in Chinese)
[2] 黄一, 张文革. 自抗扰控制器的发展[J]. 控制理论与应用，2002, 19(4): 485-492.
HUANG Yi, ZHANG Wen-ge. Development of active disturbance rejection controller[J]. Control Theory & Applications, 2002, 19(4): 485-492. (in Chinese)
[3] 高志强. 自抗扰控制思想探究[J]. 控制理论与应用, 2013, 30(12):1498-1510.
GAO Zhi-qiang. On the foundation of active disturbance rejection control[J]. Control Theory & Applications, 2013, 30(12):1498- 1510. (in Chinese)
[4] 夏元清, 付梦印, 邓志红, 等. 滑模控制和自抗扰控制的研究进展[J]. 控制理论与应用, 2013, 30(2): 137-147.
XIA Yuan-qing, FU Meng-yin, DENG Zhi-hong, et al. Recent developments in sliding mode control and active disturbance rejection control[J]. Control Theory & Applications, 2013, 30(2): 137-147. (in Chinese)
[5] 韩京清. 控制系统的非光滑综合[C]∥第十九届中国控制会议论文集（二）.香港:中国自动化学会控制理论专业委员会, 2000: 483-488.
HAN Jing-qing. Non-smooth feedback synthesis for control system[C]∥Proceedings of 19th Chinese Conference on Control. Hong Kong, China: Technical Committee on Control Theory, Chinese Association of Automation, 2000:483-488. (in Chinese)
[6] 韩京清. 自抗扰控制器及其应用[J]. 控制与决策,1998, 13(1): 19-23.
HAN Jing-qing. Auto-disturbances-rejection controller and its applications[J]. Control and Decision, 1998, 13(1):19-23. (in Chinese)
[7] Huang Y, Luo Z W, Svinin M, et al. Extended state observer based technique for control of robot systems[C]∥4th World Congress on Intelligent Control and Automation. Shanghai, China: Institute of Electrical and Electronics Engineers Inc, 2002: 2807-2811.
[8] Su Y X, Duan B Y, Zheng C H, et al. Disturbance-rejection high-precision motion control of aStewart platform[J]. IEEE Transactions on Control Systems Technology, 2004, 12(3):364-374.
[9] 阮晓钢, 王旭, 陈志刚. 独轮机器人的建模与自抗扰控制算法[J]. 控制与决策,2015, 30(12): 2253-2258.
RUAN Xiao-gang, WANG Xu, CHEN Zhi-gang. Modeling and active disturbance rejection control algorithm of single wheel robot[J]. Control and Decision, 2015, 30(12):2253-2258. (in Chinese)
[10] 熊有伦，丁汉，刘恩沧. 机器人学[M]. 北京:机械工业出版社, 1993: 200-219.
XIONG You-lun, DING Han, LIU En-cang. Robotics[M]. Beijing: China Machine Press, 1993: 200-219. (in Chinese)
[11] Hsia T C, Gao L S. Robot manipulator control using decentralized linear time-invariant time-delayed joint controllers[C]∥1990 IEEE International Conference on Robotics and Automation. Cincinnati, OH, US:IEEE,1990:2070-2075.
[12] Ghorbel F, Srinivasan B, Spong M W. On the uniform boundedness of the inertia matrix of serial robot manipulators[J]. Journal of Robotic Systems, 1998, 15(1):17-28.
[13] Belanger P R, Dobrovolny P, Helmy A, et al. Estimation of angular velocity and acceleration from shaft-encoder measurements[J]. International Journal of Robotics Research, 1998, 17(11): 1225-1233.
[14] 黄焕袍, 武利强, 韩京清, 等. 火电单元机组协调系统的自抗扰控制方案研究[J]. 中国电机工程学报, 2004, 24(10): 168-173.
HUANG Huan-pao，WU Li-qiang，HAN Jing-qing，et al. A study of active disturbance rejection control on unit coordinated control system in thermal power plant[J]. Proceedings of the Chinese Society for Electrical Engineering, 2004, 24(10): 168-173. (in Chinese)
[15] 韩京清, 黄远灿. 二阶跟踪—微分器的频率特性[J]. 数学的实践与认识, 2003, 33(3): 71-74.
HAN Jing-qing, HUANG Yuan-can. Frequency characteristic of second-order tracking-differentiator[J]. Mathematics in Practice and Theory, 2003, 33(3):71-74.(in Chinese)
[16] Guo B Z, Zhao Z L. on convergence of racking differentiator[J]. International Journal of Control, 2011, 84(4): 693-701.
[17] Li D Q, Xue D Y, Li T, et al. Dynamic model of a 3 DOF direct drive robot and its control mode[C]∥IEEE International Conference on Control and Automation. Guangzhou, China: IEEE Control Systems Society, 2007: 2694-2698.
[18] 李述清, 张胜修, 刘毅男, 等. 根据系统时间尺度整定自抗扰控制器参数[J]. 控制理论与应用, 2012, 29(1): 125-129.
LI Shu-qing, ZHANG Sheng-xiu, LIU Yi-nan, et al. Parameter-tuning in active disturbance rejection controller using time scale[J]. Control Theory & Applications, 2012, 29(1):125-129. (in Chinese)
[19] Kane T R, Levinson D A. The use of Kane's dynamical equations in robotics[J]. International Journal of Robotics Research, 1983, 2(3): 3-21.
[20] 李殿起, 薛定宇, 崔建国, 等. 一种新型的速度和加速度估计器[J]. 系统仿真学报. 2008, 20(15): 4132-4135.
LI Dian-qi, XUE Ding-yu, CUI Jian-guo, et al. Novel velocity and acceleration estimator[J]. Journal of System Simulation, 2008, 20(15):4132-4135.(in Chinese)

[1]	张天艺, 郑颖, 裘信国, 季行健, 金晓航. 基于特征模型的5阶关节伺服系统扰动补偿策略[J]. 兵工学报, 2024, 45(1): 276-287.
[2]	刘江涛, 周乐来, 李贻斌. 复杂地形六轮独立驱动与转向机器人轨迹跟踪与避障控制[J]. 兵工学报, 2024, 45(1): 166-183.
[3]	许鹏, 邢伯阳, 刘宇飞, 李泳耀, 曾怡, 郑冬冬. 基于扩张状态观测器和模型预测方法的四足机器人抗干扰复合控制[J]. 兵工学报, 2023, 44(S2): 12-21.
[4]	刘思宇, 廖峻北, 雷飞, 王志瑞, 闫曈, 党睿娜, 郭朝. 用于四足机器人的并联弹性腿足关节设计与优化[J]. 兵工学报, 2023, 44(S2): 71-83.
[5]	降晨星, 姚其昌, 许鹏, 周雨婷, 闫曈. 新技术形势下四足、双足机器人技术的变革[J]. 兵工学报, 2023, 44(S2): 84-89.
[6]	鞠爽, 王晶, 王灏, 周萌. 基于GWO-WOA的执行器严重故障多移动机器人编队重构控制[J]. 兵工学报, 2023, 44(S2): 114-125.
[7]	许鹏, 赵建新, 范文慧, 邱天奇, 江磊, 梁振杰, 刘宇飞. 四足机器人特定复杂运动技能控制[J]. 兵工学报, 2023, 44(S2): 135-145.
[8]	李曹妍, 郭振川, 郑冬冬, 魏延岭. 基于分布式模型预测控制的多机器人协同编队[J]. 兵工学报, 2023, 44(S2): 178-190.
[9]	许威, 苏波, 江磊, 闫曈, 许鹏, 王志瑞, 邱天奇. 足式越野机器人集群系统关键技术与应用展望[J]. 兵工学报, 2023, 44(9): 2568-2579.
[10]	苏波, 江磊, 刘宇飞, 邢伯阳, 李泳耀, 谭森起, 王志瑞. 移动机器人跨域跃质关键技术综述[J]. 兵工学报, 2023, 44(9): 2556-2567.
[11]	王治霖, 王江, 祁琪, 范世鹏. 基于LESO的新型自适应鲁棒滚转通道控制算法[J]. 兵工学报, 2023, 44(7): 1920-1929.
[12]	李姗姗, 王洪波, 陈建宇, 张兴超, 田俊杰, 牛建业. 新型四足并联军用机器人步态控制算法及仿真[J]. 兵工学报, 2023, 44(3): 895-909.
[13]	高强, 侯远龙, 吕明明, 毛斌, 侯润民, 羊书毅, 吴斌. 某新型车载多管负载行进间稳定控制方法[J]. 兵工学报, 2023, 44(3): 736-747.
[14]	尚哲, 王挺, 徐瑶, 吴英彪, 邵沛瑶, 邵士亮. 六轮摇臂移动机器人结构设计与越障动力学研究[J]. 兵工学报, 2023, 44(11): 3478-3488.
[15]	李辉, 宁峰平, 郭辉, 李瑞琴. 3-PRPS/RRR踝关节康复机器人运动机理研究与试验[J]. 兵工学报, 2023, 44(10): 3026-3037.