Time Optimal Trajectory Planning of Excavator

doi:10.3901/JME.2019.05.166

Abstract

Abstract: Using piece-wise polynomial interpolation method to plan the trajectory of the excavator's autonomous operation, there were some problems(the optimization trajectory is not smooth or the joints have unnecessary reciprocating movement)which leads to the large impact of the excavator joints and affects the service life of the excavator. In order to solve the problem of mining trajectory planning, the joint angle piece-wise interpolation strategy based on 4-3-3-3-4 polynomial is proposed to realize the optimal time trajectory planning of the excavator. Using the 4-3-3-3-4 polynomial, with angular velocity and angular acceleration as constraint conditions, the optimal value of interpolation time is obtained by using the differential evolution algorithm (DE), the optimal angle curve of each joint is achieved, and the optimal time trajectory planning of the excavator is realized. The simulation experiment based on 4-3-3-3-4 polynomial piece-wise interpolation strategy is carried out and compared with other polynomial interpolation strategies under the same conditions. The experimental results show that the mining trajectory of the polynomial interpolation strategy is smoother and the joints can reach the target point with small angular velocity and angular acceleration. It avoided the large impact during the operation of the joints and saved the working time, which made the excavator operate more smoothly and efficiently.

Key words: differential evolution algorithm, excavator, polynomial interpolation, trajectory planning

CLC Number:

TP242

SUN Zhiyi, ZHANG Yunyue, LI Hong, SUN Qianlai, WANG Yin. Time Optimal Trajectory Planning of Excavator[J]. Journal of Mechanical Engineering, 2019, 55(5): 166-174.

References

[1] 邵辉,胡伟石,罗继亮,等. 自动挖掘机的动作规划[C]//过程控制会议,2012年8月11~12日,华侨大学,厦门,中国. 2012:594-597. SHAO Hui,HU Weishi,LUO Jiliang,et al. Action planning of automatic excavators[C]//Process Control Conference,August 11-12,2012,Huaqiao University,Xiamen,China. 2012:594-597.
[2] LIN C S,CHANG P R,LUH J Y S. Formulation and optimization of cubic polynomial joint trajectories for industrial robots[J]. Automatic Control IEEE Transactions on,1983,28(12):1066-1074.
[3] 管成,王飞,张登雨. 基于NURBS的挖掘机器人时间最优轨迹规划[J]. 吉林大学学报,2015,45(2):540-546. GUAN Cheng,WANG Fei,ZHANG Dengyu. Time optimal trajectory planning based on NURBS for mining robots[J]. Journal of Jilin University,2015,45(2):540-546.
[4] QIANG L,LIU H,YUAN S. High accurate interpolation of NURBS tool path for CNC machine tools[J]. Chinese Journal of Mechanical Engineering,2016,29(5):911-920.
[5] 徐海黎,解祥荣,庄健,等. 工业机器人的最优时间与最优能量轨迹规划[J]. 机械工程学报,2010,46(9):19-25. XU Haili,XIE Xiangrong,ZHUANG Jian,et al. Optimum robots[J]. Journal of Mechanical Engineering,2010,46(9):19-25.
[6] 马强. 六自由度机械臂轨迹规划研究[D]. 哈尔滨:哈尔滨工程大学,2007. MA Qiang. Study on trajectory planning of six-freedom manipulator[D]. Harbin:Harbin Engineering University,2007.
[7] 张文佳,尚伟伟. 2自由度绳索牵引并联机器人的高速点到点轨迹规划方法[J]. 机械工程学报,2016,52(3):1-8. ZHANG Wenjia,SHANG Weiwei. High-speed point-to-point trajectory planning of a 2-DOF cable driven parallel manipulator[J]. Journal of Mechanical Engineering,2016,52(3):1-8.
[8] SHI Y,EBERHART R. Modified particle swarm optimizer[C]//IEEE International Conference on Evolutionary Computation Proceedings,May 4-9,1998,Anchorage,USA. New York:IEEE,2002:69-73.
[9] TAFAZOLI S,LAWRENCE P D,SALCUDEAN S E. Identification of inertial and friction parameters for excavator arms[J]. Robotics & Automation IEEE Transactions on,1999,15(5):966-971.
[10] 张大庆. 液压挖掘机工作装置运动控制研究[D]. 长沙:中南大学,2006. ZHANG Daqing. Research on motion control of hydraulic excavator working device[D]. Changsha:Central South University,2006.
[11] WANGHUI B U,LIU Z. Motion planning for industrial robots based on task process decomposition[J]. Chinese Journal of Mechanical Engineering,2010,23(2):135-141.
[12] TASGETIREN M F,PAN Q K,SUGANTHAN P N,et al. A differential evolution algorithm with variable parameter search for real-parameter continuous function optimization[C]//IEEE Congress on Evolutionary Computation,May 18-21,2009,Trondheim,Norway. New York:IEEE,2009:1247-1254.
[13] 付荣,居鹤华. 基于粒子群优化的时间最优机械臂轨迹规划算法[J]. 信息与控制,2011,40(6):802-808. FU Rong,JU Hehua. Time-optimal robot arm trajectory planning algorithm based on particle swarm optimization[J]. Information and Control,2011,40(6):802-808.
[14] 李海虹,林贞国,杜娟,等. 挖掘机自主挖掘分段可变阶多项式轨迹规划[J]. 农业机械学报,2016,47(4):319-325. LI Haihong,LIN Zhenguo,DU Juan,et al. Excavator autonomously taps subsection variable-order polynomial trajectory planning[J]. Transactions of the Chinese Society of Agricultural Machinery,2016,47(4):319-325.

[1]	SHEN Shiquan, REN Kun, LI Yongguo, HAN Yunsheng, XIANG Wanting, GENG Heyang. Automatic Coloring Trajectory Planning for Metal Surface Special-Shaped Zones [J]. Journal of Mechanical Engineering, 2024, 60(7): 258-265.
[2]	ZHOU Chen, XU Feixiang. Multi-objective Optimization Method for Steering Mode Switch Trajectory of Four-wheel Independent Steering Vehicle [J]. Journal of Mechanical Engineering, 2024, 60(6): 306-320.
[3]	ZHANG Peng, YIN Lairong, TONG Yonggang, HUANG Long. A Trajectory Optimization Method Based on the Gap Prediction Model for Automated Tape Placement [J]. Journal of Mechanical Engineering, 2024, 60(5): 296-316.
[4]	LIANG Liang, WU Chengdong, LIU Shichang. Optimal Trajectory Planning Algorithm of Industrial Robot Based on Joint Loss Constraint [J]. Journal of Mechanical Engineering, 2024, 60(19): 11-19.
[5]	QIN Tao, LI Yunhua, FAN Rujun. Trajectory Optimization of Autonomous Mining for Powerful Rocker Arm Hydraulic Shovels [J]. Journal of Mechanical Engineering, 2024, 60(18): 374-384.
[6]	WANG Hongliang, YONG Jianyu, PI Dawei, XIE Boyuan, WANG Erlie, WANG Xianhui. Multi-vehicle Formation Switching Trajectory Planning Based on Bézier Curve and Multi-objective Optimization Method [J]. Journal of Mechanical Engineering, 2024, 60(16): 270-279.
[7]	JI Yangjie, ZHANG Xinyu, YANG Ziru, ZHOU Shanghang, HUANG Yanjun, CAO Jianyong, XIONG Lu, YU Zhuoping. Trajectory Planning of Multi-intelligent Connected Vehicles: The State of the Art and Perspectives [J]. Journal of Mechanical Engineering, 2024, 60(10): 129-146.
[8]	LIANG Kaichong, ZHAO Zhiguo, YAN Danshu, ZHAO Kun. Expressway Lane Changing Trajectory Planning Method of Autonomous Vehicle Based on Dynamic Movement Primitives [J]. Journal of Mechanical Engineering, 2024, 60(10): 192-206.
[9]	ZHOU Honglong, PEI Xiaofei, LIU Yiping, ZHAO Kefan. Study on Spatio-temporal Coupled Hierarchical Trajectory Planning of Autonomous Vehicles for Dynamic Uncertain Scenarios [J]. Journal of Mechanical Engineering, 2024, 60(10): 222-234.
[10]	NIE Shida, LIU Hui, LIAO Zhihao, XIE Yujia, XIANG Changle, HAN Lijin, LIN Sihao. Study on Path Planning for Off-road Autonomous Vehicles in Complex Terrains [J]. Journal of Mechanical Engineering, 2024, 60(10): 261-272.
[11]	CHEN Xiaoming, LI Bai, FAN Lili, WANG Yazhou, ZHANG Tantan, ZHANG Youmin, CAO Dongpu. High-performance Trajectory Optimization for Automated Parking via Half-space Constraining Theory [J]. Journal of Mechanical Engineering, 2024, 60(10): 273-288.
[12]	LI Yonghui, LU Wenxiu. Design of Lower Limbs Low Torque Drive for Multi-posture Dummy in Large Amusement Facilities [J]. Journal of Mechanical Engineering, 2024, 60(1): 352-360.
[13]	YUE Xiaoming, ZANG Shuo, XU Zuoke, ZHANG Qinhe, ZHANG Jianhua, HUO Mengyou. Trajectory Planning and Servo Control Strategy of EDM Milling Based ona 6-DOF Serial Robot [J]. Journal of Mechanical Engineering, 2023, 59(9): 20-27.
[14]	GAO Jingsong, JIN Hongzhe, ZHU Yanhe, GAO Liang, Lü Hongya, ZHAO Jie, CAI Hegao. Research on Jumping Algorithm of Wheel-legged Self-balancing Robot Based on Nonlinear Spring Model [J]. Journal of Mechanical Engineering, 2023, 59(9): 51-62.
[15]	ZHANG Xin-tong, ZHANG Cheng-ming, LI Li-yi, FU Peng-rui. Design Method of High Efficiency Lightweight Permanent Magnet Synchronous Motor for Electric Propulsion [J]. Journal of Mechanical Engineering, 2023, 59(8): 181-195.