The Hybrid Position/Force Control Based on Variable Impedance Model in the Dual-Arm Coordinated Transport
DUAN Jinjun1,2, GAN Yahui1,2, DAI Xianzhong1,2
1. School of Automation, Southeast University, Nanjing 210096, China;
2. Key Laboratory of Measurement and Control of Complex Systems of Engineering, Ministry of Education, Nanjing 210096, China
段晋军, 甘亚辉, 戴先中. 双臂协调搬运过程中基于变阻抗模型的位置/力混合控制[J]. 机器人, 2019, 41(6): 795-802,812.DOI: 10.13973/j.cnki.robot.180705.
DUAN Jinjun, GAN Yahui, DAI Xianzhong. The Hybrid Position/Force Control Based on Variable Impedance Model in the Dual-Arm Coordinated Transport. ROBOT, 2019, 41(6): 795-802,812. DOI: 10.13973/j.cnki.robot.180705.
Abstract:For the complex coupling motion with external disturbance and internal force constraint existing in the dual-arm coordinated transport, an internal and external hybrid position/force control strategy based on the variable impedance model is proposed. Firstly, the motion planning and dynamic model of the manipulated object in the closed-chain system are analyzed, and then the task space is orthogonally decoupled into the position free subspace at the outer loop and the force constrained subspace at the inner loop according to the coordinated transport characteristics. For the external disturbance in the position subspace, the impedance model is used for the trajectory tracking. For the internal force in the force constrained space, the variable impedance model is used for the force tracking. Finally, dual-arm coordinated transport experiments are carried out in the simulated environment and physical environment. The experimental results show that the proposed algorithm is flexible for external disturbance and satisfies internal force constraints.
[1] Smith C, Karayiannidis Y, Nalpantidis L, et al. Dual arm manipulation-A survey[J]. Robotics and Autonomous Systems, 2012, 60(10):1340-1353.
[2] Uchiyama M, Dauchez P. A symmetric hybrid position/force control scheme for the coordination of two robots[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 1988:350-356.
[3] Uchiyama M, Dauchez P. Symmetric kinematic formulation and non-master/slave coordinated control of two-arm robots[J]. Advanced Robotics, 1992, 7(4):361-383.
[4] Bonitz R G, Hsia T C. Force decomposition in cooperating manipulators using the theory of metric spaces and generalized inverses[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 1994:1521-1527.
[5] Caccavale F, Chiacchio P, Marino A, et al. Six-DOF impedance control of dual-arm cooperative manipulators[J]. IEEE/ASME Transactions on Mechatronics, 2008, 13(5):576-586.
[6] 欧阳帆.双机器人协调运动方法的研究[D].广州:华南理工大学,2013.Ouyang F. Research on coordinated motion of dual robots[D]. Guangzhou:South China University of Technology, 2013.
[7] 周扬.双臂机器人的控制系统建立及阻抗控制研究[D].哈尔滨:哈尔滨工业大学,2014.Zhou Y. Research on control system establishment and impedance control of dual-arm robot[D]. Harbin:Harbin Institute of Technology, 2014.
[8] 贺军.变负载双臂机器人阻抗自适应控制系统研究[D].合肥:中国科学技术大学,2016. He J. Research on impedance adaptive control system of variable load dual-arm robot[D]. Hefei:University of Science and Technology of China, 2016.
[9] Sun D, Mills J K. Adaptive synchronized control for coordination of multirobot assembly tasks[J]. IEEE Transactions on Robotics and Automation, 2002, 18(4):498-510.
[10] Gueaieb W, Karray F, Al-Sharhan S. A robust adaptive fuzzy position/force control scheme for cooperative manipulators[J]. IEEE Transactions on Control Systems Technology, 2003, 11(4):516-528.
[11] Gueaieb W, Karray F, Al-Sharhan S. A robust hybrid intelligent position/force control scheme for cooperative manipulators[J]. IEEE/ASME Transactions on Mechatronics, 2007, 12(2):109-125.
[12] Basile F, Caccavale F, Chiacchio P, et al. Task-oriented motion planning for multi-arm robotic systems[J]. Robotics and Computer-Integrated Manufacturing, 2012, 28(5):569-582.
[13] Ren Y, Chen Z, Liu Y, et al. Adaptive hybrid position/force control of dual-arm cooperative manipulators with uncertain dynamics and closed-chain kinematics[J]. Journal of the Franklin Institute, 2017, 354(17):7767-7793.
[14] Duan J J, Gan Y H, Chen M, et al. Adaptive variable impedance control for dynamic contact force tracking in uncertain environment[J]. Robotics and Autonomous Systems, 2018, 102:54-65.
[15] Lynch K M, Park F C. Modern robotics:Mechanics, planning, and control[M]. Cambridge, UK:Cambridge University Press, 2017.