CN112729280A - 一种基于多面体式阵列结构的微惯性姿态测量装置及方法 - Google Patents
一种基于多面体式阵列结构的微惯性姿态测量装置及方法 Download PDFInfo
- Publication number
- CN112729280A CN112729280A CN202011451203.4A CN202011451203A CN112729280A CN 112729280 A CN112729280 A CN 112729280A CN 202011451203 A CN202011451203 A CN 202011451203A CN 112729280 A CN112729280 A CN 112729280A
- Authority
- CN
- China
- Prior art keywords
- micro
- array structure
- polyhedral
- measurement device
- attitude measurement
- 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
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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明属于捷联惯性导航技术领域,具体涉及一种微惯性姿态测量装置及方法。一种基于多面体式阵列结构的微惯性姿态测量装置,包括微测量单元,所述微测量单元至少包括三个三轴加速度计;所述三个三轴加速度计分别呈20~70°空间夹角布置,并且相互之间的夹角角度相等。本发明设计的微惯性姿态测量装置,结构原理是将三个三轴加速度计分别按照倾斜20~70°的空间夹角布置,这样针对空间内的随机运动,在三维空间里保证至少会有一个面上的三轴加速度计不会因为运动轴上的加速度相对于其他轴权重过小,而导致难以辨识载体运动中的小幅渐变加速度,进而引起姿态计算误差过大的现象,这样同时也能够及时的捕捉到重力加速度所测定的水平面。
Description
技术领域
本发明属于捷联惯性导航技术领域,具体涉及一种微惯性姿态测量装置及方法。
背景技术
在基于微惯性测量单元(MIMU)的航姿参考系统(AHRS)研究中,目前针对运动加速度的干扰以及分离方法,通常是利用加速度计测量值与重力加速度的比较这一基本过程来计算加速度计测量中的运动干扰,从而放大或缩小滤波器中的噪声协方差矩阵,以此达到抑制运动干扰的目的。由于重力加速度在三轴加速度计中的分布通常是不均匀的,权重过小的运动轴上的运动加速度无法在比较中被敏感的表现出来,同时低成本的微惯性陀螺仪不同于高端的光纤或是激光陀螺仪,误差累积的过程非常迅速,使得航姿参考系统短时间内完整准确的辨识和分离小幅渐变加速运动变得十分困难。
发明内容
本发明的目的是解决微惯性测量单元在姿态解算的过程中面对小幅渐变加速度干扰难以准确的辨识和分离,从而影响载体运动姿态测量精度的问题,提供一种基于多面体阵列结构的微惯性姿态测量装置及方法,可以平衡重力加速度在各个加速度计上的投影,准确捕捉小幅渐变加速度的运动过程,同时在融合滤波方法上采用分立式多阶卡尔曼滤波结构,避免线性化观测方程,准确估计运动误差模型,保证系统稳定可靠运行。
为了实现上述目的,本发明采用的其中一种技术方案是:一种多面体式阵列结构的微惯性姿态测量装置,包括微测量单元,所述微测量单元至少包括三个三轴加速度计;所述三个三轴加速度计分别呈20~70°空间夹角布置,并且相互之间的夹角角度相等。
作为本发明的一种优选方式,其中一个三轴加速度计位于水平面上,其他两个三轴加速度计位于与所述水平面相交的斜面上。
作为本发明的一种优选方式,所述的微测量单元还包括三轴陀螺仪。
进一步优选地,所述的微测量单元还包括三轴磁强计。
进一步优选地,所述的微测量单元还包括电路板。
进一步优选地,所述的装置还包括处理器控制单元,所述的微测量单元与所述的处理器控制单元连接。
作为本发明的一种优选方式,所述的装置还包括多面体台体结构,所述多面体台体结构至少有两个相邻侧面的夹角、以及该两个侧面与其中一个底面的夹角为20~70°,且相互之间的夹角角度相等;三个三轴加速度计分别安装在所述多面体台体结构的相邻两个侧面及其中一个底面上。
本发明还提供了一种基于多面体式阵列结构的微惯性姿态测量方法,包括:
(1)利用基于多面体式阵列结构的微惯性姿态测量装置,获得原始测量数据,并对原始数据进行校正;
进一步优选地,所述两个分立的卡尔曼滤波器模型为:
进一步优选地,在卡尔曼滤波融合的过程,分别计算三个三轴加速度计合力与重力加速度值的差异:α1=|||f1 b||2-g|,取最大值max(α1,α2,α3);然后统计计算出静止时加速度计的噪声波动幅度H,以及静止时陀螺姿态姿态漂移的时间,将三者结合作为自适应调节滤波器K值的系数。
本发明与现有技术相比,优势在于:
(1)本发明设计的微惯性姿态测量装置采用基于多面体阵列结构的空间模型,模型的结构原理是将三个三轴加速度计分别按照倾斜20~70°的空间夹角布置,这样针对空间内的随机运动,在三维空间里保证至少会有一个面上的三轴加速度计不会因为运动轴上的加速度相对于其他轴权重过小,而导致难以辨识载体运动中的小幅渐变加速度,进而引起姿态计算误差过大的现象,这样同时也能够及时的捕捉到重力加速度所测定的水平面,帮助陀螺姿态进行误差补偿,避免长时间积分而造成误差累积。
(2)本发明在融合滤波方法上采用分立式多阶卡尔曼滤波结构,直接采用加速度计和磁传感器的测量值作为两个分立滤波器的观测量,避免了线性化测量方程。在姿态融合的过程中,分别计算三个面上的三轴加速度计合力与重力加速度值的差异,将最大的差异值与加速度计噪声值以及陀螺角度漂移时间作为自适应调节的滤波系数,使得整个滤波系统对运动过程中的误差估计更加实时准确。
附图说明
图1为本发明实施例中基于多面体阵列结构的空间模型示意图;
图2为本发明实施例中基于多面体式阵列结构的微惯性姿态测量装置的结构爆炸图;
图3是本发明实施例中基于多面体式阵列结构的微惯性姿态测量装置的工作原理示意图;
图4为本发明实施例中基于多面体式阵列结构的微惯性姿态测量方法的流程图。
具体实施方式
为了便于理解本发明,下面结合附图和具体实施例,对本发明进行更详细的说明。附图中给出了本发明的较佳的实施例。但是,本发明可以以许多不同的形式来实现,并不限于本说明书所描述的实施例。相反地,提供这些实施例的目的是使对本发明公开内容的理解更加透彻全面。
实施例1本发明基于多面体式阵列结构的微惯性姿态测量装置的其中一种实施例,参见图1和图2,主要由正四棱锥六面体1、微惯性测量单元和处理器控制单元13组成。其中微惯性测量单元主要由三轴陀螺仪3、三轴磁强计4、第一三轴加速度计8、第二三轴加速度计10、第三三轴加速度计14、以及四块电路板构成。
正四棱锥六面体1为对称结构,其中相邻侧面之间的夹角、侧面与顶面和底面的夹角均为60度。第一斜面电路板7和第二斜面电路板11分别通过4个无磁螺丝5和螺柱6固定在正四棱锥六面体1的相邻的两个侧面上。顶面电路板2、底面电路板12分别通过4个无磁螺丝5和螺柱6固定在正四棱锥六面体1的顶面、底面上。
第一三轴加速度计8、第二三轴加速度计10、第三三轴加速度计14分别安装在第一斜面电路板7、第二斜面电路板11和底面电路板12上。在底面电路板是12上还安装有处理器控制单元13。三轴陀螺仪3和三轴磁强计4安装在顶面电路板2上。
参见图3,三轴陀螺仪3、三轴磁强计4、第一三轴加速度计8、第二三轴加速度计10、第三三轴加速度计14、以及四块电路均与处理器控制单元13连接。
处理器控制单元13是整个系统的控制中心,由单片机、通信接口构成,单片机可选ARM、DSP等微处理器。通信接口为串口,I2C或者SPI。把微惯性测量单元采集的原始数据通过电路板传给处理器,经处理器中的算法模块处理后,通过UART或RS232/485对外输出结果。
本实施例中,三轴陀螺仪、、三个三轴加速度计、及三轴磁强计均为中低成本MEMS芯片。
实施例2本实施例提供一种微惯性姿态测量方法,该方法通过实施例1的基于多面体式阵列结构的微惯性姿态测量装置予以实现。
参见图4所示的流程图,该方法的具体步骤如下:
步骤S21:微惯性测量单元采集数据
微惯性测量单元在使用之前需要经过严格标定,将标定后的参数存储在处理器控制的FLASH中,系统上电后首先提取存储器中的标定参数,然后与传感器原始数据如角速度数据、加速度数据、磁场数据联合计算,获得校准后测量数据。
步骤S22分立式多阶卡尔曼滤波
步骤S23自适应滤波系数计算
同时,获得经校准的传感器测量数据以后,计算卡尔曼滤波融合过程的自适应滤波系数。
然后,统计计算出静止时加速度计的噪声波动幅度H,以及静止时陀螺姿态姿态漂移的时间(如1度漂移所需的时间S),将三者结合作为自适应调节滤波器K值的系数:
其中η取值为0.1~0.8之间,在公式(3)中当max(α1,α2,α3)≥ηH·S时,表示运动载体处于运动状态,系统观测方程运动干扰较大,此时卡尔曼滤波器K值系数为零,完全由陀螺仪进行状态方程的更新,当max(α1,α2,α3)<ηH·S时,表示运动载体处于准静止状态,系统进入姿态融合过程,由β值通过实时调节K值来提升姿态融合的效率。
S24姿态计算
将上式进一步整理得磁方位角ψm:
步骤S25姿态输出
完成步骤S24姿态计算之后,将方位角ψ、俯仰角θ和横滚角φ信息通过处理器控制单元,按照通信协议对外输出。
Claims (10)
1.一种基于多面体式阵列结构的微惯性姿态测量装置,包括微测量单元,其特征在于:所述微测量单元至少包括三个三轴加速度计;所述三个三轴加速度计分别呈20~70°空间夹角布置,并且相互之间的夹角角度相等。
2.根据权利要求1所述的基于多面体式阵列结构的微惯性姿态测量装置,其特征在于:其中一个三轴加速度计位于水平面上,其他两个三轴加速度计位于与所述水平面相交的斜面上。
3.根据权利要求1所述的基于多面体式阵列结构的微惯性姿态测量装置,其特征在于:所述的微测量单元还包括三轴陀螺仪。
4.根据权利要求1所述的基于多面体式阵列结构的微惯性姿态测量装置,其特征在于:所述的微测量单元还包括三轴磁强计。
5.根据权利要求1所述的所述的基于多面体式阵列结构的微惯性姿态测量装置,其特征在于:所述的微测量单元还包括电路板。
6.根据权利要求1所述的基于多面体式阵列结构的微惯性姿态测量装置,其特征在于:还包括处理器控制单元,所述的微测量单元与所述的处理器控制单元连接。
7.根据权利要求1所述的基于多面体式阵列结构的微惯性姿态测量装置,其特征在于:所述的装置还包括多面体台体结构,所述多面体台体结构至少有两个相邻侧面的夹角、以及该两个侧面与其中一个底面的夹角为20~70°,且相互之间的夹角角度相等;三个三轴加速度计分别安装在所述多面体台体结构的相邻两个侧面及其中一个底面上。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011451203.4A CN112729280B (zh) | 2020-12-10 | 2020-12-10 | 一种基于多面体式阵列结构的微惯性姿态测量装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011451203.4A CN112729280B (zh) | 2020-12-10 | 2020-12-10 | 一种基于多面体式阵列结构的微惯性姿态测量装置及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112729280A true CN112729280A (zh) | 2021-04-30 |
CN112729280B CN112729280B (zh) | 2022-09-13 |
Family
ID=75599401
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011451203.4A Active CN112729280B (zh) | 2020-12-10 | 2020-12-10 | 一种基于多面体式阵列结构的微惯性姿态测量装置及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112729280B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113447044A (zh) * | 2021-05-21 | 2021-09-28 | 上海工程技术大学 | 一种对称结构的阵列式惯性测量实验系统的设置方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050240347A1 (en) * | 2004-04-23 | 2005-10-27 | Yun-Chun Yang | Method and apparatus for adaptive filter based attitude updating |
JP2013029512A (ja) * | 2011-07-28 | 2013-02-07 | Memsic Inc | 携帯型電子デバイスのための、磁場センサおよび加速度計を使用して姿勢および角速度を検知するシステムおよび方法 |
CN107255483A (zh) * | 2017-05-27 | 2017-10-17 | 清华大学 | 一种角锥体惯性测量单元及三轴陀螺刻度因子自标定方法 |
CN109163721A (zh) * | 2018-09-18 | 2019-01-08 | 河北美泰电子科技有限公司 | 姿态测量方法及终端设备 |
CN109269471A (zh) * | 2018-11-09 | 2019-01-25 | 上海华测导航技术股份有限公司 | 一种新型gnss接收机倾斜测量系统及方法 |
CN111896773A (zh) * | 2020-07-31 | 2020-11-06 | 西安微电子技术研究所 | 一种三轴石英挠性加速度计总成及其测量方法 |
CN213932551U (zh) * | 2020-12-10 | 2021-08-10 | 山东省科学院海洋仪器仪表研究所 | 一种基于多面体式阵列结构的微惯性姿态测量装置 |
-
2020
- 2020-12-10 CN CN202011451203.4A patent/CN112729280B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050240347A1 (en) * | 2004-04-23 | 2005-10-27 | Yun-Chun Yang | Method and apparatus for adaptive filter based attitude updating |
JP2013029512A (ja) * | 2011-07-28 | 2013-02-07 | Memsic Inc | 携帯型電子デバイスのための、磁場センサおよび加速度計を使用して姿勢および角速度を検知するシステムおよび方法 |
CN107255483A (zh) * | 2017-05-27 | 2017-10-17 | 清华大学 | 一种角锥体惯性测量单元及三轴陀螺刻度因子自标定方法 |
CN109163721A (zh) * | 2018-09-18 | 2019-01-08 | 河北美泰电子科技有限公司 | 姿态测量方法及终端设备 |
CN109269471A (zh) * | 2018-11-09 | 2019-01-25 | 上海华测导航技术股份有限公司 | 一种新型gnss接收机倾斜测量系统及方法 |
CN111896773A (zh) * | 2020-07-31 | 2020-11-06 | 西安微电子技术研究所 | 一种三轴石英挠性加速度计总成及其测量方法 |
CN213932551U (zh) * | 2020-12-10 | 2021-08-10 | 山东省科学院海洋仪器仪表研究所 | 一种基于多面体式阵列结构的微惯性姿态测量装置 |
Non-Patent Citations (4)
Title |
---|
张凯等: "基于高斯和SCKF的姿态角辅助三维目标跟踪", 《控制与决策》 * |
杨英东: "GNSS/MIMU组合系统误差补偿与抗干扰问题的研究", 《中国优秀博硕士学位论文全文数据库(博士)信息科技辑》 * |
梁云等: "基于MTi-IMU微惯性航姿系统的姿态算法", 《上海电机学院学报》 * |
黄卫权等: "基于MTi微惯性航姿系统的卡尔曼滤波器设计", 《自动化技术与应用》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113447044A (zh) * | 2021-05-21 | 2021-09-28 | 上海工程技术大学 | 一种对称结构的阵列式惯性测量实验系统的设置方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112729280B (zh) | 2022-09-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111426318B (zh) | 基于四元数-扩展卡尔曼滤波的低成本ahrs航向角补偿方法 | |
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
CN112630813B (zh) | 基于捷联惯导和北斗卫星导航系统的无人机姿态测量方法 | |
CN111024064B (zh) | 一种改进Sage-Husa自适应滤波的SINS/DVL组合导航方法 | |
CN103776451B (zh) | 一种基于mems的高精度三维姿态惯性测量系统以及测量方法 | |
CN106767805B (zh) | 基于mems传感器阵列的高精度惯性量测量方法及测量系统 | |
CN106482734A (zh) | 一种用于imu多传感器数据融合的滤波方法 | |
CN104698485B (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
CN108318038A (zh) | 一种四元数高斯粒子滤波移动机器人姿态解算方法 | |
CN109425339B (zh) | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 | |
CN108458714B (zh) | 一种姿态检测系统中不含重力加速度的欧拉角求解方法 | |
CN201561759U (zh) | 惯性姿态方位测量装置 | |
CN110174123B (zh) | 一种磁传感器实时标定方法 | |
CN106403952A (zh) | 一种动中通低成本组合姿态测量方法 | |
CN109724602A (zh) | 一种基于硬件fpu的姿态解算系统及其解算方法 | |
CN103712598A (zh) | 一种小型无人机姿态确定系统与确定方法 | |
CN110567492A (zh) | 低成本mems惯性传感器系统级标定方法 | |
CN107830861A (zh) | 基于自适应增益互补滤波运动物体姿态测量方法及装置 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN108444468B (zh) | 一种融合下视视觉与惯导信息的定向罗盘 | |
CN112729280B (zh) | 一种基于多面体式阵列结构的微惯性姿态测量装置及方法 | |
CN109916399B (zh) | 一种阴影下的载体姿态估计方法 | |
CN110375773B (zh) | Mems惯导系统姿态初始化方法 | |
CN116660579A (zh) | 一种风速计数据校正方法、系统及装置 | |
CN213932551U (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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230511 Address after: Building 1604, 1605, 1606, 1607, 1608-002, Tianbao International, No. 61 Haier Road, Laoshan District, Qingdao City, Shandong Province, 266100 (centralized office area) Patentee after: Qingdao Lijing Marine Technology Co.,Ltd. Address before: 266200, Qingdao, Shandong, Qingdao, Qingdao, the core of the blue Silicon Valley, blue Silicon Valley business center, phase one, building No. 1. Patentee before: INSTITUTE OF OCEANOGRAPHIC INSTRUMENTATION, SHANDONG ACADEMY OF SCIENCES |
|
TR01 | Transfer of patent right |