液压驱动单元基于力的阻抗控制系统前馈抗扰控制研究

doi:10.3901/JME.2023.04.295

机械工程学报 ›› 2023, Vol. 59 ›› Issue (4): 295-307.doi: 10.3901/JME.2023.04.295

扫码分享

液压驱动单元基于力的阻抗控制系统前馈抗扰控制研究

朱琦歆¹, 俞滨^1,2, 王春雨¹, 巴凯先^1,2, 孔祥东^1,2

1. 燕山大学机械工程学院秦皇岛 066004;
2. 燕山大学河北省重型机械流体动力传输与控制实验室秦皇岛 066004

收稿日期:2022-08-25 修回日期:2022-12-20 出版日期:2023-02-20 发布日期:2023-04-24
通讯作者: 巴凯先(通信作者),男,1989年出生,博士,副教授。主要研究方向为液压伺服控制系统、液压足式机器人轻量化设计与控制。E-mail:bkx@ysu.edu.cn
作者简介:朱琦歆,男,1992年出生,博士研究生。主要研究方向为足式机器人运动控制、液压系统功率匹配与优化。E-mail:qixinz@ysu.edu.cn;俞滨,男,1985年出生,博士,副教授,博士研究生导师。主要研究方向为足式机器人液压系统设计与控制、电液伺服控制系统。E-mail:yb@ysu.edu.cn;孔祥东,男,1959 年出生,博士,教授,博士研究生导师。主要研究方向为流体传动与控制。E-mail:xdkong@ysu.edu.cn
基金资助:
国家优秀青年科学基金(52122503)、国家自然科学基金(51905465, 51975506)和河北省研究生创新(CXZZBS2021133)资助项目。

Research on Feedforward Disturbance Rejection Control for Force-based Impedance Control System of Hydraulic Drive Unit

ZHU Qixin¹, YU Bin^1,2, WANG Chunyu¹, BA Kaixian^1,2, KONG Xiangdong^1,2

1. School of Mechanical Engineering, Yanshan University, Qinhuangdao 066004;
2. Hebei Provincial Key Laboratory of Heavy Machinery Fluid Power Transmission and Control, Yanshan University, Qinhuangdao 066004

Received:2022-08-25 Revised:2022-12-20 Online:2023-02-20 Published:2023-04-24

摘要/Abstract

摘要： 液压驱动单元(Hydraulic drive unit, HDU)是液压驱动型足式机器人常用的关节驱动器，具有集成度高、功率密度大等特性。机器人顶层规划后，需依靠其完成具体动作，实现机器人的行走、对角小跑、奔跑等步态。HDU所受外负载会随机器人腾空相和着地相频繁大幅变化，严重影响系统性能。若HDU具备高性能基于力的阻抗控制，则可有效减小机器人在运动过程中足地接触时的碰撞力，保证机器人运动的平稳性。为提高基于力的阻抗控制系统的抗外扰动能力，研究一种前馈抗扰控制(Feedforward disturbance rejection control, FDRC)。介绍HDU基于力的阻抗控制系统及其数学模型，推导其非线性状态空间表达式。针对系统的外扰动推导等价输入矩阵，设计前馈抗扰控制器，并估算伺服阀流量系数。利用HDU性能测试试验台，针对不同工况和典型信号进行试验。试验结果表明，FDRC可大幅提高HDU基于力的阻抗控制系统的抗外扰动能力，且工况适应性良好。该控制方法可降低外扰动对液压驱动型机器人的影响，提高机器人的适应性。

关键词: 液压驱动型足式机器人, 液压驱动单元, 基于力的阻抗控制, 前馈抗扰控制

Abstract: Hydraulic drive unit(HDU) is a common joint driver of the hydraulic drive legged robot, which has the characteristics of high integration and high power density. After the top-level planning of the robot, it need to rely on it to complete specific actions, to realize the gait of the robot, such as walking, diagonal trot, running and so on. The external load on the HDU will change greatly with the suspension phase and touchdown phase of the robot, which will seriously affect the system performance. If HDU has high performance force-based impedance control, it can effectively reduce the collision force when the foot end contacts with the ground in the process of motion, and ensure the stability of the robot movement. In order to improve the ability of force-based impedance control system to resist external disturbance, a feedforward disturbance rejection control(FDRC) is studied. Firstly, the force-based impedance control system of HDU and its mathematical model are introduced, and its nonlinear state space expression is derived. Secondly, according to the external disturbance of the system, the equivalent input matrix is derived, the FDRC is designed and the flow coefficient of the servo valve is estimated. Finally, the HDU performance test platform is used to test different working conditions and typical signals. The experimental results show that FDRC can greatly improve the ability of resisting external disturbance of the force-based impedance control system of HDU, and it has good adaptability to operating conditions. This control method can reduce the influence of external disturbance on the hydraulic drive legged robot and improve the adaptability of the robot.

Key words: hydraulic drive legged robot, hydraulic drive unit, force-based impedance control, feedforward disturbance rejection control(FDRC)

中图分类号:

TH137

朱琦歆, 俞滨, 王春雨, 巴凯先, 孔祥东. 液压驱动单元基于力的阻抗控制系统前馈抗扰控制研究[J]. 机械工程学报, 2023, 59(4): 295-307.

ZHU Qixin, YU Bin, WANG Chunyu, BA Kaixian, KONG Xiangdong. Research on Feedforward Disturbance Rejection Control for Force-based Impedance Control System of Hydraulic Drive Unit[J]. Journal of Mechanical Engineering, 2023, 59(4): 295-307.

参考文献

[1] HU Biao,CAO Zhengcai,ZHOU Mengchu. An efficient RRT-based framework for planning short and smooth wheeled robot motion under kinodynamic constraints[J]. IEEE Transactions on Industrial Electronics,2021,68(4):3292-3302.
[2] BARAKAT M H,AMMAR H H,ELSAMANTY M. Experimental path tracking optimization and control of a nonlinear skid steering tracked mobile robot[C]//The 2nd Novel Intelligent and Leading Emerging Sciences Conference,October 24-26,2020. Giza:2020 2nd Novel Intelligent and Leading Emerging Sciences Conference,2020:434-438.
[3] 周坤,李川,李超,等. 面向未知复杂地形的四足机器人运动规划方法[J]. 机械工程学报,2020,56(2):210-219. ZHOU Kun,LI Chuan,LI Chao,et al. Motion planning method for quadruped robot facing unknown complex terrain[J]. Journal of Mechanical Engineering,2020,56(2):210-219.
[4] 龚道雄,何睿,于建均,等. 一种气动肌肉拮抗驱动机器人关节的类人运动控制方法[J]. 机器人,2019,41(6):803-812. GONG Daoxiong,HE Rui,YU Jianjun,et al. A humanoid motion control method for pneumatic muscle antagonism actuating robot joints[J]. Robot,2019,41(6):803-812.
[5] WOODEN D,MALCHANO M,BLANKESPOOR K,et al. Autonomous navigation for BigDog[C]//IEEE International Conference on Robotics & Automation,May 3-7,2010. Anchorage:2010 IEEE International Conference on Robotics and Automation,2010:4736-4741.
[6] BAJRACHARYA M,MA J,MALCHANO M,et al. High fidelity day/night stereo mapping with vegetation and negative obstacle detection for vision-in-the-loop walking[C]//2013 IEEE/RSJ International Conference on Intelligent Robots and Systems,November 3-7,2013. Tokyo,2013:3663-3670.
[7] SPARROW R. Kicking a robot dog[C]//ACM/IEEE International Conference on Human-Robot Interaction (HRI),March 7-10,2016. Christchurch,2016:229-229.
[8] SEMINI C,TSAGARAKIS N G,GUGLIELMINO E,et al. Design of HyQ-a hydraulically and electrically actuated quadruped robot[J]. Proceedings of the Institution of Mechanical Engineers,Part I:Journal of Systems and Control Engineering,2011,225(I6):831-849.
[9] SEMINI C,BARASUOL V,GOLDSMITH J,et al. Design of the hydraulically-actuated, torque-controlled quadruped robot HyQ2Max[J]. IEEE/ASME Transactions on Mechatronics,2016,22(2):635-646.
[10] FAHMI S,FOCCHI M,RADULESCU A,et al. Semini. STANCE:Locomotion adaptation over soft terrain[J],IEEE Transactions on Robotics,2020,36(2):443-457.
[11] 俞滨,巴凯先,孔祥东,等. 一种用于机器人的一体化液压驱动器:中国,CN2017203975356[P]. 2017-12-26. YU Bin,BA Kaixian,KONG Xiangdong,et al. An integrated hydraulic actuator for robot:China,CN2017203975356[P]. 2017-12-26.
[12] 孔祥东,俞滨,权凌霄,等. 一种高集成性液压驱动单元结构:中国,CN201720397535.6[P]. 2015-04-29. KONG Xiangdong,YU Bin,QUAN Lingxiao,et al. A highly integrated hydraulic drive unit structure:China,CN201720397535.6[P]. 2015-04-29.
[13] 李海源,刘畅,严鲁涛,等. 上肢外骨骼机器人的阻抗控制与关节试验研究[J]. 机械工程学报,2020,56(19):200-209. LI Haiyuan,LIU Chang,YAN Lutao,et al. Impedance control and joint test of upper limb exoskeleton robot[J]. Journal of Mechanical Engineering,2020,56(19):200-209.
[14] 武文. 冗余自由度机器人操作臂主动柔顺控制研究[D]. 哈尔滨:哈尔滨工业大学,2019. WU Wen. Research on active compliance control of manipulator with redundant DOF[D]. Harbin:Harbin Institute of Technology,2019.
[15] 巴凯先,孔祥东,朱琦歆,等. 液压驱动单元基于位置/力的阻抗控制机理分析与试验研究[J]. 机械工程学报,2017,53(12):172-185. BA Kaixian,KONG Xiangdong,ZHU Qixin,et al. Analysis and experimental study of position/force based impedance control mechanism of hydraulic drive unit[J]. Journal of Mechanical Engineering,2017,53(12):172-185.
[16] 金坤善,宋建丽,李永堂,等. 四辊卷板机侧辊位移线性自抗扰控制[J]. 机械工程学报,2019,55(24):72-82. JIN Kunshan,SONG Jianli,LI Yongtang,et al. Linear active disturbance rejection control for side roll displacement of four-roll plate coiler[J]. Journal of Mechanical Engineering,2019,55(24):72-82.
[17] WANG Bin,JI Hengyu,CHANG Rui. Position control with ADRC for a hydrostatic double-cylinder actuator[J]. Actuators,2020,9(4):112.
[18] HA L K,GUK B S,RYEOL C H,et al. Feedforward model-inverse position control of three-stage servo-valve using zero magnitude error tracking control[J]. ARCHIVE Proceedings of the Institution of Mechanical Engineers Part C Journal of Mechanical Engineering Science,2018,233(7):2340-2348.
[19] WANG Xingxu,HE Guang,GAO Rui. PID sliding mode control for electro-hydraulic servo system[J]. Journal of Physics:Conference Series,2019,1168(2):22085-22085.
[20] DANG Xuanju,ZHAO Xiaoan,DANG Chao,et al. Incomplete differentiation-based improved adaptive backstepping integral sliding mode control for position control of hydraulic system[J]. ISA Transactions,2020,109:199-217.
[21] 龚征华,李刚强,熊文,等. 喷水推进操舵控制系统干扰观测器设计[J]. 上海交通大学学报,2016,50(7):1114-1118. GONG Zhenghua,LI Gangqiang,XIONG Wen,et al. Design of disturbance observer for hydraulic propulsion steering control system[J]. Journal of Shanghai Jiaotong University,2016,50(7):1114-1118.
[22] DAO H V,TRAN D T,AHN K K. Active fault tolerant control system design for hydraulic manipulator with internal leakage faults based on disturbance observer and online adaptive identification[J]. IEEE Access,2021(9):23850-23862.
[23] 李向阳,高志强. 抗扰控制中的不变性原理[J]. 控制理论与应用,2020,37(2):236-244. LI Xiangyang,GAO Zhiqiang. Invariant principle in disturbance rejection control[J]. Control Theory and Applications,2020,37(2):236-244.
[24] BA Kaixian,YU Bin,GAO Zhengjie,et al. An improved force-based impedance control method for the HDU of legged robots[J]. ISA Transactions,2018,84:187-205.
[25] BA Kaixian,YU Bin,KONG Xiangdong,et al. Parameters sensitivity characteristics of highly integrated valve-controlled cylinder force control system[J]. Chinese Journal of Mechanical Engineering,2018,31(1):43.

液压驱动单元基于力的阻抗控制系统前馈抗扰控制研究

Research on Feedforward Disturbance Rejection Control for Force-based Impedance Control System of Hydraulic Drive Unit

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 4

编辑推荐

Metrics

本文评价

[1]	俞滨, 李化顺, 黄智鹏, 何小龙, 巴凯先, 史亚鹏, 孔祥东. 足式机器人液压驱动关键技术研究综述[J]. 机械工程学报, 2023, 59(19): 81-110.
[2]	俞滨, 巴凯先, 王东坤, 刘雅梁, 李文锋, 孔祥东. 液压驱动单元位置控制系统前馈补偿控制研究[J]. 机械工程学报, 2018, 54(20): 159-169.
[3]	巴凯先, 孔祥东, 朱琦歆, 李春贺, 赵华龙, 俞滨. 液压驱动单元基于位置/力的阻抗控制机理分析与试验研究[J]. 机械工程学报, 2017, 53(12): 172-185.
[4]	孔祥东;俞滨;权凌霄;巴凯先. 四足仿生机器人液压驱动单元轨迹灵敏度分析[J]. , 2013, 49(14): 170-175.