[发明专利]基于感知驱动的自航式海底地形地貌测绘系统及测绘方法

权利要求书

1.一种基于感知驱动的自航式海底地形地貌测绘系统，其特征在于：系统包括水下自航式测绘系统和岸基单元，二者之间由通讯模块连接；

其中，水下自航式测绘系统包括：

基础探测单元：进行传感器数据的采集；

PD-SLAM单元：实现定位与路径规划；

运动控制单元：实现对移动观测设备的运动控制；

数据采集存储单元：实现数据的存储，包括传感器数据和导航数据；

和能源模块：为移动观测设备提供能源，确保正常工作；

岸基单元包括：

测绘任务设定模块：在移动观测设备执行任务前，通过岸基单元设定其扫描的区域；

和海底地貌生成模块：将实时上传的数据进行处理，生成海底地貌图像。

2.根据权利要求1所述的基于感知驱动的自航式海底地形地貌测绘系统，其特征在于：所述PD-SLAM单元包括两部分：

PDM模块：计算当前时刻航行位姿的不确定度、区域覆盖性以及对海底航迹惩罚进行评估，来决定下一刻执行活动(回访或探索)，从而引导自航式测绘系统更好的进行海底SLAM导航和目标区域覆盖；

SLAM模块：采用iSAM算法进行位姿估计，该算法基于快速递增的矩阵因式分解，通过更新稀疏平滑的信息矩阵的分解因子提供一种有效且精确的解决方案，能够随时计算出全局地图和机器人的整条轨迹，利用非线性最优化控制误差水平，从而提高计算速度，同时使用部分协方差支持数据关联。

3.一种利用如权利要求1所述的系统进行海底地形地貌测绘的方法，其特征在于：包括如下步骤：

步骤一：岸基单元通过通讯模块向测绘系统发布测绘任务；

步骤二：基础探测单元对海底地貌进行数据采集，采集的数据包括外部传感器数据和内部传感器数据；

步骤三：对采集的传感器数据进行特征分析、提取，得到移动观测设备的位姿点；

步骤四：将位姿点传输给PD-SLAM单元，进行处理；

步骤五：当目标区域扫描完成后，岸基单元输出海底地形地貌图。

4.根据权利要求3所述海底地形地貌测绘方法，其特征在于：所述步骤四中PD-SLAM单元包括PDM与SLAM两部分；

其中SLAM中采用基于递增平滑与地图构建iSAM算法，该算法基于快速递增的矩阵因式分解，通过更新稀疏平滑的信息矩阵的分解因子提供一种有效且精确的解决方案，能够随时计算出全局地图和机器人的整条轨迹，利用非线性最优化控制误差水平，从而提高计算速度，同时使用部分协方差支持数据关联；

而感知驱动PDM的工作是计算当前时刻航行位姿的不确定度、区域覆盖性以及对海底航迹惩罚进行评估，来决定下一刻执行活动(回访或探索)，从而引导自航式测绘系统更好的进行海底SLAM导航和目标区域覆盖。

5.根据权利要求4所述海底地形地貌测绘方法，其特征在于：SLAM实时构图iSAM算法处理过程包括以下步骤：

a.将SLAM问题视为信度网模型；

b.将其等价为基于最大后验概率的最小二乘问题，公式如下：

c.判断是否是周期整数倍，如果是周期的整数倍就利用吉文斯旋转和回代法进行更新；如果不是周期的整数倍，则进行基于贝叶斯树的变量重排和非线性最优化，重新计算整个解；

d.步数+1，并判断是否有新的输入，重复以上步骤直到绘制出整个地图。

6.根据权利要求4所述的海底地形地貌测绘方法，其特征在于：感知驱动PDM模块的工作过程包括以下步骤：

a.经过同时定位与构图SLAM模块后，得到的当前时刻t位姿和位姿的不确定度P：

P=|Σa-|16=|Σexp|16,P0=|Σallow|16---(2)]]>

其中|Σ_exp|是位姿一步预测协方差的模，|Σ_allow|是位姿允许协方差的模；

b.提前设定好不确定阈值P₀，然后将每一时刻的P与之进行比较，决策是进行回访或者继续探索；

c.若继续探索，则沿标定的路径继续探索，返回步骤a；

d.若需进行回访，则对显著性的节点聚类，确定候选路径，重访上一回访点。