一种通信窗口感知的AUV分层路径规划方法及系统与流程
本发明属于自主水下航行器离线任务与路径规划,具体涉及一种通信窗口感知的auv分层路径规划方法及系统。
背景技术:
1、自主水下航行器(autonomous underwater vehicle,auv)在长航程作业中,受复杂水下环境限制,auv与岸站之间的通信高度依赖有限且异构的链路资源。目前,常用的通信链路资源主要有以下四类,各类链路的工作条件与适用场景等存在以下差异:
2、1)铱星(iridium)卫星短突发数据(sbd)链路:auv需上浮至水面,且仅在卫星过顶的可见窗口内才能建立通信连接,单颗卫星的单次过顶典型持续时间为30秒至10分钟不等,多颗卫星交替过顶形成复杂的离散时间窗口序列;
3、2)uhf(或vhf)甚高频电台链路:auv需上浮至水面且auv距离母船或基站不超过视距通信范围(典型有效距离5km~30km);
4、3)水声中继链路:auv无需上浮至水面,但要求其与水下中继浮标或母船吊放换能器之间保持一定距离与深度关系,其有效通信半径受声场条件影响显著;
5、4)wi-fi链路(或4g链路):auv需上浮至水面且仅在近岸或近母船的特殊水面工况下可用,覆盖范围极小。
6、auv岸站指控系统承担auv作业前的任务规划与路径生成职能,其规划产物(任务计划、巡航路径、通信计划)直接决定auv在水下自主作业时的任务覆盖完整度、能耗水平及通信回传完整度。通过梳理现有公开文献可知,当前auv路径规划研究主要沿以下几条技术路线展开:基于确定性搜索的路径规划、基于随机采样的路径规划、基于群体智能的路径规划、结合海流场的能耗最优规划、考虑通信传播损耗的规划、多auv协同规划、考虑隐蔽性的规划与定位。
7、上述技术路线在任务完整度、能耗、避障等维度均有较成熟的处理方式,但对通信事件的处理通常采用以下几种简化方式:a)在路径上按固定时间或固定距离周期性插入上浮回传点;b)将上浮点设置为人为指定的若干固定航点;c)在路径规划完成后再用独立模块推算上浮时机;d)将通信链路质量(如声通信传播损耗)纳入目标函数但不区分具体时间窗。然而,这些对通信事件的简化处理方式存在以下缺陷:
8、1)通信资源建模简化导致窗口错配:传统方法大多按固定时间周期插入上浮点(如每3小时或4小时),无法保证auv到达水面时卫星可见;iridium卫星属于低轨道非静止卫星,单颗卫星在特定地理点的过顶窗口为分钟级,多颗卫星交替过顶形成复杂的离散时间窗口序列;窗口错配将导致auv上浮后无法建立连接、被迫空耗能量后下潜的情况,既浪费电量又延误通信回传;
9、2)路径与时间解耦求解:主流规划器普遍先生成空间路径,再以恒定或近似速度推算到达时刻;但受海流扰动、避障绕行、剖面作业等因素影响,auv到达时刻存在显著累积误差,导致事后规划的上浮窗口与实际到达时刻不匹配,误差甚至可达10分钟~30分钟;
10、3)多通信手段缺乏统一建模:iridium、电台、水声中继、wi-fi四类链路的可用性条件差异很大(iridium依赖时间窗、电台依赖距离、水声中继依赖相对位置、wi-fi依赖近场),现有规划方法通常只处理其中一类通信链路,或仅将水声通信的传播损耗作为唯一标量指标,无法在单一规划框架下实现多模态通信机会的统一利用;
11、4)多目标耦合不足:任务覆盖完整度、能耗水平及通信回传完整度三者相互制约,但现有规划方法大多以能耗水平或路径长度作为单一目标,少量多目标规划方法侧重于路径长度+水声传播损耗,缺乏针对通信回传完整度的专门建模;
12、5)应急回退机制缺失:当预设上浮点与卫星窗口匹配失败时,现有系统或重试或直接继续下潜等待下一周期,不具备在线切换至备选通信锚点(如另一颗卫星过顶、水下中继浮标、电台视距范围)的能力,任务鲁棒性差;
13、6)操作员负担高:现有规划方法的多目标权重、上浮周期等关键参数大多需要操作员针对具体任务手工调整,依赖操作员经验,且规划结果一致性较差。
技术实现思路
1、针对相关技术中存在的不足之处,本发明提供一种通信窗口感知的auv分层路径规划方法及系统,以解决背景技术中提到的至少一个技术问题。
2、本发明提供一种通信窗口感知的auv分层路径规划方法,包括以下步骤:
3、s1、获取输入信息,包括任务意图与约束、卫星星历、母船或基站航行计划、海流与环境预报、auv参数与工况;
4、s2、根据输入信息生成时空通信锚点集合,第个通信锚点表示为式(1);其中,、、、、、及分别为第个通信锚点的平面坐标、所需auv的深度区间、时间窗、链路类型、估计可用带宽、可靠度估计及上浮风险评分,链路类型包括卫星链路、电台链路、水声中继链路、wi-fi链路;
5、 (1);
6、s3、构造时空规划网络,包括:将任务区域按栅格或拓扑关键点构造空间基图;对中的每个节点按auv预计到达时刻的离散化时间轴进行时间扩展,得到时空节点集合;对每一生成通信事件节点,并将与中满足空间、时间及深度三重匹配的所有节点相连,获得时空扩展图;
7、s4、进行全局分层规划,包括:
8、构建多目标优化函数,表示为式(3);其中,为上的一条有效路径,、及分别为任务覆盖完整度代价、能耗代价及通信回传完整度代价,、及分别为基于工况模板驱动的任务覆盖完整度权重、能耗权重及通信回传完整度权重;
9、 (3);
10、以最小化为目标,在上采用改进标签修正算法搜索pareto非支配解集,以获得宏观路径骨架,包括主选通信锚点序列及粗粒度到达时间窗;
11、s5、进行局部动力学精化,包括:以为目标骨架,采用带时空双约束剪枝的改进atw算法逐段子路径求解,引入海流补偿模型校正auv实际到达时刻,通过空间可达性和时窗可达性的双重校验获得精细可执行轨迹;
12、s6、输出完整规划产物,其包括任务计划、巡航路径、通信计划。
13、在其中一些实施例中,还包括应急切换策略生成步骤,该步骤包括:基于及主选通信锚点序列,设定每个主选通信锚点的最晚决策时刻;在每个主选通信锚点的预设时间邻域内搜索同类型和异类型的多个备选通信锚点并对其排序,以获得备选通信锚点链表,从而构建主选+备选通信锚点决策树;当auv在线作业时,首选主选通信锚点,若在最晚决策时刻之前判定auv不能到达主选通信锚点,则依序尝试备选通信锚点链表中的备选通信锚点,直至命中首个可行备选通信锚点。
14、在其中一些实施例中,在应急切换策略生成步骤中,每个主选通信锚点的最晚决策时刻根据式(9)设定,其中,为第个通信锚点时间窗的开始时刻,为决策及切换裕度,根据式(10)计算,为auv判定偏差所需最短时间,为切换至备选通信锚点所需的机动时间,为安全裕度;
15、 (9);
16、 (10);
17、多个备选通信锚点的排序策略包括按主选通信锚点切换至备选通信锚点的航行代价进行升序排列、按备选通信锚点的可靠度估计进行降序排列、按备选通信锚点的时间临近度进行升序排列,取排序后的前个备选通信锚点构建有序的备选通信锚点链表。
18、在其中一些实施例中,在步骤s3中,空间基图,为的节点集合,为的边集合;对中的每个节点按auv预计到达时刻的离散化时间轴进行时间扩展,得到时空节点集合,表示为式(2);其中,为时刻,为起始时刻,为时间离散步长;
19、 (2);
20、空间、时间及深度三重匹配包括:节点与通信锚点之间的距离不超过预设距离阈值、时刻落在通信锚点的时间窗内、auv可在时刻到达深度区间;
21、时空扩展图,为的顶点集合,,为的边集合,;其中,为由派生的时空边,为中满足空间、时间及深度三重匹配的节点与之间的连边。
22、在其中一些实施例中,在步骤s4中,任务覆盖完整度代价表示为式(4),为各任务权重,为任务完成率;能耗代价表示为式(5),为auv对水速度下的航行功率,为中的边,为auv沿航行的航行时间,为auv上浮或下潜时的附加能耗,和分别为能耗归一化的下限和上限;通信回传完整度代价表示为式(6),为任务阶段对通信回传的预设优先级权重;
23、 (4);
24、 (5);
25、 (6)。
26、在其中一些实施例中,步骤s4还包括,对多目标优化函数设置能量约束条件、上浮可行性约束条件及权重约束条件;能量约束条件为,其中,为auv沿航行的能耗,为auv可用电量,为电量裕度,;上浮可行性约束条件为,auv在任一上浮段所在时空节点具备上浮至的动力学可行性;权重约束条件为,、及均大于0。
27、在其中一些实施例中,在步骤s4中,工况模板包括长航程调查、应急搜索、节能巡航、通信保障及多任务综合;当auv处于长航程调查工况下,,,;当auv处于应急搜索工况下,,,0.6;当auv处于节能巡航工况下,,,;当auv处于通信保障工况下,,,;当auv处于多任务综合工况下,,,。
28、在其中一些实施例中,在步骤s5中,auv实际到达时刻的校正包括:
29、建立式(7)所示的海流补偿模型以计算auv的实际对地速度;其中,为auv的位置坐标,为时刻,为auv的对水速度,为海流矢量场;
30、 (7);
31、针对每条边,根据式(8)迭代求解auv的实际到达时刻,其中,为时刻auv所在位置,为航向;
32、 (8)。
33、在其中一些实施例中,在步骤s5中,带时空双约束剪枝的改进atw算法包括以下子步骤:
34、s51、读入子路径起点、目标通信锚点及其时间窗、海流场;
35、s52、将子路径起点放入open列表,将其累计代价置为0、估价置为启发估计;
36、s53、取出open列表中估价最小的待扩展状态,其中,为平面位置,为航向,为到达该状态的时刻;判断是否到达目标通信锚点;若是,则回溯父指针,输出精细子路径,算法终止;若否,则对进行邻域扩展,取出一个尚未处理的邻居状态;
37、s54、对进行空间可达性验证,判断是否同时满足位于任务域内且由到满足auv动力学约束;若否,则将丢弃,返回子步骤s53继续执行;若是,则继续对进行时窗可达性验证,判断是否可在目标通信锚点的时间窗内到达;若否,则将丢弃,返回子步骤s53继续执行;若是,计算的实际到达时刻以及经到达的新累计代价;
38、s55、判断新累计代价是否小于的已记录代价;若否,则返回步骤s53继续执行;若是,则更新的累计代价、估价及父指针,并将加入open列表中,返回步骤s53继续执行;待输出精细子路径或open列表耗尽时,算法终止。
39、本发明还提供一种通信窗口感知的auv分层路径规划系统,用于执行前述的通信窗口感知的auv分层路径规划方法;通信窗口感知的auv分层路径规划系统包括:
40、输入模块,其用于获得包括任务意图与约束、卫星星历、母船或基站航行计划、海流与环境预报、auv参数与工况在内的输入信息;
41、通信资源建模模块,其用于根据输入信息生成时空通信锚点集合;
42、时空规划网络构造模块,其用于根据时空通信锚点集合与任务空间描述获得时空扩展图;
43、全局分层规划模块,其用于构建多目标优化函数,并在时空扩展图上采用改进标签修正算法搜索pareto非支配解集,获得宏观路径骨架;
44、局部精化模块,其用于根据宏观路径骨架、海流场及auv动力学约束,采用带时空双约束剪枝的改进atw算法获得精细可执行轨迹;
45、应急锚点回退模块,其用于获得每个主选通信锚点的最晚决策时刻及备选通信锚点链表,构建主选+备选通信锚点决策树;
46、输出模块,其用于输出包括任务计划、巡航路径、通信计划及应急切换策略在内的完整规划产物。
47、基于上述技术方案,本发明实施例中的通信窗口感知的auv分层路径规划方法及系统,通过stca七元组实现各异构通信资源统一建模,在规划阶段将多模态通信可用窗口作为一种时空约束纳入auv路径优化,使异构通信机会可在单一规划框架下联合求解,依托时空扩展图将通信机会作为路径节点在时间维度上的可选分支,实现通信事件与路径节点的时空绑定,克服传统方案通信窗口错配、路径与时间解耦等问题;采用全局局部分层三目标优化架构,兼顾任务覆盖完整度、能耗及通信回传完整度,结合时空双约束剪枝提升搜索求解效率,保障轨迹动力学可行性;借助工况模板实现多目标权重自适应配置,摆脱人工调参对操作员经验的依赖,提高规划结果一致性;基于最晚决策时刻与主选+备选通信锚点决策树预生成应急切换策略,可应对执行过程中的各类扰动,提升任务鲁棒性;本发明能够充分利用多模态通信机会,减少无效上浮带来的能量损耗及回传延误等问题,提升auv水下自主航行作业时的数据回传质量与任务完成水平,可应用于长航程海洋调查、水下目标搜索、海底地形测绘、水下环境监测等场景,也可用作未来多auv协同规划中的单体规划。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com