本发明专利技术公开了一种基于流体力学的无人机三维航路生成方法，属于航路规划领域，本发明专利技术首先计算得到沿X轴来流方向，位于原点的圆球障碍绕流流线，利用旋转平移矩阵得到平面中任意来流方向与任意障碍位置的绕流流线，根据流线是否满足部分重合条件采用两种方式将所有的流线合并成一条流线，之后根据无人机约束对三维流线进行处理得到无人机三维航路。本发明专利技术借鉴了自然界流水能够避开岩石的现象，将流体计算与航路规划相结合，同时考虑无人机飞于约束，在地形较为复杂时，能够规划出光滑且易于飞行的三维飞行避障航路。本发明专利技术地形建模简单，计算量小，满足无人机约束，实现方便。
【技术实现步骤摘要】
本专利技术属于航路规划领域，具体地说是指。
技术介绍
航路规划是影响无人机使用和飞行安全的关键技术，一直受到各方面的高度重视，经过几十年的研究和发展，取得了大量研究成果，为目前无人机的大发展奠定了基础。随着无人机的使用空域从中、高空不断向低空、甚至超低空的拓展，复杂地形下的无人机航路规划能力日益成为制约无人机发展的瓶颈。随着飞行高度的不断降低，地形的影响将成为航路规划需要考虑的重要因素，对于复杂地形情况还将成为关键因素。目前见诸文献的航路规划方法有基于图形的规划方法、决策型搜索方法、随机搜 索方法和人工势场法等。这些航路规划方法通常处理的障碍数目较少且相对简单，但却需要复杂的网格或数据结构进行建模。三维航路规划方法相较于二维更复杂，许多方法在复杂地形条件下存在组合爆炸的问题，并不适合复杂地形下的无人机三维航路规划。另一方面无人机自身具有一定的飞行性能约束，现有方法规划出的航路对于无人机的实际飞行存在困难。究其原因是航路不够光滑，没有考虑无人机约束。复杂地形条件约束下的无人机航路规划不但要考虑复杂地形对路径的约束，还要考虑地形对飞行安全的潜在影响，以及无人机自身的性能约束，并在垂直面内的地形跟踪和水平面的地形规避之间实现综合，最终规划出三维空间的可供无人机实际飞行的平滑航路。人工势场法中的电荷法与流函数法分别利用了电磁理论和流体计算中的概念，并将其引入到航路规划中。虽然这两种方法能够快速的规划出相对平滑的航路，但是只能作为二维航路规划方法。如何能够在三维情况下，用一种简单的地形建模方法规划出相对平滑，又适合无人机飞行的三维航路是设计无人机航路规划系统时需要面对的一个问题。
技术实现思路
针对现有技术中存在的问题，本专利技术提出，通过该方法能够在地形较为复杂的情况下，快速的生成一条满足无人机约束的光滑三维避障飞行航路。应用本专利技术提供的航路规划方法，首先计算出理想情况下沿X轴来流方向，位于原点的圆球障碍绕流流线，利用旋转平移矩阵得到XY平面中任意来流方向与任意障碍位置的绕流流线，根据障碍物间距离的不同采用两种方式将所有的流线合并成一条流线，之后根据无人机约束对三维流线进行处理得到无人机三维航路。具体包括如下步骤步骤一单个障碍时，根据定常忽略粘性的不可压缩理想流体，沿空间直角坐标系X轴来流方向作用于位于原点的圆球障碍绕流问题的解析解，在该直角坐标系下求得流速沿X、Y和Z轴的分量；定常忽略粘性的不可压缩理想流体沿X轴来流方向作用于位于原点的圆球障碍绕流问题，由于流体的运动存在对称性，描述为平面二维极坐标系下的扰流问题，对于空间中任意一点P，极坐标系建立在点P与X轴所构成的平面上,空间直角坐标系的坐标原点与平面二维极坐标系的极点重合，为点O，空间直角坐标系的X轴与平面二维极坐标系的极轴V轴重合，在该极坐标系下流体的速度势辦为权利要求1.，其特征在于具体包括以下几个步骤 步骤一单个障碍时，根据定常忽略粘性的不可压缩理想流体，沿空间直角坐标系X轴来流方向作用于位于原点的圆球障碍绕流问题的解析解，在该直角坐标系下求得流速沿X、Y和Z轴的分量； 定常忽略粘性的不可压缩理想流体沿X轴来流方向作用于位于原点的圆球障碍绕流问题，由于流体的运动存在对称性，描述为平面二维极坐标系下的扰流问题，对于空间中任意一点P，极坐标系建立在点P与X轴所构成的平面上,空间直角坐标系的坐标原点与平面二维极坐标系的极点重合，为点O，空间直角坐标系的X轴与平面二维极坐标系的极轴V轴重合，在该极坐标系下流体的速度势炉为2.根据权利要求I所述的，其特征在于所述的步骤二中解微分方程组方法包括四阶或五阶的定步长或变步长Runge-Kutta方法。全文摘要本专利技术公开了，属于航路规划领域，本专利技术首先计算得到沿X轴来流方向，位于原点的圆球障碍绕流流线，利用旋转平移矩阵得到平面中任意来流方向与任意障碍位置的绕流流线，根据流线是否满足部分重合条件采用两种方式将所有的流线合并成一条流线，之后根据无人机约束对三维流线进行处理得到无人机三维航路。本专利技术借鉴了自然界流水能够避开岩石的现象，将流体计算与航路规划相结合，同时考虑无人机飞于约束，在地形较为复杂时，能够规划出光滑且易于飞行的三维飞行避障航路。本专利技术地形建模简单，计算量小，满足无人机约束，实现方便。文档编号G01C21/20GK102749080SQ201210207710公开日2012年10月24日 申请日期2012年6月18日 优先权日2012年6月18日专利技术者李大伟, 梁宵, 王宏伦 申请人:北京航空航天大学本文档来自技高网...
【技术保护点】
一种基于流体力学的无人机三维航路生成方法，其特征在于：具体包括以下几个步骤：步骤一：单个障碍时，根据定常忽略粘性的不可压缩理想流体，沿空间直角坐标系X轴来流方向作用于位于原点的圆球障碍绕流问题的解析解，在该直角坐标系下求得流速沿X、Y和Z轴的分量；定常忽略粘性的不可压缩理想流体沿X轴来流方向作用于位于原点的圆球障碍绕流问题，由于流体的运动存在对称性，描述为平面二维极坐标系下的扰流问题，对于空间中任意一点P，极坐标系建立在点P与X轴所构成的平面上，空间直角坐标系的坐标原点与平面二维极坐标系的极点重合，为点O，空间直角坐标系的X轴与平面二维极坐标系的极轴X′轴重合，在该极坐标系下流体的速度势为其中OP与极轴之间的夹角为θ角，点P与点O的距离为|OP|＝r，V∞为流体的流速，a为圆球障碍的半径，在空间直角坐标系下，P的坐标为(x,y,z)，用u、v和w代表三维情况下流速沿空间直角坐标系X、Y和Z轴的分量，则步骤二：单个障碍时，采用解微分方程组方法，对流速沿X、Y和Z轴的分量所构成的速度势微分方程组进行求解计算，得到沿X轴来流方向的定常忽略粘性的不可压缩理想流体作用于位于原点的圆球障碍绕流流线；步骤三：单个障碍时，利用旋转平移矩阵，使计算的流线适于空间直角坐标系下XY平面内任何来流方向，并且使多个障碍在空间直角坐标系下XY平面内任意分布，在直角坐标系的XY平面，流线的起点为(x0,y0)，终点为(xc,yc)，球心坐标为(xr,yr)，旋转平移矩阵的计算过程包括以下几个步骤：(1)计算通过点(x0,y0)与点(xc,yc)的直线方程y＝k1x+b1；k1为该直线的斜率，b1为该直线在Y轴上的截距；(2)计算过点(xr,yr)并垂直于直线y＝k1x+b1的直线方程；(3)求得垂足的坐标，并计算L1，L2与L3，其中L1是垂足到点(xc,yc)的距离，L2是垂足到(x0,y0)的距离，L3是垂足到(xr,yr)的距离；(4)当转换以后点(xc′,yc′)在Y轴正半轴，有(x0′,y0′)=(？L2,L3)，(xc′,yc′)=(L1,L3)；否则(x0′,y0′)=(L2,？L3)，(xc′,yc′)=(L1,？L3)；定义点(x0,y0)到点(xc,yc)的向量为点(x0′,y0′)到点(xc′,yc′)的向量为向量和间夹角α为如果障碍的高度，则旋转平移矩阵T为T=cosαsinα00-sinαcosα000010xryrzr1zr为障碍的高度，设障碍在原点O时的流线数据为矩阵A，其中矩阵A的每一行代表一个航路点，矩阵A的列数为4列，第一列为航路点的X轴方向坐标，第二列为航路点的Y轴方向坐标，第三列为航路点的Z轴方向坐标，第四列为单位1，任意位置的流线矩阵A′为A′＝A×T；步骤四：两个障碍时，分别计算两个障碍单独避障的各自流线，判断两障碍单独避障的流线是否满足部分重合条件，计算两个障碍的总流线；(1)当两个障碍单独避障的流线能够满足部分重合时，此时两个障碍之间的两条流线重合直线线段部分长度大于等于其中Oi和Oi+1分别代表第i个和第i+1个障碍的球心，|OiOi+1|表示两个障碍之间的直线距离，|Si′Si+1′|表示两个障碍之间的两条流线重合直线线段部分长度，找到两条流线中间相重合的部分，进行流线数据合并作为总流线，合并的过程具体为：(1)找到流线Si和Si+1在Li区域内的两个流线部分；(2)流线Si和Si+1在Li区域内的两个流线部分中，每两个相邻的航路点组成一个航路段，分别计算每个航路段相较于来流方向的斜率；(3)将流线Si和Si+1在Li区域内的两个流线部分中，各航路段的斜率之差的绝对值最小的部分作为合并的位置，并剔除其余的部分；(2)当两个障碍单独避障的流线不存在部分重合的直线线段部分时，此时两个障碍之间的两条流线重合直线线段部分长度小于计算与两个障碍同时内切的虚拟障碍，对该虚拟障碍利用步骤一～步骤三的方法计算流线，该流线为两个障碍的总流线，该流线具有步骤三中矩阵A的形式，为n行4列的矩阵，n根据流线航路点个数的不同而不同；Oi和Oi+1分别代表第i个和第i+1个障碍的球心，各自的避障流线分别为Si与Si+1，Ri和Ri+1分别表示Oi和Oi+1的半径，在线段OiOi+1上存在点Onew，以该点为圆心，做出与圆Oi和Oi+1同时相内切的圆Onew，将圆Onew作为虚拟障碍进行躲避，Onew满足：|OnewOi|+Ri＝|OnewOi+1|+Ri+1步骤五：针对所有障碍，将每两个相...
【技术特征摘要】
【专利技术属性】
技术研发人员：王宏伦，梁宵，李大伟，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。