|
|
论文:2022,Vol:40,Issue(1):84-94 |
|
|
引用本文： |
|
|
普亚松, 史耀耀, 蔺小军, 张文斌, 陈振. 基于混合多项式插值的工业机器人关节运动规划[J]. 西北工业大学学报 |
|
|
PU Yasong, SHI Yaoyao, LIN Xiaojun, ZHANG Wenbin, CHEN Zhen. Joint motion planning of industrial robot based on hybrid polynomial interpolation[J]. Northwestern polytechnical university |
|
|
|
|
|
|
|
| 基于混合多项式插值的工业机器人关节运动规划 |
|
| 普亚松1,2, 史耀耀1, 蔺小军1, 张文斌2, 陈振1 |
|
1. 西北工业大学 机电学院, 陕西 西安 710072;
2. 红河学院 工学院, 云南 蒙自 661199 |
| 摘要: |
| 对于工业机器人速度约束的点到点关节运动规划，三次多项式规划存在角加速度不连续的问题，五次多项式规划方法需要预先设定目标点的角加速度值，容易引起角速度较大波动，3-5-…-5-3混合多项式规划因为五次多项式的存在，同样容易引起角速度较大波动。针对这些问题，提出一种三次多项式与四次多项式混合规划方法，第一段运动规划采用三次多项式插值，其余规划都采用四次多项式插值，在指定中间目标点角速度的同时，确保角加速度的连续性，且无需预先设定角加速度的值，避免角加速度预设定值不合理引起的角速度较大波动。并且为了避免运动规划中出现角速度峰值过大，提出了运动时间的计算方法，并设定2个目标点处较大速度为最大值，使得规划的角速度波动较小。通过算例验证了所提方法的合理性和有效性，与其他2种规划方法进行比较，有效解决了速度约束的点到点关节运动规划存在的问题，有利于提升工业机器人的工作性能和使用寿命。 |
| 关键词:
工业机器人
关节运动规划
点到点运动
速度约束
混合多项式插值
运动时间
|
|
| Joint motion planning of industrial robot based on hybrid polynomial interpolation |
|
| PU Yasong1,2, SHI Yaoyao1, LIN Xiaojun1, ZHANG Wenbin2, CHEN Zhen1 |
|
1. School of Mechanical Engineering, Northwestern Polytechnical University, Xi'an 710072, China;
2. College of Engineering, Honghe University, Mengzi 661199, China |
| Abstract: |
| To plan an industrial robot's point-to-point joint motion that has velocity constraints, the cubic polynomial interpolation planning method has angular acceleration discontinuity. The quintic polynomial interpolation planning method needs to set in advance the angular acceleration values of target points and easily causes angular velocity fluctuation. Because of the existence of quintic polynomials, hybrid polynomial planning 3-5-…-5-3 also easily causes large angular velocity fluctuation. To solve these problems, a hybrid polynomial interpolation planning method based on cubic and quartic polynomial interpolation is proposed. Cubic polynomial interpolation planning is applied to the first planning, and quartic polynomial interpolation planning is used for the rest of planning. The planning method can not only specify the angular velocities of intermediate target points but also ensure the continuity of angular acceleration. In addition, there is no need to set in advance the angular acceleration values of target points so as to avoid the angular velocity fluctuation caused by the unreasonable presetting of angular acceleration. Furthermore, in order to avoid excessive peaks of angular velocity during the joint motion planning, a calculation method for finding out reasonable motion time is put forward, under which the larger speed at two target points is taken as maximum, thus making the planned angular velocity fluctuation small. A case study is performed to verify the rationality and effectiveness of the planning method. Compared with the other two planning methods used for the case study, our planning method can effectively solve the problems of point-to-point joint motion planning with velocity constrains, therefore being beneficial to the working performance and service life of an industrial robot. |
| Key words:
industrial robot
joint motion planning
point-to-point motion
velocity constraint
hybrid polynomial interpolation
motion time
|
|
| 收稿日期: 2021-04-26
修回日期:
|
| DOI: 10.1051/jnwpu/20224010084 |
| 基金项目: 航空发动机及燃气轮机重大专项基础研究（2017-Ⅶ-0002-0095）、云南省高校重点实验室建设资助项目（2018ZD022）资助 |
| 通讯作者: 史耀耀(1959—),西北工业大学教授,主要从事机电控制及自动化、专用数控工艺装备、高速高效数控加工及加工表面光整技术研究。e-mail:shiyy@nwpu.edu.cn
Email：shiyy@nwpu.edu.cn |
| 作者简介: 普亚松(1976—),西北工业大学博士研究生,主要从事工业机器人与抛光、机械CAD/CAM研究。
|
|
|
|
|
|
|
|
参考文献: |
|
|
[1] 李黎, 尚俊云, 冯艳丽, 等. 关节型工业机器人轨迹规划研究综述[J]. 计算机工程与应用, 2018, 54(5):36-50 LI Li, SHANG Junyun, FENG Yanli, et al. Research of trajectory planning for articulated industrial robot:a review[J]. Computer Engineering and Applications, 2018, 54(5):36-50(in Chinese)
[2] 郭勇, 赖广. 工业机器人关节空间轨迹规划及优化研究综述[J]. 机械传动, 2020, 44(2):154-165 GUO Yong, LAI Guang. Review of joint space trajectory planning and optimization for industrial robot[J]. Journal of Mechanical Transmission, 2020, 44(2):154-165(in Chinese)
[3] 许健, 梅江平, 段晓斌, 等. 一种工业机器人连续轨迹规划过渡算法简[J]. 工程设计学报, 2016, 23(6):537-543 XU Jian, MEI Jiangping, DUAN Xiaobin, et al. An algorithm for segment transition in continuous trajectory planning of industrial robot[J]. Chinese Journal of Engineering Design, 2016, 23(6):537-543(in Chinese)
[4] 王川, 金晓怡, 陈志鹏, 等. 6-DOF抛光工业机器人关节空间轨迹规划研究[J]. 机械设计与制造, 2020(11):271-274 WANG Chuan, JIN Xiaoyi, CHEN Zhipeng, et al. Research on joint trajectory planning of 6-DOF polishing robots[J]. Machinery Design & Manufacture, 2020(11):271-274(in Chinese)
[5] 韩亚军, 刘家英. 基于B样条曲线的工业机器人运动轨迹误差优化研究[J]. 中国工程机械学报, 2020, 18(3):199-204 HAN Yajun, LIU Jiaying. Research on optimization of motion path error of industrial robot based on B-spline curve[J]. Chinese Journal of Construction Machinery, 2020, 18(3):199-204(in Chinese)
[6] 杨昌铸. 六轴工业机器人轨迹规划及仿真[D]. 广州:广东工业大学, 2018 YANG Changzhu. Trajectory planning and simulation of six-axis industrial robot[D]. Guangzhou:Guangdong University of Technology, 2018(in Chinese)
[7] 胡巧莉, 寿华好. 带法向约束的3次均匀B样条曲线插值[J]. 浙江大学学报, 2014, 41(6):619-623 HU Qiaoli, SHOU Huahao. Cubic uniform B-spline curves interpolation with normal constrains[J]. Journal of Zhejiang University, 2014, 41(6):619-623(in Chinese)
[8] ABBAS A, NASRI A, MAEKAWA T. Generating B-spline curves with points, normals and curvature constraints:a constructive approach[J]. The Visual Computer, 2010, 26(6):823-829
[9] NIKU S B. Introduction to robotics:analysis, control, applications[M]. 2nd ed. New Jersey:WILEY, 2011
[10] XU X R, WANG X G, QIN F. Trajectory planning of robot manipulators by using spline function approach[C]//Proceedings of the 3rd World Congress on Intelligent Control and Automation, 2000
[11] 田国富, 郑博涛, 孙书会, 等. 基于内插法的工业机器人关节空间轨迹规划[J]. 重型机械, 2019, 347(1):54-56 TIAN Guofu, ZHENG Botao, SUN Shuhui, et al. Trajectory planning of industrial robot joint space based on interpolation method[J]. Heavy Machinery, 2019, 347(1):54-56(in Chinese)
[12] 施祥玲, 方红根. 工业机器人时间-能量-脉动最优轨迹规划[J]. 机械设计与制造, 2018(6):254-257 SHI Xiangling, FANG Honggen. Time-energy-jerk optimal planning of industrial robot trajectories[J]. Machinery Design & Manufacture, 2018(6):254-257(in Chinese)
[13] 刘承立, 栾楠. 关节空间样条的连续点位运动规划算法[J]. 机械与电子, 2014(8):74-78 LIU Chengli, LUAN Nan. Continuous point-to-point motion planning algorithm based on splines in joint space[J]. Machinery & Electronics, 2014(8):74-78(in Chinese)
[14] PARIKH P A, TRIVEDI R, DAVE J. Trajectory planning for the five degree of freedom feeding robot using septic and nonic functions[J]. International Journal of Mechanical Engineering and Robotics Research, 2020, 9(7):1043-1050 |
|
|
|
|
|
|
|
