[论文解读] Trajectory Generation using Sharpness Continuous Dubins-like Paths with Applications in Control of Heavy Duty Vehicles

Rui Oliveira, Pedro F. Lima+3 more|arXiv (Cornell University)|Jan 26, 2018

Robotic Path Planning Algorithms参考文献 10被引用 5

一句话总结

本文提出了一种尖锐度连续（Sharpness Continuous, SC）路径——基于三次曲率的轨迹，通过直接施加转向角、转向速率和加速度限制，确保转向轮廓的平滑且连续可微。该方法在仿真中优于传统的Dubins路径和基于渐缩线的路径，实现了更快、更稳定的路径跟踪，提升了乘客舒适度并减少了重型车辆的执行器负荷。

ABSTRACT

We present a trajectory generation framework for control of wheeled vehicles under steering actuator constraints. The motivation is smooth autonomous driving of heavy vehicles. The key idea is to take into account rate, and additionally, torque limitations of the steering actuator directly. Previous methods only take into account curvature rate limitations, which deal indirectly with steering rate limitations. We propose the new concept of Sharpness Continuous curves, which uses cubic and sigmoid curvature trajectories together with circular arcs to steer the vehicle. The obtained trajectories are characterized by a smooth and continuously differentiable steering angle profile. These trajectories provide low-level controllers with reference signals which are easier to track, resulting in improved performance. The smoothness of the obtained steering profiles also results in increased passenger comfort. The method is characterized by a fast computation time, which can be further speeded up through the use of simple pre-computations. We detail possible path planning applications of the method, and conduct simulations that show its advantages and real time capabilities.

研究动机与目标

• 解决现有路径规划方法仅考虑曲率约束而未考虑实际转向执行器动力学的问题。
• 改善重型车辆中因执行器动态响应缓慢而导致的控制器性能与乘客舒适度。
• 开发一种计算高效的路径规划方法，直接施加转向角、转向速率和加速度限制。
• 实现实时、在线的轨迹生成，适用于自动驾驶重型车辆。
• 提供一种G³连续路径框架，支持平滑、可行且可跟踪的车辆运动。

提出的方法

• 提出使用三次曲率段与圆弧组合的尖锐度连续（SC）路径，确保转向轮廓的G³连续性。
• 采用标准自行车模型描述车辆运动学，曲率与转向角的关系为 κ = tan(φ)/L。
• 直接对转向角大小、速率（dφ/dt）和加速度（d²φ/dt²）施加约束，而非对曲率导数施加约束。
• 以三次曲率路径作为基本构建模块，实现直线段与转向段之间的平滑过渡。
• 将路径生成集成到带有PID控制器的反馈控制回路中，以评估跟踪性能。
• 采用高层路径跟踪控制器，结合前馈与比例反馈，以调节横向误差和航向误差。

实验结果

研究问题

• RQ1 能否开发一种轨迹生成方法，直接考虑转向执行器在幅值、速率和加速度方面的限制？
• RQ2 通过尖锐度连续路径实现G³连续性，对控制器跟踪性能和稳定性有何影响？
• RQ3 与传统曲率约束路径相比，SC路径在多大程度上减少了执行器负荷并提升了乘客舒适度？
• RQ4 所提方法是否能够实现实时计算，适用于自动驾驶重型车辆的在线应用？
• RQ5 在横向误差收敛性和横向急动（lateral jerk）方面，SC路径与CC（三次曲率）路径相比表现如何？

主要发现

• SC路径方法实现了稳定的控制器响应，而CC路径在转弯过程中导致横向误差无界增长，出现不稳定现象。
• SC路径实现了显著更平滑的横向加速度轮廓，降低了急动，提升了乘客舒适度。
• SC路径的三次转向轮廓因具备连续导数，实现了更优的跟踪性能，减少了执行器应力。
• 该方法保持了实时计算能力，适用于复杂运动规划器的在线集成。
• 在相同的最大转向角和速率约束下，SC路径在跟踪稳定性和平滑性方面均优于CC路径。
• 在SC路径公式中引入转向角加速度限制，使得执行器指令更加真实可行。