无参考、长时域、毫秒级激进自动驾驶轨迹优化
Reference-Free, Long-Horizon Trajectory Optimization for Aggressive Autonomous Driving in Milliseconds
AI总结:
针对无参考初始猜测下长时域轨迹优化实时性差的问题,提出基于车辆刚度分析选择A稳定积分方法、动态平衡初始猜测生成及鲁棒非线性求解器策略,在260米时域内实现55毫秒求解,支持高速漂移避障。
摘要:
自动驾驶车辆必须在实时生成长时域且动态可行的轨迹——即使在车辆操控极限下运行——以确保在不利条件下的安全操作。然而,现有工作很少量化在没有先验参考和热启动的情况下生成此类轨迹的计算需求,并且常常默认使用低保真度模型,牺牲了准确性和控制权限。我们研究了建模和求解器设计选择,使得能够使用完整车辆动力学实时求解长时域、无参考最优控制问题(OCP)。为此,我们分析车辆刚度特性以证明OCP积分方案的合理性,并表明低阶A稳定方法始终优于其他方法,求解时间差异可达两个数量级。我们表明,鲁棒非线性求解器的性能取决于理解障碍参数更新策略和针对某些内点方法固有的Hessian不定性的保护技术。最后,我们提出了一种利用动态平衡生成初始猜测的计算高效方法,实现了实时性能并将初始不可行性降低了多达四个数量级。广泛的基准测试和高保真BeamNG仿真表明,在260米时域内计算时间低至55毫秒,包括高速避障场景,其中漂移成为可行轨迹生成的必要组成部分。
英文摘要:
Autonomous vehicles must generate long-horizon and dynamically feasible trajectories in real time-even when operating at the limits of vehicle handling-to ensure safe operation in adverse conditions. However, existing work rarely quantifies the computational demands of generating such trajectories without prior references, warm starts and often defaults to low-fidelity models, compromising accuracy and control authority. We investigate the modeling and solver design choices that enable real-time solution of long-horizon, reference-free optimal control problems (OCPs) using full vehicle dynamics. To this end, we analyze vehicle stiffness properties to justify the OCP's integration scheme and show that lower-order A-stable methods consistently outperform alternatives, with solve time differences reaching two orders of magnitude. We show that robust nonlinear solver performance hinges on understanding barrier parameter update strategies and safeguarding techniques for Hessian indefiniteness, inherent in some interior point methods. Lastly, we propose a computationally efficient method for generating initial guesses using dynamic equilibrium, unlocking real-time performance and reducing initial infeasibility by up to four orders of magnitude. Extensive benchmarking and high-fidelity BeamNG simulation demonstrate compute times as low as 55 ms over a 260 m horizon, including high-speed obstacle avoidance scenarios where drifting emerges as a necessary component of feasible trajectory generation.
机构、总结、中文摘要均由AI分析而来,可能存在错误,请以论文正文为准。