摘要
为合理确定应用于四足机器人腿部机构的2自由度平面并联机构零件制造公差范围,该文进行了并联机构末端位置误差灵敏度分析与工作空间内的位置精度预估,建立2自由度平面并联机构位置方程;采用全微分理论建立2自由度平面并联机构的误差模型,得到各误差源相对于末端位置误差的映射关系;建立机构位置误差灵敏度模型与评价指标,借助灵敏度评价指标揭示出统计意义下各几何误差源对末端位置精度的影响程度;依据3?原则与灵敏度评价指标,确定了各误差源的零件制造公差;采用三坐标测量仪对试验样机制造误差值进行测量,依据误差模型对末端位置精度在工作空间内的分布进行预估及实例验证。结果表明:实际位置精度值与理论位置精度预估值最大误差绝对值为0.0038 mm,最小误差绝对值为0.001 5 mm,各误差值均较小,验证了误差传递模型、位置精度预估的正确性及该方法确定构件制造公差的有效性。研究结果可为四足机器人腿部机构的运动学标定、误差补偿及执行精确任务时的轨迹规划提供理论依据。
In order to reasonably determine the manufacturing tolerance range of 2-DOF planar parallel mechanism parts on quadruped robot, the error sensitivity analysis of the leg parallel mechanism and the position precision estimation in the working space were proposed in this paper. The leg mechanism of the quadruped robot analyzed in the paper was composed of a 2-DOF planar parallel mechanism and a RPR mechanism in series. The planar parallel mechanism realized the forward direction of leg lifting and stepping, and the RPR mechanism realized the lateral pendulum movement of leg mechanism, and the coordinate movement of the 2 mechanisms realized the spatial movement of leg mechanism. The advantage of the leg structure was that the planar parallel mechanism could enlarge the stroke of the end position to achieve rapid leg lifting and stride, and the RPR mechanism could achieve lateral swing decoupling motion. In the manufacturing process of the leg mechanism, due to the relatively simple structure of RPR mechanism and the coupling and complexity of parallel mechanism, the manufacturing of 2-DOF planar parallel mechanism was emphatically analyzed. Firstly, the composition of the leg mechanism was introduced, the position equation of 2-DOF planar parallel mechanism was established, an error model of 2-DOF planar parallel mechanism was established by using the full differential theory, the mapping relation of each error source to the end position error was obtained. Secondly, the position error sensitivity model and evaluation index of the mechanism were established. The histogram of each geometric error source on the end position precision under the significance of generalization was drawn according the sensitivity evaluation index, and the influence degree of each error source on the end position precision was revealed. The result showed that the angle error sources had a great influence on the position precision of leg mechanism, the angle error between the rod BC and the X axis was the most sensitive, other angle errors were more sensitive, while the influence of other manufacturing error sources was relatively small. Then, according to the 3? principle and sensitivity evaluation index, the allowable manufacturing tolerances of the parts of each error source were determined. Finally, according to the allowable manufacturing tolerance range, the actual parts were designed and processed. The manufacturing error values of each part were measured by using the three coordinate measuring instrument, and the actual manufacturing errors of each part were obtained. According to the error transfer model and the sensitivity evaluation index, the distribution of the end position precise in the workspace was estimated. At the same time, the representative 6 pose points in the working space of the experimental prototype were measured with the three coordinate measuring instrument, and the end precision estimation was verified by some examples. The result of precision estimation showed that the error value of the lower part of the working space was within the range of 0.18-0.3 mm, and the precision was higher; the error value of the upper part of the working space was within the range of 0.4-1 mm, and the precision was poor; and the precision of the upper part of the working space was worse, and the error of the left upper and top part was up to 1 mm. Therefore, when performing more precise tasks, the trajectory of the foot contacting to ground could be planned in the lower part of the workspace to improve the foot positioning precision. The experiments results showed that the maximum error absolute value between the actual position precision value and the theoretical position precision estimation was 0.003 8 mm, and the minimum error absolute value was 0.001 5 mm, which verifies the correctness of the error transfer model and the position precision estimation, and the validity of the method to determine the manufacturing tolerance of components. The results laid a foundation for the kinematics calibration, error compensation and trajectory planning of the leg mechanism of the quadruped robot.
引文
[1]王友渔,赵兴玉,黄田,等.可重构混联机械手TriVariant与Tricept的静动态特性预估与比较[J].天津大学学报,2007,40(6):41-45.Wang Youyu,Zhao Xingyu,Huang Tian,et al.Estimation and comparison of static and dynamic performance of two reconfigurable hybrid robots-the trivariant and the tricept[J].Journal of Tianjin University,2007,40(6):41-45.(inChinese with English abstract)
[2]荣誉,金振林,曲梦可.三自由度并联机械腿静力学分析与优化[J].农业工程学报,2012,28(20):41-49.Rong Yu,Jin Zhenlin,Qu Mengke.Statics analysis and optimal design of 3-DOF parallel mechanical leg[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2012,28(20):41-49.(in Chinese with English abstract)
[3]张金柱,金振林,张天浩.并联驱动机械腿运动学静力学性能评价及几何参数设计[J].农业工程学报,2017,33(21):61-69.Zhang Jinzhu,Jin Zhenlin,Zhang Tianhao.Kinematic/static performance evaluation and geometric parameter design of parallel-driving leg mechanism[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2017,33(21):61-69.(in Chinese with English abstract)
[4]牛建业,王洪波,史洪敏,等.变自由度轮足复合机器人轨迹规划验证及步态研究[J].农业工程学报,2017,33(23):38-47.Niu Jianye,Wang Hongbo,Shi Hongmin,et al.Trajectory planning verification and gait analysis of wheel-legged hybrid robot with variable degree of freedom[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2017,33(23):38-47.(in Chinese with English abstract)
[5]曲梦可,王洪波,荣誉.轮腿混合四足机器人六自由度并联机械腿设计[J].农业工程学报,2017,33(11):29-37.Qu Mengke,Wang Hongbo,Rong Yu.Design of 6-DOFparallel mechanical leg of wheel-leg hybrid quadruped robot[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2017,33(11):29-37.(in Chinese with English abstract)
[6]Merlet J P.Jacobian,manipulability,condition number,and accuracy of parallel robots[J].Journal of Mechanical Design,2006,128(1):199-206.
[7]Zheng Defeng,Wang Xiangzhao,Li Zhongliang.Accuracy analysis of parallel plate interferometer for angular displacement measurement[J].Optics&Laser Technology,2008,40(1):6-12.
[8]谢福贵,刘辛军,陈禹臻.一种新型虚拟中心并联机构的误差灵敏度分析[J].机械工程学报,2013,49(17):85-91.Xie Fugui,Liu Xinjun,Chen Yuzhen.Error sensitivity analysis of novel virtual center mechanism with parallel kinematics[J].Journal of Mechanical Engineering,2013,49(17):85-91.(in Chinese with English Abstract)
[9]张立杰,李永泉.球面2-DOF冗余驱动并联机器人机构误差分析[J].机械工程学报,2013,49(7):148-154.Zhang Lijie,Li Yongquan.Error analysis of spherical 2-DOFparallel manipulator with actuation redundancy[J].Journal of Mechanical Engineering,2013,49(7):148-154.(in Chinese with English Abstract)
[10]李永泉,张立杰,郭志民,等.基于D-H矩阵的球面5R并联机构误差建模及灵敏度分析[J].中国机械工程,2012,23(12):1470-1474.Li Yongquan,Zhang Lijie,Guo Zhimin,et al.Error modeling and sensitivity analysis of spherical 5R parallel manipulator based on D-H matrix[J].Chinese Mechanical Engineering,2012,23(12):1470-1474.(in Chinese with English Abstract)
[11]牛亚雯,温淑鸿,冯志友.基于正交设计法的2UPS-RPU并联机构精度综合[J].机械科学与技术,2015,34(7):997-1001.Niu Yawen,Wen Shuhong,Feng Zhiyou.Accuracy synthesis of 2UPS-RPU parallel manipulator based on orthogonal design[J].Mechanical Science and Technology for Aerospace Engineering,2015,34(7):997-1001.(in Chinese with English Abstract)
[12]Li Ruiqin,Yang Bin.Error modeling of 3-RSR parallel robot based on D-H transformation matrix[J].Journal of Measurement Science and Instrumentation,2014(3):53-59.
[13]Huang T,Whitehouse D J,Chetwynd D G.A unified error model for tolerance design,assembly and error compensation of 3-DOF parallel kinematic machines with parallelogram struts[J].Annals of CIRP,2002,5l(1):299-303.
[14]Soons J A.Error analysis of a hexapod machine tool[J].Laser Metrology and Machine Performance,1997(3):346-358.
[15]Chaker A,Mlika A,Laribi M A,et al.Accuracy analysis of non-overconstrained spherical parallel manipulators[J].European Journal of Mechanics-A/Solids,2014(47):362-372.
[16]Chebbi A H,Affi Z,Romdhane L.Prediction of the pose errors produced by joints clearance for a 3-UPU parallel robot[J].Mechanism&Machine Theory,2009,44(9):1768-1783.
[17]Cui H,Zhu Z,Gan Z,et al.Kinematic analysis and error modeling of TAU parallel robot[J].Robotics and Computer-Integrated Manufacturing,2005,21(6):497-505.
[18]孙通帅.球面并联仿生髋关节误差模型分析及运动学实验研究[D].秦皇岛:燕山大学,2017.Sun Tongshuai.Error Analysis and Kinematic Experimental Study on the Bbionic Hip Joint with Spherical Parallel Manipulator[D].Qinhuangdao:Yanshan University,2017.(in Chinese with English Abstract)
[19]荣誉,刘双勇,韩勇,等.六足制孔机器人三自由度并联机械腿的误差模型及验证[J].农业工程学报,2016,32(15):18-25.Rong Yu,Liu Shuangyong,Han Yong,et al.Error model and verification of three degrees of freedom parallel mechanical leg on hexapod drilling robot[J].Transactions of the Chinese Society of Agricultural Engineering(Transactions of the CSAE),2016,32(15):18-25.(in Chinese with English Abstract)
[20]罗庆生,罗霄.仿生四足机器人技术[M].北京:北京理工大学出版社.2016.
[21]洪振宇,梅江平,赵学满.可重构混联机械手:TriVariant的误差建模与灵敏度分析[J].机械工程学报,2006,42(12):65-69.Hong Zhenyu,Mei Jiangping,Zhao Xueman.Error modeling and sensitivity analysis of reconfigurable hybrid robot module TriVariant[J].Journal of Mechanical Engineering,2006,42(12):65-69.(in Chinese with English Abstract)
[22]李铁民,郑浩峻,汪劲松,等.并联机床不同位形下的运动精度评价指标[J].机械工程学报,2002,38(9):101-105.Li Tiemin,Zheng Haojun,Wang Jinsong,et al.Precision measures for various configurations of parallel kinematic machine tools[J].Journal of Mechanical Engineering,2002,38(9):101-105.(in Chinese with English Abstract)
[23]黄田,李亚,李思维.一种三自由度并联机构几何误差建模、灵敏度分析及装配工艺设计[J].中国科学:E辑,2002,32(5):628-635.Huang Tian,Li Ya,Li Siwei.Criteria for conceptual design of reconfigurable PKM modules theory and Application[J].Science in China:Ser.E,2002,32(5):628-635.(in Chinese with English Abstract)
[24]宋黎,杨坚,曹惟庆.用蒙特卡洛法进行平面连杆机构的运动误差综合[J].机械科学与技术,1997(3):107-110.Song Li,Yang Jian,Cao Weiqing.The motion error synthesis of planar likages through Monte Carlo method[J].Mechanical Science and Technology for Aerospace Engineering,1997(3):107-110.(in Chinese with English Abstract)
[25]曾宪菁,黄田,曾子亚.3-RRR型数控回转台的精度分析[J].机械工程学报,2001,37(11):42-45.Zeng Xianjing,Huang Tian,Zeng Ziya.Accuracy analysys of the 3-RRR NC swivel work table[J].Chinese Journal of Mechanical Engineering,2001,37(11):42-45.(in Chinese with English Abstract)
[26]甘永立.几何量公差与检测[M].上海:上海科学技术出版社,2013.
