CN114485636A - 一种仿生罗盘 - Google Patents
一种仿生罗盘 Download PDFInfo
- Publication number
- CN114485636A CN114485636A CN202210052584.1A CN202210052584A CN114485636A CN 114485636 A CN114485636 A CN 114485636A CN 202210052584 A CN202210052584 A CN 202210052584A CN 114485636 A CN114485636 A CN 114485636A
- Authority
- CN
- China
- Prior art keywords
- compass
- magnetic
- bionic
- heading
- carrier
- 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
- 239000011664 nicotinic acid Substances 0.000 title claims abstract description 61
- 238000012545 processing Methods 0.000 claims abstract description 18
- 238000012937 correction Methods 0.000 claims abstract description 7
- 238000000034 method Methods 0.000 claims description 22
- 238000004364 calculation method Methods 0.000 claims description 12
- 238000005259 measurement Methods 0.000 claims description 10
- 230000008859 change Effects 0.000 claims description 8
- 230000005540 biological transmission Effects 0.000 claims description 6
- 230000003592 biomimetic effect Effects 0.000 claims description 6
- 238000004891 communication Methods 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 abstract description 4
- 230000009471 action Effects 0.000 abstract description 2
- 238000005070 sampling Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 3
- 230000004075 alteration Effects 0.000 description 2
- 241000220317 Rosa Species 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
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/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
- 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/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/06—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving measuring of drift angle; involving correction for drift
-
- 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/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- 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
- 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/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种仿生罗盘,所述仿生罗盘包括组合导航***、三轴矢量磁传感器、数据采集模块、数据处理模块和结果显示模块;其中所述组合导航***包括卫星信号接收器和惯性传感器;卫星信号接收器与惯性传感器相连接,三轴矢量磁传感器、惯性传感器与数据采集模块相连接,数据处理模块与结果显示模块相连接。本发明的仿生罗盘能够解决现有磁罗盘因补偿技术在动态环境下鲁棒性低,而造成的罗盘导航性能下降问题,可通过简单的航行动作实现航向修正,并且具有高精度、低成本、操作简单等优势。
Description
技术领域
本发明涉及导航技术领域,具体涉及一种仿生罗盘。
背景技术
水下高精度导航是发展长航程水下机器人(Autonomous underwater vehicle)的重要技术,在过去将近20年里水下导航技术取得很大进步。磁罗盘是为航海、航空作业提供方向参考的一种仪器,是一种利用地球磁场矢量方向求解载体艏向角的重要工具。由于其具有体积小、功耗低、稳定性好等方面的优势,已在航空、航天、机器人、航海、导航等领域发挥重要作用。
由于外界磁异常干扰,导致磁罗盘在实际使用时存在较大误差。这些误差主要包括传感器的安装误差,多轴磁传感器存在的非正交误差,干扰磁场引起的磁罗差等。目前,常采取不同的补偿算法对罗差进行补偿。补偿方法可分为2类。一类是通过对磁传感器的输出做补偿,另一类是通过建立罗差模型,对罗盘测得磁航向做误差补偿。前者常采用椭圆拟合、椭球拟合来补偿磁场干扰,然而在补偿程序中需要磁传感器分别绕三轴做旋转运动,这对磁罗盘的实际使用提出了苛刻的要求,补偿程序中数据的采集质量直接影响补偿精度,且补偿参数不会随环境发生改变。当罗盘有较大的姿态角变化时,补偿精度就会受到较大影响。后者理论基础扎实,早在1984年就以投入航空飞行使用。罗差补偿法得到的拟合方程参数不会随载体运行环境而改变,在海洋环境下,补偿数据采集位置与载体实际航行位置不一致,得到的补偿程序不能完美的适用于外场环境,尤其是在动态环境下磁场测量误差较大,导致罗差模型拟合精度难以提高,实际使用场景下该补偿算法鲁棒性需进一步研究。
发明内容
针对现有技术存在的问题,本发明的目的在于提供一种仿生罗盘及其使用方法,能够解决现有磁罗盘因补偿技术在动态环境下鲁棒性低,而造成的罗盘导航性能下降问题,本发明提供的仿生罗盘可通过简单的航行动作实现航向修正,并且具有高精度、低成本、操作简单等优势。
为实现上述目的,本发明提供一种仿生罗盘,所述仿生罗盘包括组合导航***、三轴矢量磁传感器、数据采集模块、数据处理模块和结果显示模块;其中所述组合导航***包括卫星信号接收器和惯性传感器;卫星信号接收器与惯性传感器相连接,三轴矢量磁传感器、惯性传感器与数据采集模块相连接,数据处理模块与结果显示模块相连接。
进一步,所述惯性传感器包括陀螺仪和三轴加速度计。
进一步,数据采集模块从三轴矢量磁传感器获取磁场测量数据,从陀螺仪和三轴加速度计获取导航数据,并且数据采集模块使得磁场测量数据和导航数据的时间戳同步对齐;数据处理模块用于处理数据采集模块获取的磁场测量数据和导航数据,通过计算进行航向校正;结果显示模块用于将数据处理模块得到的结果实时显示。
进一步,三轴矢量磁传感器、陀螺仪、三轴加速度计之间的数据传输方式选择RS485串口通讯;卫星信号接收器与陀螺仪、三轴加速度计之间的数据传输采用RS232串口通讯。
进一步,所述仿生罗盘为单磁传感器构成的仿生罗盘,组合导航***与三轴矢量磁传感器在同一水平面刚性链接,其中陀螺仪的三个坐标轴分别与矢量磁传感器的三个坐标轴对齐。
进一步,仿生罗盘的使用方法包括以下步骤:
S1、数据处理模块建立全方位的罗差分布模型;
S2、利用最小二乘法求解罗差拟合参数;
S3、确定临界角;
S4、校正航向。
进一步,步骤S1中包括:
将三轴矢量磁传感器与载体刚性连接,陀螺仪提供载体姿态角与参考航向;定义载体坐标系下三轴矢量传感器所测磁场值为:
[Xb Yb Zb]T
载体坐标系下磁场值在水平坐标系下的投影为:
[Xh Yh Zh]T
利用下列公式将载体坐标系下三轴磁场值投影到水平面内,两者之间转换关系如公式:
进一步的,磁航向可用下列公式表示:
于是载体的航向可根据下式进行计算:
为了找到罗差为0的临界角,需建立全方向仿生罗盘的罗差模型,用下列公式表达磁航向与罗差之间的关系:
Δψ=A cos(ξ)+B sin(ξ)+C cos(2ξ)+D sin(2ξ)+E
式中ξ代表仿生罗盘输出的磁航向,Δψ是罗差,其含义为载体真实航向与仿生罗盘估计的航向之差,可用下列公式进行计算:
其中,仿生罗盘在外部设备的辅助下,采集N个方位的磁航向与罗差数据,误差关系式应满足如下等式:
其中,上式中的A、B、C、D、E为罗差拟合参数;
步骤S2中利用最小二乘法求解罗差拟合参数A、B、C、D、E。
进一步,步骤S3中包括:
对于单磁传感器的仿生罗盘,载体做绕圆运动来获得全方位的磁航向,根据步骤S1中磁航向计算公式解算出不同方位的磁航向ξ;
对于多磁传感器的仿生罗盘,根据传感器数量n来决定载体的航向改变的大小Δφ,计算公式为:
再进一步根据步骤S1中磁航向计算公式解算出全方位的磁航向ξ。
根据步骤S1中计算出的磁航向和步骤S2中解算的罗差拟合参数A,B,C,D,E计算不同方位对应的罗差Δψ;
在所测得的罗差数据中找到罗差为0或最接近0的临界角所在位置及罗差值,计算公式如下:
其中,m是最小罗差值,k是最小罗差对应序列索引,min()代表对括号中的变量取最小值,则ξk即为临界角。
进一步,步骤S4中,设含有误差的惯导指示航向为ψINS,仿生罗盘临界角时刻对应惯导指示航向为载体经t时间(t=0-n)的转向后,在k+t时刻惯导指示航向为则在k到k+t时间段内,载体真实航向变化角为:
可根据临界角推算k+t时刻载体的磁航向为:
于是k+t时刻利用仿生罗盘得到的载体航向角为:
其中Υ为当地磁偏角,可通过国际参考磁场数据库得到。
本发明与现有技术相比具有的有益效果:本发明的提出的一种仿生罗盘包括罗盘的***结构和使用方法两部分,仿生罗盘的***结构简单,易于实现。仿生罗盘的使用方法分为两个阶段。第一阶段,在开阔水域利用航行器携带的导航设备(如组合导航***)建立全方位的罗差分布模型。第二阶段,本发明受鸟类的磁罗盘机理启发,根据海洋环境中罗差临界角稳定性高的特点,建立基于罗差临界角稳定特性的实时航向校正方法,通过绕圆运动找到罗差为0的临界角,进而利用本发明提出的校正程序实现航向校正,解决了现有方法在动态环境中补偿精度低、标校过程对磁传感器动作、姿态要求苛刻的问题,提升了罗盘在动态环境中的导航精度。
附图说明
图1为根据本发明实施例一种仿生罗盘的***结构示意图;
图2为根据本发明实施例的多磁传感器仿生罗盘布局图;
图3为根据本发明实施例一种仿生罗盘使用方法的原理流程图;
图4为根据本发明实施例的单磁仿生罗盘校正的载体航行示意图;
图5为根据本发明实施例的仿生罗盘罗差分布图;
图6为使用本发明实施例校正后仿生罗盘的误差。
具体实施方式
下面将结合附图,对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要说明的是,术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”仅用于描述目的,而不能理解为指示或暗示相对重要性。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
以下结合附图对本发明的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明,并不用于限制本发明。
罗盘,又称罗经,是利用地球磁场引力作用而制造的一种能够指示地理方位和船舶航向的仪器。罗经线和磁经线偏离的角度叫做罗差,罗差的数学表达公式为:罗差=罗盘实测的磁方位角-相同目标在地形图上的磁方位角。因此在使用罗盘确定正确的方向时,需要考虑对罗差的补偿。本发明中的仿生罗盘属于磁罗盘的范畴,仿生罗盘是根据动物地磁导航原理所提出的一种新的地磁导航方法。
根据本发明的第1方面,本发明的仿生罗盘的***结构包括如下几个部分:
一种仿生罗盘100主要是由三轴矢量磁传感器101、惯性传感器102(包括陀螺仪和三轴加速度计)、卫星信号接收器103、数据采集模块104以及数据处理模块105组成,如图1所示。所述三轴矢量磁传感器101、惯性传感器102与数据采集模块104相连接,卫星信号接收器103与惯性传感器102相连接,数据采集模块104与数据处理模块105相连接,数据处理模块105与结果显示模块(未示出)相连接。
所述三轴矢量磁传感器101分辨率为0.1nT,量程为100μT,精度为0.1%全量程读数。
所述惯性传感器102的陀螺仪量程为500°/s,零偏稳定性为10°/h。
所述惯性传感器102的三轴加速度计量程为±5g,零偏稳定性不大于0.1mg。
可选的,三轴矢量磁传感器101、陀螺仪、三轴加速度计之间的数据传输方式选择RS485串口通讯。
可选的,卫星信号接收器103与陀螺仪、三轴加速度计之间的数据传输采用RS232串口通讯。
在仿生罗盘100工作时,陀螺仪、三轴加速度计与卫星信号接收器103构成组合导航***提供参考航向。
优选的,在单磁传感器构成的仿生罗盘中,组合导航***与三轴矢量磁传感器101在同一水平面刚性链接,其中陀螺仪的三个坐标轴分别与三轴矢量磁传感器101三个坐标轴对齐。在图2示出的多磁传感器(10个三轴矢量磁传感器101)构成的仿生罗盘中,每个三轴矢量磁传感器沿半圆周等角度分布,各三轴矢量磁传感器之间角度为18°。其中,各三轴矢量磁传感器101的X轴指向圆心106如图2所示。
数据处理模块105用于建立全方位的罗差分布模型,利用最小二乘法求解罗差拟合参数,确定临界角以及实现航向校正功能。
根据本发明的第2方面,仿生罗盘的使用方法如图3所示。
该方法可分为两个阶段,第一阶段在开阔水域利用航行器携带的导航设备(如组合导航***)建立全方位的罗差分布,记录不同磁航向对应的罗差大小。第二阶段在航行过程中通过改变航向找到罗差临界角,结合陀螺仪在短时间内提供的航向变化量,利用本发明提出仿生罗盘可实现载体航向的修正。
该方法包括以下步骤:
步骤S1:建立全方位的罗差分布模型
将三轴矢量磁传感器与载体刚性连接,陀螺仪提供载体姿态角与参考航向。定义载体坐标系下三轴矢量传感器所测磁场值为:
[Xb Yb Zb]T
载体坐标系下磁场值在水平坐标系下的投影为:
[Xh Yh Zh]T
利用下列公式将载体坐标系下三轴磁场值投影到水平面内,两者之间转换关系如公式:
进一步的,载体的磁航向可用下列公式表示:
于是根据仿生罗盘估计的载体航向可根据下式进行计算:
为了找到罗差为0的临界角,需建立全方向仿生罗盘的罗差模型,优选的可用下列公式表达磁航向与罗差之间的关系:
Δψ=A cos(ξ)+B sin(ξ)+C cos(2ξ)+D sin(2ξ)+E
式中ξ代表载体的磁航向,Δψ是罗差,其含义为载体真实航向与仿生罗盘估计的载体航向之差,可用下列公式进行计算:
进一步的,仿生罗盘在外部设备(GPS、陀螺)的辅助下,设置磁通门采样率为6HZ,载体在水面做绕圆运动如图4所示,本实施例中,载体为自主式水下航行器(下文简称AUV),一个圆周内共采集到N=498条不同方位的磁航向与罗差数据如图5所示,其中横轴是载体的磁航向,纵轴是不同磁航向下对应的罗差值,两者关系应满足下列等式:
步骤S2:利用最小二乘法对非线性误差参数进行计算,得到未知系数的值为别为:
A=-1.21357
B=-16.4416
C=0.45654
D=0.89676
E=0
步骤S3:临界角确定
对于单磁传感器的仿生罗盘,需要AUV做绕圆运动来获得不同角度的磁航向,如图4所示,进一步根据步骤1所述磁航向计算公式解算出不同方位的磁航向ξ。
可选的,对于多传感器的仿生罗盘,根据传感器数量n来决定载体的航向改变的量值Δφ,计算公式为:
再进一步根据步骤1所述磁航向计算公式解算出全方位的磁航向ξ。
根据步骤1中计算出的磁航向和步骤2中解算的罗差拟合参数A,B,C,D,E计算不同方位对应的罗差Δψ。
进一步的,在所测得的罗差数据中找到罗差为0或最接近0的临界角所在位置及罗差值,计算公式如下:
其中,m是最小罗差值,k是最小罗差对应序列索引,则得到临界角ξk=174.3145。
步骤S4:航向校正
进一步的,可根据临界角推算k+t时刻AUV的磁航向为:
于是利用以下公式得到k+t时刻的AUV航向角,结果如图6所示。其中,横轴采样点是传感器采集到的数据样本,比如“一个圆周内共采集到N=498条不同方位的磁航向”这里采样点就是498。再如,传感器采样率为6HZ表示1秒钟测量6次,得到6条测量数据,在统计测量数据量时可以说成6个采样点。纵轴表示经仿生罗盘计算得到的载体航向。计算公式为
其中为当地磁偏角Υ=3.78°,可通过国际参考磁场数据库得到。
在本说明书的描述中,参考术语“实施例”、“示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必须针对的是相同的实施例或示例。此外,本领域的技术人员可以在不产生矛盾的情况下,将本说明书中描述的不同实施例或示例以及其中的特征进行结合或组合。
上述内容虽然已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型等更新操作。
Claims (10)
1.一种仿生罗盘,其特征在于,所述仿生罗盘包括组合导航***、三轴矢量磁传感器、数据采集模块、数据处理模块和结果显示模块;其中所述组合导航***包括卫星信号接收器和惯性传感器;卫星信号接收器与惯性传感器相连接,三轴矢量磁传感器、惯性传感器与数据采集模块相连接,数据处理模块与结果显示模块相连接。
2.根据权利要求1所述的仿生罗盘,其特征在于,所述惯性传感器包括陀螺仪和三轴加速度计。
3.根据权利要求2所述的仿生罗盘,其特征在于,数据采集模块从三轴矢量磁传感器获取磁场测量数据,从陀螺仪和三轴加速度计获取导航数据,并且数据采集模块使得磁场测量数据和导航数据的时间戳同步对齐;
数据处理模块用于处理数据采集模块获取的磁场测量数据和导航数据,通过计算进行航向校正;
结果显示模块用于将数据处理模块得到的结果实时显示。
4.根据权利要求2所述的仿生罗盘,其特征在于,三轴矢量磁传感器、陀螺仪、三轴加速度计之间的数据传输方式选择RS485串口通讯;卫星信号接收器与陀螺仪、三轴加速度计之间的数据传输采用RS232串口通讯。
5.根据权利要求2所述的仿生罗盘,其特征在于,所述仿生罗盘为单磁传感器构成的仿生罗盘,组合导航***与三轴矢量磁传感器在同一水平面刚性链接,其中陀螺仪的三个坐标轴分别与矢量磁传感器的三个坐标轴对齐。
7.根据权利要求1-6任一项所述的仿生罗盘,其特征在于,所述仿生罗盘的使用方法包括以下步骤:
S1、数据处理模块建立全方位的罗差分布模型;
S2、利用最小二乘法求解罗差拟合参数;
S3、确定临界角;
S4、校正航向。
8.根据权利要求7所述的仿生罗盘,其特征在于,步骤S1中包括:
将三轴矢量磁传感器与载体刚性连接,陀螺仪提供载体姿态角与参考航向;定义载体坐标系下三轴矢量传感器所测磁场值为:
[Xb Yb Zb]T
载体坐标系下磁场值在水平坐标系下的投影为:
[Xh Yh Zh]T
利用下列公式将载体坐标系下三轴矢量传感器所测磁场值投影到水平面内,两者之间转换关系如公式:
进一步的,磁航向可用下列公式表示:
于是载体的航向可根据下式进行计算:
为了找到罗差为0的临界角,需建立全方向仿生罗盘的罗差模型,用下列公式表达磁航向与罗差之间的关系:
Δψ=Acos(ξ)+Bsin(ξ)+Ccos(2ξ)+Dsin(2ξ)+E
式中ξ代表仿生罗盘输出的磁航向,A、B、C、D、E为罗差拟合参数,Δψ是罗差,其含义为载体真实航向与仿生罗盘估计的航向之差,可用下列公式进行计算:
其中,仿生罗盘在外部设备的辅助下,采集N个方位的磁航向与罗差数据,误差关系式应满足如下等式:
步骤S2中利用最小二乘法求解罗差拟合参数A、B、C、D、E。
9.根据权利要求8所述的仿生罗盘,其特征在于,步骤S3中包括:
对于单磁传感器的仿生罗盘,载体做绕圆运动来获得全方位的磁航向,根据步骤S1中磁航向计算公式解算出不同方位的磁航向ξ;
对于多磁传感器的仿生罗盘,根据传感器数量n来决定载体的航向改变的量值Δφ,计算公式为:
再进一步根据步骤S1中磁航向计算公式解算出全方位的磁航向ξ;
根据步骤S1中计算出的磁航向和步骤S2中解算的罗差拟合参数A,B,C,D,E计算不同方位对应的罗差Δψ;
在所测得的罗差数据中找到罗差为0或最接近0的临界角所在位置及罗差值,计算公式如下:
其中,m是最小罗差值,k是最小罗差对应序列索引,min()代表对括号中的变量取最小值,则ξk即为临界角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210052584.1A CN114485636B (zh) | 2022-01-18 | 2022-01-18 | 一种仿生罗盘 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210052584.1A CN114485636B (zh) | 2022-01-18 | 2022-01-18 | 一种仿生罗盘 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114485636A true CN114485636A (zh) | 2022-05-13 |
CN114485636B CN114485636B (zh) | 2024-06-21 |
Family
ID=81512717
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210052584.1A Active CN114485636B (zh) | 2022-01-18 | 2022-01-18 | 一种仿生罗盘 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114485636B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040123474A1 (en) * | 2002-12-30 | 2004-07-01 | Manfred Mark T. | Methods and apparatus for automatic magnetic compensation |
CN102297687A (zh) * | 2011-05-13 | 2011-12-28 | 北京理工大学 | 一种电子罗盘的标定方法 |
CN203011386U (zh) * | 2012-12-12 | 2013-06-19 | 南宁睿洋自动化科技有限公司 | 一种磁阻式电子罗经 |
CN203005731U (zh) * | 2012-12-11 | 2013-06-19 | 南宁睿洋自动化科技有限公司 | 一种船用自动操舵*** |
US20130332098A1 (en) * | 2012-06-12 | 2013-12-12 | Trx Systems, Inc. | Methods for improved heading estimation |
CN104965102A (zh) * | 2015-05-25 | 2015-10-07 | 厦门大学 | 一种有效提高声学多普勒流速剖面仪流向测量精度的方法 |
WO2017063387A1 (zh) * | 2015-10-13 | 2017-04-20 | 上海华测导航技术股份有限公司 | 基于九轴mems传感器的农业机械全姿态角更新方法 |
CN106918352A (zh) * | 2017-05-02 | 2017-07-04 | 桂林电子科技大学 | 一种手持式mems磁力计的航向校正方法 |
-
2022
- 2022-01-18 CN CN202210052584.1A patent/CN114485636B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040123474A1 (en) * | 2002-12-30 | 2004-07-01 | Manfred Mark T. | Methods and apparatus for automatic magnetic compensation |
CN102297687A (zh) * | 2011-05-13 | 2011-12-28 | 北京理工大学 | 一种电子罗盘的标定方法 |
US20130332098A1 (en) * | 2012-06-12 | 2013-12-12 | Trx Systems, Inc. | Methods for improved heading estimation |
CN203005731U (zh) * | 2012-12-11 | 2013-06-19 | 南宁睿洋自动化科技有限公司 | 一种船用自动操舵*** |
CN203011386U (zh) * | 2012-12-12 | 2013-06-19 | 南宁睿洋自动化科技有限公司 | 一种磁阻式电子罗经 |
CN104965102A (zh) * | 2015-05-25 | 2015-10-07 | 厦门大学 | 一种有效提高声学多普勒流速剖面仪流向测量精度的方法 |
WO2017063387A1 (zh) * | 2015-10-13 | 2017-04-20 | 上海华测导航技术股份有限公司 | 基于九轴mems传感器的农业机械全姿态角更新方法 |
CN106918352A (zh) * | 2017-05-02 | 2017-07-04 | 桂林电子科技大学 | 一种手持式mems磁力计的航向校正方法 |
Non-Patent Citations (11)
Title |
---|
刘艳霞;方建军;张晓娟;孙建;: "超限学习机在磁罗盘非线性误差补偿中的应用", 仪器仪表学报, no. 09, pages 1923 - 1925 * |
吴浩文;杜刚;叶萍;战兴群;: "基于椭圆假设的磁罗盘航向测量算法研究", 计算机仿真, no. 02 * |
山寿;常永亮;霍朝晖;黄晓波;聂瑶佳;: "基于Android平台飞机罗盘校准***软件的实现", 计算机测量与控制, no. 01, 25 January 2020 (2020-01-25) * |
徐东甫;白越;宫勋;吴子毅;续志军;: "多旋翼无人机在变控制量下的三轴磁罗盘校正", 光学精密工程, no. 08 * |
李孟委;蒋孝勇;曹慧亮;张晓峰;王宾;: "基于地磁测向和时间到达差测距的行人航迹推算方法", 中国惯性技术学报, no. 01, 15 February 2017 (2017-02-15) * |
杜小菁;陈洪;王欣;李怀建;: "基于SINS解算的行人导航技术发展综述", 战术导弹技术, no. 01, 15 January 2020 (2020-01-15) * |
王宇;吴志强;朱欣华;: "一种数字磁罗盘的航向误差校正方法", 自动化仪表, no. 12, 20 December 2013 (2013-12-20) * |
王巍;隋丽娜;: "光纤陀螺机载导航***多信息融合", 中国惯性技术学报, no. 03 * |
秦勇;赵杰;王晓宇;: "基于椭圆拟合误差补偿算法的数字磁罗盘", 吉林大学学报(工学版), no. 02, 15 March 2009 (2009-03-15) * |
胡士峰;马建仓;孟凡路;: "基于MEMS传感器的微惯性导航***研究", 计算机测量与控制, vol. 17, no. 05, 25 May 2009 (2009-05-25), pages 1015 - 1017 * |
胡士峰;马建仓;孟凡路;: "基于MEMS传感器的微惯性导航***研究", 计算机测量与控制, vol. 17, no. 05, pages 1015 - 1017 * |
Also Published As
Publication number | Publication date |
---|---|
CN114485636B (zh) | 2024-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN105203098B (zh) | 基于九轴mems传感器的农业机械全姿态角更新方法 | |
CN104698486B (zh) | 一种分布式pos用数据处理计算机***实时导航方法 | |
CN100516775C (zh) | 一种捷联惯性导航***初始姿态确定方法 | |
CN108225324B (zh) | 一种基于智能终端的地磁匹配与pdr融合的室内定位方法 | |
CN103389092B (zh) | 一种系留飞艇姿态测量装置及测量方法 | |
CN108225308A (zh) | 一种基于四元数的扩展卡尔曼滤波算法的姿态解算方法 | |
CN101246012B (zh) | 一种基于鲁棒耗散滤波的组合导航方法 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN104880189B (zh) | 一种动中通天线低成本跟踪抗干扰方法 | |
CN111380518B (zh) | 一种引入径向速度的sins/usbl紧组合导航定位方法 | |
CN112630813A (zh) | 基于捷联惯导和北斗卫星导航***的无人机姿态测量方法 | |
CN109612460B (zh) | 一种基于静止修正的垂线偏差测量方法 | |
CN105892498B (zh) | 基于三轴云台的目标凝视与扫视控制*** | |
CN110954102A (zh) | 用于机器人定位的磁力计辅助惯性导航***及方法 | |
CN113866688B (zh) | 一种小姿态角条件下的三轴磁传感器误差校准方法 | |
CN114518587A (zh) | 一种室内外无缝定位***及方法 | |
CN114485636B (zh) | 一种仿生罗盘 | |
CN115112103B (zh) | 一种ladcp与组合惯性导航***联合观测***及方法 | |
CN116660579A (zh) | 一种风速计数据校正方法、***及装置 | |
CN114111840B (zh) | 一种基于组合导航的dvl误差参数在线标定方法 | |
CN114877881A (zh) | 一种无人机航向角测量数据的融合方法及融合*** | |
CN203364836U (zh) | 一种系留飞艇姿态测量装置 | |
Fontanella et al. | Exploiting low-cost compact sensor configurations performance by redundancy | |
CN113237485A (zh) | 一种基于多传感器融合的slam方法与*** |
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 |