CN106908036A - 一种基于局部偏移的auv多波束数据构图方法 - Google Patents
一种基于局部偏移的auv多波束数据构图方法 Download PDFInfo
- Publication number
- CN106908036A CN106908036A CN201710053868.1A CN201710053868A CN106908036A CN 106908036 A CN106908036 A CN 106908036A CN 201710053868 A CN201710053868 A CN 201710053868A CN 106908036 A CN106908036 A CN 106908036A
- Authority
- CN
- China
- Prior art keywords
- moment
- local offset
- likelihood
- data
- auv
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C7/00—Tracing profiles
Landscapes
- Engineering & Computer Science (AREA)
- Multimedia (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明提供一种基于局部偏移的AUV多波束数据构图方法,一是针对每一时刻的多波束地形数据和导航数据,使用前几个时刻的数据对该时刻的多波束数据进行预测,并使用预测值与实际值计算该时刻的似然性;二是将每个时刻的似然性与预设的阈值进行比较,大于阈值的时刻作为存在局部偏移的时刻;三是对所有存在局部偏移的时刻,分别沿AUV载体坐标系x轴正负方向移动一定距离并分别计算步骤一得到的预测值与每个距离对应地形数据的似然性,选择对应似然性最小值的距离作为局部偏移;四是考虑局部偏移对所有时刻的影响,计算新的航迹点位置;五是将所有航迹点连接起来作为新的修正后的路径;六是使用修正后的路径和每一时刻的多波束地形数据重新绘图。
Description
技术领域
本发明涉及一种基于局部偏移的AUV多波束数据构图方法,属于海底地形地貌的测绘技术领域。
背景技术
随着多波束技术的发展,高精度的海底地形测绘和水下机器人地形匹配导航技术的应用成为可能。水下机器人的地形匹配依赖于海底先验地图的构建。目前的海底地图构建方法通常是由船载多波束声呐扫描海底地形,但由于多波束声呐测线长度的限制,无法完成对较深海域的地形测绘。本发明提出了一种不依赖于GPS数据的AUV配载多波束声呐海底地图构图方法,能够得到误差较小,地图一致性较高的海底先验地形图。该方法通过计算所测地形数据的出现概率(似然性),进行局部偏移的计算,修正路径从而得到较精确的多波束地图,可以实现对较深海域的地形测绘作业。
目前现有的多波束海底地形构图方法均需要依赖于与GPS卫星、岸基单元或长基线基阵的通信,这种通信不仅加大了成本,更限制了作业深度和距离。
公开日为2016年11月16日、公开号为CN106123850A、发明名称为“AUV配载多波束声呐水下地形测绘修正方法”的专利申请,,该方法需要得到首位准确相对位置,这就需要AUV在完成任务后重新回到起点或前往其他能精确定位的区域,增加了作业时间和成本。采用弹簧模型按照刚度进行误差分配的方法没有考虑误差的方向性。
发明内容
本发明的目的是为了提供一种基于局部偏移的AUV多波束数据构图方法。
本发明的目的是这样实现的:包括如下步骤:
步骤一:针对每一个时刻t的多波束地形数据和导航数据,使用前A个时刻的数据对该时刻t的多波束数据进行预测得到预测值,并使用预测值与实际值计算该时刻t的似然性θt,其中7≤A≤10;
步骤二:将每个时刻的似然性θt与预设的阈值进行比较:将似然性θt大于阈值的时刻作为存在局部偏移的时刻;若似然性θt小于阈值,t=t+1,返回步骤一;
步骤三、对所有存在局部偏移的时刻,分别沿AUV载体坐标系的xAUV轴正负方向移动一定距离并分别计算步骤一得到的预测值与每个距离对应地形数据的似然性,选择对应似然性最小值的距离作为局部偏移wt,判断当前时刻是否为最后时刻,若是最后时刻则进行步骤四,否者t=t+1,返回步骤一;
步骤四、考虑局部偏移对所有时刻的影响,计算新的航迹点位置;
步骤五、将所有航迹点连接起来作为修正后的路径;
步骤六、使用修正后的路径和每一时刻的多波束地形数据重新绘图。
本发明还包括这样一些结构特征:
1.步骤一包括:
第一:对每个时刻,根据导航数据,确定该时刻的多波束测线各测点的位置;
第二:针对每个测点,根据前A个时刻的多波束数据,采用高斯加权插值的方式计算该测点的水深值,其中7≤A≤10;
第三:根据第二步测得的每个测点水深值和当前时刻实际测量的水深值zt,k,计算似然性θt:
其中:AUV惯性导航系统的路径节点坐标为zt={zt,1,zt,2,...,zt,k,...,zt,N}表示t时刻所有N个测点的集合,p(zt|xt)是当前惯导指示位置是由上一点推算的实际位置的概率,N表示每一个时刻的测点个数,σt=diag(σt,1,σt,2,...,σt,k)是由t时刻N个测点水深值标准差组成的对角阵,zt,k表示t时刻第k条测点实际测量的水深值,表示对应于zt,k位置由上一时刻推算出的水深值。
2.步骤四包括:
定义路径上存在两个局部偏移wt和wt+p分别位于t和t+p时刻,以t+1时刻为例,t+1时刻新的航迹点位置为:
式中:是当前惯导指示位置是考虑局部位置wt之后由上一点推算的实际位置的概率;σt是由t时刻各测点的标准差组成的对角矩阵;表示对应zt,k位置在考虑局部位移wt之后由上一时刻推算出的水深值;vt+1为t+1时刻xt+1位置的偏移;wt是t时刻的局部偏移,wt+p是t时刻之后第一个局部偏移;为修正后t+1时刻新的航迹点位置。
与现有技术相比,本发明的有益效果是:本发明是在AUV导航数据本身存在误差情况下使用AUV多波束数据修正AUV导航数据并最终实现多波束数据构图的方法。本发明通过对局部偏移的提取和计算修正路径并绘制地图,能够不依赖于GPS等精确导航手段,在仅获得推位导航数据和多波束数据的情况下实现路径修正和高精确度地图绘制。
附图说明
图1是本发明的流程图;
图2是本发明的坐标系图。
具体实施方式
下面结合附图与具体实施方式对本发明作进一步详细描述。
本发明的目的在于提供能够一种基于局部偏移的AUV多波束数据构图方法,首先是针对每一时刻的多波束地形数据和导航数据,使用前几个时刻的数据对该时刻的多波束数据进行预测,并使用预测值与实际值计算该时刻的似然性;然后将每个时刻的似然性与预设的阈值进行比较,大于阈值的时刻作为存在局部偏移的时刻,对该时刻,分别沿AUV载体坐标系x轴正负方向移动一定距离并分别计算步骤一得到的预测值与每个距离对应地形数据的似然性,选择对应似然性最小值的距离作为局部偏移。最后考虑局部偏移对所有时刻的影响,计算新的航迹点位置从而修正路径并最终重新绘制得到精确度较高的地图。
具体的说本发明是:
结合图1,本发明的具体流程如下:
步骤一、是针对t时刻的多波束地形数据和导航数据,使用前A个时刻(7≤A≤10)的数据对t时刻的多波束数据进行预测,并使用预测值与实际值计算该时刻的似然性θt.
步骤1.1、对t时刻,根据导航数据,确定t时刻的多波束测线各测点的位置。
步骤1.2、针对每个测点,根据前A个时刻(7≤A≤10)的多波束数据,采用高斯加权插值的方式计算该测点的水深值。
步骤1.3、根据上一步测得的每个测点水深值和当前时刻实际测量的水深值zi,k,计算似然性θt。
假设AUV惯性导航系统的路径节点坐标为AUV真实路径节点坐标为X={x0,x1,...,xn}。似然性θt为
式中,由于认为各个测点的测量之间是相互独立的,AUV惯性导航系统的路径节点坐标为zt={zt,1,zt,2,...,zt,k,...,zt,N}表示t时刻所有N个测点的集合,σt=diag(σt,1,σt,2,...,σt,N)是由N个测点水深值标准差组成的对角阵,N表示t时刻的测点个数,zt,k表示第t时刻第k条测点获得的水深值,表示对应于zt,k位置由上一时刻推算出的水深值,这个水深值是基于高斯加权插值得到的。表示的是当前惯导指示位置是由上一点推算的实际位置的概率,越大该段位移似然性越大。
步骤二、将t时刻的似然性θt与预设的阈值进行比较。若大于阈值,就作为存在局部偏移的时刻,进行步骤三;小于阈值的话,t=t+1,返回步骤一。
似然性的大小体现了预测值与实际值之间的差距,认为差距大于一定程度的时刻,该时刻的导航数据存在被干扰的可能,认为存在局部偏移。
步骤三、对t时刻,如图2所示,图2中载体坐标系为{xAUV,yAUV},大地坐标系为{x,y},G为AUV的重心位置,也是载体坐标系和大地坐标系的原点,局部偏移表示为wt。具体的说是分别沿xAUV轴正负方向移动一定距离并分别计算步骤一得到的预测值与每个距离对应地形数据的似然性,选择对应似然性最小值的距离作为局部偏移wt。判断当前时刻是否为最后时刻,若是则进行步骤四,否者t=t+1,返回步骤一。
步骤四、考虑局部偏移对所有时刻的影响,计算新的航迹点位置。
假设路径上存在两个局部偏移wt和wt+p分别位于航迹点xt和xt+p。在航迹点xt上,
式中,σt为t时刻各测点水深值标准差的对角阵,描述了的离散程度,当时,
假设t时刻的局部偏移对其后t+1,...,t+p-1时刻的影响是满足径向基函数(RBF),以t+1 时刻为例,满足
式中,δ1表示函数的宽度参数,控制了函数的径向作用范围。当σt较小即较大时,认为wt更为可靠,可以加大其作用范围即取δ1为较大值。取可以得到t+1时刻的局部偏移vt+1为:
那么,修正后位置为
对所有航迹点完成计算之后,得到修正后AUV坐标
步骤五、将所有航迹点连接起来作为新的修正后的路径。
步骤六、使用修正后的路径和每一时刻的多波束地形数据重新绘图。
Claims (3)
1.一种基于局部偏移的AUV多波束数据构图方法,其特征在于:包括如下步骤:
步骤一:针对每一个时刻t的多波束地形数据和导航数据,使用前A个时刻的数据对该时刻t的多波束数据进行预测得到预测值,并使用预测值与实际值计算该时刻t的似然性θt,其中7≤A≤10;
步骤二:将每个时刻的似然性θt与预设的阈值进行比较:将似然性θt大于阈值的时刻作为存在局部偏移的时刻;若似然性θt小于阈值,t=t+1,返回步骤一;
步骤三、对所有存在局部偏移的时刻,分别沿AUV载体坐标系的xAUV轴正负方向移动一定距离并分别计算步骤一得到的预测值与每个距离对应地形数据的似然性,选择对应似然性最小值的距离作为局部偏移wt,判断当前时刻是否为最后时刻,若是最后时刻则进行步骤四,否者t=t+1,返回步骤一;
步骤四、考虑局部偏移对所有时刻的影响,计算新的航迹点位置;
步骤五、将所有航迹点连接起来作为修正后的路径;
步骤六、使用修正后的路径和每一时刻的多波束地形数据重新绘图。
2.根据权利要求1所述的一种基于局部偏移的AUV多波束数据构图方法,其特征在于:步骤一包括:
第一:对每个时刻,根据导航数据,确定该时刻的多波束测线各测点的位置;
第二:针对每个测点,根据前A个时刻的多波束数据,采用高斯加权插值的方式计算该测点的水深值,其中7≤A≤10;
第三:根据第二步测得的每个测点水深值和当前时刻实际测量的水深值zt,k,计算似然性θt:
其中:AUV惯性导航系统的路径节点坐标为zt={zt,1,zt,2,...,zt,k,...,zt,N}表示t时刻所有N个测点的集合,p(zt|xt)是当前惯导指示位置是由上一点推算的实际位置的概率,N表示每一个时刻的测点个数,σt=diag(σt,1,σt,2,...,σt,k)是由t时刻N个测点水深值标准差组成的对角阵,zt,k表示t时刻第k条测点实际测量的水深值,表示对应于zt,k位置由上一时刻推算出的水深值。
3.根据权利要求1或2所述的一种基于局部偏移的AUV多波束数据构图方法,其特征在于:步骤四包括:
定义路径上存在两个局部偏移wt和wt+p分别位于t和t+p时刻,以t+1时刻为例,t+1时刻新的航迹点位置为:
式中:是当前惯导指示位置是考虑局部位置wt之后由上一点推算的实际位置的概率;σt是由t时刻各测点的标准差组成的对角矩阵;表示对应zt,k位置在考虑局部位移wt之后由上一时刻推算出的水深值;vt+1为t+1时刻xt+1位置的偏移;wt是t时刻的局部偏移,wt+p是t时刻之后第一个局部偏移;为修正后t+1时刻新的航迹点位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710053868.1A CN106908036B (zh) | 2017-01-24 | 2017-01-24 | 一种基于局部偏移的auv多波束数据构图方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710053868.1A CN106908036B (zh) | 2017-01-24 | 2017-01-24 | 一种基于局部偏移的auv多波束数据构图方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106908036A true CN106908036A (zh) | 2017-06-30 |
CN106908036B CN106908036B (zh) | 2019-05-21 |
Family
ID=59206673
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710053868.1A Active CN106908036B (zh) | 2017-01-24 | 2017-01-24 | 一种基于局部偏移的auv多波束数据构图方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106908036B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109724671A (zh) * | 2017-10-31 | 2019-05-07 | 罗斯蒙特储罐雷达股份公司 | 用于界面测量的雷达物位计系统和方法 |
CN110441760A (zh) * | 2019-09-16 | 2019-11-12 | 河海大学 | 一种基于先验地形图的大范围海底地形图拓展构图方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010190726A (ja) * | 2009-02-18 | 2010-09-02 | Toa Harbor Works Co Ltd | 水底地形測量方法およびシステム |
CN104390646A (zh) * | 2014-09-15 | 2015-03-04 | 东南大学 | 水下潜器地形辅助惯性导航系统的位置匹配方法 |
CN105547300A (zh) * | 2015-12-30 | 2016-05-04 | 航天恒星科技有限公司 | 用于auv的全源导航系统及方法 |
CN106123850A (zh) * | 2016-06-28 | 2016-11-16 | 哈尔滨工程大学 | Auv配载多波束声呐水下地形测绘修正方法 |
-
2017
- 2017-01-24 CN CN201710053868.1A patent/CN106908036B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010190726A (ja) * | 2009-02-18 | 2010-09-02 | Toa Harbor Works Co Ltd | 水底地形測量方法およびシステム |
CN104390646A (zh) * | 2014-09-15 | 2015-03-04 | 东南大学 | 水下潜器地形辅助惯性导航系统的位置匹配方法 |
CN105547300A (zh) * | 2015-12-30 | 2016-05-04 | 航天恒星科技有限公司 | 用于auv的全源导航系统及方法 |
CN106123850A (zh) * | 2016-06-28 | 2016-11-16 | 哈尔滨工程大学 | Auv配载多波束声呐水下地形测绘修正方法 |
Non-Patent Citations (1)
Title |
---|
陈小龙等: "基于极大似然估计的AUV水下地形匹配定位方法", 《机器人》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109724671A (zh) * | 2017-10-31 | 2019-05-07 | 罗斯蒙特储罐雷达股份公司 | 用于界面测量的雷达物位计系统和方法 |
CN110441760A (zh) * | 2019-09-16 | 2019-11-12 | 河海大学 | 一种基于先验地形图的大范围海底地形图拓展构图方法 |
CN110441760B (zh) * | 2019-09-16 | 2023-04-04 | 河海大学 | 一种基于先验地形图的大范围海底地形图拓展构图方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106908036B (zh) | 2019-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104075715B (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
US9651698B2 (en) | Multi-beam bathymetric chart construction method based on submarine digital depth model feature extraction | |
CN106885576B (zh) | 一种基于多点地形匹配定位的auv航迹偏差估计方法 | |
CN107314768A (zh) | 水下地形匹配辅助惯性导航定位方法及其定位系统 | |
CN102928858B (zh) | 基于改进扩展卡尔曼滤波的gnss单点动态定位方法 | |
CN104390646B (zh) | 水下潜器地形辅助惯性导航系统的位置匹配方法 | |
CN107390177B (zh) | 一种基于纯测向的被动水下声学定位方法 | |
CN107664758B (zh) | 基于长基线或超短基线组网的深海导航定位系统及方法 | |
CN107966145B (zh) | 一种基于稀疏长基线紧组合的auv水下导航方法 | |
CN106842209B (zh) | 一种多机器人协同水下地形匹配导航系统及方法 | |
CN107576939A (zh) | 一种基于虚拟测距信标的单信标测距定位方法 | |
CN105424036A (zh) | 一种低成本水下潜器地形辅助惯性组合导航定位方法 | |
CN113433553B (zh) | 一种水下机器人多源声学信息融合精确导航方法 | |
CN109738902B (zh) | 一种基于同步信标模式的水下高速目标高精度自主声学导航方法 | |
CN108413988A (zh) | 机器人末端经纬仪坐标系快速标定方法 | |
CN102541062A (zh) | 一种水下自主式航行器的局部路径规划方法 | |
CN107990891A (zh) | 基于长基线和信标在线标定的水下机器人组合导航方法 | |
CN109085655B (zh) | 一种水下平台重力测量方案与验证方法 | |
CN110207695A (zh) | 一种适用于深海auv的无速度辅助单信标定位方法 | |
CN109425347A (zh) | 一种半潜无人船的同时定位与地图构建方法 | |
CN110262482A (zh) | 一种无人船航速控制方法及无人船 | |
CN107643082A (zh) | 基于多波束的多路径并行iccp水下地形匹配方法 | |
CN108489497A (zh) | 一种利用地图防触礁的安全助航方法 | |
CN106908036A (zh) | 一种基于局部偏移的auv多波束数据构图方法 | |
CN107463871A (zh) | 一种基于角特征加权的点云匹配方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |