CN106403937A - 提高动基座对准精度的导航信息滤波方法 - Google Patents
提高动基座对准精度的导航信息滤波方法 Download PDFInfo
- Publication number
- CN106403937A CN106403937A CN201610529016.0A CN201610529016A CN106403937A CN 106403937 A CN106403937 A CN 106403937A CN 201610529016 A CN201610529016 A CN 201610529016A CN 106403937 A CN106403937 A CN 106403937A
- Authority
- CN
- China
- Prior art keywords
- angle
- navigation
- navigation data
- speed
- data
- 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
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
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)
Abstract
本发明的提高动基座对准精度的导航信息滤波方法包括:信息接口组合接收综合导航设备发送的导航数据;对所述导航数据进行剔点、限位、滤波的处理后,输出角度、角速度、舰速。本发明的提高动基座对准精度的导航信息滤波方法,解决在舰载平台伴有纵横摇的情况下,如何通过对高频导航数据的处理得到平滑、连续可供飞行器使用的传递对准信息的问题。
Description
技术领域
本发明涉及一种提高动基座对准精度的导航信息滤波方法。
背景技术
现代高技术战争中惯性导航***具有不可替代的作用,如何提高其快速性和准确性的精度要求是高技术战争中实现精确打击的核心问题。其中制导武器的发射反应时间主要取决于制导武器的初始对准时间,而精度打击能力主要取决于惯性导航***的精度。舰载飞行器面临动基座的条件,由于存在基座运动产生的各种干扰,以及受惯性元件的精度限制,无法采用自对准方式在较短的时间进行较高精度的初始对准。为了有效的解决上述问题,kain提出了传递对准原理,即利用运载体上高精度的主惯导计算或测量的信息作为信息源,采用惯性信息匹配的方法,实时递推估计从惯导导航坐标系相对于主惯导导航坐标系的水平和方位失准角,从而达到初始对准的目的,传递对准的时间一般较短,但是需要高精度的主惯导进行辅助对准。
虽然理论上动基座传递对准在快速性和准确性上能达到一定的要求,但是因现实环境的不同,影响惯性导航***精度的因素很多。其误差的构成主要包括:惯性仪表(陀螺和加速度计)误差、对准误差、***级误差、算法误差等。本文着重考虑杆臂效应误差、挠曲效应误差和时间延迟误差。研究表明,这三个误差是影响机载制导武器传递对准性能的关键因素。要提高机载制导武器传递对准的精度,进而提高机载制导武器的命中精度,必须考虑三大误差。及时有效的误差补偿将促成高精度惯导***的形成。
发明内容
本发明的目的在于提供一种提高动基座对准精度的导航信息滤波方法,解决在舰载平台伴有纵横摇的情况下,如何通过对高频导航数据的处理得到平滑、连续可供飞行器使用的传递对准信息的问题。
为解决上述问题,本发明提供一种提高动基座对准精度的导航信息滤波方法,包括:
信息接口组合接收综合导航设备发送的导航数据;
对所述导航数据进行剔点、限位、滤波的处理后,输出角度、角速度、舰速。
进一步的,在上述方法中,所述导航数据分为两类,一类是角度信息,包括航向角、纵摇角、横摇角,使用作为有效点数计数量,另一类是速度信息,包括舰速,使用作为其有效点数计数量。
进一步的,在上述方法中,对所述导航数据进行剔点的处理中,通过如下公式进行处理:
当 时:
其中,为剔点处理前的数据点数;
为接收到的数据值;
为剔点门限;
为第n点的剔点后的值;
为从上次数据处理后的第n-1点的角速度值或速度值;
为外推时间,即。
进一步的,在上述方法中,对所述导航数据进行剔点的处理中,所述航向角、纵摇角、横摇角分别使用独立的计数量,每发生一次剔点则,当时,重置角度有效点数,其中为导航数据处理重启点数。
进一步的,在上述方法中,对所述导航数据进行剔点的处理中,所述舰速使用计数量,每发生一次舰速剔点,则,当时,重置速度有效点数,其中为导航数据处理重启点数。
进一步的,在上述方法中,对所述导航数据进行滤波的处理,包括:
对导航数据中的角度包括航向角、纵摇角、横摇角进行滤波处理,并并计算角速度。
进一步的,在上述方法中,所述对导航数据中的角度包括航向角、纵摇角、横摇角进行滤波处理,并计算角速度,通过如下公式处理:
为第n点的角速度,计算公式如下:
当连续出现次后,滤波器重启,点数n置零。
其中:为导航的采样频率;
为接收到的数据值;
为最大角速度;
为最小角速度;
为当前角度的滤波值;
为当前经过滤波得到的角速度;
初样中,取16°/s, 取1.2°/s。
进一步的,在上述方法中,对所述导航数据进行限位的处理,包括:
对导航数据中的角度包括纵摇角、横摇角必须处于一定的范围值以内,即;
对导航数据中的角速度包括航向角速度、纵摇角速度、横摇角速度,其绝对值小于最小门限时,置为0,其绝对值大于最大门限时取边限使用,即;;
对导航数据中的舰速,规定其不得超过上限,即。
与现有技术相比,本发明可应用于高频接收不同海况下的舰载平台导航信息计算,为实时飞行器发射提供可用的传递对准信息,对新型号的研制有很好的借鉴意义,该方法分为剔点、滤波、限位三部分,另外,对于导航信息的剔点,采用了独立剔点机制,保证了某个维度出现野值的情况下不会影响其他维度的处理,对于纵横摇角速度的求取,采用了多点滑窗平滑的处理,可以准确高效地计算高频导航位置。其它海用型号可直接使用该方法,简单有效、通用性良好,能够有效的节约研制经费和人力资源成本,可满足不同舰载平台对飞行器初始预装参数解算的要求。
附图说明
图1是本发明一实施例的提高动基座对准精度的导航信息滤波方法的流程图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
如图1所示,本发明提供一种方提高动基座对准精度的导航信息滤波方法,包括:
步骤S1,信息接口组合接收综合导航设备发送的导航数据;
步骤S2,对所述导航数据进行剔点、限位、滤波的处理后,输出角度、角速度、舰速,以供其它设备使用。
优选的,所述导航数据分为两类,一类是角度信息,包括航向角、纵摇角、横摇角,使用作为有效点数计数量,另一类是速度信息,包括舰速,使用作为其有效点数计数量。其中,当前有效点数小于门限时,对相应数据不做处理,即时对角度信息不做处理,时对速度信息不做处理
优选的,对所述导航数据进行剔点的处理中,通过如下公式进行处理:
当 时:
其中,为剔点处理前的数据点数;
为接收到的数据值;
为剔点门限;
为第n点的剔点后的值;
为从上次数据处理后的第n-1点的角速度值或速度值;
为外推时间,即,以公式中的第(2)种情况即为剔点。
优选的,对所述导航数据进行剔点的处理中,所述航向角、纵摇角、横摇角分别使用独立的计数量,每发生一次剔点则,当时,重置角度有效点数,其中为导航数据处理重启点数。
优选的,对所述导航数据进行剔点的处理中,所述舰速使用计数量,每发生一次舰速剔点,则,当时,重置速度有效点数,其中为导航数据处理重启点数。
优选的,对所述导航数据进行滤波的处理,包括:
对导航数据中的角度信息包括航向角、纵摇角、横摇角进行滤波处理,并并计算角速度。
优选的,所述对导航数据中的角度包括航向角、纵摇角、横摇角进行滤波处理,并计算角速度,通过如下公式处理:
为第n点的角速度,计算公式如下:
当连续出现次后,滤波器重启,点数n置零。
其中:为导航的采样频率;
为接收到的数据值;
为最大角速度;
为最小角速度;
为当前角度的滤波值;
为当前经过滤波得到的角速度;
初样中,取16°/s, 取1.2°/s。
优选的,对所述导航数据进行限位的处理,包括:
对导航数据中的角度包括纵摇角、横摇角必须处于一定的范围值以内,即;
对导航数据中的角速度包括航向角速度、纵摇角速度、横摇角速度,其绝对值小于最小门限时,置为0,其绝对值大于最大门限时取边限使用,即;;
对导航数据中的舰速,规定其不得超过上限,即。
本发明可应用于高频接收不同海况下的舰载平台导航信息计算,为实时飞行器发射提供可用的传递对准信息,对新型号的研制有很好的借鉴意义,该方法分为剔点、滤波、限位三部分,另外,对于导航信息的剔点,采用了独立剔点机制,保证了某个维度出现野值的情况下不会影响其他维度的处理,对于纵横摇角速度的求取,采用了多点滑窗平滑的处理,可以准确高效地计算高频导航位置。其它海用型号可直接使用该方法,简单有效、通用性良好,能够有效的节约研制经费和人力资源成本,可满足不同舰载平台对飞行器初始预装参数解算的要求。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
显然,本领域的技术人员可以对发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包括这些改动和变型在内。
Claims (8)
1.一种提高动基座对准精度的导航信息滤波方法,其特征在于,包括:
信息接口组合接收综合导航设备发送的导航数据;
对所述导航数据进行剔点、限位、滤波的处理后,输出角度、角速度、舰速。
2.如权利要求1所述的提高动基座对准精度的导航信息滤波方法,其特征在于,所述导航数据分为两类,一类是角度信息,包括航向角、纵摇角、横摇角,使用作为有效点数计数量,另一类是速度信息,包括舰速,使用作为其有效点数计数量。
3.如权利要求2所述的提高动基座对准精度的导航信息滤波方法,其特征在于,对所述导航数据进行剔点的处理中,通过如下公式进行处理:
当 时:
其中,为剔点处理前的数据点数;
为接收到的数据值;
为剔点门限;
为第n点的剔点后的值;
为从上次数据处理后的第n-1点的角速度值或速度值;
为外推时间,即。
4.如权利要求3所述的提高动基座对准精度的导航信息滤波方法,其特征在于,对所述导航数据进行剔点的处理中,所述航向角、纵摇角、横摇角分别使用独立的计数量,每发生一次剔点则,当时,重置角度有效点数,其中为导航数据处理重启点数。
5.如权利要求4所述的提高动基座对准精度的导航信息滤波方法,其特征在于,对所述导航数据进行剔点的处理中,所述舰速使用计数量,每发生一次舰速剔点,则,当时,重置速度有效点数,其中为导航数据处理重启点数。
6.如权利要求5所述的提高动基座对准精度的导航信息滤波方法,其特征在于,对所述导航数据进行滤波的处理,包括:
对导航数据中的角度包括航向角、纵摇角、横摇角进行滤波处理,并并计算角速度。
7.如权利要求6所述的提高动基座对准精度的导航信息滤波方法,其特征在于,所述对导航数据中的角度包括航向角、纵摇角、横摇角进行滤波处理,并计算角速度,通过如下公式处理:
为第n点的角速度,计算公式如下:
当连续出现次后,滤波器重启,点数n置零;
为接收到的数据值;
为最大角速度;
为最小角速度;
为当前角度的滤波值;
为当前经过滤波得到的角速度;
初样中,取16°/s, 取1.2°/s。
8.如权利要求7所述的提高动基座对准精度的导航信息滤波方法,其特征在于,对所述导航数据进行限位的处理,包括:
对导航数据中的角度包括纵摇角、横摇角必须处于一定的范围值以内,即;
对导航数据中的角速度包括航向角速度、纵摇角速度、横摇角速度,其绝对值小于最小门限时,置为0,其绝对值大于最大门限时取边限使用,即;;
对导航数据中的舰速,规定其不得超过上限,即。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610529016.0A CN106403937B (zh) | 2016-07-07 | 2016-07-07 | 提高动基座对准精度的导航信息滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610529016.0A CN106403937B (zh) | 2016-07-07 | 2016-07-07 | 提高动基座对准精度的导航信息滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106403937A true CN106403937A (zh) | 2017-02-15 |
CN106403937B CN106403937B (zh) | 2023-05-26 |
Family
ID=58006359
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610529016.0A Active CN106403937B (zh) | 2016-07-07 | 2016-07-07 | 提高动基座对准精度的导航信息滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106403937B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109724624A (zh) * | 2018-12-29 | 2019-05-07 | 湖北航天技术研究院总体设计所 | 一种适用于机翼挠曲变形的机载自适应传递对准算法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101305328A (zh) * | 2005-10-12 | 2008-11-12 | 菲利普·范比尔夫列特 | 控制飞行模拟器运动的方法以及实现该方法的飞行模拟器 |
CN102256854A (zh) * | 2008-12-19 | 2011-11-23 | 沃尔沃拉斯特瓦格纳公司 | 用于对车辆巡航控件进行控制的方法和设备 |
CN102298395A (zh) * | 2011-05-31 | 2011-12-28 | 深圳华强数码电影有限公司 | 一种跟踪控制方法和*** |
CN102519450A (zh) * | 2011-12-12 | 2012-06-27 | 东南大学 | 一种用于水下滑翔器的组合导航装置及方法 |
CN103373352A (zh) * | 2012-04-27 | 2013-10-30 | 北京四维图新科技股份有限公司 | 基于航向的辅助驾驶的方法及装置 |
CN103983997A (zh) * | 2014-05-09 | 2014-08-13 | 北京航空航天大学 | 一种抗gps失效的车载组合导航方法 |
CN105021192A (zh) * | 2015-07-30 | 2015-11-04 | 华南理工大学 | 一种基于零速校正的组合导航***的实现方法 |
-
2016
- 2016-07-07 CN CN201610529016.0A patent/CN106403937B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101305328A (zh) * | 2005-10-12 | 2008-11-12 | 菲利普·范比尔夫列特 | 控制飞行模拟器运动的方法以及实现该方法的飞行模拟器 |
CN102256854A (zh) * | 2008-12-19 | 2011-11-23 | 沃尔沃拉斯特瓦格纳公司 | 用于对车辆巡航控件进行控制的方法和设备 |
CN102298395A (zh) * | 2011-05-31 | 2011-12-28 | 深圳华强数码电影有限公司 | 一种跟踪控制方法和*** |
CN102519450A (zh) * | 2011-12-12 | 2012-06-27 | 东南大学 | 一种用于水下滑翔器的组合导航装置及方法 |
CN103373352A (zh) * | 2012-04-27 | 2013-10-30 | 北京四维图新科技股份有限公司 | 基于航向的辅助驾驶的方法及装置 |
CN103983997A (zh) * | 2014-05-09 | 2014-08-13 | 北京航空航天大学 | 一种抗gps失效的车载组合导航方法 |
CN105021192A (zh) * | 2015-07-30 | 2015-11-04 | 华南理工大学 | 一种基于零速校正的组合导航***的实现方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109724624A (zh) * | 2018-12-29 | 2019-05-07 | 湖北航天技术研究院总体设计所 | 一种适用于机翼挠曲变形的机载自适应传递对准算法 |
Also Published As
Publication number | Publication date |
---|---|
CN106403937B (zh) | 2023-05-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107990910B (zh) | 一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法 | |
CN106842128B (zh) | 运动目标的声学跟踪方法及装置 | |
CN108731672B (zh) | 基于双目视觉及惯性导航的采煤机姿态检测***及方法 | |
WO2021082790A1 (zh) | 一种基于IMU的uwb定位异常值处理方法 | |
CN104121905B (zh) | 一种基于惯性传感器的航向角获取方法 | |
JP2010112854A (ja) | 歩行者用ナビゲーション装置および歩行者用ナビゲーション装置における移動方向検出方法 | |
CN105628016B (zh) | 一种基于超短基线的导航定位方法 | |
CN106643670B (zh) | 一种无人机航摄站点坐标求解装置及方法 | |
CN110174121A (zh) | 一种基于地磁场自适应修正的航姿***姿态解算方法 | |
CN109932711B (zh) | 一种雷达测量的大气折射修正方法 | |
CN109141476B (zh) | 一种动态变形下传递对准过程中角速度解耦合方法 | |
WO2018066754A1 (ko) | 라이다 센서를 이용한 차량의 자세 추정 방법 | |
KR20080086711A (ko) | 관성항법시스템의 초기정렬 방법 | |
US20210108923A1 (en) | Information processing apparatus, information processing method, and program | |
CN109765530A (zh) | 一种运动平台雷达波束解耦方法 | |
AU2015264707B2 (en) | Direct geolocation from TDOA, FDOA, and AGL | |
CN109855649A (zh) | 一种水下滑翔机平台运动轨迹被动确定方法 | |
CN103675927B (zh) | 固定翼航空电磁***接收吊舱摆动角度的校正方法 | |
CN110231620A (zh) | 一种噪声相关***跟踪滤波方法 | |
Xu et al. | A novel robust filter for outliers and time-varying delay on an SINS/USBL integrated navigation model | |
CN108413982A (zh) | 一种舰船动态对准位置杆臂补偿方法 | |
RU2564379C1 (ru) | Бесплатформенная инерциальная курсовертикаль | |
KR101953958B1 (ko) | 탄 자세추정 장치 및 방법 | |
CN108731702B (zh) | 一种基于Huber方法的大失准角传递对准方法 | |
CN106403937A (zh) | 提高动基座对准精度的导航信息滤波方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |