欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 2021105929141
申请人: 淮阴工学院(CN)
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2024-08-07
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种多约束条件下无人机路径规划方法,其特征在于,包括以下步骤:步骤1:首先分析无人机路径规划特点,建立三维数学模型,忽略无人机大小,将其视为质点,用(xi,yi,zi)表示第i个校正点的坐标i=1,2,3,…,n,起点A为(x0,y0,z0),终点B为(xn+1,yn+1,zn+1),无人机在校正过程中,从A出发,经过k个校正点到达终点,轨迹可表示为A点与k个校正点到B点依次相连的轨迹,建立所述三维数学模型的目标函数并确定其约束条件:

min k      (2)

其中,公式(1)表示飞行轨迹尽可能小,公式(2)表示矫正次数尽可能少, 表示最小轨迹为起点A(x0,y0,z0)到第一个校正点i1的距离; 表示第1个到第k个校正点之间相邻校正点累积距离之和; 表示第k个校正点到目的点B(xn+1,yn+1,zn+1)的距离;if表示为第f个校正点; 表示为第if‑1个校正点到第if个校正点的距离;

其约束条件为:

1)用ξi表示Ci校正的类型,无人机飞行过程中的定位误差有垂直误差和水平误差:

2)无人机在出发点处不存在定位误差,即水平误差和垂直误差为0;

3)到达终点B时垂直误差和水平误差均应小于θ个单位:其中, 和 分别表示经过校正点 处调整后的水平误差和垂直误差;无人机每飞行

1m,垂直误差和水平误差增加δ个专用单位;

4)飞行器在转弯时受到结构和控制系统的限制,无法完成即时转弯,利用转弯模型算法计算无人机的转弯半径,其约束半径r为:

2 2 2 2

(a‑x1) +(b‑y1) +(c‑z1) =r其中,(a,b,c)为圆心坐标O1坐标,(x1,y1,z1)为第一个校正点的坐标;

5)无人机在部分校正点进行误差校正时存在无法达到理想校正点,即将某个误差精确校正为0,用ηi表示校正点Ci是否为理想校正点:根据实时位置,获取校正点坐标和校正误差,实时判断是否在设置范围内,并判断误差校正的类型;

步骤2:确定双目标规划模型,运用贪心算法进行全局搜索最优解对无人机最优化校正点进行求解,得到最优校正点和最短飞行距离。

2.根据权利要求1所述的多约束条件下无人机路径规划方法,其特征在于,无人机在出发点A原始误差为0,到达第一个校正点i1前无需校正;同时由最后一个校正点ik到达终点B时定位误差小于θ也无需矫正。

3.根据权利要求1所述的多约束条件下无人机路径规划方法,其特征在于,所述最小轨迹为A(x0,y0,z0)到第一个校正点i1的距离:第一个校正点到第k个校正点的距离之和为:其中,if表示为第f个校正点; 表示为第if‑1个校正点到第if个校正点的距离;

第k个校正点到目的点B(xn+1,yn+1,zn+1)的距离:

4.根据权利要求1所述的多约束条件下无人机路径规划方法,其特征在于,在出发点A,无人机的水平误差和垂直误差均为0,无人机从第if‑1个校正点到if校正点的距离为产生的积累误差为 同时在到达校正点if时含有if‑1未校正的原始误差 无人机在校正点if校正前的垂直误差 为积累误差 与原始误差 之和,水平误差 与垂直误差 可表示为:

情况一,若校正点 是垂直误差校正点,需满足:经过垂直误差校正点 校正后的误差为:其中,α1为垂直误差设定值,α2为水平误差设定值,且都为常数;

情况二,若校正点 是水平误差校正点,需满足:其中,β1为垂直误差设定值,β2为水平误差设定值,且都为常数;

经过水平误差校正点 校正后的误差为:

5.根据权利要求1所述的多约束条件下无人机路径规划方法,其特征在于,所述步骤3中求解具体过程为:

第一步:赋初值;设置起点A、终点B,无人机垂直和水平误差均为0,s0=0,r0=0;

第二步:计算任意的一个校正点飞到离自身最近的一个校正点飞行积累下来的误差,判断累积下来的误差是否在允许范围内,若水平误差在允许范围内,累计误差为垂直误差则进行垂直校正,若在垂直误差允许范围内,累计误差为水平误差则进行水平校正,否则,该点为不可校正点;

第三步:从当前点出发,找到所有垂直校正点集合为Conset,判断Conset是否为空集,如果Conset是空集,则显示“路径寻找失败”,并且退出循环;如果Conset不是空集,则在集合Conset寻找距离终点B最近的一个校正点,记为Ck;

第四步:设置起点为Ck,记录调整前后的误差,若Ck不是理想校正点,用均匀分布随机数ζ来仿真纠正是否成功校正后水平剩余误差均为0,记录校正前后的误差,并设置校正后的误差值;

第五步:判断当前点能否到达终点B,如果能到达B则输出最终路线,并退出循环;如果不能到达B,转到下一步;

第六步:从当前点出发,找到所有水平校正点集合为Conset′,判断Conset′是否为空集,如果Conset′是空集,则显示“路径寻找失败”,并且退出循环;如果Conset′不是空集,则在集合Conset′寻找距离终点B最近的一个校正点,记为Ck′;

第七步:设置起点为Ck′,记录调整前后的误差,若Ck′不是理想校正点,用均匀分布随机数l来仿真纠正是否成功,校正后水平剩余误差均为0,记录校正前后的误差,并设置校正后的误差值;

第八步:判断当前点能否到达终点B,如果能到达B则输出最终路线,并退出循环;如果不能到达B,转到第二步。

6.根据权利要求5所述的多约束条件下无人机路径规划方法,其特征在于,所述第四步与第七步中用服从(0,1)均匀分布的随机数ζ纠正具体为:若ζ∈[0,0.2]则视为校正失败,校正后的剩余误差为设为min(error,5),其中error为校正前误差;反之,ζ∈(0.2,1]视为校正成功。