一种新的三维Dubins飞行器运动规划方法:球面上的特例问题

A New Approach to Motion Planning in 3D for a Dubins Vehicle: Special Case on a Sphere

摘要 Abstract

本文提出了一种适用于空中飞行器的三维运动规划新方法,用于连接初始和目标构型,同时考虑俯仰速率和偏航速率约束。我们将曲率受限飞行器在球面上的运动规划问题确定为一个中间问题,并以此作为研究重点。本文采用相平面方法推导了最小转弯半径为$r$的飞行器在单位球面上的最优路径候选解。通过简单的证明,我们表明最优路径为$CGC$或由简单$C$段($C=L, R$表示半径为$r$的转弯,$G$表示大圆弧)的串联路径。我们将先前关于最优路径为$CGC$和$CCC$路径的结果从$r \in \left(0, \frac{1}{2} \right]\bigcup\{\frac{1}{\sqrt{2}}\}$推广到$r \leq \frac{\sqrt{3}}{2}$,以涵盖具有更大$r$值的飞行器。我们进一步证明,当$r \leq \frac{1}{\sqrt{2}}$时,最优路径为$CGC, CCCC$;当$r \leq \frac{\sqrt{3}}{2}$时,最优路径为$CGC, CC_\pi C, CCCCC$。此外,我们还解析构造了所有候选路径,并在公开可访问的代码库中提供了相关代码。

In this article, a new approach for 3D motion planning, applicable to aerial vehicles, is proposed to connect an initial and final configuration subject to pitch rate and yaw rate constraints. The motion planning problem for a curvature-constrained vehicle over the surface of a sphere is identified as an intermediary problem to be solved, and it is the focus of this paper. In this article, the optimal path candidates for a vehicle with a minimum turning radius $r$ moving over a unit sphere are derived using a phase portrait approach. We show that the optimal path is $CGC$ or concatenations of $C$ segments through simple proofs, where $C = L, R$ denotes a turn of radius $r$ and $G$ denotes a great circular arc. We generalize the previous result of optimal paths being $CGC$ and $CCC$ paths for $r \in \left(0, \frac{1}{2} \right]\bigcup\{\frac{1}{\sqrt{2}}\}$ to $r \leq \frac{\sqrt{3}}{2}$ to account for vehicles with a larger $r$. We show that the optimal path is $CGC, CCCC,$ for $r \leq \frac{1}{\sqrt{2}},$ and $CGC, CC_\pi C, CCCCC$ for $r \leq \frac{\sqrt{3}}{2}.$ Additionally, we analytically construct all candidate paths and provide the code in a publicly accessible repository.

一种新的三维Dubins飞行器运动规划方法:球面上的特例问题 - arXiv