一种水陆空异构无人平台协同控制方法及系统与流程

摘要: 本发明涉及多智能体协同控制,特别涉及一种水陆空异构无人平台协同控制方法及系统。背景技术:1、近年来,随着无人机、无人车和无人船等无人平台技术的快速发展,利用异构...
一种水陆空异构无人平台协同控制方法及系统与流程

本发明涉及多智能体协同控制,特别涉及一种水陆空异构无人平台协同控制方法及系统。

背景技术:

1、近年来,随着无人机、无人车和无人船等无人平台技术的快速发展,利用异构无人平台协同作业完成复杂任务已成为重要趋势。在林业巡查、水域监测及应急救灾等场景中,空中平台凭借俯视视角能够快速掌握大范围态势,而地面或水面平台则可抵近目标执行精细化处置。然而,由于空中平台与地面或水面平台在观测视角、运动方式和所处环境方面存在本质差异,如何将空中平台识别到的目标位置准确传达给执行任务的从平台,是协同控制中亟待解决的关键问题。现有协同作业模式通常依赖人工目视判读或简单的坐标传递,自动化水平和定位精度均难以满足实际应用需求。

2、现有技术中,空中平台多通过机载相机获取目标在图像中的像素位置,再结合自身位姿信息估算目标的地理坐标,并将该坐标发送给地面或水面平台进行导航跟踪。然而,这种处理方式忽略了空中平台相机投影模型与从平台执行平面之间的几何映射关系,特别是当目标区域存在地形起伏时,空中平台基于水平面假设解算出的目标位置与实际地面位置之间会产生明显的投影偏差。同时,空中平台位姿测量误差、目标检测误差以及地形数据误差在坐标解算过程中逐级传递,导致最终提供给从平台的目标位置与实际位置存在较大偏差。上述问题使得从平台按照给定坐标抵达后往往无法直接发现目标,需在大范围内进行盲目搜索,任务执行效率和成功率显著降低。

技术实现思路

1、针对现有技术的不足,本发明提供了一种水陆空异构无人平台协同控制方法及系统,进而解决了背景技术中提及的技术问题。

2、为实现以上目的,本发明通过以下技术方案予以实现:

3、一种水陆空异构无人平台协同控制系统,包括:

4、位姿同步采集模块,用于以固定频率同步获取空中平台、地面平台和水面平台的实时位姿数据,并对各平台机载惯性测量单元和卫星定位接收机输出的原始数据进行零偏校正和卡尔曼滤波,输出融合后的六自由度位姿信息;

5、视场角投影变换模块,用于根据所述空中平台的当前位姿和相机内参,针对接收目标指引的从平台类型,构建从所述空中平台相机坐标系到所述从平台执行坐标系的动态投影映射矩阵;

6、地形坡度补偿模块,用于从数字高程模型中提取目标区域的局部地形坡度角,当所述从平台为地面无人车时提取以所述空中平台地面投影点为中心的目标点邻域局部地形坡度角,并提供给所述视场角投影变换模块用于修正投影平面的法向量,当所述从平台为水面无人船时将坡度角置为零;

7、目标重投影定位模块,用于将所述空中平台识别到的目标像素坐标,经由所述视场角投影变换模块提供的映射矩阵,反向解算为所述从平台需要抵达的目标航点坐标;

8、渐进趋近控制模块,用于驱动所述从平台在进入主动搜索半径后,切换为基于视觉特征匹配的末端精细趋近。

9、在一种可能的实现方式中,所述目标重投影定位模块下设置信度半径计算单元,所述置信度半径计算单元用于依据协方差传播律,结合目标像素坐标的检测误差协方差、所述空中平台位姿测量误差协方差以及地形坡度提取误差协方差,计算目标航点的二维位置置信椭圆,提取椭圆长半轴作为所述从平台在目标航点周围的主动搜索半径。

10、在一种可能的实现方式中,所述渐进趋近控制模块下设特征模板缓存单元和螺旋轨迹生成单元,所述特征模板缓存单元用于存储所述空中平台在锁定目标时从目标边界框内提取的局部灰度纹理特征图,所述螺旋轨迹生成单元用于根据搜索半径和所述从平台视觉传感器的水平视场宽度生成阿基米德螺旋线搜索路径,所述螺旋线相邻环之间的最大径向间隙小于所述视觉传感器在目标距离处的水平地面采样宽度。

11、在一种可能的实现方式中,一种水陆空异构无人平台协同控制方法,包括以下步骤:

12、s1:位姿同步采集模块以卫星授时秒脉冲为时间基准同步获取各平台的原始位姿数据,对各路原始数据进行零偏校正和卡尔曼滤波,输出各平台在局部导航坐标系下的六自由度位姿,并将所有平台位姿统一转换到地心地固坐标系;

13、s2:空中平台通过机载下视相机获取目标区域图像,经目标检测模型输出目标边界框并提取其几何中心作为目标像素坐标,同时截取边界框内灰度图像区域作为目标局部纹理特征图,利用相机内参矩阵的逆矩阵将像素坐标转换为归一化图像坐标;

14、s3:视场角投影变换模块根据从平台类型执行差异化的投影补偿计算,地形坡度补偿模块从数字高程模型中提取局部地形坡度角,代入投影映射公式计算目标在从平台执行平面上的水平偏移量,与所述空中平台投影点的坐标相加得到所述从平台需要抵达的初始目标点绝对地理坐标;

15、s4:目标重投影定位模块调用置信度半径计算单元,构建误差协方差矩阵,将映射关系写作向量函数形式并构造雅可比矩阵,根据协方差传播律得到偏移量估计值的协方差矩阵,对所述协方差矩阵进行特征值分解后取较大特征值计算主动搜索半径;

16、s5:渐进趋近控制模块控制所述从平台朝向初始目标点行驶,当水平距离小于所述主动搜索半径时转入螺旋搜索模式,生成阿基米德螺旋线路径,所述从平台沿螺旋线行进过程中提取滑动窗口灰度图像块与目标局部纹理特征图进行归一化互相关匹配,当相关系数超过匹配阈值时判定捕获目标并执行处置动作。

17、在一种可能的实现方式中,步骤s3中,所述从平台为地面无人车时,所述投影映射公式为:

18、

19、其中为空中平台相对地形表面的垂直高度,为空中平台的俯仰角,为局部地形坡度角,,和为相机等效焦距,为归一化图像坐标,和分别为从空中平台地面投影点到目标在地形切平面上投影点的北向和东向水平位移。

20、在一种可能的实现方式中,步骤s3中,所述从平台为水面无人船时,所述地形坡度补偿模块将坡度角取为零,所述投影映射公式退化为:

21、

22、其中为空中平台相对水面的垂直高度,和分别为空中平台水面投影点到目标在水面上投影点的北向和东向位移。

23、在一种可能的实现方式中,步骤s4中,所述误差协方差矩阵为:

24、

25、其中和为目标像素坐标检测误差在图像坐标系下两个方向的标准差,、、为空中平台位置解算误差在地心地固坐标系下三个轴向的标准差,为空中平台俯仰角测量误差的标准差,为高度测量误差的标准差,为地形坡度角提取误差的标准差;

26、将所述s3中的映射关系写作向量函数形式:

27、

28、在误差源的名义值处对函数求一阶偏导数构造雅可比矩阵,根据协方差传播律得到偏移量估计值的协方差矩阵,对进行特征值分解获得两个特征值和,取较大特征值。主动搜索半径,其中系数为与预设置信水平对应的缩放因子。

29、在一种可能的实现方式中,步骤s5中,所述阿基米德螺旋线路径参数方程为:

30、

31、其中为从搜索中心算起的径向距离,从开始以固定步长递增至,为螺旋线圈数,所述螺旋线圈数按确定,其中为视觉传感器在目标距离处的水平地面采样宽度,表示向上取整。

32、与现有技术相比的有益效果:

33、1.本方案中,通过引入动态投影映射矩阵,针对从平台类型分别构建空中平台相机坐标系到局部地形切平面或水平面坐标系的转换关系,并利用地形坡度角修正投影平面的法向量,有效消除了空中平台倾斜视角与地面或水面平台平视视角之间因观测几何差异导致的投影偏差,使空中平台识别的目标像素坐标能够被准确映射为从平台执行坐标系中的实际航点位置,显著提高了异构平台间目标信息传递的准确性;

34、2.本方案中,通过协方差传播律构建目标重投影位置的置信椭圆,将目标检测误差、平台位姿测量误差和地形坡度提取误差纳入统一的误差传播框架,并以椭圆长半轴为依据生成自适应搜索半径,使不同从平台在执行任务时能够获得与自身定位精度相匹配的目标搜索范围,避免了固定半径搜索导致的效率低下或遗漏目标的问题,在保证捕获率的同时有效缩减了末端搜索区域;

35、3.本方案中,通过渐进趋近控制策略将从平台导航过程划分为远程直行趋近与末端螺旋搜索两个阶段,在进入搜索半径后切换为基于局部纹理特征匹配的视觉闭环趋近,利用阿基米德螺旋路径确保视觉传感器扫视区域无缝覆盖搜索圆域,使从平台在无需依赖高精度全局定位的条件下,依靠空中平台提供的目标外观先验信息自主完成目标确认与捕获,提升了系统在复杂环境下的作业成功率。