CN112923924B - 一种锚泊船舶姿态与位置监测方法及*** - Google Patents
一种锚泊船舶姿态与位置监测方法及*** Download PDFInfo
- Publication number
- CN112923924B CN112923924B CN202110135135.9A CN202110135135A CN112923924B CN 112923924 B CN112923924 B CN 112923924B CN 202110135135 A CN202110135135 A CN 202110135135A CN 112923924 B CN112923924 B CN 112923924B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- ship
- sensing module
- data
- attitude
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
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)
- Navigation (AREA)
Abstract
本发明公开了一种锚泊船舶姿态与位置监测方法及***,其方法包括步骤:S1、通过设置于船舶船体外侧的多个惯导传感模块测量加速度、角速度、磁场强度、气压信息、GPS‑RTK信息,GPS‑RTK信息为全球定位卫星载波相位动态时差分信息;S2、对惯导传感模块测量得到的信息进行融合处理,以分析船舶的姿态数据和位置数据;步骤S2中包括:S2.1、采用基于梯度下降法的两级姿态更新解算算法分析船舶的实时姿态数据;S2.2、采用多个传感器融合的卡尔曼滤波算法分析船舶的实时位置数据。本发明提供了一种成本低、精度高、速度快、稳定性好的锚泊船舶姿态与位置监测***,而且不仅能准确监测船舶的实时姿态、位置数据,还能很好的预测下一时刻船舶的姿态、位置数据。
Description
技术领域
本发明属于物体姿态与位置实时监测领域,具体涉及一种锚泊船舶姿态与位置监测方法及***。
背景技术
船舶在海上锚泊时,由于受到海风、海浪和洋流等不确定性海况的影响,不可避免的会产生存在一个相耦合作用的六自由度摇荡运动,这使得船舶在海上作业具有很大的安全隐患。因此,对于容易受海况条件影响的船舶来说,船舶姿态的精确检测和位置实时更新显得尤为重要。
常用的船舶姿态监测设备有三轴加速度传感器和三轴陀螺仪,只用三轴加速度传感器采集姿态数据,具有数据单一,短时姿态监测效果差的缺点,而三轴陀螺仪测量姿态角时虽然短时精度高,但由于漂移会导致误差累计。
目前,通用的船舶姿态测量设备结构复杂、造价昂贵、体积质量大、不便于装卸等问题。而且,船舶姿态监测设备中的有关传感器都是安装于船体内,因此磁力计容易受到船体金属外壳的影响,导致磁力计测量精度下降,从而影响船舶姿态监测精度。
因此,需要设计一种利用敏感惯性传感器直接测量船舶的姿态和位置信息,并利用计算机进行姿态计算、坐标变换和位置更新的实时监测装置。通过对船舶四周扩展范围内惯导传感模块的数据实时检测,可以准确得到船舶的运动状态。利用这些得到状态数据,船舶上装有的一些运动补偿结构可以及时做出调整,这将在很大程度上提高船舶海上作业的安全性和稳定性,具有显著的社会价值、经济价值以及军事意义。
发明内容
为了解决现有设备价格高、无法提前获得船舶状态数据的缺陷,本发明的目的是设计一种成本低、精度高、速度快、稳定性好的锚泊船舶姿态与位置监测方法及***,以保证船舶正常锚泊作业安全。
本发明采用以下技术方案:一种锚泊船舶姿态与位置监测方法,包括步骤:
S1、通过设置于船舶船体外侧的多个惯导传感模块测量加速度、角速度、磁场强度、气压信息、GPS-RTK信息,GPS-RTK信息为全球定位卫星载波相位动态时差分信息;
S2、对惯导传感模块测量得到的信息进行融合处理,以分析船舶的姿态数据和位置数据;
步骤S2中包括:
S2.1、采用基于梯度下降法的两级姿态更新解算算法分析船舶的实时姿态数据;
S2.2、采用多个传感器融合的卡尔曼滤波算法分析船舶的实时位置数据。
作为优选方案,惯导传感模块包括九轴传感器单元、所述九轴传感器单元包括三轴加速度计、三轴陀螺仪、三轴磁力计;
步骤S2.1中,具体包括:
S2.1.1、根据初始时刻的加速度数据、磁场强度数据得出惯导传感模块初始时刻的姿态数据,姿态数据包括俯仰角、横滚角以及偏航角;
S2.1.2、基于梯度下降法的两级姿态更新解算算法分析惯导传感模块的实时姿态数据,具体为:第一级,根据建立的三轴陀螺仪、三轴加速度计量测模型构建第一损失函数,并采用梯度下降法对惯导传感模块的俯仰角和横滚角进行更新,第二级,根据建立的三轴磁力计量测模型构建第二损失函数,并采用梯度下降法对惯导传感模块的偏航角进行更新;
S2.1.3、根据各惯导传感模块更新后的姿态数据计算得到船舶实时姿态数据。
作为优选方案,步骤S2.2中,具体包括:
S2.2.1、根据初始时刻的GPS-RTK信息和气压信息分别得出各个惯导传感模块的地理位置坐标和所处海平面高度,从而计算得到惯导传感模块的初始位置;
S2.2.2、采用多个传感器融合的卡尔曼滤波算法分析惯导传感模块的实时位置数据,具体为:根据惯导传感模块的安装关系得到惯导传感模块的空间距离,作为距离观测量;由时间更新得到惯导传感模块的位置估计量以计算出惯导传感模块之间的距离估计量;由距离观测量减去距离估计量以得到惯导传感模块的位置误差值;在卡尔曼滤波的状态更新时,将得到的位置误差值乘以卡尔曼增益以得到更新后的状态量,利用更新后的状态量的误差修正每个惯导传感模块的位置估计量的累计误差,以得到惯导传感模块的最终位置;
S2.2.3、对步骤S2.2.2计算得到的多个惯导传感模块的最终位置取均值以得到船舶实时位置数据。
作为优选方案,步骤S2.2.2中,所述惯导传感模块的位置估计量为通过旋转四元数算法和加速度双重积分法计算得到,具体为:
根据步骤S2.1.2计算得到的俯仰角、横滚角以及偏航角计算得到四元数,并通过旋转四元数算法得到姿态转移矩阵,通过姿态转移矩阵将惯导传感模块测得的载体坐标系的三轴加速度转移成导航坐标系的三轴加速度,对导航坐标系的三轴加速度数据进行二重积分,以得到惯导传感模块的位移,在初始位置的基础上进行位移叠加进而得到惯导传感模块的位置估计量。
作为优选方案,步骤S2之后还包括:
S3、根据惯导传感模块的历史姿态数据以及历史位置数据以分别推测船舶下一时刻的姿态数据以及下一时刻的位置数据。
作为优选方案,步骤S3具体包括:
S3.1、根据惯导传感模块的历史姿态数据进行卡尔曼滤波建模以推测船舶下一时刻的姿态数据;
S3.2、根据惯导传感模块的历史位置数据进行卡尔曼滤波建模,以预测下一时刻的船舶位置数据。
相应地,还提供一种一种锚泊船舶姿态与位置监测***,基于上述的锚泊船舶姿态与位置监测方法,包括中央处理模块、多个惯导传感模块,惯导传感模块与中央处理模块连接;
惯导传感模块包括九轴传感器单元、气压测量单元、GPS-RTK测量单元和第一通信单元,中央处理模块包括第二通信单元和信息分析单元;
所述九轴传感器单元用于测量加速度、角速度、磁场强度,所述气压测量单元用于测量气压信息,所述GPS-RTK测量单元用于测量GPS-RTK信息,GPS-RTK信息为全球定位卫星载波相位动态时差分信息;
所述第一通信单元,用于将惯导传感模块测量得到的信息传输至第二通信单元;
所述信息分析单元,用于对第二通信单元接收得到的信息进行融合处理,以分析船舶的姿态数据和位置数据。
作为优选方案,所述信息分析单元包括初始姿态计算子单元、姿态更新子单元、船舶姿态计算子单元;
所述初始姿态计算子单元,用于根据初始时刻的加速度数据、磁场强度数据得出惯导传感模块初始时刻的姿态数据,姿态数据包括俯仰角、横滚角以及偏航角;
姿态更新子单元,采用基于梯度下降法的两级姿态更新解算算法分析惯导传感模块的实时姿态数据;
所述船舶姿态计算子单元,用于根据各惯导传感模块更新后的姿态数据计算得到船舶实时姿态数据。
作为优选方案,所述信息分析单元还包括初始位置计算子单元、位置更新计算子单元、船舶位置计算子单元;
所述初始位置计算子单元,用于根据初始时刻的GPS-RTK信息和气压信息分别得出各个惯导传感模块的地理位置坐标和所处海平面高度,从而计算得到惯导传感模块的初始位置;
所述位置更新计算子单元,采用多个传感器融合的卡尔曼滤波算法分析惯导传感模块的实时位置数据;
所述船舶位置计算子单元,用于对位置更新计算子单元计算得到的多个惯导传感模块的最终位置取均值以得到船舶实时位置数据。
作为优选方案,所述船舶姿态计算子单元,还用于根据惯导传感模块的历史姿态数据进行卡尔曼滤波建模以推测船舶下一时刻的姿态数据;
所述船舶位置计算子单元,还用于根据惯导传感模块的历史位置数据进行卡尔曼滤波建模,以预测下一时刻的船舶位置数据。
本发明的有益效果是:
1.本发明的姿态与位置监测方法成本低、易操作、数据采集精度高,惯导传感模块的安装方式考虑到了船体对磁力计产生磁场干扰的影响。
2.本发明通过采用微惯性与磁传感器组合测量姿态的方式,弥补了单一测量方式在测量过程中存在的不足,利用两级更新的姿态解算方法可以有效校正角速度积分带来的累计误差,提高了姿态解算精度,优化了测试效果。
3.在多个传感器测量方案的基础上,相当于增加了位置观测量来计算出位置误差,利用位置误差来补偿滤波状态量,达到了减小累计误差的目的,此方法可用于无GPS信号的环境中的船舶定位。
4、不仅能准确监测船舶的实时姿态、位置数据,还能很好的预测下一时刻船舶的姿态、位置数据。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1实施例一提供的一种锚泊船舶姿态与位置监测方法的流程图;
图2是惯导传感模块安装示意图;
图3是船舶姿态更新算法流程图;
图4是船舶位置更新算法流程图;
图5是坐标系转换示意图;
图6是实施例二提供的一种锚泊船舶姿态与位置监测***的结构示意图。
具体实施方式
以下通过特定的具体实施例说明本发明的实施方式,本领域技术人员可由本说明书所揭露的内容轻易地了解本发明的其他优点与功效。本发明还可以通过另外不同的具体实施方式加以实施或应用,本说明书中的各项细节也可以基于不同观点与应用,在没有背离本发明的精神下进行各种修饰或改变。需说明的是,在不冲突的情况下,以下实施例及实施例中的特征可以相互组合。
实施例一:
参照图1,本实施例提供一种锚泊船舶姿态与位置监测方法,包括步骤:
S1、通过设置于船舶船体外侧的多个惯导传感模块测量加速度、角速度、磁场强度、气压信息、GPS-RTK信息,GPS-RTK信息为全球定位卫星载波相位动态时差分信息;
S2、对惯导传感模块测量得到的信息进行融合处理,以分析船舶的姿态数据和位置数据;
步骤S2中包括:
S2.1、采用基于梯度下降法的两级姿态更新解算算法分析船舶的实时姿态数据;
S2.2、采用多个传感器融合的卡尔曼滤波算法分析船舶的实时位置数据。
具体的:
参照图2,本实施例以设置四个惯导传感模块为例进行说明,船体外侧周围均匀设置有四根具有一定长度的刚体,四个惯导传感模块分别固定安装于相应刚体的另一端。这样做的目的一是由于在运动过程中,船舶四周位置的线性加速度相比于中心位置的线性加速度对运动更敏感,因此在四周放置的加速度传感器可以提高测量灵敏度和精度,也可以更快的获得测量数据来推算船舶中心处的姿态和位置,预留更多预判时间;二是为了减小船体对磁力计测量模块的磁场干扰。
惯导传感模块包括九轴传感器单元、所述九轴传感器单元包括三轴加速度计、三轴陀螺仪、三轴磁力计;
进一步地,步骤S2.1中,具体包括:
S2.1.1、根据初始时刻的加速度数据、磁场强度数据得出惯导传感模块初始时刻的姿态数据,姿态数据包括俯仰角、横滚角以及偏航角;
S2.1.2、基于梯度下降法的两级姿态更新解算算法分析惯导传感模块的实时姿态数据,参照图3所示,具体为:第一级,根据建立的三轴陀螺仪、三轴加速度计量测模型构建第一损失函数,并采用梯度下降法对惯导传感模块的俯仰角θa和横滚角γa进行更新,第二级,根据建立的三轴磁力计量测模型构建第二损失函数,并采用梯度下降法对惯导传感模块的偏航角Ψm进行更新,以提高***解算精度,针对磁力计易受外界铁磁干扰问题,该算法在第二级滤波中对铁磁干扰进行实时估计并补偿,使算法具有一定的抗铁磁干扰能力;
S2.1.3、根据各惯导传感模块更新后的姿态数据计算得到船舶实时姿态数据。
进一步地,步骤S2.2中,具体包括:
S2.2.1、根据初始时刻的GPS-RTK信息和气压信息分别得出各个惯导传感模块的地理位置坐标和所处海平面高度,从而计算得到惯导传感模块的初始位置;
S2.2.2、采用多个传感器融合的卡尔曼滤波算法分析惯导传感模块的实时位置数据,参照图4所示,具体为:根据惯导传感模块的安装关系得到惯导传感模块的空间距离,作为距离观测量;由时间更新得到惯导传感模块的位置估计量以计算出惯导传感模块之间的距离估计量;由距离观测量减去距离估计量以得到惯导传感模块的位置误差值;在卡尔曼滤波的状态更新时,将得到的位置误差值乘以卡尔曼增益以得到更新后的状态量,利用更新后的状态量的误差修正每个惯导传感模块的位置估计量的累计误差,以得到惯导传感模块的最终位置;
S2.2.3、对步骤S2.2.2计算得到的多个惯导传感模块的最终位置取均值以得到船舶实时位置数据。
进一步地,步骤S2.2.2中,所述惯导传感模块的位置估计量为通过旋转四元数算法和加速度双重积分法计算得到,具体为:
根据步骤S2.1.2计算得到的俯仰角、横滚角以及偏航角计算得到四元数,并通过旋转四元数算法得到姿态转移矩阵,通过姿态转移矩阵将惯导传感模块测得的载体坐标系的三轴加速度转移成导航坐标系的三轴加速度,对导航坐标系的三轴加速度数据进行二重积分,以得到惯导传感模块的位移,在初始位置的基础上进行位移叠加进而得到惯导传感模块的位置估计量。
可参照图3、5所示,通过加速度计、陀螺仪以及磁力计数据融合,解算由载体坐标系(b系)到导航坐标系(n系)(参照图5所示)的旋转四元数算法(参照图3所示),图3中,qag,t为t时刻第1级后验姿态四元数,qmg,t为t时刻第2级后验姿态四元数,qt为t时刻后验估计四元数,F1(qt-1)为第一损失函数,F2(xt-1)为第二损失函数,xt-1为t-1时刻后验估计四元数和后验估计铁磁干扰组成的向量,p1和p2为可调参数,θa、γa分别为通过加速度计更新的横滚角和俯仰角,Ψm为通过磁力计数据更新的偏航角,表示F1(qt-1)关于qt-1求偏导后装置的结果。yg,t为陀螺仪所测数据,ya,t为加速度计所测数据,ym,t为加速度计所测数据,h为t时刻b系下所观测的当地真实地磁场。
进一步地,步骤S2之后还包括:
S3、根据惯导传感模块的历史姿态数据以及历史位置数据以分别推测船舶下一时刻的姿态数据以及下一时刻的位置数据。
步骤S3具体包括:
S3.1、根据惯导传感模块的历史姿态数据进行卡尔曼滤波建模以推测船舶下一时刻的姿态数据;
S3.2、根据惯导传感模块的历史位置数据进行卡尔曼滤波建模,以预测下一时刻的船舶位置数据。
上述载体坐标系即船舶坐标系,该坐标系为随着船舶位置变化实时变化的,导航坐标系可认为是地理坐标系为不变的。
在本实施例中,基于多个传感器融合的卡尔曼滤波的位置更新算法主要用于无GPS信号环境和辅助提升GPS定位实时性和精确性。
与现有技术相比,本发明具有以下优点:
1.本发明的姿态与位置检测方法成本低、易操作、数据采集精度高,传感器测量模块的安装考虑到了船体对磁力计产生磁场干扰的影响。
2.本发明通过采用微惯性与磁传感器组合测量姿态的方式,弥补了单一测量方式在测量过程中存在的不足,利用两级更新的姿态解算方法可以有效校正角速度积分带来的累计误差,提高了姿态解算精度,优化了测试效果。
3.在多个传感器测量方案的基础上,相当于增加了位置观测量来计算出位置误差,利用位置误差来补偿滤波状态量,达到了减小累计误差的目的,此方法可用于无GPS信号的环境中的船舶定位。
4、不仅能准确监测船舶的实时姿态、位置数据,还能很好的预测下一时刻船舶的姿态、位置数据。
实施例二:
参照图6所示,本实施例提供了一种锚泊船舶姿态与位置监测***,基于实施例一所述的锚泊船舶姿态与位置监测方法,包括中央处理模块、多个惯导传感模块,惯导传感模块与中央处理模块连接;
惯导传感模块包括九轴传感器单元、气压测量单元、GPS-RTK测量单元和第一通信单元,中央处理模块包括第二通信单元和信息分析单元;
所述九轴传感器单元用于测量加速度、角速度、磁场强度,所述气压测量单元用于测量气压信息,所述GPS-RTK测量单元用于测量GPS-RTK信息,GPS-RTK信息为全球定位卫星载波相位动态时差分信息;
所述第一通信单元,用于将惯导传感模块测量得到的信息传输至第二通信单元;
所述信息分析单元,用于对第二通信单元接收得到的信息进行融合处理,以分析船舶的姿态数据和位置数据。
具体的:
所述信息分析单元包括初始姿态计算子单元、姿态更新子单元、船舶姿态计算子单元;
所述初始姿态计算子单元,用于根据初始时刻的加速度数据、磁场强度数据得出惯导传感模块初始时刻的姿态数据,姿态数据包括俯仰角、横滚角以及偏航角;
姿态更新子单元,采用基于梯度下降法的两级姿态更新解算算法分析惯导传感模块的实时姿态数据;
所述船舶姿态计算子单元,用于根据各惯导传感模块更新后的姿态数据计算得到船舶实时姿态数据。
所述信息分析单元还包括初始位置计算子单元、位置更新计算子单元、船舶位置计算子单元;
所述初始位置计算子单元,用于根据初始时刻的GPS-RTK信息和气压信息分别得出各个惯导传感模块的地理位置坐标和所处海平面高度,从而计算得到惯导传感模块的初始位置;
所述位置更新计算子单元,采用多个传感器融合的卡尔曼滤波算法分析惯导传感模块的实时位置数据;
所述船舶位置计算子单元,用于对位置更新计算子单元计算得到的多个惯导传感模块的最终位置取均值以得到船舶实时位置数据。
所述船舶姿态计算子单元,还用于根据惯导传感模块的历史姿态数据进行卡尔曼滤波建模以推测船舶下一时刻的姿态数据;
所述船舶位置计算子单元,还用于根据惯导传感模块的历史位置数据进行卡尔曼滤波建模,以预测下一时刻的船舶位置数据。
需要说明的是,本实施例提供的一种锚泊船舶姿态与位置监测***与实施例一类似,在此不多做赘述。
以上所述的实施例仅仅是对本发明的优选实施方式进行描述,并非对本发明的范围进行限定,在不脱离本发明设计精神的前提下,本领域普通技术人员对本发明的技术方案作出的各种变形和改进,均应落入本发明的保护范围内。
Claims (8)
1.一种锚泊船舶姿态与位置监测方法,其特征在于,包括步骤:
S1、通过设置于船舶船体外侧的多个惯导传感模块测量加速度、角速度、磁场强度、气压信息、GPS-RTK信息,GPS-RTK信息为全球定位卫星载波相位动态时差分信息;
S2、对惯导传感模块测量得到的信息进行融合处理,以分析船舶的姿态数据和位置数据;
步骤S2中包括:
S2.1、采用基于梯度下降法的两级姿态更新解算算法分析船舶的实时姿态数据;
S2.2、采用多个传感器融合的卡尔曼滤波算法分析船舶的实时位置数据;
惯导传感模块包括九轴传感器单元,所述九轴传感器单元包括三轴加速度计、三轴陀螺仪、三轴磁力计;
步骤S2.1中,具体包括:
S2.1.1、根据初始时刻的加速度数据、磁场强度数据得出惯导传感模块初始时刻的姿态数据,姿态数据包括俯仰角、横滚角以及偏航角;
S2.1.2、基于梯度下降法的两级姿态更新解算算法分析惯导传感模块的实时姿态数据,具体为:第一级,根据建立的三轴陀螺仪、三轴加速度计量测模型构建第一损失函数,并采用梯度下降法对惯导传感模块的俯仰角和横滚角进行更新;第二级,根据建立的三轴磁力计量测模型构建第二损失函数,并采用梯度下降法对惯导传感模块的偏航角进行更新;
S2.1.3、根据各惯导传感模块更新后的姿态数据计算得到船舶实时姿态数据;
步骤S2.2中,具体包括:
S2.2.1、根据初始时刻的GPS-RTK信息和气压信息分别得出各个惯导传感模块的地理位置坐标和所处海平面高度,从而计算得到惯导传感模块的初始位置;
S2.2.2、采用多个传感器融合的卡尔曼滤波算法分析惯导传感模块的实时位置数据,具体为:根据惯导传感模块的安装关系得到惯导传感模块的空间距离,作为距离观测量;由时间更新得到惯导传感模块的位置估计量以计算出惯导传感模块之间的距离估计量;由距离观测量减去距离估计量以得到惯导传感模块的位置误差值;在卡尔曼滤波的状态更新时,将得到的位置误差值乘以卡尔曼增益以得到更新后的状态量,利用更新后的状态量的误差修正每个惯导传感模块的位置估计量的累计误差,以得到惯导传感模块的最终位置;
S2.2.3、对步骤S2.2.2计算得到的多个惯导传感模块的最终位置取均值以得到船舶实时位置数据。
2.根据权利要求1所述的一种锚泊船舶姿态与位置监测方法,其特征在于,步骤S2.2.2中,所述惯导传感模块的位置估计量为通过旋转四元数算法和加速度双重积分法计算得到,具体为:
根据步骤S2.1.2计算得到的俯仰角、横滚角以及偏航角计算得到四元数,并通过旋转四元数算法得到姿态转移矩阵,通过姿态转移矩阵将惯导传感模块测得的载体坐标系的三轴加速度转移成导航坐标系的三轴加速度,对导航坐标系的三轴加速度数据进行二重积分,以得到惯导传感模块的位移,在初始位置的基础上进行位移叠加进而得到惯导传感模块的位置估计量。
3.根据权利要求2所述的一种锚泊船舶姿态与位置监测方法,其特征在于,步骤S2之后还包括:
S3、根据惯导传感模块的历史姿态数据以及历史位置数据以分别推测船舶下一时刻的姿态数据以及下一时刻的位置数据。
4.根据权利要求3所述的一种锚泊船舶姿态与位置监测方法,其特征在于,步骤S3具体包括:
S3.1、根据惯导传感模块的历史姿态数据进行卡尔曼滤波建模以推测船舶下一时刻的姿态数据;
S3.2、根据惯导传感模块的历史位置数据进行卡尔曼滤波建模,以预测下一时刻的船舶位置数据。
5.一种锚泊船舶姿态与位置监测***,基于权利要求1-4任一项所述的锚泊船舶姿态与位置监测方法,其特征在于,包括中央处理模块、多个惯导传感模块,惯导传感模块与中央处理模块连接;
惯导传感模块包括九轴传感器单元、气压测量单元、GPS-RTK测量单元和第一通信单元,中央处理模块包括第二通信单元和信息分析单元;
所述九轴传感器单元用于测量加速度、角速度、磁场强度,所述气压测量单元用于测量气压信息,所述GPS-RTK测量单元用于测量GPS-RTK信息,GPS-RTK信息为全球定位卫星载波相位动态时差分信息;
所述第一通信单元,用于将惯导传感模块测量得到的信息传输至第二通信单元;
所述信息分析单元,用于对第二通信单元接收得到的信息进行融合处理,以分析船舶的姿态数据和位置数据。
6.根据权利要求5所述的一种锚泊船舶姿态与位置监测***,其特征在于,所述信息分析单元包括初始姿态计算子单元、姿态更新子单元、船舶姿态计算子单元;
所述初始姿态计算子单元,用于根据初始时刻的加速度数据、磁场强度数据得出惯导传感模块初始时刻的姿态数据,姿态数据包括俯仰角、横滚角以及偏航角;
姿态更新子单元,采用基于梯度下降法的两级姿态更新解算算法分析惯导传感模块的实时姿态数据;
所述船舶姿态计算子单元,用于根据各惯导传感模块更新后的姿态数据计算得到船舶实时姿态数据。
7.根据权利要求6所述的一种锚泊船舶姿态与位置监测***,其特征在于,所述信息分析单元还包括初始位置计算子单元、位置更新计算子单元、船舶位置计算子单元;
所述初始位置计算子单元,用于根据初始时刻的GPS-RTK信息和气压信息分别得出各个惯导传感模块的地理位置坐标和所处海平面高度,从而计算得到惯导传感模块的初始位置;
所述位置更新计算子单元,采用多个传感器融合的卡尔曼滤波算法分析惯导传感模块的实时位置数据;
所述船舶位置计算子单元,用于对位置更新计算子单元计算得到的多个惯导传感模块的最终位置取均值以得到船舶实时位置数据。
8.根据权利要求7所述的一种锚泊船舶姿态与位置监测***,其特征在于,
所述船舶姿态计算子单元,还用于根据惯导传感模块的历史姿态数据进行卡尔曼滤波建模以推测船舶下一时刻的姿态数据;
所述船舶位置计算子单元,还用于根据惯导传感模块的历史位置数据进行卡尔曼滤波建模,以预测下一时刻的船舶位置数据。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110135135.9A CN112923924B (zh) | 2021-02-01 | 2021-02-01 | 一种锚泊船舶姿态与位置监测方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110135135.9A CN112923924B (zh) | 2021-02-01 | 2021-02-01 | 一种锚泊船舶姿态与位置监测方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112923924A CN112923924A (zh) | 2021-06-08 |
CN112923924B true CN112923924B (zh) | 2023-06-30 |
Family
ID=76169190
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110135135.9A Active CN112923924B (zh) | 2021-02-01 | 2021-02-01 | 一种锚泊船舶姿态与位置监测方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112923924B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113942622B (zh) * | 2021-11-19 | 2023-11-07 | 博迈科海洋工程股份有限公司 | 适用于fpso上部模块提升安装过程的运动补偿方法 |
CN114577218B (zh) * | 2022-05-07 | 2022-08-05 | 中国人民解放军海军工程大学 | 基于磁力仪和深度计的水下运载体姿态测量方法及*** |
CN117450992B (zh) * | 2023-09-21 | 2024-05-03 | 中国海洋工程研究院(青岛) | 一种姿态与磨损监测预警方法和*** |
CN117073769A (zh) * | 2023-10-17 | 2023-11-17 | 中交第一航务工程局有限公司 | 一种全漂浮状态下船体姿态的检测装置 |
CN117970820A (zh) * | 2024-04-01 | 2024-05-03 | 南通市鸿博信息科技有限公司 | 一种基于信号传输的数字化浮筒自动系泊控制*** |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2347192C1 (ru) * | 2007-08-06 | 2009-02-20 | Валерий Наумович Нарвер | Способ и устройство определения курса объекта |
CN107796388A (zh) * | 2016-09-06 | 2018-03-13 | 北京自动化控制设备研究所 | 一种基于惯性技术的相对姿态测量方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120086598A1 (en) * | 2010-10-08 | 2012-04-12 | Canadian Space Agency | Apparatus and methods for driftless attitude determination and reliable localization of vehicles |
CN104197927B (zh) * | 2014-08-20 | 2017-06-23 | 江苏科技大学 | 水下结构检测机器人实时导航***及方法 |
CN107390247A (zh) * | 2017-07-27 | 2017-11-24 | 河南省科学院应用物理研究所有限公司 | 一种导航方法、***及导航终端 |
CN109001787B (zh) * | 2018-05-25 | 2022-10-21 | 北京大学深圳研究生院 | 一种姿态角解算与定位的方法及其融合传感器 |
CN109612471B (zh) * | 2019-02-02 | 2021-06-25 | 北京理工大学 | 一种基于多传感器融合的运动体姿态解算方法 |
CN109916394A (zh) * | 2019-04-04 | 2019-06-21 | 山东智翼航空科技有限公司 | 一种融合光流位置和速度信息的组合导航算法 |
-
2021
- 2021-02-01 CN CN202110135135.9A patent/CN112923924B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2347192C1 (ru) * | 2007-08-06 | 2009-02-20 | Валерий Наумович Нарвер | Способ и устройство определения курса объекта |
CN107796388A (zh) * | 2016-09-06 | 2018-03-13 | 北京自动化控制设备研究所 | 一种基于惯性技术的相对姿态测量方法 |
Non-Patent Citations (2)
Title |
---|
ANCHOR: Navigation, Routing and Collision Warning during Operations in Harbors;AndreasTrzuskowsky 等;IFAC;第220–225页 * |
一种微惯性与磁组合测量单元的姿态解算方法;严丹;邓志红;张雁鹏;;兵工学报;第40卷(第12期);第2447-2456页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112923924A (zh) | 2021-06-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112923924B (zh) | 一种锚泊船舶姿态与位置监测方法及*** | |
CN109916395B (zh) | 一种姿态自主冗余组合导航算法 | |
US8577595B2 (en) | Location and path-map generation data acquisition and analysis systems | |
CN106500693B (zh) | 一种基于自适应扩展卡尔曼滤波的ahrs算法 | |
CN109931926A (zh) | 一种基于站心坐标系的小型无人机无缝自主式导航算法 | |
US10209159B2 (en) | Displacement detecting device for structural object, sharing system of displacement of structural object, and method and program of detecting displacement of structural object | |
CN109540135B (zh) | 水田拖拉机位姿检测和偏航角提取的方法及装置 | |
CN104880189B (zh) | 一种动中通天线低成本跟踪抗干扰方法 | |
CN110926468A (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN103175502A (zh) | 一种基于数据手套低速运动的姿态角检测方法 | |
US11408735B2 (en) | Positioning system and positioning method | |
CN103852081A (zh) | 用于大气数据/捷联惯导组合导航***的真空速解算方法 | |
CN109764870B (zh) | 基于变换估计量建模方案的载体初始航向估算方法 | |
CN108801250B (zh) | 基于水下机器人的实时姿态获取方法及装置 | |
CN110986997A (zh) | 一种提高室内惯性导航精度的方法及*** | |
CN112556724A (zh) | 动态环境下的微型飞行器低成本导航***初始粗对准方法 | |
CN108444468B (zh) | 一种融合下视视觉与惯导信息的定向罗盘 | |
CN109827580A (zh) | 一种汽车姿态数据采集*** | |
CN111141286A (zh) | 一种无人机飞控多传感器姿态置信解算方法 | |
CN104748734A (zh) | 一种带倾角补偿的车载电子海拔罗盘仪 | |
CN103192958B (zh) | 船舶姿态显示装置的控制方法 | |
CN115356965B (zh) | 一种松散耦合实装数据采集装置及数据处理方法 | |
CN111812737A (zh) | 水下导航与重力测量一体化*** | |
CN114659496B (zh) | 一种用于船载北斗一体机倾斜监测的方法 | |
CN116660579A (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 |