震源车无人驾驶控制算法设计与应用

doi:10.3901/JME.2022.06.211

机械工程学报 ›› 2022, Vol. 58 ›› Issue (6): 211-220.doi: 10.3901/JME.2022.06.211

扫码分享

震源车无人驾驶控制算法设计与应用

刘鹏涛^1,2, 汪首坤^1,2, 王军政^1,2, 雷涛^1,2, 法炜³, 韩中华³

1. 北京理工大学复杂系统智能控制与决策国家重点实验室北京 100081;
2. 北京理工大学伺服运动系统驱动与控制工信部重点实验室北京 100081;
3. 中国石油集团东方地球物理勘探有限责任公司涿州 072750

收稿日期:2021-05-21 修回日期:2021-10-25 出版日期:2022-03-20 发布日期:2022-05-19
通讯作者: 汪首坤,男,1977年出生,博士,副研究员,博士研究生导师。主要研究方向为运动驱动与伺服控制、控制系统静动态性能仿真与实验、基于图像的动态目标检测与跟踪和机器人控制。E-mail:bitwsk@163.com
作者简介:刘鹏涛,男,1997年出生。主要研究方向为无人车路径规划与跟踪。E-mail:3120190911@bit.edu.cn
基金资助:
国家重点研发计划(2019YFC1511401)和国家自然科学基金(6110315)资助项目。

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

LIU Pengtao^1,2, WANG Shoukun^1,2, WANG Junzheng^1,2, LEI Tao^1,2, FA Wei³, HAN Zhonghua³

1. State Key Laboratory of Intelligent Control and Decision of Complex Systems, Beijing Institute of Technology, Beijing 100081;
2. Key Laboratory of Servo Motion System Drive and Control, Ministry of Industry and Information Technology, Beijing Institute of Technology, Beijing 100081;
3. BGP INC., China National Petroleum Corporation, Zhuozhou 072750

Received:2021-05-21 Revised:2021-10-25 Online:2022-03-20 Published:2022-05-19

摘要/Abstract

摘要： 为满足震源车无人驾驶作业需求，设计出一套符合其工作特点的无人驾驶系统，并对其中的关键技术问题开展研究。首先，进行系统的设计与搭建。其次，针对铰接车结构特点，对震源车进行运动学分析与建模；提出基于转向几何约束的局部纠偏路径规划算法，解决了工作点偏离路径问题；设计出基于运动学模型的模型预测控制算法用于车辆路径跟踪，提高了震源车路径跟踪精度；提出工作点定位误差补偿算法，减小了地形因素带来的工作点定位误差；设计出一种新的跟车车距解算算法，保证了编队作业时的车辆安全。最后，进行实车测试与野外实际生产测试，实车测试结果验证了所提出算法的有效性，野外生产数据表明该系统可将震源车作业效率提高15%，精度提高57%。

关键词: 可控震源, 无人驾驶, 路径跟踪, 定位补偿, 车距解算

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

中图分类号:

TP273
U273

刘鹏涛, 汪首坤, 王军政, 雷涛, 法炜, 韩中华. 震源车无人驾驶控制算法设计与应用[J]. 机械工程学报, 2022, 58(6): 211-220.

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.

参考文献

[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]	吴西涛, 魏超, 翟建坤, 苑士华. 考虑横摆稳定性的无人车轨迹跟踪控制优化研究[J]. 机械工程学报, 2022, 58(6): 130-142.
[2]	梁艺潇, 李以农, KHAJEPOUR Amir, 郑玲. 基于转向与主动横摆力矩协调的四轮驱动智能电动汽车路径跟踪控制[J]. 机械工程学报, 2021, 57(6): 142-155.
[3]	宫文峰, 王元哲, 陈辉, WANG Danwei. 基于深度学习的无人驾驶汽车导航传感器异常诊断方法[J]. 机械工程学报, 2021, 57(24): 268-278.
[4]	庄未, 苏晓, 赵逸舟, 张瑞欣. 车把前倾角对无人驾驶自行车90°圆周运动的影响[J]. 机械工程学报, 2021, 57(2): 256-264.
[5]	魏子茹, 卢延辉, 王鹏宇, 马天飞, 赵世杰. 基于CRITIC法的灰色关联理论在无人驾驶车辆测试评价中的应用[J]. 机械工程学报, 2021, 57(12): 99-108.
[6]	林添良, 姚瑜, 许文杰, 付胜杰, 任好玲, 陈其怀. 基于环境识别的电动工程机械无人驾驶行走方法[J]. 机械工程学报, 2021, 57(10): 42-49.
[7]	柳晨光, 初秀民, 毛庆洲, 谢朔. 无人船自适应路径跟踪控制系统[J]. 机械工程学报, 2020, 56(8): 216-227.
[8]	熊璐, 杨兴, 卓桂荣, 冷搏, 章仁夑. 无人驾驶车辆的运动控制发展现状综述[J]. 机械工程学报, 2020, 56(10): 127-143.
[9]	王艺, 蔡英凤, 陈龙, 王海, 何友国, 李健. 基于模型预测控制的智能网联汽车路径跟踪控制器设计[J]. 机械工程学报, 2019, 55(8): 136-144,153.
[10]	赵治国, 周良杰, 朱强. 无人驾驶车辆路径跟踪控制预瞄距离自适应优化[J]. 机械工程学报, 2018, 54(24): 166-173.
[11]	朱敏, 陈慧岩. 无人驾驶越野车辆纵向速度跟踪控制试验[J]. 机械工程学报, 2018, 54(24): 111-117.
[12]	章仁燮, 熊璐, 余卓平, 柏满飞, 付志强. 基于条件积分算法的无人驾驶车辆轨迹跟踪鲁棒控制方法[J]. 机械工程学报, 2018, 54(18): 129-139.
[13]	刘凯, 龚建伟, 陈舒平, 张玉, 陈慧岩. 高速无人驾驶车辆最优运动规划与控制的动力学建模分析[J]. 机械工程学报, 2018, 54(14): 141-151.
[14]	孙扬, 熊光明, 陈慧岩, 姜岩, 龚建伟. 基于混沌理论的无人驾驶车辆行驶轨迹量化分析[J]. 机械工程学报, 2016, 52(2): 127-133.
[15]	李运华;何刘宇;杨丽曼. 非完整约束多轴驱动车辆的路径跟踪控制[J]. , 2014, 50(5): 33-41.

震源车无人驾驶控制算法设计与应用

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

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价