CN104197927A - 水下结构检测机器人实时导航***及方法 - Google Patents
水下结构检测机器人实时导航***及方法 Download PDFInfo
- Publication number
- CN104197927A CN104197927A CN201410413791.0A CN201410413791A CN104197927A CN 104197927 A CN104197927 A CN 104197927A CN 201410413791 A CN201410413791 A CN 201410413791A CN 104197927 A CN104197927 A CN 104197927A
- Authority
- CN
- China
- Prior art keywords
- navigation
- value
- gyroscope
- speed
- depth
- 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
- 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/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种水下结构检测机器人实时导航***及方法。所述导航***包括磁罗盘、陀螺仪、加速度计、深度计、导航微处理器,所述磁罗盘、陀螺仪、加速度计和深度计分别采集磁场强度、角速度、线速度和下潜深度数据,传输至导航微处理器,所述导航微处理器根据采集数据解算水下机器人的姿态和位置。所述导航方法包括姿态算法、速度算法和深度算法,所述姿态算法结合互补滤波、四元数梯度下降法和卡尔曼算法获取姿态矩阵和姿态角,所述速度算法采用带有旋转补偿的三阶迎风格式求解机器人速度和位置,所述深度算法运用滑动平均滤波处理深度计数据,获得下潜深度。本发明降低了导航成本并获得较好的导航精度。
Description
技术领域
本发明涉及一种水下机器人实时导航技术,尤其涉及一种应用于海洋工程的水下结构检测的机器人导航***及方法。
背景技术
远程遥控水下机器人(Remotely Operated Vehicle,ROV)是一种通过脐带电缆与水面支持平台联系的水下作业机器人,由水面控制***和水下潜航体两部分组成,被广泛应用于水下观察、海底勘探、水下结构检修、海底管线检测以及水下安装等作业,已经成为海洋工程水下结构安全检测及维护的关键装备。
精确导航是水下结构检测机器人的重要内容,为水下结构物检测提供必要的技术支撑。现有的水下导航技术,例如水下声学导航、惯性导航、利用声波影像、光学等的视觉导航方法,都可直接应用在潜水器上,但都有各自的缺点。组合导航是将多导航***组合构成的性能更为完善的导航***,可以取长补短,提高导航精度,是未来导航技术的发展方向。目前,水下导航大多以惯性导航为主,辅以其他导航设备如多普勒速度记录仪(DVL)、磁航向仪(MCP)和GPS等,但是这些设备或者体积庞大,或者水下导航性能欠佳,或者成本高昂,具有明显的缺陷。
采用基于微机电***(MEMS)的导航设备,组合惯性组件如磁罗盘、深度计等器件,改善现有的导航算法,可以最大程度上减小积累误差,抑制姿态角误差,取得良好的满足水下检测机器人需求的导航效果。申请号为“2013100128123”的专利文献公开了一种“水下机器人的线地形匹配导航方法”,但可靠性较低,导航延迟大;申请号为“2012103320229”的专利文献公开了一种“自主式水下机器人组合导航***及方法”,其导航***结构复杂,成本高昂,且GPS不适用于水下导航。
发明内容
本发明的目的是提供一种水下结构检测机器人实时导航***及方法,为水下结构物检测ROV设计出实用的导航***,提高精度的同时降低成本。
本发明的目的通过以下技术方案予以实现:
一种水下结构检测机器人导航***,包括磁罗盘1、陀螺仪2、加速度计3、深度计4、导航微处理器5,所述磁罗盘1、陀螺仪2、加速度计3和深度计4分别采集水下机器人磁场强度、角速度、线速度和下潜深度数据,传输至导航微处理器5;所述导航微处理器5对磁罗盘1、陀螺仪2、加速度计3、深度计4采集的数据进行A/D转换;所述导航微处理器5结合四元数梯度下降法、互补滤波、卡尔曼算法对磁罗盘1、陀螺仪2、加速度计3采集的数据进行数据融合,获取姿态矩阵和姿态角;所述导航微处理器5对陀螺仪2、加速度计3采集的数据采用带有旋转补偿的三阶迎风算法求解速度和位置;所述导航微处理器5对深度计采用滑动平均滤波求取水下机器人下潜深度,得到组合导航信息。
一种水下结构检测机器人导航方法,以四元数和角误差为滤波估计对象,首先进行互补滤波,对陀螺仪测量值作初步补偿;其次运用梯度下降法更新四元数,有效降低姿态角漂移;再进行卡尔曼滤波,采用矩阵中的UD分解方法,避免滤波器发散,得到水下机器人姿态矩阵和姿态角;然后对加速度计和陀螺仪数据运用三阶迎风算法求解速度和位置。同时,对深度计采集数据进行滑动平均滤波,得到水下机器人深度值,水下机器人的垂向位置以此为准。该方法包括以下步骤:
1)姿态、速度、位置解算,过程如下:
(1)水下机器人导航***采用的离散卡尔曼方程为:
Xk=Φk,k-1Xk-1+Wk-1
Zk=HkXk+Vk
式中,k表示***离散采样时间点,k≥0;Xk为k时刻的***估计状态量;Φk,k-1为Xk-1到Xk的一步转移矩阵;Wk-1为***激励高斯白噪声序列,均值为E[w(k)]=0,方差为E[w(k)w(k)T]=Qk,Qk即***噪声方差;Zk为k时刻的传感器量测值;Hk为量测矩阵,反应量测量和估计量之间的数学关系;Vk为量测值高斯白噪声序列,均值为E[v(k)]=0,方差为E[v(k)v(k)T]=Rk,Rk即测量噪声方差;Wk、Vk互不相关;
(2)确定参数初始状态,包括:
当地重力加速度g,***采样时间t,角速度误差Δω1、Δω2、Δω3,互补滤波参数kp、ki,被估计状态量初值估计均方误差矩阵初值P0|0;其中kp、ki取值规则为:kp+ki=1,0.95<kp<1,通过多次试验确定最优值;P0|0按如下取值:设定导航坐标系为东北天坐标系,记为n系;设定机体坐标系为b系,初始时刻与导航坐标系重合,n系和b系均为三轴正交坐标系;四元数表示坐标旋转关系Q=[q0,q1,q2,q3],其中q0为旋转标量,q1、q2、q3为坐标旋转矢量,用四元数表述n系到b系转换关系表示为:
而b系到n系为rij(1≤i,j≤3)表示矩阵中各元素值;
(3)利用陀螺仪和磁罗盘、加速度计的频域互补特性校正角速度矢量,过程如下:
设磁罗盘测量值为mb,加速度计测量值为a,陀螺仪测量值为ω,mb、a、ω均为3×1列矩阵;
首先把磁场量由机体坐标系转换到导航坐标系 并计算水平和垂直方向磁场:by=0、bz=mnz;
然后把磁场转换到机体坐标系: 并利用第三列估计重力加速度矢量:
再计算加速度和磁场补偿误差:
式中,“×”表示向量乘法;
得到累积误差为:errInt=Ki∑err*t;
最后得到校正之后的角速度矢量:ωc=ω+kp*err+errInt
其中,Ki、Kp是互补滤波参数;
(4)利用梯度下降法更新四元数:
由得到新四元数q0、q1、q2、q3,其中,μ是梯度下降的步长值,由确定; d为传感器基于机体坐标系的测量值,s为传感器基于导航坐标系的实际值,“*”表示伴随矩阵,“”为梯度乘法,“ο”为四元数乘法;
(5)基于UD分解的卡尔曼滤波过程依次为:
状态一步预测:
UD分解:HkPk/k-1Hk T+R=U∧D;
一步预测均方误差:Pk/k-1=Φk,k-1Pk-1/k-1Φk/k-1 T+Qk-1;
计算滤波增益:Kk=Pk/k-1Hk T(HkPk/k-1Hk T+R)-1=Pk/k-1Hk T(UDUT)-1;
计算新息(新息由最新量测值计算获得):
状态估值计算:
估计均方误差:Pk/k=(I-KkHk)Pk/k-1;
(6)运用三阶迎风格式求解速度和位置,并进行旋转补偿,按如下过程计算:
设加速度计在k时刻、k-1时刻、k-2时刻的测量值分别为ak、ak-1、ak-2,陀螺仪在k时刻、k-1时刻、k-2时刻的测量值分别为ωk、ωk-1、ωk-2,令T=2t,则Tm、Tm-1、Tm-2时刻的速度分别设为vm、vm-1、vm-2,Tm、Tm-1时刻的位置分别为Pm、Pm-1;
首先计算两个采样时刻的速度增量和角增量:
速度增量为
角增量为
然后采用三阶迎风格式求解速度和位置:
速度为
位置为
式中,即为旋转补偿部分,“×”表示向量乘法;
2)深度计解算
对深度计采用等权端点平滑作滑动平均滤波,计算水下机器人下潜深度:
不断逐个滑动地去取m个相邻数据作算数平均计算,式中,di是深度计采集的第i个数据,depth为滤波后的深度值。
本发明的目的还可以通过以下技术措施进一步予以实现:
前述水下结构检测机器人导航***,其中磁罗盘1采用Honeywell公司的电子罗盘IC HMC5883L。
前述水下结构检测机器人导航***,其中陀螺仪2、加速度计3是InvenSense公司生产的微机电(MEMS)产品。
前述水下结构检测机器人导航***,其中深度计4是扩散硅型压力变送器,在100m量程范围内具有良好的精度。
前述水下结构检测机器人导航***,其中导航微处理器5采用基于ARMCortexTM-M3内核的STM32F103T8。
与现有技术相比,本发明的有益效果是:与现有的导航***及算法相比,采用基于梯度下降法的四元数更新算法,有效降低姿态漂移;对扩展卡尔曼滤波算法,采用矩阵中的UD分解方法,有效抑制滤波器发散。
附图说明
图1为本发明导航***结构图;
图2为本发明导航方法解算流程图;
图3为本发明四元数梯度下降法原理图;
图4为本发明卡尔曼滤波原理图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明。
本发明的基本思想是,基于微机电设备,利用四元数梯度下降法、互补滤波、卡尔曼滤波融合导航信息获得水下机器人的姿态信息,运用三阶迎风格式求解水下机器人的速度和位置,采用滑动平均滤波计算水下机器人下潜深度,可以在一定程度上降低成本、提高精度。
如图1所示,一种水下结构检测机器人导航***,由磁罗盘1、陀螺仪2、加速度计3、深度计4、导航微处理器5组成,所述磁罗盘1、陀螺仪2、加速度计3和深度计4分别采集水下机器人磁场强度、角速度、线速度和下潜深度数据,传输至导航微处理器5,其中磁罗盘1、陀螺仪2、加速度计3是三轴传感器,深度计4是基于水压测量深度的器件;所述导航微处理器5对磁罗盘1、陀螺仪2、加速度计3、深度计4采集数据进行16位A/D转换,进行数据融合、滤波,解算出水下机器人的姿态角、速度和位置,并传输至图1中的水下微控制器6。其中磁罗盘1采用的是Honeywell电子罗盘IC HMC5883L,陀螺仪2、加速度计3是InvenSense公司生产的微机电(MEMS)产品,深度计4是扩散硅型压力变送器,在100m量程范围内具有良好的精度,导航微处理器5采用基于ARM CortexTM-M3内核的STM32F103T8。
如图2所示,一种水下结构检测机器人导航方法,对磁罗盘、陀螺仪、加速度计、深度计采集数据进行数据融合。首先对卡尔曼初始化,对四元数初始化,对采样时间、重力加速度初始化。然后进行互补滤波,对陀螺仪测量值角加速度作初步补偿;运用梯度下降法更新四元数,有效降低姿态角漂移;进行卡尔曼滤波,采用矩阵中的UD分解方法,抑制滤波器的发散,得到水下机器人姿态和位置;对加速度计和陀螺仪数据运用三阶迎风格式求解速度和位置。同时,对深度计采集数据进行滑动平均滤波,得到水下机器人深度值,水下机器人的垂向位置以此为准。如图2所示,结合具体实施例,实现步骤如下:
1.参数初始化:当地重力加速度g=9.79973,采样时间t=0.02s,四元数初值q0=1,q1=0,q2=0,q3=0,角速度误差Δω1=0,Δω2=0,Δω3=0;根据互补滤波原理,确定滤波参数kp=0.0132,ki=0.9868;***噪声方差Qk和测量噪声方差Rk为:
Q=diag([0.0001 0.0001 0.0001 0.0001 0.005 0.005 0.005])
R=diag([0.005 0.005 0.005 0.003 0.003 0.003])
估计均方误差矩阵初值:
P0/0=diag([0.001 0.001 0.001 0.001 0.005 0.005 0.005])
被估计矢量初值:
设定导航坐标系为东北天坐标系,记为n系;设定机体坐标系为b系,初始与导航坐标系重合,四元数表述n系到b系转换关系表示为:
式中,表示从导航坐标系到机体坐标系的转换,表示从机体坐标系到导航坐标系的转换。
2.利用陀螺仪和加速度计、磁罗盘频域互补的思想,对角加速度补偿:
设磁罗盘测量值为mb,加速度计测量值为a,陀螺仪测量值为ω,mb、a、ω均为3×1列矩阵。
1)把磁场量由机体坐标系转换到导航坐标系 然后
计算水平和垂直方向磁场:by=0;bz=mnz;
2)把磁场转换到机体坐标系:
3)利用第三列估计重力加速度矢量:
4)计算加速度和磁场补偿误差:由此得到累积误差为:errInt=Ki*∑err*t;
5)最后得到校正之后的角速度矢量:ωc=ω+kp*err+errInt。
3.如图3所示,采用梯度下降法更新四元数:
1)定义相关变量
加速度测量值,机体坐标系内表示;
磁场强度测量值,机体坐标系内表示;
2)误差函数
根据式 可得
3)目标误差函数
将上述两个误差函数合成一个,这里用平方和取标量值,得到
f(a,h)=|a|2+|h|2,此时函数值大于等于0。
4)梯度
5)四元数更新
步长μ设置为梯度长度的0.041倍,更新方程为
6)最后对四元数归一化,得到新的四元数:
4.基于UD分解的扩展卡尔曼滤波,如图4所示,滤波过程依次为:
状态一步预测:
UD分解:HkPk/k-1Hk T+R=U∧D;
一步预测均方误差:Pk/k-1=Φk,k-1Pk-1/k-1Φk/k-1 T+Qk-1;
计算滤波增益:Kk=Pk/k-1Hk T(HkPk/k-1Hk T+R)-1=Pk/k-1Hk T(UDUT)-1;
计算新息:
状态估值计算:
估计均方误差:Pk/k=(I-KkHk)Pk/k-1。
反复循环更新。
式中,
5.每完成一次数据融合,计算一次姿态矩阵:
由上式可计算出水下机器人姿态角;
ψ=arctan(r12/r22)
θ=arcsinr32
γ=arctan(-r31/r33)
6.运用三阶迎风格式求解速度和位置,并进行旋转补偿,按如下过程计算:
设加速度计在k时刻、k-1时刻、k-2时刻的测量值分别为ak、ak-1、ak-2,陀螺仪在k时刻、k-1时刻、k-2时刻的测量值分别为ωk、ωk-1、ωk-2,令T=2t,则Tm、Tm-1、Tm-2时刻的速度分别设为vm、vm-1、vm-2,Tm、Tm-1时刻的位置分别为Pm、Pm-1。
首先计算两个采样时刻的速度增量和角增量:
速度增量为
角增量为
然后采用三阶迎风格式求解速度和位置:
速度为
位置为
式中,即为旋转补偿部分,“×”表示向量乘法。
7.对深度计采用等权端点平滑作滑动平均滤波,计算下潜深度:
不断逐个滑动地去取m个相邻数据作算数平均计算。式中,di是深度计采集的第i个数据,depth为滤波后的深度值。
除上述实施例外,本发明还可以有其他实施方式,凡采用等同替换或等效变换形成的技术方案,均落在本发明要求的保护范围内。
Claims (6)
1.一种水下结构检测机器人导航***,包括磁罗盘(1)、陀螺仪(2)、加速度计(3)、深度计(4)、导航微处理器(5),其特征在于,所述磁罗盘(1)、陀螺仪(2)、加速度计(3)和深度计(4)分别采集水下机器人磁场强度、角速度、线速度和下潜深度数据,传输至导航微处理器(5);所述导航微处理器(5)对磁罗盘(1)、陀螺仪(2)、加速度计(3)、深度计(4)采集的数据进行A/D转换;所述导航微处理器(5)结合四元数梯度下降法、互补滤波、卡尔曼算法对磁罗盘(1)、陀螺仪(2)、加速度计(3)采集的数据进行数据融合,获取姿态矩阵和姿态角;所述导航微处理器(5)对陀螺仪(2)、加速度计(3)采集的数据采用带有旋转补偿的三阶迎风算法求解速度和位置;所述导航微处理器(5)对深度计采用滑动平均滤波求取水下机器人下潜深度,得到组合导航信息。
2.如权利要求1所述水下结构检测机器人导航***,其特征在于,所述磁罗盘(1)采用Honeywell公司的电子罗盘IC HMC5883L。
3.如权利要求1所述水下结构检测机器人导航***,其特征在于,所述陀螺仪(2)、加速度计(3)是InvenSense公司生产的微机电产品。
4.如权利要求1所述水下结构检测机器人导航***,其特征在于,所述深度计(4)是扩散硅型压力变送器,在100m量程范围内具有良好的精度。
5.如权利要求1所述水下结构检测机器人导航***,其特征在于,所述导航微处理器(5)采用基于ARM CortexTM-M3内核的STM32F103T8。
6.如权利要求1所述水下结构检测机器人导航***的导航方法,其特征在于,以四元数和角误差为滤波估计对象,首先进行互补滤波,对陀螺仪测量值作初步补偿;其次运用梯度下降法更新四元数,有效降低姿态角漂移;再进行卡尔曼滤波,采用矩阵中的UD分解方法,避免滤波器发散,得到水下机器人姿态矩阵和姿态角;然后对加速度计和陀螺仪数据运用三阶迎风算法求解速度和位置。同时,对深度计采集数据进行滑动平均滤波,得到水下机器人深度值,水下机器人的垂向位置以此为准。该方法包括以下步骤:
1)姿态、速度、位置解算,过程如下:
(1)水下机器人导航***采用的离散卡尔曼方程为:
Xk=Φk,k-1Xk-1+Wk-1
Zk=HkXk+Vk
式中,k表示***离散采样时间点,k≥0;Xk为k时刻的***估计状态量;Φk,k-1为Xk-1到Xk的一步转移矩阵;Wk-1为***激励高斯白噪声序列,均值为E[w(k)]=0,方差为E[w(k)w(k)T]=Qk,Qk即***噪声方差;Zk为k时刻的传感器量测值;Hk为量测矩阵,反应量测量和估计量之间的数学关系;Vk为量测值高斯白噪声序列,均值为E[v(k)]=0,方差为E[v(k)v(k)T]=Rk,Rk即测量噪声方差;Wk、Vk互不相关;
(2)确定参数初始状态,包括:
当地重力加速度g,***采样时间t,角速度误差Δω1、Δω2、Δω3,互补滤波参数kp、ki,被估计状态量初值估计均方误差矩阵初值P0|0;其中kp、ki取值规则为:kp+ki=1,0.95<kp<1,通过多次试验确定最优值;P0|0按如下取值:设定导航坐标系为东北天坐标系,记为n系;设定机体坐标系为b系,初始时刻与导航坐标系重合,n系和b系均为三轴正交坐标系;四元数表示坐标旋转关系Q=[q0,q1,q2,q3],其中q0为旋转标量,q1、q2、q3为坐标旋转矢量,用四元数表述n系到b系转换关系表示为:
而b系到n系为rij(1≤i,j≤3)表示矩阵中各元素值;
(3)利用陀螺仪和磁罗盘、加速度计的频域互补特性校正角速度矢量,过程如下:
设磁罗盘测量值为mb,加速度计测量值为a,陀螺仪测量值为ω,mb、a、ω均为3×1列矩阵;
首先把磁场量由机体坐标系转换到导航坐标系 并计算水平和垂直方向磁场:by=0、bz=mnz;
然后把磁场转换到机体坐标系: 并利用第三列估计重力加速度矢量:
再计算加速度和磁场补偿误差:
式中,“×”表示向量乘法;
得到累积误差为:errInt=Ki∑err*t;
最后得到校正之后的角速度矢量:ωc=ω+kp*err+errInt
其中,Ki、Kp是互补滤波参数;
(4)利用梯度下降法更新四元数:
由得到新四元数q0、q1、q2、q3,其中,μ是梯度下降的步长值,由确定; d为传感器基于机体坐标系的测量值,s为传感器基于导航坐标系的实际值,“*”表示伴随矩阵,“”为梯度乘法,“ο”为四元数乘法;
(5)基于UD分解的卡尔曼滤波过程依次为:
状态一步预测:
UD分解:HkPk/k-1Hk T+R=U∧D;
一步预测均方误差:Pk/k-1=Φk,k-1Pk-1/k-1Φk/k-1 T+Qk-1;
计算滤波增益:Kk=Pk/k-1Hk T(HkPk/k-1Hk T+R)-1=Pk/k-1Hk T(UDUT)-1;
计算新息(新息由最新量测值计算获得):
状态估值计算:
估计均方误差:Pk/k=(I-KkHk)Pk/k-1;
(6)运用三阶迎风格式求解速度和位置,并进行旋转补偿,按如下过程计算:
设加速度计在k时刻、k-1时刻、k-2时刻的测量值分别为ak、ak-1、ak-2,陀螺仪在k时刻、k-1时刻、k-2时刻的测量值分别为ωk、ωk-1、ωk-2,令T=2t,则Tm、Tm-1、Tm-2时刻的速度分别设为vm、vm-1、vm-2,Tm、Tm-1时刻的位置分别为Pm、Pm-1;
首先计算两个采样时刻的速度增量和角增量:
速度增量为
角增量为
然后采用三阶迎风格式求解速度和位置:
速度为
位置为
式中,即为旋转补偿部分,“×”表示向量乘法;
2)深度计解算
对深度计采用等权端点平滑作滑动平均滤波,计算水下机器人下潜深度:
不断逐个滑动地去取m个相邻数据作算数平均计算,式中,di是深度计采集的第i个数据,depth为滤波后的深度值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410413791.0A CN104197927B (zh) | 2014-08-20 | 2014-08-20 | 水下结构检测机器人实时导航***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410413791.0A CN104197927B (zh) | 2014-08-20 | 2014-08-20 | 水下结构检测机器人实时导航***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104197927A true CN104197927A (zh) | 2014-12-10 |
CN104197927B CN104197927B (zh) | 2017-06-23 |
Family
ID=52083255
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410413791.0A Expired - Fee Related CN104197927B (zh) | 2014-08-20 | 2014-08-20 | 水下结构检测机器人实时导航***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104197927B (zh) |
Cited By (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104898669A (zh) * | 2015-04-30 | 2015-09-09 | 贺杰 | 一种基于惯性传感器进行虚拟现实行走控制的方法及*** |
CN105619394A (zh) * | 2016-02-29 | 2016-06-01 | 青岛海山海洋装备有限公司 | 一种基于误差四元数反馈的rov姿态控制方法 |
CN105651242A (zh) * | 2016-04-05 | 2016-06-08 | 清华大学深圳研究生院 | 一种基于互补卡尔曼滤波算法计算融合姿态角度的方法 |
CN105910606A (zh) * | 2016-06-20 | 2016-08-31 | 天津大学 | 一种基于角速度差值的方向修正方法 |
CN106054607A (zh) * | 2016-06-17 | 2016-10-26 | 江苏科技大学 | 水下检测与作业机器人动力定位方法 |
CN106370178A (zh) * | 2015-07-21 | 2017-02-01 | 阿里巴巴集团控股有限公司 | 移动终端设备的姿态测量方法及装置 |
CN106500721A (zh) * | 2016-09-27 | 2017-03-15 | 哈尔滨工程大学 | 一种水下机器人双冗余姿态检测*** |
CN107014374A (zh) * | 2017-01-03 | 2017-08-04 | 东南大学 | 一种基于互补滤波的水下滑翔器节能算法 |
CN107560613A (zh) * | 2017-08-15 | 2018-01-09 | 江苏科技大学 | 基于九轴惯性传感器的机器人室内轨迹跟踪***及方法 |
CN107577158A (zh) * | 2017-09-22 | 2018-01-12 | 哈尔滨工程大学 | 水下作业级rov的导航仿真***及其控制方法 |
CN107883951A (zh) * | 2017-10-19 | 2018-04-06 | 福建海图智能科技有限公司 | 一种水下机器人三维姿态的计算方法及终端 |
CN108037658A (zh) * | 2017-11-15 | 2018-05-15 | 东莞市松迪智能机器人科技有限公司 | 一种基于导航***的机器人运行误差的纠偏方法 |
CN108398128A (zh) * | 2018-01-22 | 2018-08-14 | 北京大学深圳研究生院 | 一种姿态角的融合解算方法和装置 |
CN108731664A (zh) * | 2018-05-18 | 2018-11-02 | 深圳清创新科技有限公司 | 机器人状态估计方法、装置、计算机设备和存储介质 |
CN108801260A (zh) * | 2018-05-07 | 2018-11-13 | 约肯机器人(上海)有限公司 | 基于水下机器人的数据处理方法及装置 |
CN108801250A (zh) * | 2018-05-07 | 2018-11-13 | 约肯机器人(上海)有限公司 | 基于水下机器人的实时姿态获取方法及装置 |
CN108803673A (zh) * | 2018-05-07 | 2018-11-13 | 约肯机器人(上海)有限公司 | 定向控制方法和装置 |
CN109238262A (zh) * | 2018-11-05 | 2019-01-18 | 珠海全志科技股份有限公司 | 一种航向姿态解算及罗盘校准抗干扰方法 |
CN110540118A (zh) * | 2019-06-21 | 2019-12-06 | 浙江大学 | 一种用于检测轿厢运动状态的智能检测装置 |
CN111141283A (zh) * | 2020-01-19 | 2020-05-12 | 杭州十域科技有限公司 | 一种通过地磁数据判断行进方向的方法 |
CN111551168A (zh) * | 2020-04-30 | 2020-08-18 | 江苏帝一集团有限公司 | 一种水下机器人位姿数据采集***及其数据融合方法 |
CN112363169A (zh) * | 2020-10-27 | 2021-02-12 | 哈尔滨工程大学 | 全海深水下机器人及其定位方法 |
CN112693985A (zh) * | 2020-12-10 | 2021-04-23 | 太原理工大学 | 一种融合传感器数据的非侵入式电梯状态监测方法 |
CN112710309A (zh) * | 2020-12-08 | 2021-04-27 | 中国石油大学胜利学院 | 航姿参数估计方法 |
CN112824830A (zh) * | 2019-11-21 | 2021-05-21 | 中国石油天然气集团有限公司 | 水下管道定位方法及装置 |
CN112923924A (zh) * | 2021-02-01 | 2021-06-08 | 杭州电子科技大学 | 一种锚泊船舶姿态与位置监测方法及*** |
CN114440871A (zh) * | 2021-12-29 | 2022-05-06 | 宜昌测试技术研究所 | 一种基于自适应互补滤波的九轴磁罗盘数据融合方法 |
CN114770598B (zh) * | 2022-04-08 | 2024-01-26 | 上海中车艾森迪海洋装备有限公司 | 水下机器人姿态估算方法、装置、电子设备及存储介质 |
CN118129695A (zh) * | 2024-05-07 | 2024-06-04 | 浙江智强东海发展研究院有限公司 | 一种水下采集装置的控制方法及芯片 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0989543A (ja) * | 1995-09-21 | 1997-04-04 | Ishikawajima Harima Heavy Ind Co Ltd | 水中検査装置の位置決め方法 |
RU2344435C1 (ru) * | 2007-05-08 | 2009-01-20 | Институт проблем морских технологий Дальневосточного отделения Российской академии наук (ИПМТ ДВО РАН) | Способ навигационного обеспечения автономного подводного робота, контролируемого с борта обеспечивающего судна |
WO2011020096A1 (en) * | 2009-08-14 | 2011-02-17 | IPOZ Systems, LLC | Device, program product and computer implemented method for touchless metrology using an inertial navigation system and laser |
CN102052923A (zh) * | 2010-11-25 | 2011-05-11 | 哈尔滨工程大学 | 一种小型水下机器人组合导航***及导航方法 |
CN102829777A (zh) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | 自主式水下机器人组合导航***及方法 |
CN103047984A (zh) * | 2013-01-14 | 2013-04-17 | 哈尔滨工程大学 | 水下机器人的线地形匹配导航方法 |
-
2014
- 2014-08-20 CN CN201410413791.0A patent/CN104197927B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0989543A (ja) * | 1995-09-21 | 1997-04-04 | Ishikawajima Harima Heavy Ind Co Ltd | 水中検査装置の位置決め方法 |
RU2344435C1 (ru) * | 2007-05-08 | 2009-01-20 | Институт проблем морских технологий Дальневосточного отделения Российской академии наук (ИПМТ ДВО РАН) | Способ навигационного обеспечения автономного подводного робота, контролируемого с борта обеспечивающего судна |
WO2011020096A1 (en) * | 2009-08-14 | 2011-02-17 | IPOZ Systems, LLC | Device, program product and computer implemented method for touchless metrology using an inertial navigation system and laser |
CN102052923A (zh) * | 2010-11-25 | 2011-05-11 | 哈尔滨工程大学 | 一种小型水下机器人组合导航***及导航方法 |
CN102829777A (zh) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | 自主式水下机器人组合导航***及方法 |
CN103047984A (zh) * | 2013-01-14 | 2013-04-17 | 哈尔滨工程大学 | 水下机器人的线地形匹配导航方法 |
Non-Patent Citations (1)
Title |
---|
宋振华: "水下机器人自主导航***的研究", 《中国优秀博硕士学位论文全文数据库·信息科技辑》 * |
Cited By (41)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104898669A (zh) * | 2015-04-30 | 2015-09-09 | 贺杰 | 一种基于惯性传感器进行虚拟现实行走控制的方法及*** |
CN106370178A (zh) * | 2015-07-21 | 2017-02-01 | 阿里巴巴集团控股有限公司 | 移动终端设备的姿态测量方法及装置 |
CN105619394A (zh) * | 2016-02-29 | 2016-06-01 | 青岛海山海洋装备有限公司 | 一种基于误差四元数反馈的rov姿态控制方法 |
CN105651242A (zh) * | 2016-04-05 | 2016-06-08 | 清华大学深圳研究生院 | 一种基于互补卡尔曼滤波算法计算融合姿态角度的方法 |
CN105651242B (zh) * | 2016-04-05 | 2018-08-24 | 清华大学深圳研究生院 | 一种基于互补卡尔曼滤波算法计算融合姿态角度的方法 |
CN106054607A (zh) * | 2016-06-17 | 2016-10-26 | 江苏科技大学 | 水下检测与作业机器人动力定位方法 |
CN106054607B (zh) * | 2016-06-17 | 2019-02-12 | 江苏科技大学 | 水下检测与作业机器人动力定位方法 |
CN105910606A (zh) * | 2016-06-20 | 2016-08-31 | 天津大学 | 一种基于角速度差值的方向修正方法 |
CN105910606B (zh) * | 2016-06-20 | 2019-01-29 | 天津大学 | 一种基于角速度差值的方向修正方法 |
CN106500721A (zh) * | 2016-09-27 | 2017-03-15 | 哈尔滨工程大学 | 一种水下机器人双冗余姿态检测*** |
CN107014374B (zh) * | 2017-01-03 | 2020-04-21 | 东南大学 | 一种基于互补滤波的水下滑翔器节能算法 |
CN107014374A (zh) * | 2017-01-03 | 2017-08-04 | 东南大学 | 一种基于互补滤波的水下滑翔器节能算法 |
CN107560613B (zh) * | 2017-08-15 | 2020-03-31 | 江苏科技大学 | 基于九轴惯性传感器的机器人室内轨迹跟踪***及方法 |
CN107560613A (zh) * | 2017-08-15 | 2018-01-09 | 江苏科技大学 | 基于九轴惯性传感器的机器人室内轨迹跟踪***及方法 |
CN107577158A (zh) * | 2017-09-22 | 2018-01-12 | 哈尔滨工程大学 | 水下作业级rov的导航仿真***及其控制方法 |
CN107883951A (zh) * | 2017-10-19 | 2018-04-06 | 福建海图智能科技有限公司 | 一种水下机器人三维姿态的计算方法及终端 |
CN108037658A (zh) * | 2017-11-15 | 2018-05-15 | 东莞市松迪智能机器人科技有限公司 | 一种基于导航***的机器人运行误差的纠偏方法 |
CN108398128A (zh) * | 2018-01-22 | 2018-08-14 | 北京大学深圳研究生院 | 一种姿态角的融合解算方法和装置 |
CN108398128B (zh) * | 2018-01-22 | 2021-08-24 | 北京大学深圳研究生院 | 一种姿态角的融合解算方法和装置 |
CN108801260B (zh) * | 2018-05-07 | 2022-01-28 | 约肯机器人(上海)有限公司 | 基于水下机器人的数据处理方法及装置 |
CN108801250A (zh) * | 2018-05-07 | 2018-11-13 | 约肯机器人(上海)有限公司 | 基于水下机器人的实时姿态获取方法及装置 |
CN108801260A (zh) * | 2018-05-07 | 2018-11-13 | 约肯机器人(上海)有限公司 | 基于水下机器人的数据处理方法及装置 |
CN108803673A (zh) * | 2018-05-07 | 2018-11-13 | 约肯机器人(上海)有限公司 | 定向控制方法和装置 |
CN108731664B (zh) * | 2018-05-18 | 2020-08-11 | 深圳一清创新科技有限公司 | 机器人状态估计方法、装置、计算机设备和存储介质 |
CN108731664A (zh) * | 2018-05-18 | 2018-11-02 | 深圳清创新科技有限公司 | 机器人状态估计方法、装置、计算机设备和存储介质 |
CN109238262A (zh) * | 2018-11-05 | 2019-01-18 | 珠海全志科技股份有限公司 | 一种航向姿态解算及罗盘校准抗干扰方法 |
CN109238262B (zh) * | 2018-11-05 | 2020-10-30 | 珠海全志科技股份有限公司 | 一种航向姿态解算及罗盘校准抗干扰方法 |
CN110540118A (zh) * | 2019-06-21 | 2019-12-06 | 浙江大学 | 一种用于检测轿厢运动状态的智能检测装置 |
CN112824830B (zh) * | 2019-11-21 | 2023-08-22 | 中国石油天然气集团有限公司 | 水下管道定位方法 |
CN112824830A (zh) * | 2019-11-21 | 2021-05-21 | 中国石油天然气集团有限公司 | 水下管道定位方法及装置 |
CN111141283A (zh) * | 2020-01-19 | 2020-05-12 | 杭州十域科技有限公司 | 一种通过地磁数据判断行进方向的方法 |
CN111551168A (zh) * | 2020-04-30 | 2020-08-18 | 江苏帝一集团有限公司 | 一种水下机器人位姿数据采集***及其数据融合方法 |
CN112363169A (zh) * | 2020-10-27 | 2021-02-12 | 哈尔滨工程大学 | 全海深水下机器人及其定位方法 |
CN112363169B (zh) * | 2020-10-27 | 2022-12-13 | 哈尔滨工程大学 | 全海深水下机器人及其定位方法 |
CN112710309A (zh) * | 2020-12-08 | 2021-04-27 | 中国石油大学胜利学院 | 航姿参数估计方法 |
CN112710309B (zh) * | 2020-12-08 | 2023-03-28 | 中国石油大学胜利学院 | 航姿参数估计方法 |
CN112693985A (zh) * | 2020-12-10 | 2021-04-23 | 太原理工大学 | 一种融合传感器数据的非侵入式电梯状态监测方法 |
CN112923924A (zh) * | 2021-02-01 | 2021-06-08 | 杭州电子科技大学 | 一种锚泊船舶姿态与位置监测方法及*** |
CN114440871A (zh) * | 2021-12-29 | 2022-05-06 | 宜昌测试技术研究所 | 一种基于自适应互补滤波的九轴磁罗盘数据融合方法 |
CN114770598B (zh) * | 2022-04-08 | 2024-01-26 | 上海中车艾森迪海洋装备有限公司 | 水下机器人姿态估算方法、装置、电子设备及存储介质 |
CN118129695A (zh) * | 2024-05-07 | 2024-06-04 | 浙江智强东海发展研究院有限公司 | 一种水下采集装置的控制方法及芯片 |
Also Published As
Publication number | Publication date |
---|---|
CN104197927B (zh) | 2017-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104197927A (zh) | 水下结构检测机器人实时导航***及方法 | |
CN108225308B (zh) | 一种基于四元数的扩展卡尔曼滤波算法的姿态解算方法 | |
KR101988786B1 (ko) | 관성 항법 장치의 초기 정렬 방법 | |
CN104198765B (zh) | 车辆运动加速度检测的坐标系转换方法 | |
Wu et al. | Velocity/position integration formula part I: Application to in-flight coarse alignment | |
CN105259902B (zh) | 水下机器人惯性导航方法及*** | |
CN104655131B (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN103994763B (zh) | 一种火星车的sins/cns深组合导航***及其实现方法 | |
CN108106635A (zh) | 惯性卫导组合导航***的长航时抗干扰姿态航向校准方法 | |
CN103776446B (zh) | 一种基于双mems-imu的行人自主导航解算算法 | |
CN103743395B (zh) | 一种惯性重力匹配组合导航***中时间延迟的补偿方法 | |
CN108318038A (zh) | 一种四元数高斯粒子滤波移动机器人姿态解算方法 | |
US20140316708A1 (en) | Oriented Wireless Structural Health and Seismic Monitoring | |
CN101706284B (zh) | 提高船用光纤陀螺捷联惯导***定位精度的方法 | |
CN105203098A (zh) | 基于九轴mems传感器的农业机械全姿态角更新方法 | |
CN102116634A (zh) | 一种着陆深空天体探测器的降维自主导航方法 | |
CN109186597B (zh) | 一种基于双mems-imu的室内轮式机器人的定位方法 | |
CN103630137A (zh) | 一种用于导航***的姿态及航向角的校正方法 | |
CN101846510A (zh) | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 | |
CN102829777A (zh) | 自主式水下机器人组合导航***及方法 | |
CN102937450B (zh) | 一种基于陀螺测量信息的相对姿态确定方法 | |
CN103727941A (zh) | 基于载体系速度匹配的容积卡尔曼非线性组合导航方法 | |
Troni et al. | Preliminary experimental evaluation of a Doppler-aided attitude estimator for improved Doppler navigation of underwater vehicles | |
CN109612460B (zh) | 一种基于静止修正的垂线偏差测量方法 | |
CN103175545A (zh) | 惯导***速度加部分角速度匹配抗干扰快速传递对准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20201229 Address after: Room 17-1, building 033, building 2, No.15, Lane 587, Juxian Road, high tech Zone, Ningbo, Zhejiang 315000 Patentee after: CHINA E-TECH (NINGBO) MARITIME ELECTRONICS RESEARCH INSTITUTE Co.,Ltd. Address before: Meng Xi Road 212003 Zhenjiang city of Jiangsu province Jingkou District No. 2 Patentee before: JIANGSU University OF SCIENCE AND TECHNOLOGY |
|
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170623 |