CN115031785B - 一种基于多传感器融合技术的软土勘测方法 - Google Patents

一种基于多传感器融合技术的软土勘测方法 Download PDF

Info

Publication number
CN115031785B
CN115031785B CN202210705235.5A CN202210705235A CN115031785B CN 115031785 B CN115031785 B CN 115031785B CN 202210705235 A CN202210705235 A CN 202210705235A CN 115031785 B CN115031785 B CN 115031785B
Authority
CN
China
Prior art keywords
penetrometer
soft soil
coordinate system
information
measurement unit
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
Application number
CN202210705235.5A
Other languages
English (en)
Other versions
CN115031785A (zh
Inventor
周一览
赵帅
黄腾超
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN202210705235.5A priority Critical patent/CN115031785B/zh
Publication of CN115031785A publication Critical patent/CN115031785A/zh
Application granted granted Critical
Publication of CN115031785B publication Critical patent/CN115031785B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D21/00Measuring or testing not otherwise provided for
    • G01D21/02Measuring two or more variables by means not covered by a single other subclass
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/15Correlation function computation including computation of convolution operations
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/30Assessment of water resources

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Computational Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Pure & Applied Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Algebra (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Computing Systems (AREA)
  • Gyroscopes (AREA)
  • Investigating Strength Of Materials By Application Of Mechanical Stress (AREA)
  • Geophysics And Detection Of Objects (AREA)
  • Testing Or Calibration Of Command Recording Devices (AREA)

Abstract

本发明公开了一种基于多传感器融合技术的软土勘测方法,属于岩土工程和惯性传感领域。同步采集软土贯入仪中的多传感器的输出数据并预处理;初始对准,得到贯入仪的载体坐标系到地理坐标系的姿态矩阵;将软土贯入仪内的多传感器与软土贯入仪的重心重合,多传感器的Z轴与重力方向平行,将软土贯入仪悬挂在待测软土表面上方的预设高度;释放软土贯入仪,使其做自由落体运动并贯入软土中,直至进入静止状态;通过压力计测量贯入仪周边软土的压力情况,并根据惯性测量单元中的输出结果解算贯入仪在不同时刻的位置姿态信息;根据获得的不同时刻位置姿态信息反演软土强度。本发明可以实现更高精度的位姿解算,进而获得更加精度的海洋软土强度特性。

Description

一种基于多传感器融合技术的软土勘测方法
技术领域
本发明涉及岩土工程和惯性传感领域,具体涉及一种基于多传感器融合技术的软土勘测方法。
技术背景
随着海上油气等资源的战略意义不断提高,世界各国也越发重视对海洋的开发。海洋基础设施建设相关的岩土工程通常涉及到复杂的土壤性质评估,实现软土强度准确而又便捷的测量对海洋基础设施项目建设有重要的意义。
贯入法通过将测量装置以恒定的速度压入土中,通过测得的土体阻力以及其他数据,分析得到土体的相关参数,可以直接进行现场的测量实验,相比于传统方法更加方便快捷,目前常见的基于贯入法的仪器包括锥形贯入仪、T形贯入仪、球形贯入仪和自由落体贯入仪。圆形贯入仪可以避免上覆土压力较大所产生的测量误差,而自由落体贯入仪则是通过侧有裸体方式贯入软土进行测量,相比于传统方法无需额外的加载装置,操作便捷。因此目前自由落体球形贯入仪凭借着其独特的优势,成为目前研究应用的热点。而传统的自由落体球形贯入仪通常采用加速度传感器,实现贯入阻力的测量,由于贯入阻力与剪切强度之间具有严格的塑性解,进而可以实现软土强度参数的反演。但由于球形贯入仪在贯入土中的过程中会产生旋转,导致传统基于加速度传感器的测量方案效果并不理想。
综上所述,目前现有的测量方法无法同时满足海洋软体勘测领域所需要的高高精度与高适应性。
发明内容
为了解决上述技术问题,本发明提供了一种基于多传感器融合技术的软土强度勘测方法,利用MEMS惯性测量单元、三轴磁强计和压力计等多传感器,可以获得不同时刻贯入仪的位置姿态和表面的压力信息,进而实现软土参数的解算。
为达到上述目的,本发明的技术方案如下:
一种基于多传感器融合技术的软土勘测方法,包括以下步骤:
步骤1:同步采集软土贯入仪中的多传感器的输出数据,并使用卡尔曼滤波对传感器数据进行预处理;所述的多传感器包括MEMS惯性测量单元、三轴磁强计和压力计;
步骤2:对MEMS惯性测量单元和三轴磁强计的输出结果进行初始对准,得到贯入仪的载体坐标系到地理坐标系的姿态矩阵;
步骤3:将软土贯入仪内的多传感器与软土贯入仪的重心重合,多传感器的Z轴与重力方向平行,将软土贯入仪悬挂在待测软土表面上方的预设高度;
步骤4:释放软土贯入仪,使其做自由落体运动并贯入软土中,直至进入静止状态;通过软土贯入仪内的压力计测量贯入仪周边软土的压力情况,并根据MEMS惯性测量单元中的输出结果解算出贯入仪在不同时刻的位置姿态信息;
步骤5:根据贯入仪在不同时刻的位置姿态信息反演软土强度。
进一步地,所述的MEMS惯性测量单元包括三轴加速度计和三轴陀螺仪。
进一步地,所述的步骤2包括:
步骤2-1:利用MEMS惯性测量单元中的三轴加速度信息,计算初始俯仰角a0和初始横滚角β0
Figure BDA0003705054840000021
式中:
Figure BDA0003705054840000022
Figure BDA0003705054840000023
分別是MEMS惯性测量单元的x、y轴的加速度,g表示地球重力加速度;
步骤2-2:根据三轴磁强计输出结果、初始俯仰角a0和初始横滚角β0,计算初始航向角γ0
Figure BDA0003705054840000024
式中:mx、my和mz分别为三轴磁强计x、y和z轴的输出值;
步骤2-3:使用解析法对MEMS惯性测量单元和三轴磁强计的输出结果进行粗对准,得到贯入仪的载体坐标系到地理坐标系的初始姿态矩阵
Figure BDA0003705054840000025
Figure BDA0003705054840000026
进一步地,所述的步骤4中,解算贯入仪在不同时刻的位置姿态信息包括实时更新姿态信息和位置信息两部分,具体为:
步骤4-1:使用四元数表示载体坐标系转换到地理坐标系的过程,即:
Q=q0+q1ib+q2jb+q3kb
其中,q0、q1、q2、q3为实数;ib、jb、kb为单位向量且相互正交,Q为载体坐标系到地理坐标系的转动角度;
步骤4-2:根据姿态角、姿态矩阵和四元数之间的关系,得到:
Figure BDA0003705054840000031
步骤4-3:根据MEMS惯性测量单元的三轴陀螺仪输出的角增量信息,计算四元数微分方程:
Figure BDA0003705054840000032
其中,Q(tk+1)表示k+1时刻的四元数,I表示单位矩阵,Q(tk)表示k时刻的四元数,ΔΘ表示角增量信息;
步骤4-4:根据计算得到的k+1时刻的四元数Q(tk+1)实时更新姿态矩阵
Figure BDA0003705054840000033
并将姿态矩阵
Figure BDA0003705054840000034
表示为:
Figure BDA0003705054840000035
步骤4-5:根据步骤4-4得到的姿态矩阵
Figure BDA0003705054840000036
计算姿态角信息:
αm=sin-1(T32)
Figure BDA0003705054840000037
Figure BDA0003705054840000038
根据姿态角信息和姿态矩阵
Figure BDA0003705054840000039
获得实时姿态信息:
α=αm
Figure BDA0003705054840000041
Figure BDA0003705054840000042
其中,αm、βm、γm为计算得到的姿态角信息,α、β、γ为实时姿态信息;
步骤4-6:将MEMS惯性测量单元中原始输出的三轴加速度信息
Figure BDA0003705054840000043
通过更新后的姿态矩阵
Figure BDA0003705054840000044
转换到地理坐标系中:
Figure BDA0003705054840000045
其中,
Figure BDA0003705054840000046
为贯入仪相对于地球坐标系的速度增量在地理坐标系下的投影,gn为重力加速度在地理坐标系的投影,
Figure BDA0003705054840000047
为地球自转角度率在地理坐标系的投影,
Figure BDA0003705054840000048
为贯入仪相对于地球坐标系的自转角速率在地理坐标系的投影,
Figure BDA0003705054840000049
为贯入仪相对于地球坐标系的速度在地理坐标系下的投影;
将上述公式展开,得到:
Figure BDA00037050548400000410
其中,fE、fN、fU分别为由三轴加速度计测得的比力在地理坐标系下的三轴映射,随着姿态矩阵而更新;
Figure BDA00037050548400000411
分别为
Figure BDA00037050548400000412
在xn、yn、zn上的分量,即更新后的贯入仪在东向、北向、天向上的速度增量;ωie为地球自转角度率,RM、RN分别为载体所在地沿地球子午圈和卯酉圈的曲率半径,VE、VN、VU分别为
Figure BDA00037050548400000413
在xn、yn、zn上的分量,即更新后的贯入仪在东向、北向、天向上的速度信息;L为纬度,g表示地球重力加速度;
步骤4-7:根据速度信息,实时更新位置,计算公式为:
Figure BDA0003705054840000051
Figure BDA0003705054840000052
其中,
Figure BDA0003705054840000053
表示贯入仪的位置增量,X表示贯入仪的位置,λ、h表示经度和高度。
进一步地,在所述的步骤4中,还包括对三轴陀螺仪进行修正的步骤,具体为:
根据三轴加速度计测量到的加速度值和当前姿态矩阵,计算三轴加速度计反馈的角速度误差e,计算公式为:
Figure BDA0003705054840000054
式中,
Figure BDA0003705054840000055
为所在地的重力加速度在地理坐标系下的投影值,‖.‖为取模运算,
Figure BDA0003705054840000056
为MEMS惯性测量单元中原始输出的三轴加速度信息,
Figure BDA0003705054840000057
为当前姿态矩阵;
对角速度误差e进行增益和积分运算补偿,得到补偿后角速度误差量为:
Figure BDA0003705054840000058
式中,Kp为比例增益调整权值,KI为积分增益调整权值,S为复数域变量,Δωf为角速度误差量;
计算角速度的修正值为:
Figure BDA0003705054840000059
利用修正后的角速度计算角增量信息,进而更新姿态矩阵。
进一步地,所述的比例增益调整权值Kp和积分增益调整权值KI根据贯入仪的不同状态进行调节,分为四个阶段,具体为:
Z轴加速度
Figure BDA00037050548400000510
时,表明贯入仪处于待释放状态,此时Kp的值为1,KI的值为0.001;
Z轴加速度
Figure BDA0003705054840000061
时,表明贯入仪处于释放后自由落地状态,此时Kp的值为1.5,KI的值为0.001;
Z轴加速度变化率大于0.1g后,表明贯入仪正在贯入软土,此时Kp与KI的值为0;
Z轴加速度
Figure BDA0003705054840000062
且持续1s后,表明贯入仪已经结束贯入,此时Kp的值为1.3,KI的值为0.002。
进一步地,所述的反演软土强度的公式为:
Figure BDA0003705054840000063
式中,Wb为贯入仪在水中的浮重量,Fm为位于贯入仪下方的压力值,m为贯入仪质量,V为贯入仪体积,ρsoil为软土密度,f1为贯入仪率效应函数,f2为摩擦阻力函数,f3为拖曳阻力函数,At为贯入仪投影面积,Fb为位于贯入仪上方的压力值,su为软土强度,A,B为拟合参数,可以通过最小二乘法解算得到;VU为贯入仪在天向上的速度信息,
Figure BDA0003705054840000064
为贯入仪在天向上的速度增量。
本发明的有益效果是:传统基于惯性测量装置的贯入仪无法获取贯入仪的初始姿态信息,只能近似获得竖直方向的运动信息,精度有限,没有充分考虑可能发生的旋转等运动,而本发明提出的基于多传感器融合技术的软土强度勘测方法可以获得贯入仪的初始姿态信息,并且针对不同运动状态下的数据特性,提出了自适应的互补滤波,可以实现更高精度的位姿解算,进而获得更加精度的海洋软土强度特性。
附图说明
图1是本发明的基于多传感器融合技术的软土勘测方法的流程示意图;
图2是本实施例中贯入仪贯入软土过程中的加速度、速度与位移测量结果。
具体实施方式
为了更好的说明本发明的目的和优点,下面结合附图和实例对发明内容做进一步说明。
一种基于多传感器融合技术的软土强度勘测方法,如图1所示,步骤如下:
步骤1:将MEMS惯性测量单元和三轴磁强计从自由落体球形贯入仪内取出,同步采集MEMS惯性测量单元和三轴磁强计的输出数据,并使用卡尔曼滤波对传感器数据进行预处理;所述MEMS惯性测量单元包括三轴加速度计和三轴陀螺仪。
步骤2:利用MEMS惯性测量单元和三轴磁强计输出进行初始对准,得到贯入仪的载体坐标系到地理坐标系的姿态矩阵。
本实施例中,步骤2中初始对准的方法为:
步骤2-1:利用MEMS惯性测量单元中的三轴加速度信息,计算初始俯仰角a0和初始横滚角β0
Figure BDA0003705054840000071
式中:
Figure BDA0003705054840000072
Figure BDA0003705054840000073
分別是MEMS惯性测量单元的x、y轴的加速度,是从MEMS惯性测量单元中原始输出的三轴加速度信息
Figure BDA0003705054840000074
中分解得到的;g表示地球重力加速度;
步骤2-2:结合三轴磁强计输出,可以计算出初始航向角γ0
Figure BDA0003705054840000075
式中:mx、my和mz分别为三轴磁强计x、y和z轴的输出值;
步骤2-3:使用解析法进行系统的粗对准,可以得到贯入仪的载体坐标系(b系)到地理坐标系(n系)的姿态矩阵
Figure BDA0003705054840000076
Figure BDA0003705054840000077
得到初始姿态矩阵后,可以根据MEMS惯性测量单元的输出信息更新载体的姿态角、姿态矩阵。依据更新后的姿态矩阵,将三轴加速度计测量的载体加速度信息转换到地理坐标系中,通过比力方程计算出载体在地理坐标系中的速度与位置信息。
步骤3:根据MEMS惯性测量单元中三轴加速度信息和三轴角速度信息解算出自由落体球形贯入仪在不同时刻的位置姿态信息;将多传感器安装于自由落体球形贯入仪内,所述的多传感器包括MEMS惯性测量单元、三轴磁强计和压力计;所述的多传感器的重心与自由落体球形贯入仪的重心重合,多传感器的Z轴与重力方向平行,此时开始采集压力计的输出数据,测量自由落体球形贯入仪上表面与下表面的压力变化情况,随后通过自动脱钩装置和安装绳将组装好的自由落体球形贯入仪悬挂在软土表面预定高度。
本实施例中,步骤3中计算自由落体球形贯入仪在不同时刻的位置姿态信息,包括实时更新姿态信息和位置信息两部分。
姿态信息的更新方法为:
使用四元数表示载体坐标系(b系)转换到地理坐标系(n系)的过程,即:
Q=q0+q1ib+q2jb+q3kb
其中,q0、q1、q2、q3为实数;ib、jb、kb为单位向量且相互正交,Q为载体坐标系到地理坐标系的转动角度;四元数微分方程对b系到n系的转动角速率
Figure BDA0003705054840000081
表达式为:
Figure BDA0003705054840000082
Figure BDA0003705054840000083
式中,
Figure BDA0003705054840000084
为三轴陀螺仪输出角速度,
Figure BDA0003705054840000085
为地球自转角度率在n系上的投影,
Figure BDA0003705054840000086
为载体相当于地球自转角速率在n系上的投影,
Figure BDA0003705054840000087
表示载体坐标系下的角速率。
Figure BDA0003705054840000088
Figure BDA0003705054840000089
其中,L为纬度,VE、VN分别为贯入仪在东向、北向上的速度,RM、RN分别为载体所在地沿地球子午圈和卯酉圈的曲率半径,ωie为地球自转角度率。
根据姿态角、姿态矩阵和四元数之间的关系,计算矩阵
Figure BDA0003705054840000091
Figure BDA0003705054840000092
式中,α、β、γ表示俯仰角、横滚角和航向角;
可以根据初始姿态角计算得出初始四元数为:
q0(0)=cos(γ0/2)cos(α0/2)cos(β0/2)-sin(γ0/2)sin(α0/2)sin(β0/2)
q1(0)=cos(γ0/2)sin(α0/2)cos(β0/2)-sin(γ0/2)cos(α0/2)sin(β0/2)
q2(0)=cos(γ0/2)cos(α0/2)sin(β0/2)+sin(γ0/2)sin(α0/2)cos(β0/2)
q3(0)=cos(γ0/2)sin(α0/2)sin(β0/2)+sin(γ0/2)cos(α0/2)cos(β0/2)
MEMS惯性测量单元中陀螺仪的输出形式通常是角增量,根据角增量信息来计算四元数微分方程,一阶近似解表示为:
Figure BDA0003705054840000093
Figure BDA0003705054840000094
其中,Δθx、Δθy和Δθz为陀螺仪三轴在时间间隔(tk+1-tk)中输出的角增量(
Figure BDA0003705054840000095
信息已被补偿),Q(tk+1)表示k+1时刻的四元数,I表示3行3列的单位矩阵,ΔΘ表示角增量信息。
用计算得到的四元数Q实时更新矩阵
Figure BDA0003705054840000096
Figure BDA0003705054840000097
由上式中所表示的矩阵T的元素计算下式可得:
αm=sin-1(T32)
Figure BDA0003705054840000101
Figure BDA0003705054840000102
根据姿态角θm、γm和ψm判断其真值的具体数值,即:
α=αm
Figure BDA0003705054840000103
Figure BDA0003705054840000104
由此,根据更新后的姿态角信息θm、γm和ψm,即可得到实时姿态信息α、β、γ。
位置信息的更新方法为:
由于三轴加速度计固连在MEMS惯性测量器件上,其输出信息是载体相对于惯性空间的比力在载体坐标系中的投影。因此,需要根据更新后的姿态矩阵信息,将三轴加速度计原始输出
Figure BDA0003705054840000105
通过姿态矩阵
Figure BDA0003705054840000106
转换到地理坐标系中,再进行速度更新。
根据哥式定理,可将载体相对惯性系的运动速度表示如下:
Figure BDA0003705054840000107
其中,R为位置矢量;
Figure BDA0003705054840000108
为惯性系(i系)中的速度;
Figure BDA0003705054840000109
称为地球坐标系(e系)中的速度;ωie×R为惯性系中的速度。
对上式求微分并且改写成向量形式,即可得到捷联惯性导航系统的比力方程:
Figure BDA00037050548400001010
其中,其中,
Figure BDA00037050548400001011
为贯入仪相对于地球坐标系的速度增量在地理坐标系下的投影,gn为重力加速度在地理坐标系的投影,
Figure BDA00037050548400001012
为地球自转角度率在地理坐标系的投影,
Figure BDA0003705054840000111
为贯入仪相对于地球坐标系的自转角速率在地理坐标系的投影,
Figure BDA0003705054840000112
为贯入仪相对于地球坐标系的速度在地理坐标系下的投影;
Figure BDA0003705054840000113
为三轴加速度计输出的原始信息。
将上式展开,可以表示为:
Figure BDA0003705054840000114
其中,fE、fN、fU分别为由三轴加速度计测得的比力在地理坐标系下的三轴映射,随着姿态矩阵而更新;
Figure BDA0003705054840000115
分别为
Figure BDA0003705054840000116
在xn、yn、zn上的分量,即更新后的贯入仪在东向、北向、天向上的速度增量;ωie为地球自转角度率,RM、RN分别为载体所在地沿地球子午圈和卯酉圈的曲率半径,VE、VN、VU分别为
Figure BDA0003705054840000117
在xn、yn、zn上的分量,即更新后的贯入仪在东向、北向、天向上的速度信息;L为纬度,g表示地球重力加速度。
计算位置信息:
Figure BDA0003705054840000118
Figure BDA0003705054840000119
其中,
Figure BDA00037050548400001110
表示贯入仪的位置增量,X表示贯入仪的位置,λ、h表示经度和高度。
步骤4:通过自动脱钩装置释放自由落体球形贯入仪,使自由落体球形贯入仪开始自由落体并贯入软土中,最终静置,在此期间根据三轴加速度计的输出值对三轴陀螺仪进行修正。
本实施例中,步骤4中对三轴陀螺仪进行修正的方法为:
根据三轴加速度计测量到的归一化加速度值和当前姿态矩阵
Figure BDA0003705054840000121
计算三轴加速度计反馈的的角速度误差e;
Figure BDA0003705054840000122
式中,
Figure BDA0003705054840000123
为所在地的重力加速度在地理坐标系下的投影值;
对e进行增益和积分运算补偿,得到e对应的补偿后角速度误差量为:
Figure BDA0003705054840000124
式中,Kp为比例增益调整权值,KI为积分增益调整权值,S为复数域变量,Δωf为角速度误差量;
计算角速度的修正值为:
Figure BDA0003705054840000125
利用角速度修正值进行姿态更新。根据Z轴加速度值
Figure BDA0003705054840000126
判断软土强度勘测过程中的运动状态,进而调节上述Kp与KI的值,分为四个阶段,具体为:
Z轴加速度
Figure BDA0003705054840000127
时,表明贯入仪处于待释放状态,此时Kp的值为1,KI的值为0.001;
Z轴加速度
Figure BDA0003705054840000128
时,表明贯入仪处于释放后自由落地状态,此时Kp的值为1.5,KI的值为0.001;
Z轴加速度变化率大于0.1g后,表明贯入仪正在贯入软土,此时Kp与KI的值为0;
Z轴加速度
Figure BDA0003705054840000129
且持续1s后,表明贯入仪已经结束贯入,此时Kp的值为1.3,KI的值为0.002。
从图2中可以看到,前0.8s为悬挂至一定高度待释放状态,0.8s-1.38s为释放后自由落体状态,1.38s-1.6s为贯入软土的过程,1.6s后为静止状态,可以看到贯入深度为2.2m。
步骤5:自由落体球形贯入仪进入静止状态10s后,回收装置,分析数据,反演软土强度等信息。
具体反演软土强度的公式为:
Figure BDA0003705054840000131
式中,Wb为贯入仪在水中的浮重量,Fm为位于贯入仪下方的压力值,m为贯入仪质量,V为贯入仪体积,ρsoil为软土密度,f1为贯入仪率效应函数,f2为摩擦阻力函数,f3为拖曳阻力函数,At为贯入仪投影面积,Fb为位于贯入仪上方的压力值,su为软土强度,A,B为拟合参数,利用最小二乘法对贯入仪贯入的过程中所获得的数据进行拟合即可获得;VU为贯入仪在天向上的速度信息,
Figure BDA0003705054840000132
为贯入仪在天向上的速度增量。
本发明的技术内容及技术特种已揭示如上,然而熟悉本领域的技术人员仍可能基于本发明的教示及揭示而作种种不背离本发明精神的替换和修饰,因此,本发明保护范围应不限于实施例所揭示的内容,而应包括各种不背离本发明的替换和修饰,并为本专利申请权利要求所涵盖。

Claims (6)

1.一种基于多传感器融合技术的软土勘测方法,其特征在于,包括以下步骤:
步骤1:同步采集软土贯入仪中的多传感器的输出数据,并使用卡尔曼滤波对传感器数据进行预处理;所述的多传感器包括MEMS惯性测量单元、三轴磁强计和压力计;
步骤2:对MEMS惯性测量单元和三轴磁强计的输出结果进行初始对准,得到贯入仪的载体坐标系到地理坐标系的姿态矩阵;
步骤3:将软土贯入仪内的多传感器与软土贯入仪的重心重合,多传感器的Z轴与重力方向平行,将软土贯入仪悬挂在待测软土表面上方的预设高度;
步骤4:释放软土贯入仪,使其做自由落体运动并贯入软土中,直至进入静止状态;通过软土贯入仪内的压力计测量贯入仪周边软土的压力情况,并根据MEMS惯性测量单元中的输出结果解算出贯入仪在不同时刻的位置姿态信息;
所述的步骤4中,解算贯入仪在不同时刻的位置姿态信息包括实时更新姿态信息和位置信息两部分,具体为:
步骤4-1:使用四元数表示载体坐标系转换到地理坐标系的过程,即:
Q=q0+q1ib+q2jb+q3kb
其中,q0、q1、q2、q3为实数;ib、jb、kb为单位向量且相互正交,Q为载体坐标系到地理坐标系的转动角度;
步骤4-2:根据姿态角、姿态矩阵和四元数之间的关系,得到:
Figure FDA0004051835510000011
步骤4-3:根据MEMS惯性测量单元的三轴陀螺仪输出的角增量信息,计算四元数微分方程:
Figure FDA0004051835510000012
其中,Q(tk+1)表示k+1时刻的四元数,I表示单位矩阵,Q(tk)表示k时刻的四元数,ΔΘ表示角增量信息;
步骤4-4:根据计算得到的k+1时刻的四元数Q(tk+1)实时更新姿态矩阵
Figure FDA0004051835510000021
并将姿态矩阵
Figure FDA0004051835510000022
表示为:
Figure FDA0004051835510000023
步骤4-5:根据步骤4-4得到的姿态矩阵
Figure FDA0004051835510000024
计算姿态角信息:
αm=sin-1(T32)
Figure FDA0004051835510000025
Figure FDA0004051835510000026
根据姿态角信息和姿态矩阵
Figure FDA0004051835510000027
获得实时姿态信息:
α=αm
Figure FDA0004051835510000028
Figure FDA0004051835510000029
其中,αm、βm、γm为计算得到的姿态角信息,α、β、γ为实时姿态信息;
步骤4-6:将MEMS惯性测量单元中原始输出的三轴加速度信息
Figure FDA00040518355100000210
通过更新后的姿态矩阵
Figure FDA00040518355100000211
转换到地理坐标系中:
Figure FDA00040518355100000212
其中,
Figure FDA00040518355100000213
为贯入仪相对于地球坐标系的速度增量在地理坐标系下的投影,gn为重力加速度在地理坐标系的投影,
Figure FDA00040518355100000214
为地球自转角度率在地理坐标系的投影,
Figure FDA00040518355100000215
为贯入仪相对于地球坐标系的自转角速率在地理坐标系的投影,
Figure FDA00040518355100000216
为贯入仪相对于地球坐标系的速度在地理坐标系下的投影;
将上述公式展开,得到:
Figure FDA0004051835510000031
其中,fE、fN、fU分别为由三轴加速度计测得的比力在地理坐标系下的三轴映射,随着姿态矩阵而更新;
Figure FDA0004051835510000032
分别为
Figure FDA0004051835510000033
在xn、yn、zn上的分量,即更新后的贯入仪在东向、北向、天向上的速度增量;ωie为地球自转角度率,RM、RN分别为载体所在地沿地球子午圈和卯酉圈的曲率半径,VE、VN、VU分别为
Figure FDA0004051835510000034
在xn、yn、zn上的分量,即更新后的贯入仪在东向、北向、天向上的速度信息;L为纬度,g表示地球重力加速度;
步骤4-7:根据速度信息,实时更新位置,计算公式为:
Figure FDA0004051835510000035
Figure FDA0004051835510000036
其中,
Figure FDA0004051835510000037
表示贯入仪的位置增量,X表示贯入仪的位置,λ、h表示经度和高度;
步骤5:根据贯入仪在不同时刻的位置姿态信息反演软土强度。
2.根据权利要求1所述的一种基于多传感器融合技术的软土勘测方法,其特征在于,所述的MEMS惯性测量单元包括三轴加速度计和三轴陀螺仪。
3.根据权利要求2所述的一种基于多传感器融合技术的软土勘测方法,其特征在于,所述的步骤2包括:
步骤2-1:利用MEMS惯性测量单元中的三轴加速度信息,计算初始俯仰角a0和初始横滚角β0
Figure FDA0004051835510000041
式中:
Figure FDA0004051835510000042
Figure FDA0004051835510000043
分別是MEMS惯性测量单元的x、y轴的加速度,g表示地球重力加速度;
步骤2-2:根据三轴磁强计输出结果、初始俯仰角a0和初始横滚角β0,计算初始航向角γ0
Figure FDA0004051835510000044
式中:mx、my和mz分别为三轴磁强计x、y和z轴的输出值;
步骤2-3:使用解析法对MEMS惯性测量单元和三轴磁强计的输出结果进行粗对准,得到贯入仪的载体坐标系到地理坐标系的初始姿态矩阵
Figure FDA0004051835510000045
Figure FDA0004051835510000046
4.根据权利要求1所述的一种基于多传感器融合技术的软土勘测方法,其特征在于,在所述的步骤4中,还包括对三轴陀螺仪进行修正的步骤,具体为:
根据三轴加速度计测量到的加速度值和当前姿态矩阵,计算三轴加速度计反馈的角速度误差e,计算公式为:
Figure FDA0004051835510000047
式中,
Figure FDA0004051835510000048
为所在地的重力加速度在地理坐标系下的投影值,||.||为取模运算,
Figure FDA0004051835510000049
为MEMS惯性测量单元中原始输出的三轴加速度信息,
Figure FDA00040518355100000410
为当前姿态矩阵;
对角速度误差e进行增益和积分运算补偿,得到补偿后角速度误差量为:
Figure FDA00040518355100000411
式中,Kp为比例增益调整权值,KI为积分增益调整权值,S为复数域变量,Δωf为角速度误差量;
计算角速度的修正值为:
Figure FDA0004051835510000051
利用修正后的角速度计算角增量信息,进而更新姿态矩阵。
5.根据权利要求4所述的一种基于多传感器融合技术的软土勘测方法,其特征在于,所述的比例增益调整权值Kp和积分增益调整权值KI根据贯入仪的不同状态进行调节,分为四个阶段,具体为:
Z轴加速度
Figure FDA0004051835510000052
时,表明贯入仪处于待释放状态,此时Kp的值为1,KI的值为0.001;
Z轴加速度
Figure FDA0004051835510000053
时,表明贯入仪处于释放后自由落地状态,此时Kp的值为1.5,KI的值为0.001;
Z轴加速度变化率大于0.1g后,表明贯入仪正在贯入软土,此时Kp与KI的值为0;
Z轴加速度
Figure FDA0004051835510000054
且持续1s后,表明贯入仪已经结束贯入,此时Kp的值为1.3,KI的值为0.002。
6.根据权利要求1所述的一种基于多传感器融合技术的软土勘测方法,其特征在于,所述的反演软土强度的公式为:
Figure FDA0004051835510000055
式中,Wb为贯入仪在水中的浮重量,Fm为位于贯入仪下方的压力值,m为贯入仪质量,V为贯入仪体积,ρsoil为软土密度,f1为贯入仪率效应函数,f2为摩擦阻力函数,f3为拖曳阻力函数,At为贯入仪投影面积,Fb为位于贯入仪上方的压力值,su为软土强度,A,B为拟合参数;VU为贯入仪在天向上的速度信息,
Figure FDA0004051835510000056
为贯入仪在天向上的速度增量。
CN202210705235.5A 2022-06-21 2022-06-21 一种基于多传感器融合技术的软土勘测方法 Active CN115031785B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210705235.5A CN115031785B (zh) 2022-06-21 2022-06-21 一种基于多传感器融合技术的软土勘测方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210705235.5A CN115031785B (zh) 2022-06-21 2022-06-21 一种基于多传感器融合技术的软土勘测方法

Publications (2)

Publication Number Publication Date
CN115031785A CN115031785A (zh) 2022-09-09
CN115031785B true CN115031785B (zh) 2023-05-16

Family

ID=83124730

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210705235.5A Active CN115031785B (zh) 2022-06-21 2022-06-21 一种基于多传感器融合技术的软土勘测方法

Country Status (1)

Country Link
CN (1) CN115031785B (zh)

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105180937B (zh) * 2015-10-15 2018-01-02 常熟理工学院 一种mems‑imu初始对准方法
CN107478223A (zh) * 2016-06-08 2017-12-15 南京理工大学 一种基于四元数和卡尔曼滤波的人体姿态解算方法
CN106053295A (zh) * 2016-07-28 2016-10-26 东南大学 一种用于评价粘土强度的自落式球型动态贯入仪
CN108152170B (zh) * 2017-12-27 2020-04-07 大连理工大学 带有推进器的自由落体式球形贯入仪
CN110196211A (zh) * 2019-06-10 2019-09-03 中国海洋大学 一种用于自由下落式触探技术的率相关系数测定方法
AU2020101268A4 (en) * 2020-07-06 2020-08-13 Harbin Engineering University The initial alignment method for sway base
CN112629538B (zh) * 2020-12-11 2023-02-14 哈尔滨工程大学 基于融合互补滤波和卡尔曼滤波的舰船水平姿态测量方法

Also Published As

Publication number Publication date
CN115031785A (zh) 2022-09-09

Similar Documents

Publication Publication Date Title
JP5383801B2 (ja) 位置及び経路地図表示用の位置及び経路地図データを生成する装置及び当該データ提供方法
CN103090870B (zh) 一种基于mems传感器的航天器姿态测量方法
CN109425339B (zh) 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法
CN104374388B (zh) 一种基于偏振光传感器的航姿测定方法
CN108458714B (zh) 一种姿态检测系统中不含重力加速度的欧拉角求解方法
CN109540130A (zh) 一种连采机惯性导航定位定向方法
CN110017812B (zh) 一种垂线偏差、重力加速度和重力梯度的测量装置及方法
CN105841698A (zh) 一种无需调零的auv舵角精确实时测量系统
CN104833375B (zh) 一种借助星敏感器的imu两位置对准方法
CN107709926A (zh) 自动化的移动岩土测绘
CN102706349A (zh) 一种基于光纤捷联罗经技术的载体姿态确定方法
CN112378399A (zh) 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法
CN107764261A (zh) 一种分布式pos传递对准用模拟数据生成方法和系统
CN110440746A (zh) 一种基于四元数梯度下降的非开挖地下钻头姿态融合方法
CN106767925A (zh) 带双轴转位机构的惯导系统三位置参数辨识对准方法
CN113340298A (zh) 一种惯导和双天线gnss外参标定方法
CN107202578A (zh) 一种基于mems技术的捷联式垂直陀螺仪解算方法
CN104848818A (zh) Stewart平台姿态测量装置及测量方法
CN110095135B (zh) 一种用于掘进机定位定向的方法及装置
CN108868772A (zh) 一种连采机快速准直控制方法
CN105606093B (zh) 基于重力实时补偿的惯性导航方法及装置
CN109029499B (zh) 一种基于重力视运动模型的加速度计零偏迭代寻优估计方法
CN109084755B (zh) 一种基于重力视速度与参数辨识的加速度计零偏估计方法
CN104034333B (zh) 测井探管三维实时姿态检测系统的检测方法
CN103901496A (zh) 一种基于光纤陀螺sins与北斗的重力测量方法

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