张元飞, 刘伊威, 金明河, 刘宏. 基于连杆力矩传感器动态补偿的机器人灵巧手笛卡儿阻抗控制[J]. 机器人, 2012, 34(1): 22-31..
ZHANG Yuanfei, LIU Yiwei, JINMinghe, LIU Hong. Cartesian Impedance Control for Dexterous Robot Hand Based on Dynamic Compensation of Link Torque Sensor. ROBOT, 2012, 34(1): 22-31..
摘要为了对连杆空间力矩传感器进行动态补偿,提出了适用于求取串联机器人任意连杆中任意一点处所受的内力和内力矩的算法.该算法采用连杆假想截断原理利用牛顿-欧拉方程推导而出.推导过程综合考虑了串联机器人是否处于静态以及末端是否受外力作用的情况,以及串联机器人的关节是否是回转关节的情况.然后利用该算法计算动态补偿值,构建了基于连杆力矩传感器动态补偿的笛卡儿阻抗控制器.最后在HIT/DLR Hand II五指灵巧手上进行了实验验证.实验结果一方面验证了该算法的有效性,另一方面也验证了本文所构建的笛卡儿阻抗控制器的有效性.
Abstract:In order to achieve dynamic compensation of torque sensor in link space,an effective algorithm for calculating the internal force and torque at any point in any link of a serial robot is proposed.This algorithm is derived by Newton-Euler equations using a hypothetical truncation principle of the link.In the deriving process,some situations are taken into account,such as whether the serial robot is static,whether an external force is exerted on its end,and whether each joint of the serial robot is a rotary joint.Then a Cartesian impedance control scheme based on the dynamic compensation of link torque sensor is developed,in which the dynamic compensative values are calculated by the algorithm.Finally,the algorithm and the Cartesian impedance control scheme are verified on five-finger dexterous hand of HIT/DLR Hand.The experimental results demonstrate the validity of the algorithm and the Cartesian impedance control scheme.
[1] Raibert M H,Craig J J.Hybrid position/force control of manipulators[J].Journal of Dynamic Systems,Measurement and Control,Transactions of the ASME,1981,103(2):126-133.
[2] Hogan N.Impedance control:An approach to manipulation[C]//American Control Conference.Piscataway,NJ,USA:IEEE,1984:304-313.
[3] Lan T,Liu Y W,Jin M H,et al.DSP&FPGA-based joint impedance controller for DLR/HIT Ⅱ dexterous robot hand[C]//IEEE/ASME International Conference on Advanced Intelligent Mechatronics.Piscataway,NJ,USA:IEEE,2009:1594-1599.
[4] Wu K,Lan T,Chen Y B,et al.DSP & FPGA-based control architecture for a highly integrated robot hand with enhanced impedance performance[J].High Technology Letters,2010,16(2):178-183.
[5] Chen Z P,Lii N Y,Wu K,et al.Flexible FPGA-based controller architecture for five-fingered dexterous robot hand with effective impedance control[C]//IEEE International Conference on Robotics and Biomimetics.Piscataway,NJ,USA:IEEE,2009:1063-1068.
[6] Tsetserukou D,Tadakuma R,Kajimoto H,et al.Intelligent variable joint impedance control and development of a new whole-sensitive anthropomorphic robot arm[C]//IEEE International Symposium on Computational Intelligence in Robotics and Automation.Piscataway,NJ,USA:IEEE,2007:338-343.
[7] Jiang L,Liu H,Cai H G.Cartesian impedance control of dexterous robot hand[J].Journal of Harbin Institute of Technology:New Series,2005,12(3):239-244.
[8] Yang L,Gao X H,Liu H,et al.Cartesian impedance control for HIT dexterous robot hand based on fingertip force sensor[J].Control and Decision,2004,19(11):1255-1258.
[9] Biagiotti L,Liu H,Hirzinger G,et al.Cartesian impedance control for dexterous manipulation[C]//IEEE International Conference on Intelligent Robots and Systems.Piscataway,NJ,USA:IEEE,2003:3270-3275.
[10] Liu H,Liu Y C,Jin M H,et al.An experimental study on Cartesian impedance control for a joint torque-based manipulator[J].Advanced Robotics,2008,22(11):1155-1180.
[11] Huang J B,Xie Z W,Liu H,et al.DSP/FPGA-based controller architecture for flexible joint robot with enhanced impedance performance[J].Journal of Intelligent and Robotic Systems:Theory and Applications,2008,53(3):247-261.
[12] Huang J B,Xie Z W,Liu H,et al.Adaptive Cartesian impedance control system for flexible joint robot by using DSP/FPGA architecture[J].International Journal of Robotics and Automation,2008,23(4):251-258.
[13] Chen Z P,Lii N Y,Jin M H,et al.Cartesian impedance control on five-finger dexterous robot hand DLR-HIT Ⅱ with flexible joint[C]//Lecture Notes in Computer Science(including subseries Lecture Notes in Artificial Intelligence and Lecture Notes in Bioinformatics),vol.6424.Berlin,Germany:SpringerVerlag,2010:1-12.
[14] Chen Z P,Lii N Y,Wimboeck T,et al.Experimental study on impedance control for the five-finger dexterous robot hand DLR-HIT Ⅱ[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems.Piscataway,NJ,USA:IEEE,2010:5867-5874.
[15] Albu-Schaffer A,Ott C,Frese U,et al.Cartesian impedance control of redundant robots:Recent results with the DLR-lightweight-arms[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,2003:3704-3709.
[16] Fan S W,Liu Y W,Jin M H,et al.Research on the mechanics of the HIT/DLR Hand Ⅱ anthropomorphic five-finger dexterous hand[J].Journal of Harbin Engineering University,2009,30(2):171-177.
[17] Fan S W,Liu Y W,Jin M H,et al.The anthropomorphic design and experiments of HIT/DLR five-fingered dexterous hand[J].High Technology Letters,2009,15(3):239-244.
[18] Craig J J.Introduction to robotics:Mechanics and control[M].3rd ed.Upper Saddle River,NJ,USA:Prentice Hall,2004.
[19] Lan T,Liu Y W,Jin M H,et al.Study of ultra-miniature giant magneto resistance sensor system based on 3D static magnetic analysis technique[J].Measurement:Journal of the International Measurement Confederation,2009,42(7):1011-1016.
[20] Zhang Y F.Liu Y W,Jin M H,et al.Design of a finger-tip flexible tactile sensor for an anthropomorphic robot hand[C]//Lecture Notes in Computer Science(including subseries Lecture Notes in Artificial Intelligence and Lecture Notes in Bioinformatics),vol.6424.Berlin,Germany:Springer-Verlag,2010:762-773.