一种基于预转向NMPC的路径跟踪控制系统及方法

By combining pre-steering control and NMPC algorithm, and using sensors such as LiDAR to construct scene point cloud maps, the ideal turning angle and optimal turning angle are calculated, which solves the accuracy and stability problems of existing path tracking control algorithms in curve scenarios and achieves more efficient path tracking control.

CN117369266BActive Publication Date: 2026-07-17WUHAN UNIV

Patent Information

Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
WUHAN UNIV
Filing Date
2023-10-26
Publication Date
2026-07-17

AI Technical Summary

Technical Problem

Existing path tracking control algorithms have low vehicle tracking accuracy in high-speed or high-curvature scenarios, slow solution speed of nonlinear model predictive controllers, and poor vehicle tracking performance in curve scenarios due to steering hysteresis.

Method used

By combining the pre-steering control algorithm and the nonlinear model predictive controller (NMPC), a scene point cloud map is constructed using lidar, IMU sensors, speed sensors, and steering angle sensors. The ideal steering angle and the optimal steering angle are calculated, and the vehicle control sequence is optimized using a sequential quadratic programming algorithm to achieve accurate path tracking.

Benefits of technology

It improves vehicle path tracking accuracy and stability in curve scenarios, solves the hysteresis problem of steering actuator, and provides higher tracking system stability and accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117369266B_ABST
    Figure CN117369266B_ABST
Patent Text Reader

Abstract

本发明提出了一种基于预转向NMPC的路径跟踪控制系统及方法。车辆根据该地图进行点云匹配,得到车辆位置、航向角,以及障碍物位置和方向;根据车辆位置计算弯道圆半径,进而判断车辆运动场景;若为弯道场景,计算理想转角,实施弯道预控制;通过曲线拟合生成车辆参考轨迹,计算距离场景点云地图最近的参考轨迹点;根据位姿预测下一时刻车辆位姿,计算横向和航向跟踪误差,构建目标函数,使用二次规划算法优化求解得到最优控制序列,实现弯道场景控制;本发明尤其是在弯道场景下有效预测和控制车辆运动,提高路径跟踪控制效率及稳定性,为自动驾驶路径跟踪控制提供思路。
Need to check novelty before this filing date? Find Prior Art