考虑洋流和地面信息的两栖车辆环境构建与路径规划方法与流程
本发明属于两栖车辆环境构建与路径规划,具体涉及一种考虑洋流和地面信息的两栖车辆环境构建与路径规划方法。
背景技术:
1、随着两栖车辆技术发展,已有无人两栖车辆应用于水下探索和救援。与陆地或空中环境相比,水下环境具有高度的复杂性与动态性,为两栖车辆的自主导航与路径规划带来了严峻挑战。
2、目前,传统的水下路径规划方法多基于静态环境模型,主要考虑静态障碍物(如礁石、沉船)与恒定水深,规划出几何上的最短或最安全路径。然而,这类方法存在显著局限性。首先,它们普遍忽视了动态洋流的影响。洋流作为一种持续存在的自然力,其流速和方向随时间和空间变化。忽略洋流的动态特性,可能导致规划出的路径在实际航行中产生巨大偏差,甚至导致任务失败。
3、其次,现有方法通常缺乏对海床土壤信息的有效集成。两栖车辆区别于水下航行器,需要实时与还装土壤接触。不同区域的海床土壤类型(如松软淤泥、坚硬沙质或黏土)对其通行能力有决定性影响。驶入承力极差的淤泥区,车辆极易陷入其中,发生“陷车”事故,丧失机动能力。传统路径规划仅将海床视为一个统一的二维平面,无法识别和规避此类地质风险区域,严重威胁任务安全。
4、综上所述,现有技术由于未能同时考虑动态洋流与海床土壤特性这两大关键环境要素。因此,迫切需要发展一种新型的水下路径规划方法,它能够融合预报的洋流数据与的海床底质信息,在复杂的时空变化环境中,为两栖车辆综合规划出一条可行路径。
技术实现思路
1、(一)要解决的技术问题
2、本发明要解决的技术问题是:如何解决两栖履带车辆水下路径规划中的环境构建问题。
3、(二)技术方案
4、为解决上述技术问题,本发明提供一种考虑洋流和地面信息的两栖车辆环境构建与路径规划方法,如图1所示,所述两栖车辆环境构建与路径规划方法包括以下步骤:
5、步骤s1:栅格地图规划;
6、步骤s2:地形环境构建;
7、步骤s3:洋流环境构建;
8、步骤s4:形成地形-洋流复合地图;
9、步骤s5:路径规划;
10、步骤s6:限定路径高度;
11、步骤s7:判断是否碰撞;
12、步骤s8:判断路径是否最优。
13、其中,所述步骤s1中,栅格地图规划:
14、根据目标海域的范围规划地图尺寸,初始化三维空间栅格地图,地图结构尺寸表示为长×宽×高,规划一定长、宽、水深的海域区域栅格地图用于两栖车辆水下路径规划,即规划栅格地图长为200米,宽为200米,水深为15米的水域区域空间,即200×200×15海域区域用于两栖车辆水下路径规划。
15、其中,所述步骤s2中,地形环境构建:
16、根据目标海域的地质特性加载数字海床地形数据,数据包含海床地面承载能力信息、海床地形地势信息、障碍物分布信息,如图4所示。
17、其中,所述步骤s3中,洋流环境构建:
18、根据目标海域的海文信息加载数字动态洋流信息,数据包含海洋涡旋分布位置、速度强度、核心半径、作用深度信息。
19、其中,所述步骤s4中,形成地形-洋流复合地图:
20、将地形环境、洋流环境叠加映射到步骤s1的200米×200米×15米海域区域栅格地图中,如图6所示。
21、其中,所述步骤s5中,路径规划:
22、以地形-洋流复合地图为基础,应用路径规划算法进行水下路径全局规划(a-star、rrt、pso智能算法等路径规划方法均可实现);
23、按照实际需求设置两栖车辆所执行任务的起始点和终止点,置地形-洋流复合地图中(1, 1)为起始点,(200, 200)为终止点。
24、其中,所述步骤s6中,限定路径高度:
25、应用pso粒子群算法进行两栖车辆的水下路径规划,根据对路径规划的需求设置,在起始点与终止点间生成一系列控制点,本实施例中控制点数量设置为10个;
26、通过地形插值函数强制控制点保持在安全高度,保证两栖车辆的路径与地势保持贴合状态,且不与海床地形碰撞,安全高度与车辆质心高度保持一致,如无法准确获取车辆质心高度,则简化为车身高度的一半。
27、其中,所述步骤s7中,判断是否碰撞:
28、校核当前规划路径是否与障碍发生碰撞,若判断无碰撞执行下一步;若判断有碰撞,重新进行路径规划;
29、其中,所述步骤s8:判断路径是否最优:
30、选取起始点至终止点规划的最短路径作为最优路径的判断标准,粒子群算法循环结束后,两栖车辆选取最优路径执行,如图7所示。
31、其中,如图2所示,所述步骤s2的地形环境构建,具体为以下步骤s21-步骤s23:
32、步骤s21:获取海床地形数据:
33、根据提前探测的海床地形数据(如多波束测深数据等)映射为二维矩阵,其中矩阵的行向量映射为目标海域长度,列向量为映射目标海域的宽度,矩阵中的数值映射为该位置的地形高度;
34、步骤s22:海底数据归一化处理:
35、为避免地形坡度特征值过大或过小可能导致数值计算的不稳定,对海床地形二维矩阵进行归一化处理:
36、
37、式中:为矩阵当前值;为矩阵中最小值;为矩阵中最大值;
38、在矩阵归一化的基础上,利用三次样条插值建立地形映射函数,结合高程恢复系数,生成连续的真实海床高程模型,若提前探测采集的海床地形特性点稀疏,通过插值算法增加地形分辨率,保证精度满足路径规划算法;
39、步骤s23:生成地形映射模型:
40、在矩阵归一化的基础上,利用三次样条插值建立地形映射函数,结合高程恢复系数,生成连续的真实海床高程模型,映射到200米×200米×15米海域区域栅格地图中;
41、其中,若提前探测采集的海床地形特性点稀疏,可通过插值算法增加地形分辨率,保证地面精度满足路径规划算法;
42、步骤s24:设置障碍物信息:
43、根据提前探测的海床地形障碍信息,及疑似不可通信区域设为障碍物,障碍物不限于形状,本实施例用圆球形表示,如图5所示。
44、其中,如图3所示,所述步骤s3的洋流环境构建,具体为以下步骤s31-步骤s34:
45、步骤s31:海域表层流速初始化:
46、根据开阔水域的风浪等级初始化海面表层流速,海水表层流速表示为:
47、
48、式中:为海面表层流速;
v为目标海域的风速,根据当天的天气预报查询;
49、步骤s32:海床层流速度计算:
50、根据海面表层流速计算两栖车辆所处海床位置的层流流速,表示为:
51、
52、式中:为海床洋流流速;
z为海水深度,本实施例中
z=15米;
h为洋流衰减特征深度,取值15~30米;
53、步骤s33:海床涡流速度评估:
54、根据开阔海域涡流的强度、径向距离、扩散时间评估两栖车辆所处海床位置的涡流流速,表示为:
55、
56、式中:为涡流的切向速度;为涡旋的强度,取值0.1~1 m/s;
r是距离涡心的径向距离;是流体的运动粘性系数,取值1e-6 m²/s;
t是扩散时间;
57、其中距离涡心的径向距离,表示为:
58、
59、式中:为涡心坐标,根据海文信息设置;为两栖车辆坐标;涡旋为二维涡旋,沿深度均匀分布;
60、步骤s34:洋流环境映射:
61、根据海床层流速度计算、海床涡流速度评估结果,表示为:
62、
63、式中:为二维矩阵位置的洋流速度,为二维矩阵位置的层流速度;为二维矩阵位置处的涡流速度;将二维矩阵中每一点层流速度和涡流速度进行线性叠加,映射至200米×200米×15米海域区域栅格地图中。
64、(三)有益效果
65、与现有技术相比较,本发明提供一种考虑洋流和地面信息的两栖车辆环境构建与路径规划方法,以解决两栖履带车辆水下路径规划中的环境构建问题,涉及水下洋流环境、海床土壤环境、地形坡度信息,实现两栖车辆在复杂的时空变化环境中路径规划。
66、具体而言,该方法通过构建融合洋流与海底地形信息的复合地图,实现两栖车辆的水下路径规划。该方法首先初始化三维栅格地图,并分别加载海床地形数据(含承载能力、地势及障碍物信息)与动态洋流数据(含涡旋分布、流速等信息),将其叠加为复合环境模型。基于此,采用路径规划算法(如pso)生成起点至终点的控制点,并通过地形插值确保路径与海底保持安全高度。规划过程中进行碰撞检测,并选取最短路径作为最优路径输出,从而保障两栖车辆在复杂水下环境中的可行性与路径最优性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com