Design for Flexible Joint Controller Based on a New Compensation Control Strategy
DANG Jin1, NI Fenglei1, LIU Yechao1, LIU Hong1,2
1. State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 150001, China; 2. Institute of Robotics and Mechatronics, German Aerospace Center, Munich 82230, Germany
党进, 倪风雷, 刘业超, 刘宏. 基于新型补偿控制策略的柔性关节控制器设计[J]. 机器人, 2011, 33(2): 150-155..
DANG Jin, NI Fenglei, LIU Yechao, LIU Hong. Design for Flexible Joint Controller Based on a New Compensation Control Strategy. ROBOT, 2011, 33(2): 150-155..
Abstract:For the uncertain disturbance,friction and parameter variation,modeling errors and other issues in flexible joint robot control system,conventional PID control can not take into account both the requirements of stability and control accuracy.To solve this problem,a novel robust joint controller based on a new compensation control strategy is designed.In the controller design,the friction is divided into two parts,linear and nonlinear,and the disturbance into certain and uncertain. The part associated with the robot self structure,deterministic disturbance and the linear part of the friction can be controlled effectively by the feedforward compensation part.Feedback compensation part of the proposed controller can compensate nonlinear part of friction,system parameter variation,external uncertain disturbance,modeling error and so on.Its stability is completely proved by Lyapunov stability theory.Finally,the results on the platform of HIT 4-DOF flexible manipulator show that the controller has good position tracking performance and robustness.
[1] Huang J B,Xie Z W,Liu H.Adaptive Cartesian impedance control system for flexible joint robot by using DSP/FPGA architecture[J].Intemational Journal of Robotics and Automation,2008,23(4):251-258.
[2] Hauschild J P,Heppler G R.Control of harmonic drive motor actuated flexible linkages[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,2007:3451-3456.
[3] Gandhi P S,Ohorbel F H,Dabney J.Modeling,identification.and compensation of friction in harmonic drives[C]//41st IEEE Conference on Decision and Control:vol.1.Piscataway,NJ.USA:IEEE.2002:160-166.
[4] 邱志成,谈大龙.基于加速度反馈的柔性关节机械臂接触力控制[J].机械工程学报,2002,3800):37-42.Qiu Z C,Tan D L.On accelerauon sensor-based feedback control for contact force of the flexible.joint manipulator[J].Chinese Journal of Mechanical Engineering,2002,38(10):37-42.
[5] 刘业超,金明河,刘宏.柔性关节机器人基于柔性补偿的奇异摄动控制[J].机器人,2008,30(5):460-465.Liu Y C,Jin M H,Liu H.Singular perturbation control for flexible-joint manipulator based on flexibility compensation[J].Robot,2008,30(5):460-465.
[6] Albu-Schaffer A,Ott C,Freses U,et al.Cartesian impedance control of redundant robots:Recent results with the DLR-lightweight-arms[C]//IEEE Intemational Conference on Robotics and Automation:vol.3.Piscataway,NJ,USA:IEEE,2003:3704-3709.
[7] De Luca A,Lucibello P.A general algorithm for dynamic feedback linearization of robots with elastic joints[C]//IEEE International Conference on Robotics and Automatior/:vol.1.Piscaraway,N J,USA:IEEE,1998:504.5-10.
[8] 王景,王昊瀛,刘良栋,等.空间机械臂的鲁棒复合自适应控制[J].自动化学报,2002,28(3):378-383.Wang J,Wang H Y,Liu L D,et al.Robust composite adaptive control for space manipulators[J].Acta Automatica Sinica,2002,28(3):378-383.
[9] Spong M W.Modeling and control of elastic joint robots[J].Journal of Dynamic Systems,Measurement,and Control,1987,109(4):310-319.