arXivDaily arXiv每日学术速递 周一至周五更新
arXiv 2107.02384cs.ROcs.SYeess.SY
收藏

基于复合位姿图优化的多模态运动规划

Multi-Modal Motion Planning Using Composite Pose Graph Optimization

Massachusetts Institute of Technology (MIT)(麻省理工学院)

L. Lao Beyer, N. Balabanska, E. Tal, S. Karaman

摘要:

在本文中,我们提出了一个多模态车辆动力学的运动规划框架。我们所提出的算法采用转录的优化目标函数,车辆动力学,状态和控制约束到稀疏因子图,其中-结合模式转换约束-构成一个复合姿态图。通过以复合姿态图的形式来公式化多模态运动规划问题,我们使得能够利用有效的技术来优化稀疏图,诸如广泛应用于双重估计问题的那些,例如,同时定位与地图构建(SLAM)。所得到的运动规划算法优化了多模态轨迹,包括模式转换的位置,并且由姿态图优化过程引导以消除不必要的转换,从而能够从粗略的初始猜测中有效地发现优化的模式序列。我们演示了多模态轨迹优化在模拟和现实世界的实验中的车辆与各种动力学模型,如飞机与滑行和飞行模式,和垂直起降(VTOL)固定翼飞机之间的过渡悬停和水平飞行模式。

英文摘要:

In this paper, we present a motion planning framework for multi-modal vehicle dynamics. Our proposed algorithm employs transcription of the optimization objective function, vehicle dynamics, and state and control constraints into sparse factor graphs, which -- combined with mode transition constraints -- constitute a composite pose graph. By formulating the multi-modal motion planning problem in composite pose graph form, we enable utilization of efficient techniques for optimization on sparse graphs, such as those widely applied in dual estimation problems, e.g., simultaneous localization and mapping (SLAM). The resulting motion planning algorithm optimizes the multi-modal trajectory, including the location of mode transitions, and is guided by the pose graph optimization process to eliminate unnecessary transitions, enabling efficient discovery of optimized mode sequences from rough initial guesses. We demonstrate multi-modal trajectory optimization in both simulation and real-world experiments for vehicles with various dynamics models, such as an airplane with taxi and flight modes, and a vertical take-off and landing (VTOL) fixed-wing aircraft that transitions between hover and horizontal flight modes.

机构、总结、中文摘要均由AI分析而来,可能存在错误,请以论文正文为准。

↑