CN104344835A - 一种基于切换式自适应控制罗经的捷联惯导动基座对准方法 - Google Patents
一种基于切换式自适应控制罗经的捷联惯导动基座对准方法 Download PDFInfo
- Publication number
- CN104344835A CN104344835A CN201410589895.7A CN201410589895A CN104344835A CN 104344835 A CN104344835 A CN 104344835A CN 201410589895 A CN201410589895 A CN 201410589895A CN 104344835 A CN104344835 A CN 104344835A
- Authority
- CN
- China
- Prior art keywords
- controller
- omega
- pseudo
- cost function
- reference quantity
- 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
- 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)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提出了一种基于切换式自适应控制罗经的捷联惯导动基座对准方法,该方法通过引入伪参考量、伪误差量以及代价函数,可以同时计算控制器集合中的所有备选控制器的代价值,将最佳控制器切换至回路中,而无须将所有控制器都切换入控制回路中即可评估其性能,这就避免了频繁切换的风险以及时间损耗。该方法构建简单,易于工程实现。
Description
技术领域
本发明涉及一种捷联式惯导系统技术,具体涉及一种基于切换式自适应控制罗经的捷联惯导动基座对准方法。
背景技术
在军、民领域中的各类飞行器上,惯导系统作为一种现代化导航设备已被广泛应用。惯导系统主要分为平台式惯导系统和捷联式惯导系统两大类。捷联惯导系统(SINS)是在平台式惯导系统基础上发展而来的,它是一种无框架系统,由三个速率陀螺、三个线加速度计和微型计算机组成。
捷联惯导系统和平台式惯导系统一样,能精确提供载体的姿态、地速、经纬度等导航参数。在捷联惯导系统中,由于计算机中存储的方向余弦解析参考系取代了平台系统以物理形式实现的参考系,因此,捷联惯导系统有以下独特优点:去掉了复杂的平台机械系统,系统结构极为简单,减小了系统的体积和重量,同时降低了成本,简化了维修,提高了可靠性;除能提供平台式系统所能提供的所有参数外,还可以提供沿弹体三个轴的速度和加速度信息。
一般性的捷联惯导系统主要包括三个部分,如图1所示:1)惯性测量单元(IMU),即3个陀螺和3个加速度计;2)外部传感器,为卫星、里程计等,提供速度参考量;3)导航计算机,即具有较强计算能力的计算基板;导航计算机通过采集陀螺和加速度计的原始数据(角速度、加速度),利用捷联导航算法计算出当前的姿态、速度、位置,作为被控对象的输出y;导航计算机同时采集外部传感器的信息作为参考信号r。
如图1所示,切换式自适应控制方法需要针对一个被控对象建立一个控制器集合(C1~Cn),在任意时刻t,有且只有1个控制器在控制回路中,采集被控对象的输出y,参考量r,控制量u,并依据一定的切换法则选择合适的控制器并将其切换到控制回路中。其中,rfk,k=1,2...n表示利用控制量u和控制器模型Ckk∈{1,2...n}计算得到的伪参考量。其物理含义是:对于控制器Ck,如果参考量为rfk时,可以产生大小为u的控制信号。
该方法的主要缺点有两个:首先,如果控制器集合中的元素数量庞大,则将全部控制器遍历一次,耗时将会很长;其次,如果控制器集合中包含不稳定的控制器,则有是控制回路跑飞的风险。
发明内容
为了解决上述问题,本发明提出了一种基于切换式自适应控制罗经的捷联惯导动基座对准方法。本方法在一种新型切换式自适应控制方法的基础上,将其与罗经对准方法结合,设计了一种基于切换式自适应控制罗经的捷联惯导动基座对准方法。
本发明请求保护一种基于切换式自适应控制罗经的捷联惯导动基座对准方法,其特征在于,该方法包括如下步骤:
步骤S101,计算控制器参数;
控制器参数可通过理论最优值通过扩展得到,其计算方法如公式(1):
其中σ为衰减系数,ωs为振荡周期,g为重力加速度。
步骤S102,建立控制器集合;
首先按照公式(1),令σ=0.055,ωs=50,计算得到一组基础参数:K11~K41,再以K11~K41为4维球体的中心扩展开来:K12=K11+0.01*K11,K22=K21+0.01*K21,K32=K31+0.01*K31,K42=K42+0.01*K42
Kjk=K1k+0.01*k*K1k,j=1~4,k=1~N, (2)
其中N代表控制器集合的元素个数。
步骤103,计算伪参考量;
伪参考量的计算公式如下:
其中,R为地球曲率半径,y为输出量,L为当地纬度,K1k~K4k表示第k个待选控制器回路中的一组参数,输入量(控制角速率)ωcx、ωcy、ωcz通过采样得到,s为拉氏变换符号。
步骤S104,计算各个备选控制器的代价函数值;
在引入了伪参考量后,对于每个不在控制回路中的备选控制器,均能得到与之相关的三种参考信息,即(rfk,u,y),分别为伪参考量、控制量、输出量,通过这三种参考信息,计算代价函数如下:
其中w1为加权函数,efk为伪误差量,rfk为伪参考量,μ为一正数小量,其作用是防止时代价函数无意义;
步骤S105,选择代价函数值最小的控制器切换入控制回路中。
进一步的,加权函数w1是为了更精细地筛选所期望的控制器特性而加入的,其计算方式如下:
其中M为峰值频率,与超调相关,ωb为穿越频率,与相应速度相关,A为通过频率的幅值,表示稳态速度误差。
进一步的,伪误差量efk的计算方法为:
进一步的,代价函数的物理意义为:当有相同的参考量时,误差越小,则代价函数值越小。
该方法通过引入伪参考量、伪误差量以及代价函数,可以同时计算控制器集合中的所有备选控制器的代价值,将最佳控制器切换至回路中,而无须将所有控制器都切换入控制回路中即可评估其性能,这就避免了频繁切换的风险以及时间损耗。该方法构建简单,易于工程实现。
附图说明
图1为一般性的捷联惯导系统的结构示意图;
图2为根据本发明实施例的方法的流程示意图。
具体实施方式
下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。以下实施例用于说明本发明,但不用来限制本发明的范围。
如图2所示,本发明提出了一种基于切换式自适应控制罗经的捷联惯导动基座对准方法,该方法包括如下步骤:
步骤S101,计算控制器参数;
控制器参数可通过理论最优值通过扩展得到,其计算方法如公式(1):
其中σ为衰减系数,ωs为振荡周期,g为重力加速度。
步骤S102,建立控制器集合;
首先按照公式(1),令σ=0.055,ωs=50,计算得到一组基础参数:K11~K41,K1=K4=2σ,g表示重力加速度
再以K11~K41为4维球体的中心扩展开来:K12=K11+0.01*K11,K22=K21+0.01*K21,K32=K31+0.01*K31,K42=K42+0.01*K42
Kjk=K1k+0.01*k*K1k,j=1~4,K=1~N, (2)
其中N代表控制器集合的元素个数。
步骤103,计算伪参考量;
伪参考量的计算公式如下:
其中,R为地球曲率半径,y为输出量,L为当地纬度,K1k~K4k表示第k个待选控制器回路中的一组参数(具体来说,K1k~K4k是控制器增益参数,每个控制器包含4个参数(角标1~4),角标k表示第k个待选控制器),输入量(控制角速率)ωcx、ωcy、ωcz通过采样得到,s为拉氏变换符号。
步骤S104,计算各个备选控制器的代价函数值;
在引入了伪参考量后,对于每个不在控制回路中的备选控制器,均能得到与之相关的三种参考信息,即(rfk,u,y),分别为伪参考量、控制量、输出量。本方法通过这三种参考信息,在敏感性函数概念的基础上,设计了一种代价函数.
注:代价函数(Costfunction)是(rfk,u,y)的函数,记为Jk(rfk,u,y),它将观测数据映射为一个实数,该实数代表控制器的性能,此值越小,表明控制器性能越优良,反之亦然。
本方法所采用的代价函数如下:
其中w1为加权函数,efk为伪误差量,rfk为伪参考量,μ为一正数小量,其作用是防止时代价函数无意义。
具体的,τ表示当前时间。
定义连续信号
它的L2范数为
可见,代价函数的物理意义为:当有相同的参考量时,误差越小,则代价函数值越小。
其中,加权函数w1是为了更精细地筛选所期望的控制器特性而加入的,其计算方式如下:
其中M为峰值频率,与超调相关,ωb为穿越频率,与相应速度相关,A为通过频率的幅值,表示稳态速度误差。
其中,伪误差量efk的计算方法为:efk=y+rfk
步骤S105,选择代价函数值最小的控制器切换入控制回路中。
本发明的描述是为了示例和描述起见而给出的,而并不是无遗漏的或者将本发明限于所公开的形式。很多修改和变化对于本领域的普通技术人员而言是显然的。选择和描述实施例是为了更好说明本发明的原理和实际应用,并且使本领域的普通技术人员能够理解本发明从而设计适于特定用途的带有各种修改的各种实施例。
Claims (4)
1.一种基于切换式自适应控制罗经的捷联惯导动基座对准方法,其特征在于,该方法包括如下步骤:
步骤S101,计算控制器参数;
控制器参数可通过理论最优值通过扩展得到,其计算方法如公式(1):
其中σ为衰减系数,ωs为振荡周期,g为重力加速度。
步骤S102,建立控制器集合;
首先按照公式(1),令σ=0.055,ωs=50,计算得到一组基础参数:K11~K41,再以K11~K41为4维球体的中心扩展开来:K12=K11+0.01*K11,K22=K21+0.01*K21,K32=K31+0.01*K31,K42=K42+0.01*K42
Kjk=K1k+0.01*k*K1k,j=1~4,k=1~N, (2)
其中N代表控制器集合的元素个数。
步骤103,计算伪参考量;
伪参考量的计算公式如下:
其中,R为地球曲率半径,y为输出量,L为当地纬度,K1k~K4k表示第k个待选控制器回路中的一组参数,输入量(控制角速率)ωcx、ωcy、ωcz通过采样得到,s为拉氏变换符号。
步骤S104,计算各个备选控制器的代价函数值;
在引入了伪参考量后,对于每个不在控制回路中的备选控制器,均能得到与之相关的三种参考信息,即(rfk,u,y),分别为伪参考量、控制量、输出量,通过这三种参考信息,计算代价函数如下:
其中w1为加权函数,efk为伪误差量,rfk为伪参考量,μ为一正数小量,其作用是防止时代价函数无意义;
步骤S105,选择代价函数值最小的控制器切换入控制回路中。
2.如权利要求1所述的方法,其特征在于,加权函数w1是为了更精细地筛选所期望的控制器特性而加入的,其计算方式如下:
其中M为峰值频率,与超调相关,ωb为穿越频率,与相应速度相关,A为通过频率的幅值,表示稳态速度误差。
3.如权利要求1所述的方法,其特征在于,伪误差量efk的计算方法为:efk=y+rfk。
4.如权利要求1所述的方法,其特征在于,代价函数的物理意义为:当有相同的参考量时,误差越小,则代价函数值越小。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410589895.7A CN104344835B (zh) | 2014-10-28 | 2014-10-28 | 一种基于切换式自适应控制罗经的捷联惯导动基座对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410589895.7A CN104344835B (zh) | 2014-10-28 | 2014-10-28 | 一种基于切换式自适应控制罗经的捷联惯导动基座对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104344835A true CN104344835A (zh) | 2015-02-11 |
CN104344835B CN104344835B (zh) | 2017-06-16 |
Family
ID=52500939
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410589895.7A Active CN104344835B (zh) | 2014-10-28 | 2014-10-28 | 一种基于切换式自适应控制罗经的捷联惯导动基座对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104344835B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109282831A (zh) * | 2018-09-01 | 2019-01-29 | 哈尔滨工程大学 | 一种直接基于四阶罗经方位对准系统收敛时间的分析方法 |
CN109863367A (zh) * | 2016-10-11 | 2019-06-07 | 赛峰电子与防务公司 | 对惯性导航系统对准方法的改进 |
CN111024128A (zh) * | 2019-12-30 | 2020-04-17 | 哈尔滨工程大学 | 一种机载光电吊舱光轴稳定状态传递对准方法 |
CN116295389A (zh) * | 2023-05-23 | 2023-06-23 | 中国船舶集团有限公司第七〇七研究所 | 一种捷联罗经系统状态平稳切换方法、装置、设备和介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040073360A1 (en) * | 2002-08-09 | 2004-04-15 | Eric Foxlin | Tracking, auto-calibration, and map-building system |
CN102519460A (zh) * | 2011-12-09 | 2012-06-27 | 东南大学 | 一种捷联惯性导航系统非线性对准方法 |
CN103776449A (zh) * | 2014-02-26 | 2014-05-07 | 北京空间飞行器总体设计部 | 一种提高鲁棒性的动基座初始对准方法 |
-
2014
- 2014-10-28 CN CN201410589895.7A patent/CN104344835B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040073360A1 (en) * | 2002-08-09 | 2004-04-15 | Eric Foxlin | Tracking, auto-calibration, and map-building system |
CN102519460A (zh) * | 2011-12-09 | 2012-06-27 | 东南大学 | 一种捷联惯性导航系统非线性对准方法 |
CN103776449A (zh) * | 2014-02-26 | 2014-05-07 | 北京空间飞行器总体设计部 | 一种提高鲁棒性的动基座初始对准方法 |
Non-Patent Citations (3)
Title |
---|
MICHAEL G.SAFONOV ETC.: "The Unfalsified Control Concept and Learning", 《IEEE TRANSACTIONS ON AUTOMATIC CONTROL》 * |
PAUL B.BRUGAROLAS ETC.: "Robust Switching Missle Autopilot", 《AMERICAN CONTROL CONFERENCE》 * |
梁俊宇等: "小波组合滤波技术在捷联式寻北仪中的应用研究", 《兵工学报》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109863367A (zh) * | 2016-10-11 | 2019-06-07 | 赛峰电子与防务公司 | 对惯性导航系统对准方法的改进 |
CN109863367B (zh) * | 2016-10-11 | 2020-06-09 | 赛峰电子与防务公司 | 对惯性导航系统对准方法的改进 |
CN109282831A (zh) * | 2018-09-01 | 2019-01-29 | 哈尔滨工程大学 | 一种直接基于四阶罗经方位对准系统收敛时间的分析方法 |
CN109282831B (zh) * | 2018-09-01 | 2022-06-21 | 哈尔滨工程大学 | 一种直接基于四阶罗经方位对准系统收敛时间的分析方法 |
CN111024128A (zh) * | 2019-12-30 | 2020-04-17 | 哈尔滨工程大学 | 一种机载光电吊舱光轴稳定状态传递对准方法 |
CN111024128B (zh) * | 2019-12-30 | 2022-11-15 | 哈尔滨工程大学 | 一种机载光电吊舱光轴稳定状态传递对准方法 |
CN116295389A (zh) * | 2023-05-23 | 2023-06-23 | 中国船舶集团有限公司第七〇七研究所 | 一种捷联罗经系统状态平稳切换方法、装置、设备和介质 |
CN116295389B (zh) * | 2023-05-23 | 2023-08-04 | 中国船舶集团有限公司第七〇七研究所 | 一种捷联罗经系统状态平稳切换方法、装置、设备和介质 |
Also Published As
Publication number | Publication date |
---|---|
CN104344835B (zh) | 2017-06-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101256080B (zh) | 卫星/惯性组合导航系统的空中对准方法 | |
CN106767787A (zh) | 一种紧耦合gnss/ins组合导航装置 | |
CN105043415B (zh) | 基于四元数模型的惯性系自对准方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN106643737A (zh) | 风力干扰环境下四旋翼飞行器姿态解算方法 | |
CN108759845A (zh) | 一种基于低成本多传感器组合导航的优化方法 | |
CN106990426A (zh) | 一种导航方法和导航装置 | |
CN103471613A (zh) | 一种飞行器惯性导航系统参数仿真方法 | |
CN103278163A (zh) | 一种基于非线性模型的sins/dvl组合导航方法 | |
CN105021183A (zh) | 多旋翼飞行器gps和ins低成本组合导航系统 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN102937449A (zh) | 惯性导航系统中跨音速段气压高度计和gps信息两步融合方法 | |
CN103196448A (zh) | 一种机载分布式惯性测姿系统及其传递对准方法 | |
CN105737823A (zh) | 基于五阶ckf的gps/sins/cns组合导航方法 | |
CN102519485B (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN109443342A (zh) | 新型自适应卡尔曼无人机姿态解算方法 | |
CN102768043B (zh) | 一种无外观测量的调制型捷联系统组合姿态确定方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN103454662B (zh) | 一种基于ckf的sins/北斗/dvl组合对准方法 | |
CN106153073A (zh) | 一种全姿态捷联惯导系统的非线性初始对准方法 | |
CN104344835A (zh) | 一种基于切换式自适应控制罗经的捷联惯导动基座对准方法 | |
CN103414451A (zh) | 一种应用于飞行器姿态估计的扩展卡尔曼滤波方法 | |
CN103017787A (zh) | 适用于摇摆晃动基座的初始对准方法 | |
CN105547300A (zh) | 用于auv的全源导航系统及方法 | |
CN103398725A (zh) | 一种基于星敏感器的捷联惯导系统初始对准的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant |