吉林大学学报(工学版) ›› 2015, Vol. 45 ›› Issue (2): 540-546.doi: 10.13229/j.cnki.jdxbgxb201502030

• 论文 • 上一篇    下一篇

基于NURBS的挖掘机器人时间最优轨迹规划

管成，王飞，张登雨   

  1. 浙江大学 机械设计研究所，杭州 310027
  • 收稿日期:2013-06-17 出版日期:2015-04-01 发布日期:2015-04-01
  • 作者简介:管成(1968)，男，副教授，博士.研究方向:工程机械液压控制，挖掘机器人技术.E-mail:guan@zju.edu.cn
  • 基金资助:
    “863”国家高技术研究发展计划项目(2010AA044401).

NURBS-based time-optimal trajectory planning on robotic excavators

GUAN Cheng, WANG Fei, ZHANG Deng-yu   

  1. Institute of Mechanical Design, Zhejiang University, Hangzhou 310027, China
  • Received:2013-06-17 Online:2015-04-01 Published:2015-04-01

RICH HTML

0   

PDF (PC)

337

摘要： 为提高挖掘机器人的工作效率，保证其运行轨迹平滑，提出了一种基于NURBS曲线的轨迹规划方法。利用5次NURBS曲线插值挖掘机器人关节位置，引入矢值函数，通过莱布尼茨公式求解NURBS曲线的高阶导矢，设定启停速度和加速度，得到经过指定关节位置加加速度连续的轨迹曲线。分析了NURBS曲线权因子在挖掘轨迹局部规划中的作用。采用序列二次规划方法求解约束条件下的非线性最小化问题，规划出时间最优轨迹曲线。仿真和试验表明:提出的轨迹规划方法能够得到满足物理约束的时间最优关节轨迹，且可进行轨迹局部优化。

关键词: 自动控制技术, 挖掘机器人, 轨迹规划, 序列二次规划

Abstract: In order to improve the efficiency of the robotic excavator meanwhile to obtain its smooth running trajectory, a new trajectory planning method based on Non-uniform Rational Basis Spline (NURBS) was proposed. A quintic NURBS curve was employed to interpolate joint positions of the robotic excavator. Using the vector-valued function, by Leibniz formula, higher order derivative vector of NURBS curve was obtained to set the start and stop speeds and accelerations; and to make up the trajectory curves with continuous jerk, which passes specified joint positions. The effect of NURBS weight factor in sectional trajectory planning was analyzed. Nonlinear minimization problems under constraints were solved using sequential quadratic programming; then time-optimal trajectories were planned. Simulation and experiment results show that the proposed trajectory planning method can provide time-optimal trajectories, which satisfy kinematic constraints and the sectional trajectory optimization is effective.

Key words: automitic control technology, robotic excavator, trajectory planning, sequential quadratic programming

中图分类号: 

  • TP242.6
[1] 冯培恩,孙守迁,杨毅,等.采掘机器人的规划级控制技术研究[J].自动化学报,1995,21(1):33-38.
Feng Pei-en, Sun Shou-qian, Yang Yi, et al. Research on the technique of planning level control for excavating-robot[J]. Acta Automatica Sinica, 1995,21(1):33-38.
[2] 王昕,赵丁选,尚涛,等.基于单神经元的液压挖掘机自适应PID节能控制[J].吉林大学学报:工学版,2005,35(4):377-380.
Wang Xin, Zhao Ding-xuan, Shang Tao, et al. Adaptive PID control for energy-saving of hydraulic excavator based on single neuron[J].Joumal of Jilin University(Engineering and Technology Edition), 2005, 35(4):377-380.
[3] 徐海黎,解祥荣,庄健,等.工业机器人的最优时间与最优能量轨迹规划[J].机械工程学报,2010,46(9):19-25.
Xu Hai-li, Xie Xiang-rong, Zhuang Jian, et al. Global time-energy optimal planning of industrial robot trajectories[J]. Journal of Mechanical Engineering, 2010,46(9):19-25.
[4] 张大庆,何清华,郝鹏,等.液压挖掘机铲斗的轨迹跟踪控制[J].吉林大学学报:工学版,2005,35(5):490-494.
Zhang Da-qing, He Qing-hua, Hao Peng, et a1. Trajector tracking control of hydraulic excavator bucket[J]. Joumal of Jilin University(Engineering and Technology Edition), 2005, 35(5):490-494.
[5] 朱世强,刘松国,王宣银,等.机械手时间最优脉动连续轨迹规划算法[J].机械工程学报,2010,46(3):47-52.
Zhu Shi-qiang, Liu Song-guo, Wang Xuan-yin, et al. Time-optimal and jerk-continuous trajectory planning algorithm for manipulators[J]. Journal of Mechanical Engineering, 2010,46(3):47-52.
[6] 刘宇,刘春时,张义民.基于NURBS的挖掘机自主控制铲斗轨迹规划方法[J].中国工程机械学报,2012,10(2):145-149.
Liu Yu, Liu Chun-shi, Zhang Yi-min. NURBS-based autonomously-controlled bucket trajectory planning on robotic excavators[J]. Chinese Journal of Construction Machinery, 2012,10(2):145-149.
[7] Kim D, Kim J, Lee K, et al. Excavator tele-operation system using a human arm[J]. Automation in Construction,2009,18(2): 173-182.
[8] Lee S U, Chang P H. Control of a heavy-duty robotic excavator using time delay control with integral sliding surface[J]. Control Engineering Practice, 2002,10(7): 697-711.
[9] Gu J, Seward D. Digital servo control of a robotic excavator[J]. Chinese Journal of Mechanical Engineering, 2009,22(2):190-197.
[10] Saravanan R, Ramabalan S, Balamurugan C. Multiobjective trajectory planner for industrial robots with payload constraints[J]. Robotica,2008, 26 (6):753-765.
[11] 梁宏斌,王永章,李霞.自动调节进给速度的NURBS插补算法的研究与实现[J].计算机集成制造系统,2006,12(3):428-433.
Liang Hong-bin, Wang Yong-zhang, Li Xia. Research and implementation of NURBS interpolation algorithm for adaptive feed speed[J]. Computer Integrated Manufacturing Systems, 2006, 12(3): 428-433.
[12] 玄冠涛,邵园园,吕钊钦,等.基于NURBS的空间分度凸轮廓面重构与仿真[J].农业机械学报,2012,43(6):226-234.
Xuan Guan-tao, Shao Yuan-yuan, Lü Zhao-qin, et al. Profile reconstruction of spatial indexing cam and simulation based on NURBS[J]. Transactions of the Chinese Society for Agricultural Machinery, 2012,43(6):226-234.
[1] 顾万里,王萍,胡云峰,蔡硕,陈虹. 具有H∞性能的轮式移动机器人非线性控制器设计[J]. 吉林大学学报(工学版), 2018, 48(6): 1811-1819.
[2] 李战东,陶建国,罗阳,孙浩,丁亮,邓宗全. 核电水池推力附着机器人系统设计[J]. 吉林大学学报(工学版), 2018, 48(6): 1820-1826.
[3] 赵爽,沈继红,张刘,赵晗,陈柯帆. 微细电火花加工表面粗糙度快速高斯评定[J]. 吉林大学学报(工学版), 2018, 48(6): 1838-1843.
[4] 王德军, 魏薇郦, 鲍亚新. 考虑侧风干扰的电子稳定控制系统执行器故障诊断[J]. 吉林大学学报(工学版), 2018, 48(5): 1548-1555.
[5] 闫冬梅, 钟辉, 任丽莉, 王若琳, 李红梅. 具有区间时变时滞的线性系统稳定性分析[J]. 吉林大学学报(工学版), 2018, 48(5): 1556-1562.
[6] 张茹斌, 占礼葵, 彭伟, 孙少明, 刘骏富, 任雷. 心肺功能评估训练系统的恒功率控制[J]. 吉林大学学报(工学版), 2018, 48(4): 1184-1190.
[7] 董惠娟, 于震, 樊继壮. 基于激光测振仪的非轴对称超声驻波声场的识别[J]. 吉林大学学报(工学版), 2018, 48(4): 1191-1198.
[8] 张琳, 章新杰, 郭孔辉, 王超, 刘洋, 刘涛. 未知环境下智能汽车轨迹规划滚动窗口优化[J]. 吉林大学学报(工学版), 2018, 48(3): 652-660.
[9] 田彦涛, 张宇, 王晓玉, 陈华. 基于平方根无迹卡尔曼滤波算法的电动汽车质心侧偏角估计[J]. 吉林大学学报(工学版), 2018, 48(3): 845-852.
[10] 张士涛, 张葆, 李贤涛, 王正玺, 田大鹏. 基于零相差轨迹控制方法提升快速反射镜性能[J]. 吉林大学学报(工学版), 2018, 48(3): 853-858.
[11] 王林, 王洪光, 宋屹峰, 潘新安, 张宏志. 输电线路悬垂绝缘子清扫机器人行为规划[J]. 吉林大学学报(工学版), 2018, 48(2): 518-525.
[12] 胡云峰, 王长勇, 于树友, 孙鹏远, 陈虹. 缸内直喷汽油机共轨系统结构参数优化[J]. 吉林大学学报(工学版), 2018, 48(1): 236-244.
[13] 朱枫, 张葆, 李贤涛, 王正玺, 张士涛. 基于强跟踪卡尔曼滤波的陀螺信号处理[J]. 吉林大学学报(工学版), 2017, 47(6): 1868-1875.
[14] 晋超琼, 张葆, 李贤涛, 申帅, 朱枫. 基于扰动观测器的光电稳定平台摩擦补偿策略[J]. 吉林大学学报(工学版), 2017, 47(6): 1876-1885.
[15] 曲兴田, 闫龙威, 孙慧超, 周伟, 李光辉. 工作平台可翻转的3D打印机装置结构分析[J]. 吉林大学学报(工学版), 2017, 47(5): 1489-1497.
Viewed
Full text


Abstract

Cited
  Shared   
  Discussed   
No Suggested Reading articles found!
版权所有 © 《吉林大学学报(工学版)》编辑部
地址：长春市人民大街5988号　电话：+86-431-85095297　传真：+86-431-85094074　E-mail: xbgxb@jlu.edu.cn
本系统由北京玛格泰克科技发展有限公司设计开发