基于自适应边界能量法的柔顺力控制研究

王洪艳，刘春洁，黄 智



基于自适应边界能量法的柔顺力控制研究

王洪艳1，刘春洁2，黄 智1

(1. 电子科技大学机械电子工程学院 成都 611731； 2. 黑龙江建筑职业技术学院 哈尔滨 150025)

阻抗控制方法是有效的机器人接触控制方法，但是该方法只能在预估的环境参数范围内保证系统的稳定性。针对这一问题，该文提出一种新的自适应边界能量(Energy Boundary Method-EBM)方法，通过在线估计控制参数提高系统整体性能，保证系统的稳定性。在该控制方法下，系统在与超出预估范围内的不确定环境相接触时，仍可保持期望的稳定接触力，同时具备较强的鲁棒性。为证实该方法的可行性及有效性，以气液联控柔顺力控制系统为例，进行理论及仿真研究，理论性能及仿真结果分析证明了该方法的有效性。

自适应控制; 柔顺力控制; 边界能量算法; 阻抗控制

近年来，工业机器人已经被广泛使用在许多工厂自动化领域。在机器人的众多执行任务中，与环境相接触的任务必不可少。机器人的接触任务不仅需要位置控制，而且也需要对接触力进行控制，这样才能保证机器人与环境之间的安全工作模式。以往，许多学者针对机器人稳定接触任务问题提出了力控制方法[1-2]。其中，阻抗控制和位置/力混合控制是机器人力控制的两个主要策略[3-4]。

通常的工业机器人具备精确且鲁棒性高的位置控制器。基于这一发展现状，以位置控制器作为控制内环的基于位置的阻抗控制策略(position based impedance control, PBIC)被首先应用于执行交互任务的工业机器人[5]。该方法不需要修改任何传统的位置控制器，能够完成系统由自由运动到接触运动的平稳转换。然而，当接触环境参数超出控制器设计阶段所预估值以外的情况，PBIC就很可能不能保证接触任务的稳定性[6]。在这种情况下，由于系统的稳定性与外界环境参数密切相关，基于模型鲁棒控制方法的阻抗控制机器人必须对阻抗控制中的参数进行重新设计。为防止环境参数变化引起潜在的不稳定问题，针对未知不确定的环境参数离线估计方法、文献[7-8]提出在线识别方法以及自适应阻抗控制等方法。同时，基于神经网络和模糊控制和的智能力控制算法与传统控制方法结合，补充了其自身控制方法的不足，提高了系统性能[9]。然而，这些控制算法难以解决环境参数巨幅变化的情况。

本文提出一种新的自适应边界能量(EBM)控制算法，该方法首先将工业机器人由位置控制模式变为基于位置的阻抗控制(PBIC)模式，然后根据实验或经验所得环境参数范围设计PBIC控制器。在通常情况下，由于实验和经验的限制，这些环境参数有可能是不确定参数或变量，而自适应边界能量法通过在线估计控制参数来提高性能。同时，当环境参数在初始预估的范围内时，这种自适应边界能量法能够保留最初的阻抗控制性能。该方法使用基于位置控制的阻抗模式完成接触力任务，并能保证具有鲁棒性的稳定接触，尤其适用于环境刚度巨幅变化的场合。

1 气液联控(PHCC)柔顺力控制系统描述及其建模

1.1 系统描述

气液联控伺服系统是基于克服或者补偿气体介质的根本缺点，将液体介质引入到常规气压伺服系统中，并进行控制而构成的一种新型的气、液介质复合控制系统[10]。试验证明，这种气液联控系统既能够保持气压伺服系统的快速性和柔顺性等特点，又能够提高定位精度和定位刚度，提高系统的低速性能[11]。该系统具有刚柔兼并的优点，尤其适合应用于进行接触任务的机器人系统中，因此，本文以该系统为例验证自适应EBM算法的有效性。

气液联控柔顺力控制系统结构如图1所示，该系统可以划分成两部分。左侧是气液联控伺服系统，由气液串联缸、负载、两位三通电磁阀、位移传感器、力传感器及其驱动电路等组成。右侧为环境模拟系统，由气缸、位移传感器、两位三通电磁阀及其驱动电路等组成。

1.2 PHCC系统动力学建模

2 基于位置的阻抗控制(PBIC)

图2 PBIC原理框图

3 基于PBIC的自适应边界能量法

阻抗控制下，单自由度机械手受力情况如图3所示。

在该控制结构下，被控系统的动力学可表示为：

图3 阻抗控制下单自由度机械手受力示意图

图4为基于阻抗控制的自适应EBM网络能量流布示意图。

图4 基于阻抗控制的自适应EBM网络能量图

如果在任意时间段[0,]内，端口吸收的净能量大于或等于在相同时间段内净能量存储的增加量，那么这个单端口网络系统就是被动的，即有：

首先，在0≤<的时间内，流入导纳子系统的净能量为：

其次，在0≤<的时间段内，流入SCE子系统的净能量为：

由式(7)～式(8)可知，如果下式成立，则整个机器人环境交互系统为被动系统：

将式(4)带入式(7)，则有：

利用Cauchy–Schwarz不等式，有：

式(12)可变为：

将式(13)分成两个部分，可以定义两个条件如下：

1)

2)

式(13)能够成立的充分条件是同时满足条件1)和条件2)。

接触力的自适应EBM控制递归公式为：

式中，有：

图5为自适应EBM算法的整体框图。

图5 自适应EBM算法框图

由式(14)和式(16)可得：

4 仿真研究

仿真中，设定环境模拟系统中弹簧刚度值(1.1 N/mm)远远超出算法中对于环境刚度的预估值(0.6 N/mm)。图6和图7分别为环境模拟系统固定不动情况和作正弦运动的仿真结果图。其中，图6a为采用常规自适应控制算法的仿真结果图，图6b为采用自适应EBM控制算法的仿真结果图。从仿真结果来看，当环境刚度超出预估范围时，常规的自适应控制算法不能保证系统正常运行，出现不稳定的振荡现象。而采用自适应EBM控制算法可以很好的保证系统的稳定性，能够保证自由运动与接触运动稳定过渡，系统柔顺力跟踪性能良好。

a. 常规自适应控制仿真结果图

b. 自适应EBM算法控制仿真结果图

图6 环境模拟系统不动情况

a. 常规自适应控制仿真结果图

b. 自适应EBM算法控制仿真结果图

图7 环境模拟系统做正弦运动仿真结果图

5 结束语

本文针对阻抗控制中环境预估不精准对系统稳定性造成较坏影响的问题，提出一种自适应EBM控制算法。以气液柔顺力控制系统为例，进行了仿真研究。仿真结果表明，所提控制策略能够较好的实现系统的柔顺力控制。在保证系统具备良好动态性能的基础上，解决了当环境参数预估不准确情况下柔顺力控制的稳定性问题

[1] CHIAVERINI S, SICILIANO B, VILLANI L. A survey of robot interaction control schemes with experimental comparison[J]. Mechatronics, 1999, 4(3): 273-285.

[2] DE SANTIS A, SICILIANO B, DE LUCA A, et al. An atlas of physical human-robot interaction[J]. Mechanism and Machine Theory, 2008, 43(3): 253-270.

[3] 姜力, 蔡鹤皋, 刘宏. 基于滑模位置的机器人灵巧手模糊自适应阻抗控制[J]. 控制与决策, 2001, 16(5): 612-616.

JANG Li, CAI He-gao, LIU Hong. Fuzzy adaptive impedance control of dextrous robot hand based on sliding mode position control[J]. Control and Decision, 2001, 16(5): 612-616.

[4] NAVEEN K, VIKAS P, NAGARAJAN S, et al. Neural network based hybrid force/position control for robot manipulators[J]. International Journal of Precision Engineering and Manufacturing, 2011, 3(12): 419-426.

[5] AREVALO J C, GARCIA E. Impedance control for legged robots: an insight into the concepts involved[J]. Systems, Man, and Cybernetics, Part C: Applications and Reviews, 2012, 6(42): 1400-1411.

[6] MEHDI H, BOUBAKER O. Stiffness and impedance control using lyapunov theory for robot-aided rehabilitation [J]. International Journal of Social Robotics, 2011, 1(4): 107-119.

[7] JLASSI S, TLIBA S. An event-controlled online trajectory generator based on the human-robot interaction force processing[J]. Industrial Robot, 2014, 1(41): 15-25.

[8] SHARIFI M, BEHZADIPOUR S, VOSSOUGHI G. Nonlinear model reference adaptive impedance control for human-robot interactions[J]. Control Engineering Practice, 2014, 1(32): 9-27.

[9] MAI Thang-long, WANG Yao-nan. Adaptive-backstepping force/motion control for mobile-manipulator robot based on fuzzy CMAC neural networks[J]. Control Theory and Technology, 2014, 12(4): 368-382.

[10] 王洪艳, 陆金波. PHCC平台下鲁棒性阻抗控制算法的研究[J], 电子科技大学学报, 2014, 31(5): 794-799.

WANG Hong-yan, LU Jin-bo. Robust impedance control method on PHCC system[J]. Journal of University of Electronic Science and Technology of China, 2014, 31(5): 794-799.

[11] 王洪艳, 赵克定, 徐秀芬, 等. 气液联控柔顺力控制系统及其自适应试验研究[J]. 西安交通大学学报, 2007, 41(9): 1106-1109.

WANG Hong-yan, ZHAO Ke-ding, XU Xiu-fen, et al. Pneumatic hydraulic combination compliant force control system with adaptive experiments[J]. Journal of Xi’an Jiaotong University, 2007, 41(9): 1106-1109.

[12] JUNG S, HSIA T C, BONITZ R G. Force tracking impedance control of robot manipulators under unknown environment[J]. IEEE Transactions on Control Systems Technology, 2004, 3(12): 474-483.

编 辑 黄 莘

Compliant Control Research Based on Adaptive Energy Bounding Method

WANG Hong-yan1, LIU Chun-jie2, and HUANG Zhi1

(1. School of Mechatronics Engineering, University of Electronic Science and Technology of China Chengdu 611731; 2. Heilongjiang Institute of Construction Technology Harbin 150025)

Impedance control is an effective method to deal with contact task of robot, but this method can only guarantee the stability of system for assumed range of environments. Aiming at this problem, this paper proposes a new adaptive energy boundary method (EBM), which improves system performance by on-line estimation of control parameters, and guarantees the stability of system. Under the control method, the system can keep expected contact force stably, and have strong robustness when contact with uncertain environment. To verify the effectiveness of the proposed method, theoretical and simulation researches are conducted to pneumatic hydraulic combination compliant control system, which prove the effectiveness of the method.

adaptive control; compliant control; energy-bounding method; impedance control

TP249

A

10.3969/j.issn.1001-0548.2017.06.026

2015-10-12；

2017-06-19

国家自然科学基金(51275078)

王洪艳(1979-)，女，博士，主要从事机电液一体化系统建模及其智能控制方面的研究.