-
摘要: 串联弹性驱动器(Series elastic actuator,SEA)是机器人交互系统中的一种理想力源.本文针对非线性SEA的力矩控制问题提出一种基于RISE(Robust integral of the sign of the error)反馈的最优控制方法,能够克服模型参数不确定和有界扰动,实现SEA输出力矩在交互过程中快速平稳地收敛到期望值.具体来说,首先对SEA的模型进行分析和变换;然后假设模型参数和扰动均已知,并在此基础上基于二次型指标设计最优控制律;之后基于RISE反馈重新设计控制律抵消模型参数不确定性和有界扰动,基于Lyapunov理论分析控制器的收敛性和信号的有界性,实验结果表明这种基于RISE反馈的最优控制方法具有良好的控制性能和对有界扰动的鲁棒性.Abstract: Series elastic actuator (SEA) is an ideal power source in robots interaction systems. Aiming at SEA torque control, an optimization scheme with an RISE (robust integral of the sign of the error) feedback structure is proposed to ensure the output of SEA asymptotically tracks a desired time-varying torque despite uncertainties in the dynamics like bounded disturbance or parametric uncertainty. Specifically, the generic dynamics of SEA system is described and some analysis and transformation operations are performed. The system in which all terms are assumed to be known is feedback linearized and a control law is developed using the optimization method for a given quadratic performance index. Then the control law is modified to contain the RISE feedback term for identifying the uncertainty. At last, a Lyapunov stability analysis is included to show that the tracking error converges to zero with all signals bounded. Experiment results show that the suggested controller achieves satisfactory control performance and strong robustness to disturbance.1) 本文责任编委 郭戈
-
表 1 SEA机械参数
Table 1 Mechanical parameter of SEA
Parameter Value Uanit $J_M$ $0.082$ kgm$^2$ $c_M$ $0.75$ kgm$^2$/s $Ks$ $13\, 600$ N/m $c$ $0.018$ m $R$ $0.020$ m $r$ $0.005$ m -
[1] Veneman J F, Ekkelenkamp R, Kruidhof R, Van Der Helm F C, Van Der Kooij H. A series elastic-and Bowden-cable-based actuation system for use as torque actuator in exoskeleton-type robots. International Journal of Robotics Research, 2006, 25(3):261-281 doi: 10.1177/0278364906063829 [2] Vallery H, Veneman J F, Van Asseldonk E, Buss R M, Van Der Kooij H. Compliant actuation of rehabilitation robots. IEEE Robotics and Automation Magazine, 2008, 15(3):60-69 doi: 10.1109/MRA.2008.927689 [3] Sulzer J S, Roiz R A, Peshkin M A, Patton J L. A highly backdrivable, lightweight knee actuator for investigating gait in stroke. IEEE Transactions on Robotics, 2009, 25(3):539-548 doi: 10.1109/TRO.2009.2019788 [4] Mathijssen G, Lefeber D, Vanderborght B. Variable recruitment of parallel elastic elements:series-parallel elastic actuators (SPEA) with dephased mutilated gears. IEEE/ASME Transactions on Mechatronics, 2015, 20(2):594-602 doi: 10.1109/TMECH.2014.2307122 [5] Pfeifer S, Pagel A, Riener R, Vallery H. Actuator with angle-dependent elasticity for biomimetic transfemoral prostheses. IEEE/ASME Transactions on Mechatronics, 2015, 20(3):1384-1394 doi: 10.1109/TMECH.2014.2337514 [6] Pratt G A, Williamson M M. Series elastic actuators. In: Proceedings of the 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems 95. Pittsburgh, PA, USA: IEEE, 1995. 399-406 http://www.mendeley.com/catalog/series-elastic-actuators/ [7] Pratt G A, Willisson P, Bolton C, Hofman A. Late motor processing in low-impedance robots: impedance control of series-elastic actuators. In: Proceedings of the 2004 American Control Conference. Boston, MA, USA: IEEE, 2004. 3245-3251 http://www.mendeley.com/catalog/late-motor-processing-lowimpedance-robots-impedance-control-serieselastic-actuators/ [8] Wyeth G. Control issues for velocity sourced series elastic actuators. In: Proceedings of the 2006 Australasian Conference on Robotics and Automation. Auckland, New Zealand: Australian Robotics and Automation Association Inc., 2006. 1-6 [9] Wyeth G. Demonstrating the safety and performance of a velocity sourced series elastic actuator. In: Proceedings of the 2008 IEEE International Conference on Robotics and Automation (ICRA). Pasadena, CA, USA: IEEE, 2008. 3642-3647 http://www.mendeley.com/catalog/demonstrating-safety-performance-velocity-sourced-series-elastic-actuator/ [10] Vallery H, Ekkelenkamp R, Van der Kooij H, Buss M. Passive and accurate torque control of series elastic actuators. In: Proceedings of the 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). San Diego, CA, USA: IEEE, 2007. 3534-3538 http://www.mendeley.com/catalog/passive-accurate-torque-control-series-elastic-actuators/ [11] Tagliamonte N L, Accoto D. Passivity constraints for the impedance control of series elastic actuator. Proceedings of Institution of Mechanical Engineers, Part Ⅰ:Journal of Systems and Control Engineering, 2013, 228(3):138-153 [12] Kong K, Bae J, Tomizuka M. Control of rotary series elastic actuator for ideal force-mode actuation in human-robot interaction applications. IEEE/ASME Transactions on Mechatronics, 2009, 14(1):105-118 doi: 10.1109/TMECH.2008.2004561 [13] Kong K, Bae J, Tomizuka M. A compact rotary series elastic actuator for human assistive systems. IEEE/ASME Transactions on Mechatronics, 2012, 17(2):288-297 doi: 10.1109/TMECH.2010.2100046 [14] Yoo S, Chung W K. SEA force/torque servo control with model-based robust motion control and link-side motion feedback. In: Proceedings of the 2015 IEEE International Conference on Robotics and Automation (ICRA). Seattle, WA, USA: IEEE, 2015. 1042-1048 http://www.mendeley.com/catalog/sea-forcetorque-servo-control-modelbased-robust-motion-control-linkside-motion-feedback/ [15] Calanca A, Fiorini P. Human-adaptive control of series elastic actuators. Robotica, 2014, 32(8):1301-1316 doi: 10.1017/S0263574714001519 [16] Bae J, Kong K, Tomizuka M. Gait phase-based smoothed sliding mode control for a rotary series elastic actuator installed on the knee joint. In: Proceedings of the 2010 American Control Conference (ACC). Baltimore, MD, USA: IEEE, 2010. 6030-6035 http://www.mendeley.com/catalog/gait-phasebased-smoothed-sliding-mode-control-rotary-series-elastic-actuator-installed-knee-joint/ [17] Misgeld B J E, Pomprapa A, Leonhardt S. Robust control of compliant actuators using positive real H2-controller synthesis. In: Proceedings of the 2014 American Control Conference (ACC). Portland, OR, USA: IEEE, 2014. 5477-5483 https://ieeexplore.ieee.org/document/6858609 [18] 朱秋国, 熊蓉, 吕铖杰, 毛翊超.新型串联弹性驱动器设计与速度控制.电机与控制学报, 2015, 19(6):83-88 http://d.old.wanfangdata.com.cn/Periodical/djykzxb201506013Zhu Qiu-Guo, Xiong Rong, Lv Cheng-Jie, Mao Yi-Chao. Novel series elastic actuator design and velocity control. Electric Machines and Control, 2015, 19(6):83-88 http://d.old.wanfangdata.com.cn/Periodical/djykzxb201506013 [19] Wolf S, Hirzinger G. A new variable stiffness design: matching requirements of the next robot generation. In: Proceedings of the 2008 IEEE International Conference on Robotics and Automation (ICRA). Pasadena, CA, USA: IEEE, 2008. 1741-1746 http://www.mendeley.com/catalog/new-variable-stiffness-design-matching-requirements-next-robot-generation/ [20] Jafari A, Tsagarakis N G, Caldwell D G. A novel intrinsically energy efficient actuator with adjustable stiffness (AwAS). IEEE/ASME Transactions on Mechatronics, 2013, 18(1):355-365 doi: 10.1109/TMECH.2011.2177098 [21] Mooney L, Herr H. Continuously-variable series-elastic actuator. In: Proceedings of the 2013 IEEE International Conference on Rehabilitation Robotics (ICORR). Seattle, WA, USA: IEEE, 2013. 1-6 https://www.ncbi.nlm.nih.gov/pubmed/24187221 [22] Paine N, Sentis L. A new prismatic series elastic actuator with compact size and high performance. In: Proceedings of the 2012 IEEE International Conference on Robotics and Biomimetics (ROBIO). Guangzhou, China: IEEE, 2012. 1759-1766 http://www.mendeley.com/catalog/new-prismatic-series-elastic-actuator-compact-size-high-performance/ [23] Laffranchi M, Chen L S, Kashiri N, Lee J, Tsagarakis N G, Caldwell D G. Development and control of a series elastic actuator equipped with a semi active friction damper for human friendly robots. Robotics and Autonomous Systems, 2014, 62(12):1827-1836 doi: 10.1016/j.robot.2014.06.007 [24] Austin J, Schepelmann A, Geyer H. Control and evaluation of series elastic actuators with nonlinear rubber springs. In: Proceedings of the 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Hamburg, Germany: IEEE, 2015. 6563-6568 http://www.mendeley.com/catalog/control-evaluation-series-elastic-actuators-nonlinear-rubber-springs/ [25] Yu H Y, Huang S N, Chen G, Pan Y P, Guo Z. Human-robot interaction control of rehabilitation robots with series elastic actuators. IEEE Transactions on Robotics, 2015, 31(5):1089-1100 doi: 10.1109/TRO.2015.2457314 [26] Garabini M, Passaglia A, Belo F, Salaris P, Bicchi A. Optimality principles in stiffness control: the VSA kick. In: Proceedings of the 2012 IEEE International Conference on Robotics and Automation (ICRA). Saint Paul, MN, USA: IEEE, 2012. 3341-3346 http://www.mendeley.com/catalog/optimality-principles-stiffness-control-vsa-kick/ [27] Braun D J, Howard M, Vijayakumar S. Optimal variable stiffness control:formulation and application to explosive movement tasks. Autonomous Robots, 2012, 33(3):237-253 doi: 10.1007/s10514-012-9302-3 [28] Lee J, Laffranchi M, Kashiri N, Tsagarakis N G, Caldwell D G. Model-free force tracking control of piezoelectric actuators: application to variable damping actuator. In: Proceedings of the 2014 IEEE International Conference on Robotics and Automation (ICRA). Hong Kong, China: IEEE, 2014. 2283-2289 http://www.mendeley.com/research/modelfree-force-tracking-control-piezoelectric-actuators-application-variable-damping-actuator/ [29] Lee J, Jin M L, Tsagarakis N G, Caldwell D G. Terminal sliding-mode based force tracking control of piezoelectric actuators for variable physical damping system. In: Proceedings of the 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Chicago, IL, USA: 2014. 2407-2413 http://ieeexplore.ieee.org/xpls/icp.jsp?arnumber=6942889 [30] Wang M, Sun L, Yin W, Dong S, Liu J T. A novel sliding mode control for series elastic actuator torque tracking with an extended disturbance observer. In: Proceedings of the 2015 IEEE International Conference on Robotics and Biomimetics (ROBIO). Zhuhai, China: IEEE, 2015. 2407-2412 http://ieeexplore.ieee.org/xpls/abs_all.jsp?arnumber=7419699 [31] Dupree K, Patre P M, Wilcox Z D, Dixon W E. Optimal control of uncertain nonlinear systems using RISE feedback. In: Proceedings of the 47th IEEE Conference on Decision and Control (CDC). Cancun, Mexico: IEEE, 2008. 2154-2159 http://www.mendeley.com/catalog/optimal-control-uncertain-nonlinear-systems-using-rise-feedback/ [32] 王萌, 孙雷, 尹伟, 董帅, 刘景泰.面向交互应用的串联弹性驱动器力矩控制方法.自动化学报, 2017, 43(8):1319-1328 http://www.aas.net.cn/CN/abstract/abstract19106.shtmlWang Meng, Sun Lei, Yin Wei, Dong Shuai, Liu Jing-Tai. Series elastic actuator torque control approach for interaction application. Actia Automatica Sinca, 2017, 43(8):1319-1328 http://www.aas.net.cn/CN/abstract/abstract19106.shtml