Study on Modular Assembly Errors Identification of Modular Reconfigurable Robots
-
摘要: 基于对可重构机器人配对接口间位姿误差的分析划分,研制模块间装配误差在线测量识别接口,建立配对接口位姿误差与接口几何结构偏差之间的关系模型,进而建立配对接口位姿误差与配对接口内部测距传感器测量值之间的映射关系模型,提出一种基于内部测距传感器位移量的模块间装配误差在线识别、补偿方法。为验证方法的正确性,研制单关节-连杆试验平台。试验结果表明装配误差经在线识别、补偿后,连杆末端的位置误差平均值减少7倍多。Abstract: Based on the analysis and division of the position and orientation errors among the pairing connector of reconfigurable robots, a special pair of the connector is designed for online measurement and identification of the assembly errors among the assembled modules. The relation model between the errors of position and orientation in the pairing connector and deviations of the geometric structure in adjoining modules is established. Furthermore, the mapping relation model among the measuring values of the internal range sensors and the errors of the position and orientation in the pairing connector is also established. An online identification and compensation method for the assembly errors among the consecutive modules is presented, based on the displacement of the internal range sensors. In order to verify the correctness of the present method, a single joint-link test platform is developed. After the assembly errors are identified and compensated online, the test results show that the average position errors of the end-link are reduced by above 7 times.
-
表 1 模块几何参数测量值
几何参数 r L0 L1 L2 测量值/mm 25.027 5 44.002 4 5.996 2 43.500 0 表 2 理论坐标值
mm 测试点 坐标 1 (220.196 8, 14.863 0) 2 (-122.970 1, 183.264 5) 3 (-97.226 7, 198.127 5) 表 3 指示表示值
mm 序号 1#传感器 2#传感器 3#传感器 1 8.012 8.365 7.603 2 7.345 7.976 8.584 3 8.877 8.039 7.023 4 7.704 7.356 9.297 5 8.859 7.855 7.272 6 8.713 7.524 7.877 表 4 补偿后坐标值
序号 测试点补偿后坐标/mm 1 2 3 1 (219.913 4, 13.531 7) (-121.675 5, 183.684 7) (-98.237 9, -197.216 4) 2 (220.915 3, 13.793 2) (-122.402 9, 184.421 7) (-98.512 4, -198.214 9) 3 (219.217 3, 14.920 9) (-122.530 5, 182.387 3) (-96.686 8, -197.308 2) 4 (221.208 2, 15.447 6) (-123.982 1, 183.848 1) (-97.226 1, -199.295 7) 5 (219.399 3, 16.057 6) (-123.605 9, 181.976 6) (-95.793 4, -198.034 2) 6 (219.758 0, 17.318 4) (-124.877 2, 181.656 8) (-94.880 8, -198.975 2) 表 5 实测坐标值
序号 测试点实测坐标/mm 1 2 3 1 (219.863 0, 13.422 5) (-121.942 3, 183.516 2) (-98.312 5, -197.534 6) 2 (220.920 0, 13.626 4) (-122.587 0, 184.356 8) (-98.692 2, -198.504 5) 3 (219.249 5, 14.810 6) (-122.778 2, 182.780 0) (-96.870 8, -197.660 5) 4 (221.150 9, 15.468 8) (-124.358 8, 183.640 7) (-97.246 2, -199.678 1) 5 (219.478 2, 15.656 2) (-123.552 5, 182.104 0) (-96.183 9, -198.202 7) 6 (219.706 2, 17.637 6) (-125.399 5, 181.425 2) (-94.689 2, -199.346 0) -
[1] 王丹, 孟悦, 尹伟萌, 等.可重构模块化空间机械臂的模块库与构型[J].机械设计与研究, 2018, 34(6):176-181, 187 https://www.cnki.com.cn/Article/CJFDTOTAL-JSYY201806043.htmWANG D, MENG Y, YIN W M, et al. Study on module library and configuration of reconfigurable modular space manipulator[J]. Machine Design & Research, 2018, 34(6):176-181, 187 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JSYY201806043.htm [2] 吴文强, 管贻生, 朱海飞, 等.面向任务的可重构模块化机器人构型设计[J].哈尔滨工业大学学报, 2014, 46(3):93-98 https://www.cnki.com.cn/Article/CJFDTOTAL-HEBX201403016.htmWU W Q, GUANG Y S, ZHU H F, et al. Task-oriented configuration design of reconfigurable modular robots[J]. Journal of Harbin Institute of Technology, 2014, 46(3):93-98 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-HEBX201403016.htm [3] 田聚峰, 王攀峰, 刘世博, 等.考虑关节刚度的轻型模块化机器人标定方法[J].机械科学与技术, 2018, 37(8):1217-1222 doi: 10.13433/j.cnki.1003-8728.20180015TIAN J F, WANG P F, LIU S B, et al. Calibration method for lightweight modular robot with joint stiffness taken into account[J]. Mechanical Science and Technology for Aerospace Engineering, 2018, 37(8):1217-1222 (in Chinese) doi: 10.13433/j.cnki.1003-8728.20180015 [4] CHEN I M, YANG G L. Kinematic calibration of modular reconfigurable robots using product-of-exponentials formula[J]. Journal of Robotic Systems, 1997, 14(11):807-821 doi: 10.1002/(SICI)1097-4563(199711)14:11<807::AID-ROB4>3.0.CO;2-Y [5] YANG G, CHEN I M. A novel kinematic calibration algorithm for reconfigurable robotic systems[C]//Proceedings of the 1997 IEEE International Conference on Robotics and Automation. Albuquerque, NM: IEEE, 1997: 3197-3202 [6] 高文斌, 王洪光, 姜勇, 等.一种模块化机器人的标定方法研究[J].机械工程学报, 2014, 50(3):33-40 https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB201403005.htmGAO W B, WANG H G, JIANG Y, et al. Research on the calibration for a modular robot[J]. Journal of Mechanical Engineering, 2014, 50(3):33-40 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB201403005.htm [7] LIN Y, XI F F, Mohamed R P, et al. Calibration of modular reconfigurable robots based on a hybrid search method[J]. Journal of Manufacturing Science and Engineering, 2010, 132(6):061002 doi: 10.1115/1.4002586 [8] 高文斌, 王洪光, 姜勇, 等.模块化可重构机器人标定方法研究[J].机械工程学报, 2013, 49(17): 92-100 https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB201317017.htmGAO W B, WANG H G, JIANG Y, et al. Research on the calibration of modular reconfigurable robot[J]. Journal of Mechanical Engineering, 2013, 49(17):92-100 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB201317017.htm [9] PAN X A, WANG H G, JIANG Y. Research on the kinematic calibration of a modular reconfigurable robot[C]//Proceedings of 2013 IEEE International Conference on Mechatronics and Automation. Takamatsu: IEEE, 2013: 562-568 [10] KANG S K, PRYOR M W, TESAR D. Kinematic model and metrology system for modular robot calibration[C]//Proceedings of IEEE International Conference on Robotics and Automation. New Orleans, LA: IEEE, 2004: 2894-2899 [11] CHEN I M, YANG G L, TAN C T, et al. Local POE model for robot kinematic calibration[J]. Mechanism and Machine Theory, 2001, 36(11-12):1215-1239 doi: 10.1016/S0094-114X(01)00048-9 [12] 陈伟海, 高勇, 杨桂林, 等.模块化可重构三腿并联机器人的运动学控制[J].机械工程学报, 2005, 41(8): 96-102 https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB200508016.htmCHEN W H, GAO Y, YANG G L, et al. Kinematic control of 3-legged modular reconfigurable parallel manipulators[J]. Journal of Mechanical Engineering, 2005, 41(8):96-102 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB200508016.htm [13] 周旋.机械装备装配公差与运动精度的分析研究[D].武汉: 华中科技大学, 2018ZHOU X. Research on assembly tolerance analysis and kinematic accuracy analysis of mechanical equipment[D]. Wuhan: Huazhong University of Science and Technology, 2018 (in Chinese) [14] 白争锋.考虑铰间间隙的机构动力学特性研究[D].哈尔滨: 哈尔滨工业大学, 2011BAI Z F. Research on dynamic characteristics of mechanism with joint clearance[D]. Harbin: Harbin Institute of Technology, 2011 (in Chinese) [15] JIANG Z Z, GAO W B, YU X L. An innovative error measuring method for modular interfaces of modular reconfigurable robots[C]//Proceedings of the 3rd International Conference on Robotics, Control and Automation. Chengdu: ACM, 2018: 119-122