一种水平姿态测量方法、系统、处理设备及存储介质技术方案

本发明专利技术涉及一种水平姿态测量方法、系统、处理设备及存储介质，其特征在于，包括：将MIMU放置于载体上，根据载体的初始姿态，对MIMU的陀螺输出数据进行姿态解算，获取载体的姿态角；进行载体的静止状态判断，并根据MIMU内加速度计的输出数据，实时计算进入静止状态的载体水平姿态角和载体的噪声动态观测方差阵；根据获取的姿态角和实时计算的水平姿态角，实时确定载体的失准角；根据载体的噪声动态观测方差阵和失准角，确定MIMU的陀螺零偏，并得到更新后的载体姿态角；对更新后的载体姿态角和进入静止状态的载体水平姿态角进行融合，确定载体的水平姿态角，本发明专利技术可以广泛应用于惯性技术领域中。术领域中。术领域中。

【技术实现步骤摘要】
一种水平姿态测量方法、系统、处理设备及存储介质


[0001]本专利技术涉及惯性
，特别是关于一种水平姿态测量方法、系统、处理设备及存储介质。

技术介绍

[0002]MIMU(Micro Inertial Measurement Unit，微惯性测量单元)由于其自身小体积、低功耗、低成本等特点，已经成为小型无人机、无人车、微型稳定平台以及人体可穿戴式智能化设备的首选器件，应用于姿态测量及导航定位。目前，应用于MIMU测姿的方法主要是利用MIMU内加速度计的精度和稳定性远高于陀螺器件水准的特点，在考虑载体运动过程中的静止或准静止状态下，通过互补滤波等方法融合陀螺的解算姿态和加速度计的估计姿态，达到提升载体水平姿态的测量精度。
[0003]但是，目前采用互补滤波方法进行融合时，对于不同姿态的权重设置仅依靠经验值，或者基于加速度计幅值的一阶线性关系，不能更为准确地评估加速度计水平姿态估计的精度。因此，需要一种能够实时动态地计算加速度计水平姿态的估计精度的方法，从而更为准确的进行姿态融合解算。

技术实现思路
/>[0004]针对本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种水平姿态测量方法，其特征在于，包括：将MIMU放置于载体上，根据载体的初始姿态，对MIMU的陀螺输出数据进行姿态解算，获取载体的姿态角；根据MIMU内加速度计的输出数据，实时计算进入静止状态的载体水平姿态角和载体的噪声动态观测方差阵；根据获取的姿态角和实时计算的水平姿态角，实时确定载体的失准角；根据载体的噪声动态观测方差阵和失准角，确定MIMU的陀螺零偏，并得到更新后的载体姿态角；对更新后的载体姿态角和进入静止状态的载体水平姿态角进行融合，确定载体的水平姿态角。2.如权利要求1所述的一种水平姿态测量方法，其特征在于，所述将MIMU放置于载体上，根据载体的初始姿态，对MIMU的陀螺输出数据进行姿态解算，获取载体的姿态角，包括：将MIMU放置于载体上，获取MEMS陀螺的初始零偏；采用四元数姿态更新方法，根据载体的初始姿态，对MIMU的陀螺输出数据进行姿态解算，获取载体的姿态角包括横滚角俯仰角和航向角3.如权利要求1所述的一种水平姿态测量方法，其特征在于，所述根据MIMU内加速度计的输出数据，实时计算进入静止状态的载体水平姿态角和载体的噪声动态观测方差阵，包括：根据MIMU内加速度计的输出数据和加速度计输出幅值阈值范围，进行载体的静止状态判断；当载体进入静止状态时，根据加速度计的输出数据，实时计算载体的水平姿态角；根据加速度计输出的水平姿态方差，实时确定噪声动态观测方差阵。4.如权利要求3所述的一种水平姿态测量方法，其特征在于，所述根据MIMU内加速度计的输出数据和加速度计输出幅值阈值范围，进行载体的静止状态判断，包括：设定三轴加速度计的输出为其中，b为载体坐标系，和分别为x轴、y轴、z轴加速度计的输出，取前右下坐标投影，导航系n系选择北东地坐标；设定加速度计输出幅值的阈值范围：其中，g为重力加速度的值；k为阈值系数；为加速度计的输出含有误差；为三轴加速度计的输出模值。5.如权利要求3所述的一种水平姿态测量方法，其特征在于，所述根据加速度计输出的水平姿态方差，实时确定噪声动态观测方差阵，包括：根据加速度计输出的噪声方差，采用下述模型，实时动态确定水平姿态角的方差：
其中，D(φ
N
)、D(φ
E
)为水平姿态角的方差；为加速度计输出的噪声方差；根据实时动态确定的水平姿态角的方差，实时确定噪声动态观测方差阵根据实时动态确定的水平姿态角的方差，实时确...

【专利技术属性】
技术研发人员：郭美风，杨海军，王成宾，李新，陈建强，石耿修，梁弘毅，
申请(专利权)人：上海塞嘉电子科技有限公司，
类型：发明
国别省市：