Amplitude-Saturated Nonlinear State Feedback Position Control for Flexible Joint Robots
YIN Wei1,2, SUN Lei1,2, WANG Meng1,2, LIU Jingtai1,2
1. Institute of Robotics and Automatic Information System, Nankai University, Tianjin 300350, China;
2. Tianjin Key Laboratory of Intelligent Robotics, Tianjin 300350, China
尹伟, 孙雷, 王萌, 刘景泰. 用于柔性关节机器人位置控制的幅值饱和非线性状态反馈控制器[J]. 机器人, 2017, 39(4): 458-465.DOI: 10.13973/j.cnki.robot.2017.0458.
YIN Wei, SUN Lei, WANG Meng, LIU Jingtai. Amplitude-Saturated Nonlinear State Feedback Position Control for Flexible Joint Robots. ROBOT, 2017, 39(4): 458-465. DOI: 10.13973/j.cnki.robot.2017.0458.
Abstract:To achieve position control of flexible joint robot (FJR), an amplitude-saturated nonlinear state feedback controller (ASNSFC) is designed along with friction compensation. The controller uses only position and velocity of motor side to achieve position control of FJR, and residual vibration can be well suppressed. Specifically, some deficiencies of traditional PD (proportional-differential) controller are analyzed based on FJR's dynamics model. Subsequently, an ASNSFC is designed according to safety requirements in the field of tri-co (coexisting-cooperative-cognitive) robots, and the stability of the proposed closed-loop system is proven theoretically by Lyapunov stability theory. Performance of the proposed approach is evaluated on a self-built FJR platform, and experiment results illustrate that the proposed scheme can achieve better performance, including one-tenth overshoot and half settling time.
[1] Pratt G A, Williamson M M. Series elastic actuators[C]//IEEE/RSJ International Conference on Intelligent Robots and Sys-tems. Piscataway, USA:IEEE, 1995:399-406.
[2] Zinn M, Khatib O, Roth B R, et al. A new actuation approach for human friendly robot design[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2004:249-254.
[3] Kong K, Bae J, Tomizuka M. Control of rotary series elastic actuator for ideal force-mode actuation in human-robot interaction applications[J]. IEEE/ASME Transactions on Mechatronics, 2009, 14(1):105-118.
[4] Tsagarakis N G, Laffranchi M, Vanderborght B, et al. A compact soft actuator unit for small scale human friendly robots[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2009:1998-2004.
[5] Garcia E, Arevalo J C, Munoz G, et al. Combining series elastic actuation and magneto-rheological damping for the control of agile locomotion[J]. Robotics and Autonomous Systems, 2011, 59(10):827-839.
[6] Laffranchi M, Chen L, Kashiri N, et al. Development and control of a series elastic actuator equipped with a semi active friction damper for human friendly robots[J]. Robotics and Autonomous Systems, 2014, 62(12):1827-1836.
[7] Park C, Kyung J H, Park D I. Development of an industrial robot manipulator for the easy and safe human-robot cooperation[C]//IEEE International Conference on Control, Automation and Systems. Piscataway, USA:IEEE, 2010:678-681.
[8] Tadele T S, de Vries T J A, Stramigioli S. The safety of domestic robots:A survey of various safety-related publications[J]. IEEE Robotics and Automation Magazine, 2014, 21(3):134-142.
[9] Sariyildiz E, Ohnishi K. On the explicit robust force control via disturbance observer[J]. IEEE Transactions on Industrial Electronics, 2015, 62(3):1581-1589.
[10] Vallery H, Veneman J, Asseldonk E V, et al. Compliant actuation of rehabilitation robots-Benefits and limitations of series elastic actuators[J]. IEEE Robotics and Automation Magazine, 2008, 15(3):60-69.
[11] Fujimoto Y, Murakami T, Oboe R. Advanced motion control for next-generation industrial applications[J]. IEEE Transactions on Industrial Electronics, 2016, 63(3):1886-1888.
[12] Spong M W. Modeling and control of elastic joint robots[J]. Journal of Dynamic Systems, Measurement, and Control, 1987, 109(4):310-319.
[13] Tomei P. A simple PD controller for robots with elastic joints[J]. IEEE Transactions on Automatic Control, 1991, 36(10):1208-1213.
[14] De Luca A, Siciliano B, Zollo L. PD control with on-line gravity compensation for robots with elastic joints:Theory and experiments[J]. Automatica, 2005, 41(10):1809-1819.
[15] De Luca A, Flacco F. A PD-type regulator with exact gravity cancellation for robots with flexible joints[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2011:317-323.
[16] Albu-Schaffer A, Ott C, Petit F. Energy shaping control for a class of underactuated Euler-Lagrange systems[J]. IFAC Proceedings Volumes, 2012, 45(22):567-575.
[17] Ott C, Albu-Schaffer A, Kugi A, et al. On the passivity-based impedance control of flexible joint robots[J]. IEEE Transactions on Robotics, 2008, 24(2):416-429.
[18] Le-Tien L, Albu-Schaffer A. Improving tracking accuracy of a MIMO state feedback controller for elastic joint robots[C]//IEEE 53rd Annual Conference on Decision and Control. Piscataway, USA:IEEE, 2014:4548-4553.
[19] Kim M J, Chung W K. Robust control of flexible joint robots based on motor-side dynamics reshaping using disturbance observer (DOB)[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2014:2381-2388.
[20] Kim M J, Chung W K. Disturbance-observer-based PD control of flexible joint robots for asymptotic convergence[J]. IEEE Transactions on Robotics, 2015, 31(6):1508-1516.
[21] Kashiri N, Lee J, Tsagarakis N G, et al. Proxy-based position control of manipulators with passive compliant actuators:Stability analysis and experiments[J]. Robotics and Autonomous Systems, 2016, 75:398-408.
[22] Zhang Q, Liu G J. Precise control of elastic joint robot using an interconnection and damping assignment passivity based approach[J]. IEEE/ASME Transactions on Industrial Electronics, 2016, 21(6):2728-2736.
[23] Garofalo G, Englsberger J, Ott C. On the regulation of the energy of elastic joint robots:Excitation and damping of oscilla-tions[C]//American Control Conference. Piscataway, USA:IEEE, 2015:4825-4831.
[24] Talole S E, Kolhe J P, Phadke S B. Extended-state-observer-based control of flexible-joint system with experimental validation[J]. IEEE Transactions on Industrial Electronics, 2010, 57(4):1411-1419.
[25] Ginoya D, Shendge P D, Phadke S B. Sliding mode control for mismatched uncertain systems using an extended disturbance observer[J]. IEEE Transactions on Industrial Electronics, 2014, 61(4):1983-1992.
[26] Ginoya D, Shendge P D, Phadke S B. Delta-operator-based extended disturbance observer and its applications[J]. IEEE Transactions on Industrial Electronics, 2015, 62(9):5817-5828.
[27] Sariyildiz E, Chen G, Yu H. Robust position control of a novel series elastic actuator via disturbance observer[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2015:5423-5428.
[28] Petit F, Ott C, Albu-Schaffer A. A model-free approach to vibration suppression for intrinsically elastic robots[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2014:2176-2182.
[29] Kostarigka A K, Doulgeri Z, Rovithakis G A. Prescribed performance tracking for flexible joint robots with unknown dynamics and elasticity[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2012:5365-5370.
[30] Sariyildiz E, Chen G, Yu H. An acceleration-based robust motion controller design for a novel series elastic actuator[J]. IEEE Transactions on Industrial Electronics, 2016, 63(3):1900-1910.
[31] 方勇纯,卢桂章.非线性系统理论[M].北京:清华大学出版社,2009. Fang Y C, Lu G Z. Nonlinear system theory[M]. Beijing:Tsinghua University Press, 2009.