Abstract:To meet the high-accuracy control requirements of the coordinated operation task performed by the Robonaut under unknown interferences, a coordinated impedance control method based on disturbance observer is proposed. Firstly, geometric constraints and force constraints between the object and the Robonaut are analyzed to establish a unified dynamics model of the object and the Robonaut. Secondly, a momentum disturbance observer is designed for the coordinated control system of the Robonaut based on the generalized momentum of the robot. Thirdly, an impedance control method is designed for coordinated operation of the Robonaut based on the disturbance observer, combining with the unified dynamic model. Finally, a numerical simulation is carried out to verify the proposed method. Results show that the position error of the object is controlled within the order of 10-5 m, when the arms are influenced by unknown interferences. The proposed method effectively reduces the influence of the unknown interferences on the accuracy of the object pose control, and ensures the high precision control of the coordinated operation task.
[1] 吴海彬,李实懿,吴国魁,等.基于动量偏差观测器的机器人碰撞检测算法[J].电机与控制学报,2015,19(5):97-104.Wu H B, Li S Y, Wu G K, et al. Collision detection algorithm for robot manipulator based on momentum deviation observer[J]. Electric Machines and Control, 2015, 19(5):97-104.
[2] 史政,沈兴全.无传感器机械臂碰撞估测及处理策略研究[J].科学技术与工程,2015,15(28):27-31.Shi Z, Shen X Q. Sensorless collision estimation and control strategy for robot manipulation[J]. Science Technology and Engineering, 2015, 15(28):27-31.
[3] 钟琮玮,项基,韦巍,等.基于扰动观测器的机械手碰撞检测与安全响应[J].浙江大学学报:工学版,2012,46(6):162-168.Zhong C W, Xiang J, Wei W, et al. Collision detection and safe reaction of manipulator based on disturbance observer[J]. Journal of Zhejiang University:Engineering Science, 2012, 46(6):162-168.
[4] Jonathan V, Moritz S, Sami H. Collision detection, isolation and identification for humanoids[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2017:4754-4761.
[5] Sadeghian H, Villani L, Keshmiri M, et al. Task-space control of robot manipulators with null-space compliance[J]. IEEE Transactions on Robotics, 2014, 30(2):493-506.
[6] Tsetserukou D, Kawakami N, Tachi S. iSoRA:Humanoid robot arm for intelligent haptic interaction with the environment[J]. Advanced Robotics, 2009, 23(10):1327-1358.
[7] Tao J M, Luh J Y S. Position and force controls for two coordinating robots[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 1991:176-181.
[8] 张秋豪,孙汉旭.三分支机器人协调操作及关节力矩优化[J].机器人,2004,26(6):502-505.Zhang Q H, Sun H X. Coordinated manipulator and joint torque optimization of three branches robot[J]. Robot, 2004, 26(6):502-505.
[9] Yan L, Mu Z G, Xu W F, et al. Coordinated compliance control of dual-arm robot for payload manipulation:Master-slave and shared force control[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2016:2697-2702.
[10] Platt R, Abdallah M, Wampler C. Multiple-priority impedance control[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2011:6033-6038.
[11] Sadeghian H, Villani L, Keshmiri M, et al. Multi-priority control in redundant robotic systems[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2011:3752-3757.
[12] 申浩宇,吴洪涛,陈柏,等.基于主从任务转化的冗余度机器人避障算法[J].机器人,2014,36(4):425-429.Shen H N, Wu H T, Chen B, et al. Obstacle avoidance algorithm for redundant robots based on transitioning between the primary and the secondary task[J]. Robot, 2014, 36(4):425-429.
[13] Murray R M,李泽湘,Sastry S.机器人操作的数学导论[M].徐卫良,钱瑞明,译.北京:机械工业出版社,1997.Murray R M, Li Z X, Sastry S. A mathematical introduction to robotic manipulation[M]. Xu W L, Qian R M, trans. Beijing:China Machine Press, 1997.