研究了不同空间轨迹曲线对激光跟踪仪、视觉测量设备等影响,以规划标准路径,保证经济、高效且高精度。以工业机器人为研究对象,建立机器人Denavit-Hartenberg(D-H)参数模型,对其结构和连杆参数进行分析,推导运动学方程,利用MATLAB Robotics toolbox分析验证机器人正、逆向运动学的正确性。在工业机器人运动学模型的基础上进行轨迹规划,分析了在关节空间和笛卡尔空间的轨迹规划方法,在MATLAB Robotics toolbox环境下对三次和五次多项式插值法等多种不同轨迹进行仿真,得出在关节空间中采取高次多项式插值法进行标准轨迹规划的初步结论,验证了关节轨迹的平顺性,保证测量设备的速度和连续性。为后续研究轨迹对不同测量设备的影响,规划标准路径进行测量设备的溯源提供理论基础。
Abstract
Under the background of the research on traceability technology of pose measurement equipment, a standard path should be planned to reflect the difference of measurement under the same condition. And in order to design the standard path which has the economic rationality, high efficiency and high accuracy, the influences of different spatial trajectory curves on measuring equipment should be studied, such as laser tracker and visual measurement equipment. The industrial robot was took as the research object, the D-H parameter model of the robot was established, the structure and connecting rod parameters were analyzed, and kinematics equations were derived. The correctness of forward and reverse kinematics of the robot were verified using MATLAB robotics toolbox. The trajectory planning methods were analyzed and simulated in joint space and cartesian space on the basis of the industrial robot kinematics model, such as three times polynomial interpolation method and five times polynomial interpolation method. Through a series of simulations, it is concluded that the method of higher degree polynomial interpolation in joint space for standard trajectory planning can be used. The simulation images can also verify the smooth joint trajectory and ensure the speed and the continuity of the measurements. The analysis and simulations provided the theoretical foundation for the further study of trajectory on the influence of different measuring equipment and standard path planning.
关键词
计量学 /
工业机器人 /
轨迹规划 /
高次多项式插值法 /
关节空间
Key words
metrology /
industrial robots /
trajectory planning /
high degree polynomial interpolation /
joint space
{{custom_sec.title}}
{{custom_sec.title}}
{{custom_sec.content}}
参考文献
[1]李黎, 尚俊云, 冯艳丽, 等. 关节型工业机器人轨迹规划研究综述[J]. 计算机工程与应用, 2018, 54(5): 36-50.
Li L, Shang J Y, Feng Y L, et al. Summary of Research on Trajectory Planning of Articulated Industrial Robot[J]. Computer Engineering and Applications, 2018, 54(5): 36-50.
[2]Chwa D, Kang J, Jin Y C. Online trajectory planning of robot arms for interception of fast maneuvering object under torque and velocity constraints[J]. IEEE Transactions on Systems, Man, and Cybernetics-Part A: Systems and Humans, 2005, 35(6): 831-843.
[3]Saravanan R, Ramabalan S, Balamurugan C. Multi-objective trajectory planner for industrial robots with payload constraints[M]. Lodon: Cambridge University Press, 2008: 33-38.
[4]Xu X R, Wang X G, Qin F. Trajectory planning of robot manipulators by using spline function approach[C]//3rd World Congress on Intelligent Control and Automation. 2000: 1215-1219.
[5]国家质量监督检验检疫总局. GB/T 12642-2013 工业机器人性能规范及其试验方法[S]. 2013.
[6]任瑜, 张丰, 郭志敏, 等. 一种通用的工业机器人位姿检测方法[J]. 计量学报, 2018, 39(5): 615-621.
Ren Y, Zhang F, Guo Z M, et al. A general detection method of industrial robot posture[J]. Acta Metrologica Sinica, 2018, 39(5): 615-621.
[7]叶声华, 王一, 任永杰, 等. 基于激光跟踪仪的机器人运动学参数标定方法[J]. 天津大学学报, 2007, 40(2): 202-205.
Ye S H, Wang Y, Ren Y J, et al. A Calibration Method of Robot Kinematics Parameters Based on Laser Tracker[J]. Journal of Tianjin University, 2007,40(2): 202-205.
[8]Kucuk S, Bingul Z. Inverse kinematics solutions for industrial robot manipulators with offset wrists [J]. Applied Mathematical Modelling, 2014, 38(7-8):1983-1999.
[9]冯瑶, 公茂震. 6R机器人笛卡尔空间轨迹规划中的逆运动学[J]. 自动化技术与应用, 2018, 37(6): 68-73.
Feng Y, Gong M Z. Inverse kinematics of 6R robot Cartesian space trajectory planning[J]. Automation Technology and Application, 2018, 37(6): 68-73.
[10]Gasparetto A, Boscariol P, Lanzutti A, et al. Trajectory Planning in Robotics [J]. Mathematics in Computer Science, 2012, 6(3): 269-279.
[11]赵春芳, 李江昊, 张大伟. 基于改进免疫遗传优化蚁群算法的移动机器人路径寻优研究[J]. 计量学报, 2019, 40(3): 505-510.
Zhao C F, Li J H, Zhang D W. Research on path optimization of mobile robot based on improved immune genetic optimization ant colony algorithm[J]. Acta Metrologica Sinica, 2019, 40(3): 505-510.
[12]Tan G Z, Wang Y C, et al. Theoretical and experimental research on time-optimal trajectory planning and control of industrial robots[J]. Journal of Control Theory & Applications, 2003, 20(2):185-192.
[13]Kim J, Kim S. A practical approach for minimum-time trajectory planning for industrial robots[J]. Journal of Industrial Robot, 2010, 37(1): 51-61.
[14]韩军, 郝立. 机器人关节空间的轨迹规划及仿真[J]. 南京理工大学学报, 2000,24(6): 540-543.
Han J, Hao L. The Trajectory Planning and Simulation of Robot Joint Space[J]. Journal of Nanjing University of Science and Technology, 2000,24(6): 540-543.
[15]杜亮, 张铁. 工业机器人连续轨迹位置规划算法的研究[J]. 装备制造技术, 2006,(5): 29-31.
Du L, Zhang T. Study on the Algorithm of Continuous Trajectory Position Planning for Industrial Robots[J]. Equipment manufacturing technology,2006,(5):29-31.
[16]左富勇, 胡小平, 谢珂, 等. 基于MATLAB Robotics工具箱的SCARA机器人轨迹规划与仿真[J]. 湖南科技大学学报(自然科学版), 2012, 27(2): 41-44.
Zuo F Y, Hu X P, Xie K, et al. Strategy Planning and Simulation of SCARA Robot Based on MATLAB Robotics Toolbox[J]. Journal of Hunan University of Science and Technology(Natural Science), 2012, 27(2): 41-44.
基金
国家重点研发计划(2018YFF0212700)