改进B样条曲线应用于6R机器人轨迹优化

摘要/Abstract

摘要： 利用D-H标架法建立了机器人的运动学模型，并在分析轨迹规划流程基础上将改进B样条曲线用于机器人关节空间轨迹插值；在论述改进原因并详细阐述改进B样条曲线的生成方法后，给出改进B样条曲线应用时的速度与加速度性质及算法实现细节；在MATLAB 2014a平台上进行仿真实验，利用改进方法实现圆弧轨迹运动。结果表明，该方法能够有效提高机器人在关节运动及空间轨迹的平滑性，进而可优化机器人的轨迹运动。

关键词: 工业机器人, 轨迹优化, 关节空间, 改进B样条

Abstract: A kinematics model of robots was established firstly by D-H frame method. Based on the analyses of trajectory planning processes, an improved B-spline curve was applied to the robot joint space trajectory interpolations. Secondly, after discussing the improvement reasons and elaborating the methods of improving the B-spline curves, the speed and acceleration properties， and the implementation details of the improved B-spline curves were given. Finally, simulation experiments were carried out on MATLAB 2014a platform, and the improved method was used to realize the circular trajectory. Results show that the method may improve the smoothness of robots in joint motions and spatial trajectories, and then optimize the trajectory motions of the robots.

Key words: industrial robot, trajectory optimization, joint space, improved B-spline

中图分类号:

TP242.2

董甲甲;王太勇;董靖川;张永宾;陶浩. 改进B样条曲线应用于6R机器人轨迹优化[J]. 中国机械工程.

DONG Jiajia;WANG Taiyong;DONG Jingchuan;ZHANG Yongbin;TAO Hao. Applications of Improved B-Spline Curves to 6R Robot Trajectory Optimization[J]. China Mechanical Engineering.

参考文献

[1]张红强, 章兢, 王耀南,等. 机器人关节空间B样条轨迹设计的混沌优化[J]. 电机与控制学报, 2007, 11(2): 174-177.
ZHANG Hongqiang, ZHANG Jin, WANG Yaonan, et al. Chaos Optimization of B-splines Path Planning for Robot in Joint Space [J]. Electric Machines and Control, 2007, 11(2):174-177.
[2]胡绳荪, 庹宇鲲, 申俊琦,等.基于B样条空间等距线的机器人轨迹优化算法[J]. 天津大学学报(自然科学与工程技术版), 2015, 48(8):723-727.
HU Shengsun, TOU Yukun, SHEN Junqi, et al. Robot Trajectory Optimization Algorithm Based on Spatial Offset B-Spline [J]. Journal of Tianjin University(Science and Technolgy), 2015, 48(8): 723-727.
[3]解则晓, 商大伟, 任凭. 基于Lamé曲线的Delta并联机器人拾放操作轨迹的优化与试验验证[J]. 机械工程学报, 2015, 51(1):52-59.
XIE Zexiao, SHANG Dawei, REN Ping. Optimization and Experimental Verification of Pick-and-place Trajectory for a Delta Parallel Robot Based on Lamé Curves [J]. Journal of Mechanical Engineering, 2015, 51(1):52-59.
[4]马睿, 胡晓兵, 殷国富,等. 六关节工业机器人最短时间轨迹优化[J]. 机械设计与制造, 2014(4):30-32.
MA Rui, HU Xiaobing, YIN Guofu, et al. The Shortest Time Optimal Planning of 6-DOF Industrial Robot's Trajectory[J]. Machinery Design & Manufacture, 2014(4): 30-32.
[5]李恩林. 数控系统插补原理通论[M]. 北京：国防工业出版社, 2008.
LI Enlin. CNC System Interpolation Principle Theory [M]. Beijing：National Defense Industry Press, 2008.
[6]姬帅, 胡天亮, 张承瑞. 基于实时以太网的高速精插补算法及其实现[J]. 计算机集成制造系统, 2012, 18(10): 2211-2216.
JI Shuai, HU Tianliang, ZHANG Chengrui. High Speed Fine Interpolation Algorithm and Its Implement Based on Real-time Ethernet [J]. CIMS, 2012, 18(10):2211-2216.
[7]RECLIK D, KOST G G. A Rational B-Spline Curves in Robot Collision-free Movement Planning[J]. Journal of Automation, Mobile Robotics & Intelligent Systems, 2008, 2(3):38-42.
[8]WANG C, WANG X, ZHENG H. Trajectory Planning for a Welding Robot Based on the Bezier Curve[J]. International Journal of Control & Automation, 2015, 8(2): 351-362.
[9]蔡自兴.机器人学[M].北京：清华大学出版社, 2015.
CAI Zixing. Robotics[M]. Beijing：Tsinghua University Press, 2015.
[10]刘蕾, 曾辉, 柳贺,等. 六自由度机器人S型曲线速度规划[J]. 计算技术与自动化, 2015, 21(2):42-45.
LIU Lei, ZENG Hui, LIU He, et al. S-curve Velocity Planning for 6-DOF Robot [J]. Computing Technology and Automation, 2015, 21(2):42-45.
[11]史步海, 孙会会. 基于新S型速度规划的B样条曲线算法研究[J]. 机床与液压, 2016, 44(15):72-79.
SHI Buhai, SUN Huihui. B-spline Curve Algorithm Research Based on New S Velocity Planning [J]. Machine Tool & Hydraulics, 2016, 44(15):72-79.
[12]李小霞, 汪木兰, 刘坤,等. 基于五次B样条的机械手关节空间平滑轨迹规划[J]. 组合机床与自动化加工技术, 2012(8):39-42.
LI Xiaoxia, WANG Mulan, LIU Kun, et al. Smooth Trajectory Planning Based on Five Degrees B-spline for Manipulators in Joint Space[J]. Modular Machine Tool & Automatic Manufacturing Technique, 2012(8):39-42.
[13]毛征宇, 刘中坚. 一种三次均匀B样条曲线的轨迹规划方法[J]. 中国机械工程, 2010, 21(21):2569-2572.
MAO Zhengyu, LIU Zhongjian. A Trajectory Planning Method for Cubic Uniform B-spline Curve [J]. China Mechanical Engineering, 2010, 21(21):2569-2572.
[14]王栋, 高成英, 梁云,等. 基于等式约束最小二乘的B样条曲线拟合[J]. 中山大学学报(自然科学版), 2008, 47(4): 15-18.
WANG Dong, GAO Chengying, LIANG Yun, et al. B-spline Curve Fitting Using Equality-constrained Least Squares [J]. Acta Scientiarum Naturalium Uuniversitatis Sunyatseni, 2008, 47(4):15-18.
[15]周红梅, 王燕铭, 刘志刚,等. 基于最少控制点的非均匀有理B样条曲线拟合[J]. 西安交通大学学报, 2008, 42(1):73-77.
ZHOU Hongmei, WANG Yanming, LIU Zhigang, et al. Non-uniform Rational B-Splines Curve Fitting Based on the Least Control Points [J]. Journal of Xi'an Jiatong University, 2008, 42(1):73-77.
[16]张斌. 基于多约束的机器人关节空间轨迹规划[J]. 机械工程学报, 2011, 47(21):1-6.
ZHANG Bin. Joint-space Trajectory Planning for Robots under Multiple Constraints [J]. Journal of Mechanical Engineering, 2011, 47(21):1-6.
[17]徐海黎, 解祥荣, 庄健,等. 工业机器人的最优时间与最优能量轨迹规划[J]. 机械工程学报, 2010, 46(9):19-25.
XU Haili, XIE Xiangrong, ZHUANG Jian, et al. Global Time-energy Optimal Planning of Industrial Robot Trajectories [J]. Journal of Mechanical Engineering, 2010, 46(9):19-25.
[18]勾治践, 牛永康, 王成. 基于B样条的6R机器人轨迹规划及仿真[J]. 煤矿机械, 2013, 34(2):48-50.
GOU Zhijian, NIU Yongkang, WANG Cheng. Trajectory Planning and Simulation of 6R Robot Based on B-splines [J]. Coal Mine Machinery, 2013, 34(2):48-50.