震源车车队跟随控制方法的研究

Study on the following control method of the source vehicle fleet

为实现在野外施工过程中多辆震源车以车队形式跟随行驶,采用领航驾驶模型,采取实时记录领航车行驶的自身状态信息,即时发送给后续车辆进行自动跟随行驶的方法。自动跟随车辆根据获取的速度和航向角等信息进行控制,首先提出了融合PID控制和模型预测控制(MPC)的控制算法,并设计控制器,确定了控制算法的执行规则,以保证车辆间的安全距离。通过Carsim/MATLAB仿真验证,将提出的控制方法与线性二次型控制(LQR)进行对比实验,结果表明控制方法能够在纵向控制上满足加速、匀速、降速等工况的跟随行驶,在横向控制上能够进行180°和90°等弯道跟随行驶,且与领航车保持良好的安全距离。

In order to realize that multiple seismic source vehicles follow in the form of a fleet during the field construction, this paper adopts a pilot driving model to record the state information of the pilot vehicle in real time and send it to subsequent vehicles for automatic follow-up driving. The auto-following vehicle is controlled according to the acquired speed and heading angle. This paper firstly proposes a control algorithm that combines PID control and model predictive control(MPC), and designs a controller to determine the execution rules of the control algorithm to ensure that the vehicle Safe distance. Through Carsim/Matlab simulation verification, the control method proposed in this paper is compared with linear quadratic control(LQR). The results show that the control method proposed in this paper can meet the following driving conditions in acceleration, uniform speed, and deceleration in the longitudinal control, and can follow the corners such as 180 degrees and 90 degrees in the lateral control, and maintains good performance with the pilot vehicle. safe distance.