Design and Application of the Unmanned Driving Control Algorithm for the Vibroseis Vehicle

doi:10.3901/JME.2022.06.211

Abstract

Abstract: In order to meet the operation demand of the vibroseis vehicle in the case of unmanned driving, an unmanned driving system that meets the working characteristics of the vibroseis vehicle is designed, and the key technical problems are studied. Firstly, the system is designed and built. Secondly, according to the structural characteristics of articulated vehicle, the kinematic analysis and modeling of the vibroseis vehicle are carried out. A local path planning algorithm based on steering geometry constraint is proposed to solve the problem of work point deviation. A model predictive control algorithm based on the kinematic model is designed for vehicle path tracking to improve the path tracking accuracy of the vibroseis vehicle. A compensation algorithm for positioning error of the working point is proposed to reduce the positioning error caused by terrain factors. A new car following distance calculation algorithm is designed to ensure vehicle safety during formation operation. Finally, the real-vehicle experiment and field production test are carried out. The experiment results verify the effectiveness of the proposed algorithms. And the field production data shows that the system can improve the work efficiency of the vibroseis vehicle by 15% and the accuracy by 57%.

Key words: vibrator, unmanned driving, path tracking, positioning compensation, vehicle distance calculation

CLC Number:

TP273
U273

LIU Pengtao, WANG Shoukun, WANG Junzheng, LEI Tao, FA Wei, HAN Zhonghua. Design and Application of the Unmanned Driving Control Algorithm for the Vibroseis Vehicle[J]. Journal of Mechanical Engineering, 2022, 58(6): 211-220.

References

[1] 肖虎，何永清，刘兵，等. 复杂区可控震源高效采集技术及应用[J]. 工程地球物理学报，2020，17(2)：135-144. XIAO Hu，HE Yongqing，LIU Bing，et al. Vibroseis high- efficiency acquisition technology and application in complex area[J]. Chinese Journal of Engineering Geophysics，2020，17(2)：135-144.
[2] 熊璐，杨兴，卓桂荣，等. 无人驾驶车辆的运动控制发展现状综述[J]. 机械工程学报，2020，56(10)：127-143. XIONG Lu，YANG Xing，ZHUO Guirong，et al. Review on motion control of autonomous vehicles[J]. Journal of Mechanical Engineering，2020，56(10)：127-143.
[3] 陶知非，刘志刚，马磊，等. EV-56高精度可控震源技术[J]. 物探装备，2018，28(5)：281-282，288. TAO Zhifei，LIU Zhigang，MA Lei，et al. EV-56 high precision vibroseis technology[J]. EGP，2018，28(5)：281-282，288.
[4] 法炜，洪毅，王凯基，等. 常规可控震源限定频谱高频拓展[J]. 物探装备，2014，24(6)：387-390，415. FA Wei，HONG Yi，WANG Kaiji，et al. The method for high frequency sweep signal expanding on conventional vibrator[J]. EGP，2014，24(6)：387-390，415.
[5] NAYL T，NIKOLAKOPOULOS G，GUSTAFSSON T，et al. A full error dynamics switching modeling and control scheme for an articulated vehicle[J]. International Journal Of Control Automation and Systems，2015，13(5)：1221-1232.
[6] LEE J H，YOO W S. Predictive control of a vehicle trajectory using a coupled vector with vehicle velocity and slideslip angle[J]. International Journal of Automotive Technology，2009，10(2)：211-217.
[7] RIDLEY P，CORKE P. Load haul dump vehicle kinemattics and control[J]. Journal of Dynamic Systems，Measurement，and Control，2003，125(1)：54-59.
[8] 崔卫卫. 无人驾驶清扫车运动规划与实验研究[D]. 合肥：合肥工业大学，2020. CUI Weiwei. The motion planning and experimental research for autonomous sweeping vehicle[D]. Hefei：Hefei University of Technology，2020.
[9] 邵俊恺，赵翾，杨珏，等. 无人驾驶铰接式车辆强化学习路径跟踪控制算法[J]. 农业机械学报，2017，48(3)：376-382. SHAO Junkai，ZHAO Xuan，YANG Jue，et al. Reinforcement learning algorithm for path following control of articulated vehicle[J]. Transactions of the Chinese Society for Agricultural Machinery，2017，48(3)：376-382.
[10] 赵翾，杨珏，张文明，等. 农用轮式铰接车辆滑模轨迹跟踪控制算法[J]. 农业工程学报，2015，31(10)：198-203. ZHAO Xuan，YANG Jue，ZHANG Wenming，et al. Sliding mode control algorithm for path tracking of articulated dump truck[J]. Transactions of the Chinese Society of Agricultural Engineering，2015，31(10)：198-203.
[11] 窦凤谦. 地下矿用铰接车路径跟踪与智能避障控制研究[D]. 北京：北京科技大学，2018. DOU Fengqian. Research on path tracking and obstacles avoidance for autonomous underground mining articulated steering vehicles[D]. Beijing：University of Science and Technology Beijing，2018.
[12] 孟宇，甘鑫，白国星. 基于预瞄距离的地下矿用铰接车路径跟踪预测控制[J]. 工程科学学报，2019，41(5)：662-671. MENG Yu，GAN Xin，BAI Guoxing. Path following control of underground mining articulated vehicle based on the preview control method[J]. Chinese Journal of Engineering，2019，41(5)：662-671.
[13] 龚建伟，姜岩，徐威. 无人驾驶车辆模型预测控制[M]. 北京：北京理工大学出版社，2014. GONG Jianwei，JIANG Yan，XU Wei. Model predictive control for self-driving vehicles[M]. Beijing：Beijing Institute of Technology Press，2014.
[14] KUHNE F，FETTER W，LAGES J，et al. Model predictive control of a mobile robot using linearization[J]. Proceedings of Mechatronics and Robototics，2004 (4)：525-530.

[1]	ZHANG Hao, WEI Chao, HU Jibin, CHEN Yongdan. Research on Three-axis Independent Steering Vehicle Path Tracking Control Based on Steering Mode Switching [J]. Journal of Mechanical Engineering, 2024, 60(2): 243-251.
[2]	WANG Hongbo, ZHOU Juntao, CHEN Wuwei, ZHENG Wenjie, XIE Youhao. Intelligent Vehicle Path Tracking Coordinated Control Based on Steering/Yaw Nash Game [J]. Journal of Mechanical Engineering, 2024, 60(10): 439-452.
[3]	ZHANG Xufei, LIU Xinchao, MA Jie, ZHANG Fengyang, QUAN Long. Research on Harmonic Control of Electromagnetic Standard Vibrator Based on Neural Network Inverse Model of Nearest Neighbor Uniform Design [J]. Journal of Mechanical Engineering, 2023, 59(5): 180-191.
[4]	REN Haoling, WU Jiangdong, LIN Tianliang, ZHANG Chunhui, LI Yukun. Construction Machinery Localization and Mapping System Based on Multi-sensor Tight Coupling [J]. Journal of Mechanical Engineering, 2023, 59(24): 323-333.
[5]	LIN Xinyou, YE Zhuoming, ZHOU Binhao. DQN Reinforcement Learning-based Steering Control Strategy for Autonomous Driving [J]. Journal of Mechanical Engineering, 2023, 59(16): 315-324.
[6]	ZHANG Yongmeng, GUO Kechen, SUN Jiangkun, YU Sheng, XIAO Dingbang, WU Xuezhong. Research on Damping Error Tuning and Compensating Technology of Whole Angle Mode Hemispherical Resonator Gyroscope [J]. Journal of Mechanical Engineering, 2022, 58(16): 145-152.
[7]	WANG Yi, CAI Yingfeng, CHEN Long, WANG Hai, HE Youguo, LI Jian. Design of Intelligent and Connected Vehicle Path Tracking Controller Based on Model Predictive Control [J]. Journal of Mechanical Engineering, 2019, 55(8): 136-144,153.
[8]	ZHAO Zhiguo, ZHOU Liangjie, ZHU Qiang. Preview Distance Adaptive Optimization for the Path Tracking Control of Unmanned Vehicle [J]. Journal of Mechanical Engineering, 2018, 54(24): 166-173.
[9]	ZHU Min, CHEN Huiyan. Experiment on Longitudinal Speed Tracking Control for Unmanned Off-road Vehicles [J]. Journal of Mechanical Engineering, 2018, 54(24): 111-117.
[10]	ZHANG Qingdong, ZENG Jiewei, LUO Xiaoming, ZHANG Xiaofeng, CHEN Bing. Experimental Study on Residual Stress Reduction for the High-strength Steel Based on Vibration Stress Relief [J]. Journal of Mechanical Engineering, 2017, 53(1): 86-92.
[11]	YE Ping;HAN Liangliang;ZHANG Tianshi;WANG Xuan;SUN Hanxu. Design and Motion Control of Ball-shaped Robot with Stereo Vision [J]. , 2013, 49(11): 8-15.
[12]	TAO Junyong;LIU Bin;CHEN Xun. Study on Performance and Optimal Design of Pneumatic Vibrator of Repetitive Shock Machine on Cold Soak Temperature [J]. , 2012, 48(2): 50-56.
[13]	WU Xing;LOU Peihuang;TANG Dunbing. Integrated Motion Control of Path Tracking and Servo Control for an Automated Guided Vehicle [J]. , 2011, 47(3): 43-48.
[14]	LUO Chunlei;HAN Qingkai. Synchronization Characteristics Research of Eccentric Gyration System Controlled by Hydraulic Driving [J]. , 2010, 46(6): 176-181.
[15]	LU Qinghua;RAO Delin;ZHU Zhengqiang CHEN Ligong;NI Chunzhen. EXPERIMENTAL STUDY ON MECHANICAL PROPERTIES OF WELDED JOINT USING VIBRATORY CONDITIONING TECHNOLOGY [J]. , 2006, 42(增刊): 219-222.