CN111578944B - 一种基于单信标的水下滑翔机定位方法 - Google Patents
一种基于单信标的水下滑翔机定位方法 Download PDFInfo
- Publication number
- CN111578944B CN111578944B CN202010440777.5A CN202010440777A CN111578944B CN 111578944 B CN111578944 B CN 111578944B CN 202010440777 A CN202010440777 A CN 202010440777A CN 111578944 B CN111578944 B CN 111578944B
- Authority
- CN
- China
- Prior art keywords
- positioning
- beacon
- underwater glider
- time
- underwater
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/203—Specially adapted for sailing ships
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/14—Receivers specially adapted for specific applications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于单信标的水下滑翔机定位***及方法。定位***包括水下滑翔机内的定位声学接收模块、定位处理模块、压力传感器、姿态传感器和卫星接收模块,以及一个部署于海底或海面的定位信标。首先单定位信标以固定时间间隔发送包含经纬度和高程信息的定位报文,水下滑翔机侦听并解析定位报文,结合报文信息和节点姿态信息建立状态向量、测量向量以及相应的状态方程和测量方程,利用扩展卡尔曼滤波,计算得到估计的水下移动节点位置。本方法对水下滑翔机进行定位时,无需水下滑翔机与信标保持时钟同步,且无需装备速度仪。
Description
技术领域
本发明属于定位技术领域,涉及一种基于单信标的水下滑翔机定位***及方法,结合单个定位信标所发的定位报文信息与水下机器人的姿态信息,实现水下滑翔机的定位。
背景技术
近年来,海洋资源勘探、海洋环境监测、水下设备研发等成为热点方向。水下机器人,如自主水下机器人(Autonomous Underwater Vehicles,AUV)、水下滑翔机(UnderwaterGliders,UG)、遥控水下机器人(Remote Operated Vehicles,ROV)等,越来越多地应用于海洋环境监测与水下目标探测中,且这类水下设备常需要机动到指定区域执行相应水下任务。因此,水下机器人的定位跟踪是机器人在科学研究与工程应用中的支撑技术之一。
由于电磁波信号在海水中会受到较大的衰减,陆地上较为成熟的定位***(如美国的全球定位***,中国的北斗定位***等)并不适合用于水下机器人的定位。声信号在海水中的衰减小,水声信号是水下信息传输的主要载体,常被用于水下设备的定位跟踪领域。
在此基础上发展出来了以长基线、短基线和超短基线为代表的水下设备定位方法及其***。长基线定位***可用于水下设备的自主定位,要在海底布设传感器阵列,采用应答机制进行测距,从而得到较高的定位精度,但是需要固定水域内的部署水声应答装置,而且应答器节点位置标定难度高,使其实现代价较高。短基线水声定位***需要在载体平台上布放传感器阵列,水下设备安装应答器,可对水下设备进行定位,但是无法实现水下设备自主定位。超短基线水声定位***需要在载体平台上布放声学基线阵列,水下设备安装应答器,采用应答机制实现对水下设备定位,但是同样无法实现水下设备的自主定位。同时,超短基线定位***还存在着复杂的校准问题。在此基础上,也有一些组合形式的定位方案,兼具长基线的精度和超短基线的便携性。但是,上述水声定位方法均需要安装应答器以完成距离测量或到达角度测量,无法实现水下设备节能且隐蔽型的定位。
在水声测距基础上发展出了基于多信标的水下机器人定位方法。利用多个信标和水下机器人进行信息交互实现测距,结合多个信标的位置与测距信息实现水下机器人的位置解算。根据工作方式的不同,水下机器人可以主动向信标发送定位请求,也可以被动接收信标广播的定位报文获取测距信息。经检索,中国专利申请号CN201711371839.6公开了一种基于北斗信标的水下移动节点自主定位方法,海面3个信标组成定位阵列,同步广播定位报文,水下机器人被动侦听报文,当接收到3条定位报文之后完成位置解算;中国专利申请号CN201910635423.3公开了一种基于多信标的超短基线标定***及标定方法,通过多信标对一体化安装的超短基线换能器进行了精确标定。
相较于基于多信标的水下机器人定位方法,基于单定位信标的水下机器人定位技术是水声定位的一个新研究方向。这种定位方式水下机器人只需要利用一个信标节点发送的定位报文信息,将声学测距定位设备与机器人平台运动传感器组合使用,实现水下机器人自身位置的估计。目前,已有一些基于单定位信标的水下机器人定位跟踪方法。经检索,中国专利申请号CN201710599165.9和中国专利申请号CN201710599155.5分别发明公开了一种基于虚拟信标的AUV定位跟踪方法和一种基于虚拟收发信标的单信标测距定位方法。这两种跟踪方法的局限在于利用定位信标到AUV的斜距进行节点定位,要求节点与信标保持着较为严格的时钟同步。此外,也有基于利用传输时间进行序贯滤波的单信标水下机器人的定位跟踪方法,这种方法局限在于要求节点与信标保持时钟同步且需要实时获取移动节点的速度。
现有水下机器人的水声定位方法大多存在以下问题:
1、水下机器人与信标需要保持时钟同步。在复杂的水下环境中,水下机器人的时钟漂移难以补偿,无法保持和信标节点的精确同步,这给测量计算环节带来较大的影响。
2、应答式方式下水下机器人需要装备应答器。出于节能的考虑,一些水下机器人未配备信号发射装置,无法发送应答信号。另外,在特殊安全需求的场景中,出于隐蔽性考虑,水下节点不能发送信号。
3、水下机器人需要装备多普勒速度仪。对于小型化的水下机器人平台来说,高精度的多普勒速度仪成本高昂,寻找合适的方法去减少速度仪的使用或者代替速度仪测量是很有必要的。
因此,在时钟不同步且水下机器人不采用应答机制的情况下,实现水下机器人的定位是非常必要的。
发明内容
本发明的一个目的是针对水下滑翔机时钟与信标非同步,且不采用应答机制的情况下,提供一种实现没有装备速度仪的水下滑翔机的定位***。
本发明的定位***,包括设置在水下滑翔机内的定位声学接收模块、定位处理模块、压力传感器、姿态传感器和卫星接收模块,以及一个部署于海底或海面的定位信标。定位声学接收模块包括水听器和水声接收模块,用于接收来自定位信标的定位报文和记录定位报文到达时刻;压力传感器用于获取水下滑翔机的深度信息;姿态传感器用于获取水下滑翔机的实时姿态信息;定位处理模块用于执行定位算法,估计水下滑翔机的位置;水下滑翔机在开始一次滑翔或结束一次滑翔时浮出水面,卫星接收模块用于此时对水下滑翔机进行初始位置校正。
如定位信标是部署于海底的海底信标,则该海底信标包含声学***和定位声学收发机。声学***用于标定海底信标的位置;定位声学收发机用于广播定位报文。海底信标布放后,首先处于信标位置标定模式,在获取自身位置后,再切换至信标工作模式,并以固定的时间间隔广播定位报文。
如定位信标是部署于海面的海面信标,则该海面信标包含卫星信号接收机和定位声学收发机。卫星信号接收机用于接收卫星信号,获取海面信标的实时位置;定位声学收发机用于广播定位报文。海面信标布放后,直接进入信标工作模式,通过卫星信号接收机实时获取信标的位置信息,并以固定的时间间隔广播定位报文。
所述的定位报文共128比特,依次包括:12比特的同步码SYN(SynchronizeSequence Numbers,同步序列编号),用于指示定位报文的起始位;4比特的类型码TYP,用于指示定位报文的类型;8比特的标号码ADR,用于指示定位报文由哪个信标发送;8比特的保留位RES,用于控制功能的保留位;32比特的经度信息LON,32比特的纬度信息LAT,16比特的高程(深度)信息HEI;16比特的纠错冗余位FCC,用于报文的帧纠错。
本发明的另一个目的是提供一种利用以上***实现水下滑翔机定位的方法。
本发明方法包含以下步骤:
步骤(1).部署于海底或海面的定位信标周期性地发送定位报文,具体是:定位信标按照规定的定位报文格式,将包含定位信标的经度、纬度和高程的信息组成定位报文,以固定的时间间隔广播定位报文;
步骤(2).水下滑翔机侦听定位报文,具体是:水下滑翔机通过定位声学接收模块接收到定位信标发送的定位报文,同时记录第n个定位报文到达定位声学接收模块的达到时刻tn;接收到的定位报文及其达到时刻发送给水下滑翔机的定位处理模块;
步骤(3).定位处理模块完成对水下滑翔机自身位置的估计,具体步骤如下:
(3-1).定位处理模块解析定位报文,得到定位信标的经度L、纬度B和高程H;
(3-2).定位处理模块从姿态传感器读取水下滑翔机当前的姿态信息;水下滑翔机在tn时刻获取的姿态信息包括:水下滑翔机移动方向与水平面的夹角θn;水下滑翔机移动方向的水平分量与正东方向的夹角,即航向角水下滑翔机的深度zn;
(3-3).定位处理模块根据姿态信息构建测量向量与状态向量;tn时刻水下滑翔机的测量向量Ψn=tn,状态向量sn=[xn yn τn]T,xn表示水下滑翔机的水平位置X轴坐标,yn表示水下滑翔机的水平位置Y轴坐标,τn表示水下滑翔机与定位信标在tn时刻的时钟漂移因子,规定正北方向为Y轴正方向,正东方向为X轴正方向,T表示转置;
(3-4).定位处理模块根据测量向量和状态向量的转换关系建立测量方程和状态方程;具体是:
定位处理模块将定位信标的经度、纬度和高程(L,B,H)转换成笛卡尔坐标(X,Y,Z);测量方程为:其中,c 为有效声速,ωn表示测量噪声,为白高斯噪声,(Xb,Yb,Zb)表示定位信标的坐标,Tb为报文发送时间间隔;
在tn-1时刻到tn时刻之内,vx,n=vx,n-1+εvx,n,vy,n=vy,n-1+εvy,n;其中,vx,n和vy,n分别表示tn时刻水下滑翔机速度的X轴和Y轴的分量;εvx,n和εvy,n分别表示tn-1时刻与tn时刻两相邻时刻的X轴和Y轴方向的速度误差;tn-1时刻到tn时刻的时间间隔Δtn=tn-tn-1;
得到tn-1时刻到tn时刻水下滑翔机的水平位置(xn,yn);
xn=xn-1+vx,n·Δtn+εx,n,yn=yn-1+vy,n·Δtn+εy,n;其中,εx,n和εy,n分别表示tn-1时刻与tn时刻两相邻时刻的X轴和Y轴方向的位置估计误差;
在tn-1时刻到tn时刻之内,τn=τn-1+ετ,n,ετ,n为水下滑翔机与定位信标在tn-1时刻与tn时刻两相邻时刻的时钟漂移误差;
(3-5).定位处理模块根据测量向量、状态向量、测量方程和状态方程,完成定位解算,得到定位结果;具体是:
利用扩展卡尔曼滤波进行位置估计,包括状态预测和状态更新循环处理;
在开始一次滑翔或结束一次滑翔时,水下滑翔机浮出水面,通过卫星接收模块行初始位置校正,然后执行状态预测和状态更新;
本发明方法利用单定位信标广播的定位报文和水下滑翔机的姿态信息就可以实现水下滑翔机的定位,定位***的结构较为简单。和水下滑翔机内部的推算位置相比,本发明方法可以提高水下滑翔机的定位精度。水下滑翔机被动侦听定位报文,无需向定位信标发送定位请求,整个定位过程节能,也具有一定的隐秘性。此外,利用单个定位信标便可以覆盖一定的海区,多个信标采取单信标的布放模式,便可以覆盖较大的定位面积,具有更强的经济性。
附图说明
图1是本发明方法中扩展卡尔曼滤波流程示意图。
具体实施方式
为了更详细的对于该发明进行解释说明,拟结合附图进行示例性说明,但并不局限于附图中,其中附图中结构有所省略或者比例大小不符合实际尺寸,仅供说明参考使用。
在没有装备速度仪条件下的水下滑翔机,通过以下定位***实现定位。
本发明的定位***包括设置在水下滑翔机内的定位声学接收模块、定位处理模块、压力传感器、姿态传感器和卫星接收模块,以及一个部署于海底或海面的定位信标。定位声学接收模块包括水听器和水声接收模块,用于接收来自定位信标的定位报文和记录定位报文到达时刻;压力传感器用于获取水下滑翔机的深度信息;姿态传感器用于获取水下滑翔机的实时姿态信息;定位处理模块用于执行定位算法,估计水下滑翔机的位置;水下滑翔机在开始一次滑翔或结束一次滑翔时浮出水面,卫星接收模块用于此时对水下滑翔机进行初始位置校正。
如定位信标是部署于海底的海底信标,则该海底信标包含声学***和定位声学收发机。声学***用于标定海底信标的位置;定位声学收发机用于广播定位报文。海底信标布放后,首先处于信标位置标定模式,在获取自身位置后,再切换至信标工作模式,并以固定的时间间隔广播定位报文。
如定位信标是部署于海面的海面信标,则该海面信标包含卫星信号接收机和定位声学收发机。卫星信号接收机用于接收卫星信号,获取海面信标的实时位置;定位声学收发机用于广播定位报文。海面信标布放后,直接进入信标工作模式,通过卫星信号接收机实时获取信标的位置信息,并以固定的时间间隔广播定位报文。
定位报文共128比特,依次包括:12比特的同步码SYN(Synchronize SequenceNumbers,同步序列编号),用于指示定位报文的起始位;4比特的类型码TYP,用于指示定位报文的类型;8比特的标号码ADR,用于指示定位报文由哪个信标发送;8比特的保留位RES,用于控制功能的保留位;32比特的经度信息LON,32比特的纬度信息LAT,16比特的高程(深度)信息HEI;16比特的纠错冗余位FCC,用于报文的帧纠错。
定位信标按固定的时间间隔广播定位报文,水下滑翔机侦听海底单信标的定位报文,结合姿态信息实现定位。具体方法是:
步骤(1).部署于海底或海面的定位信标周期性地发送定位报文,具体是:定位信标按照规定的定位报文格式,将包含定位信标的经度、纬度和高程的信息组成定位报文,以固定的时间间隔广播定位报文。
步骤(2).水下滑翔机侦听定位报文,具体是:水下滑翔机通过定位声学接收模块接收到定位信标发送的定位报文,同时记录第n个定位报文到达定位声学接收模块的达到时刻tn;接收到的定位报文及其达到时刻发送给水下滑翔机的定位处理模块。
步骤(3).定位处理模块完成对水下滑翔机自身位置的估计,具体步骤如下:
(3-1).定位处理模块解析定位报文,得到定位信标的经度L、纬度B和高程H;
(3-2).定位处理模块从姿态传感器读取水下滑翔机当前的姿态信息;水下滑翔机在tn时刻获取的姿态信息包括:水下滑翔机移动方向与水平面的夹角θn;水下滑翔机移动方向的水平分量与正东方向的夹角,即航向角水下滑翔机的深度zn;
(3-3).定位处理模块根据姿态信息构建测量向量与状态向量;tn时刻水下滑翔机的测量向量Ψn=tn,状态向量sn=[xn yn τn]T,xn表示水下滑翔机的水平位置X轴坐标,yn表示水下滑翔机的水平位置Y轴坐标,τn表示水下滑翔机与定位信标在tn时刻的时钟漂移因子,规定正北方向为Y轴正方向,正东方向为X轴正方向,T表示转置;
(3-4).定位处理模块根据测量向量和状态向量的转换关系建立测量方程和状态方程;
定位处理模块将定位信标的经度、纬度和高程(L,B,H)转换成笛卡尔坐标(X,Y,Z);测量方程为:其中,c 为有效声速,ωn表示测量噪声,为白高斯噪声,(Xb,Yb,Zb)表示定位信标的坐标,Tb为报文发送时间间隔;
在tn-1时刻到tn时刻之内,vx,n=vx,n-1+εvx,n,vy,n=vy,n-1+εvy,n;其中,vx,n和vy,n分别表示tn时刻水下滑翔机速度的X轴和Y轴的分量;εvx,n和εvy,n分别表示tn-1时刻与tn时刻两相邻时刻的X轴和Y轴方向的速度误差;tn-1时刻到tn时刻的时间间隔Δtn=tn-tn-1;
得到tn-1时刻到tn时刻水下滑翔机的水平位置(xn,yn);
xn=xn-1+vx,n·Δtn+εx,n,yn=yn-1+vy,n·Δtn+εy,n;其中,εx,n和εy,n分别表示tn-1时刻与tn时刻两相邻时刻的X轴和Y轴方向的位置估计误差;
由水下滑翔机的姿态信息,水下滑翔机速度的X轴和Y轴的分量表示为:
在tn-1时刻到tn时刻之内,τn=τn-1+ετ,n,ετ,n为水下滑翔机与定位信标在tn-1时刻与tn时刻两相邻时刻的时钟漂移误差;
(3-5).定位处理模块根据测量向量、状态向量、测量方程和状态方程,完成定位解算,得到定位结果;具体是:
利用扩展卡尔曼滤波进行位置估计,包括状态预测和状态更新循环处理;
在开始一次滑翔或结束一次滑翔时,水下滑翔机浮出水面,通过卫星接收模块行初始位置校正,然后执行状态预测和状态更新,如图1;
算法仿真:海底单信标的经纬度坐标为(111.82101°E,18.04949°N),布放在深度为1000 米的海底。设置定位信标以8秒的时间间隔广播定位报文。一个水下滑翔机在定位报文覆盖范围内运动。仿真参数设置如下:
Claims (2)
1.一种基于单信标的水下滑翔机定位方法,其特征在于:
采用的定位***包括设置在水下滑翔机内的定位声学接收模块、定位处理模块、压力传感器、姿态传感器和卫星接收模块,以及一个部署于海底或海面的定位信标;定位声学接收模块包括水听器和水声接收模块,用于接收来自定位信标的定位报文和记录定位报文到达时刻;压力传感器用于获取水下滑翔机的深度信息;姿态传感器用于获取水下滑翔机的实时姿态信息;定位处理模块用于执行定位算法,估计水下滑翔机的位置;水下滑翔机在开始一次滑翔或结束一次滑翔时浮出水面,卫星接收模块用于此时对水下滑翔机进行初始位置校正;
如定位信标是部署于海底的海底信标,则该海底信标包含声学***和定位声学收发机;声学***用于标定海底信标的位置;定位声学收发机用于广播定位报文;海底信标布放后,首先处于信标位置标定模式,在获取自身位置后,再切换至信标工作模式,并以固定的时间间隔广播定位报文;
如定位信标是部署于海面的海面信标,则该海面信标包含卫星信号接收机和定位声学收发机;卫星信号接收机用于接收卫星信号,获取海面信标的实时位置;定位声学收发机用于广播定位报文;海面信标布放后,直接进入信标工作模式,通过卫星信号接收机实时获取信标的位置信息,并以固定的时间间隔广播定位报文;
具体定位方法如下:
步骤(1).部署于海底或海面的定位信标周期性地发送定位报文,具体是:定位信标按照规定的定位报文格式,将包含定位信标的经度、纬度和高程的信息组成定位报文,以固定的时间间隔广播定位报文;
步骤(2).水下滑翔机侦听定位报文,具体是:水下滑翔机通过定位声学接收模块接收到定位信标发送的定位报文,同时记录第n个定位报文到达定位声学接收模块的达到时刻tn;接收到的定位报文及其达到时刻发送给水下滑翔机的定位处理模块;
步骤(3).定位处理模块完成对水下滑翔机自身位置的估计,具体步骤如下:
(3-1).定位处理模块解析定位报文,得到定位信标的经度L、纬度B和高程H;
(3-2).定位处理模块从姿态传感器读取水下滑翔机当前的姿态信息;水下滑翔机在tn时刻获取的姿态信息包括:水下滑翔机移动方向与水平面的夹角θn;水下滑翔机移动方向的水平分量与正东方向的夹角,即航向角水下滑翔机的深度zn;
(3-3).定位处理模块根据姿态信息构建测量向量与状态向量;tn时刻水下滑翔机的测量向量Ψn=tn,状态向量sn=[xn yn τn]T,xn表示水下滑翔机的水平位置X轴坐标,yn表示水下滑翔机的水平位置Y轴坐标,τn表示水下滑翔机与定位信标在tn时刻的时钟漂移因子,规定正北方向为Y轴正方向,正东方向为X轴正方向,T表示转置;
(3-4).定位处理模块根据测量向量和状态向量的转换关系建立测量方程和状态方程;具体是:
定位处理模块将定位信标的经度、纬度和高程(L,B,H)转换成笛卡尔坐标(X,Y,Z);测量方程为:其中,c为有效声速,ωn表示测量噪声,为白高斯噪声,(Xb,Yb,Zb)表示定位信标的坐标,Tb为报文发送时间间隔;
在tn-1时刻到tn时刻之内,vx,n=vx,n-1+εvx,n,vy,n=vy,n-1+εvy,n;其中,vx,n和vy,n分别表示tn时刻水下滑翔机速度的X轴和Y轴的分量;εvx,n和εvy,n分别表示tn-1时刻与tn时刻两相邻时刻的X轴和Y轴方向的速度误差;tn-1时刻到tn时刻的时间间隔Δtn=tn-tn-1;
得到tn-1时刻到tn时刻水下滑翔机的水平位置(xn,yn);
xn=xn-1+vx,n·Δtn+εx,n,yn=yn-1+vy,n·Δtn+εy,n;其中,εx,n和εy,n分别表示tn-1时刻与tn时刻两相邻时刻的X轴和Y轴方向的位置估计误差;
由水下滑翔机的姿态信息,水下滑翔机速度的X轴和Y轴的分量表示为:
在tn-1时刻到tn时刻之内,τn=τn-1+ετ,n,ετ,n为水下滑翔机与定位信标在tn-1时刻与tn时刻两相邻时刻的时钟漂移误差;
(3-5).定位处理模块根据测量向量、状态向量、测量方程和状态方程,完成定位解算,得到定位结果;具体是:
利用扩展卡尔曼滤波进行位置估计,包括状态预测和状态更新循环处理;
在开始一次滑翔或结束一次滑翔时,水下滑翔机浮出水面,通过卫星接收模块进行初始位置校正,然后执行状态预测和状态更新;
2.如权利要求1所述的一种基于单信标的水下滑翔机定位方法,其特征在于:所述的定位报文共128比特,依次包括:12比特的同步码SYN,用于指示定位报文的起始位;4比特的类型码TYP,用于指示定位报文的类型;8比特的标号码ADR,用于指示定位报文由哪个信标发送;8比特的保留位RES,用于控制功能的保留位;32比特的经度信息LON,32比特的纬度信息LAT,16比特的高程信息HEI;16比特的纠错冗余位FCC,用于报文的帧纠错。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010440777.5A CN111578944B (zh) | 2020-05-22 | 2020-05-22 | 一种基于单信标的水下滑翔机定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010440777.5A CN111578944B (zh) | 2020-05-22 | 2020-05-22 | 一种基于单信标的水下滑翔机定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111578944A CN111578944A (zh) | 2020-08-25 |
CN111578944B true CN111578944B (zh) | 2021-12-21 |
Family
ID=72119230
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010440777.5A Active CN111578944B (zh) | 2020-05-22 | 2020-05-22 | 一种基于单信标的水下滑翔机定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111578944B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112285652B (zh) * | 2020-10-28 | 2022-06-07 | 浙江大学 | 利用单信标虚拟到达时刻差的水下滑翔机定位方法 |
CN112393729B (zh) * | 2020-10-29 | 2021-07-16 | 国家深海基地管理中心 | 一种深海水面移动声学基准层联合导航定位***及方法 |
CN115032590B (zh) * | 2022-05-12 | 2023-06-16 | 中国人民解放军海军潜艇学院 | 基于时间信息通过单个水听器对水底声信标的定位方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109814069A (zh) * | 2019-01-22 | 2019-05-28 | 浙江大学 | 一种基于单定位信标的水下移动节点无源定位方法及其*** |
CN110865333A (zh) * | 2019-11-19 | 2020-03-06 | 浙江大学 | 洋流影响下水下滑翔机单信标无源声学定位方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5119341A (en) * | 1991-07-17 | 1992-06-02 | The United States Of America As Represented By The Secretary Of The Air Force | Method for extending GPS to underwater applications |
FR2880132B1 (fr) * | 2004-12-23 | 2007-02-02 | Thales Sa | Dispositif de determination autonome des coordonnees geographiques absolues d'un mobile evoluant en immersion |
US7512036B2 (en) * | 2005-08-16 | 2009-03-31 | Ocean Server Technology, Inc. | Underwater acoustic positioning system and method |
CN108318863B (zh) * | 2017-12-28 | 2020-11-24 | 浙江大学 | 基于海底信标的水下无人设备无源定位方法及其*** |
CN110366095B (zh) * | 2019-05-28 | 2020-06-19 | 浙江大学 | 一种水下节点分布式定位***及方法 |
-
2020
- 2020-05-22 CN CN202010440777.5A patent/CN111578944B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109814069A (zh) * | 2019-01-22 | 2019-05-28 | 浙江大学 | 一种基于单定位信标的水下移动节点无源定位方法及其*** |
CN110865333A (zh) * | 2019-11-19 | 2020-03-06 | 浙江大学 | 洋流影响下水下滑翔机单信标无源声学定位方法 |
Non-Patent Citations (1)
Title |
---|
基于单信标的水下移动节点定位技术研究;李裕隆;《中国优秀硕士学位论文全文数据库信息科技辑》;20200115(第01期);第1-59页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111578944A (zh) | 2020-08-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111578944B (zh) | 一种基于单信标的水下滑翔机定位方法 | |
Eustice et al. | Recent advances in synchronous-clock one-way-travel-time acoustic navigation | |
CN109737956A (zh) | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 | |
KR100906362B1 (ko) | 2개의 기준점에 대한 거리정보와 저정밀도 관성센서를 이용한 무인잠수정 선단의 의사 lbl 수중항법시스템 | |
CN109814069B (zh) | 一种基于单定位信标的水下移动节点无源定位方法及其*** | |
CN111366962A (zh) | 一种深远海低成本长航时协同导航定位*** | |
CN104316045A (zh) | 一种基于sins/lbl的auv水下交互辅助定位***及定位方法 | |
CN104180804A (zh) | 基于水下信息网络的单参考节点水下航行器组合导航方法 | |
Liu et al. | Time-difference-of-arrival-based localization methods of underwater mobile nodes using multiple surface beacons | |
CN107748352B (zh) | 适用于浅水定位的超短基线装置及定位方法 | |
CN110294080B (zh) | 一种利用超短基线实现水下精确作业的方法 | |
CN110865333B (zh) | 洋流影响下水下滑翔机单信标无源声学定位方法 | |
CN110389318B (zh) | 一种基于立体六元阵的水下移动平台定位***及方法 | |
CN104197939A (zh) | 基于水下信息网络的多参考节点水下航行器组合导航方法 | |
AU2005268886B2 (en) | Method for an antenna angular calibration by relative distance measuring | |
JP2018084445A (ja) | 水中音響測位システム | |
Zhang et al. | Integration of communication, positioning, navigation and timing for deep-sea vehicles | |
US11719784B2 (en) | Method for positioning underwater glider based on virtual time difference of arrival of single beacon | |
CN111142144B (zh) | 一种水声定位与授时浮标及水下定位方法 | |
CN113155134B (zh) | 一种基于惯性信息辅助的水声信道跟踪与预测方法 | |
CN117146830B (zh) | 一种自适应多信标航位推算和长基线的紧组合导航方法 | |
Crosbie et al. | Synchronous navigation of AUVs using WHOI micro-modem 13-bit communications | |
Peyronnet et al. | Posidonia 6000: a new long range highly accurate ultra short base line positioning system | |
CN116609815A (zh) | 一种海底航行器智能定位***及方法 | |
CN113176539B (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 |