CN107270899B - 基于切换控制的长航时惯性导航系统阻尼切换方法 - Google Patents
基于切换控制的长航时惯性导航系统阻尼切换方法 Download PDFInfo
- Publication number
- CN107270899B CN107270899B CN201710599147.0A CN201710599147A CN107270899B CN 107270899 B CN107270899 B CN 107270899B CN 201710599147 A CN201710599147 A CN 201710599147A CN 107270899 B CN107270899 B CN 107270899B
- Authority
- CN
- China
- Prior art keywords
- navigation system
- inertial navigation
- switching
- state
- damping
- 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.)
- Active
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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于切换控制的长航时惯性导航系统阻尼切换方法。使用本发明能够有效减小惯性导航系统在阻尼切换时的超调量,提高了惯性导航系统的导航定位精度。本发明避免了传统方法简单地通过加速度将惯性导航系统的阻尼状态和无阻尼状态进行区分和切换,利用建立的惯性导航系统数学模型来考虑惯性导航系统的阻尼状态和无阻尼状态切换问题,并利用反馈控制和最优控制理论,通过状态反馈使惯性导航系统的性能指标最优,达到使系统在切换时超调量最小的目的,提高了系统导航定位精度。此外,本发明利用加加速度来进行阻尼切换,能够更早的检测到载体运动状态的变化,实现提前切换,增加了惯性导航系统的稳定性及定位精度。
Description
技术领域
本发明涉及导航、制导与控制技术领域,具体涉及一种基于切换控制的长航时惯性导航系统阻尼切换方法。
背景技术
惯性导航系统由于能够实时地为载体提供位置、速度、姿态等导航定位信息,在陆、海、空、天各类载体中广泛应用。从控制系统角度来看,惯性导航系统是一个临界稳定的系统,在误差源激励下,系统输出的导航信息中会产生振荡的误差。对于长航时惯导系统,减小振荡误差的有效方法是在惯导系统中引入阻尼。但阻尼的引入会破坏惯导系统原有的舒拉调谐条件,使得载体在机动运行时,系统输出产生误差。为了解决这一问题,惯导系统需要在无阻尼和阻尼状态间进行切换:当载体处于非机动运行时,惯导系统工作在阻尼状态,减小振荡误差带来的影响;当载体处于机动运行时,惯导系统工作在无阻尼状态,减小机动带来的误差。传统方法的切换规则是对加速度设定一个阈值,根据加速度相对阈值的大小来进行切换。这种方法可能会使惯导系统在阈值附近出现频繁切换的现象,从而影响系统性能。为了减小切换时产生的超调,传统方法仅通过设计不同的阻尼网络或对误差进行补偿来改善性能,超调衰减时间长,定位精度提升小。
发明内容
有鉴于此,本发明提供了一种基于切换控制的长航时惯性导航系统阻尼切换方法,能够有效减小惯性导航系统在阻尼切换时的超调量,提高了惯性导航系统的导航定位精度。
本发明的基于切换控制的长航时惯性导航系统阻尼切换方法,包括如下步骤:
步骤1,建立考虑阻尼状态和非阻尼状态的惯性导航系统的数学模型为:
其中,σ(t)是阻尼状态与无阻尼状态的切换律,σ(t)=1代表阻尼状态,σ(t)=2代表无阻尼状态,t0是初始时间,x0是初始状态,t是时间;Aσ(t)(t)为惯性导航系统的系统矩阵,Aσ(t)(t)={A1(t),A2(t)},A1(t)为阻尼状态系统矩阵,A2(t)为无阻尼状态系统矩阵;Bσ(t)(t)为惯性导航系统的输入矩阵,Bσ(t)(t)={B1(t),B2(t)},B1(t)为阻尼状态系统输入矩阵,B2(t)为无阻尼状态系统输入矩阵;Cσ(t)(t)是惯性导航系统输出矩阵,Cσ(t)(t)={C1(t),C2(t)},C1(t)为阻尼状态系统输出矩阵,C2(t)为无阻尼状态系统输出矩阵;x(t)为惯性导航系统的系统状态;Dw为惯性导航系统的系统干扰矩阵;
u(t)是惯性导航系统的控制输入,u(t)=-Kσ(t)(t)x(t),Kσ(t)(t)为反馈控制矩阵,Kσ(t)(t)={K1(t),K2(t)},K2(t)为无阻尼状态下的反馈控制矩阵,K2(t)=-1;K1(t)为阻尼状态下的反馈控制矩阵,其中,R-1(t)为控制加权矩阵的逆,P(t)由Riccati方程解得,上标T表示转置;
步骤2,根据设置的切换律,利用步骤1建立的惯性导航系统的数学模型实现阻尼切换。
进一步的,所述切换律为:根据惯性导航系统的加加速度相对于设定阈值的大小来进行阻尼切换。
进一步的,对惯性导航系统的加加速度进行小波分解,得到小波系数,对小波系数设定一个阈值,根据小波系数相对其阈值的大小进行阻尼切换。
进一步的,采用Daubechies小波进行小波分解。
有益效果:
(1)本发明避免了传统方法简单地通过加速度将惯性导航系统的阻尼状态和无阻尼状态进行区分和切换,利用建立的惯性导航系统数学模型来考虑惯性导航系统的阻尼状态和无阻尼状态切换问题,并利用反馈控制和最优控制理论,通过状态反馈使惯性导航系统的性能指标最优,达到使系统在切换时超调量最小的目的,提高了系统导航定位精度。
(2)本发明利用加加速度与设定阈值的大小作为切换律来进行阻尼切换,较传统的利用加速度实现阻尼切换,能够避免载体以加速度设定阈值航行时,阻尼切换系统频繁切换导致系统不稳定的问题,并且,以加加速度为指标来进行阻尼切换,可以更早的检测到载体运动状态的变化,相对于传统方法能够实现阻尼的提前切换,增加了惯性导航系统的稳定性,提高了系统导航定位精度。
(3)本发明使用的小波算法实时对加加速度进行检测,可以更准确地判断载体运动状态,进而确定更为精确的切换时间,进一步提高惯性导航系统的定位精度。
附图说明
图1为基于切换控制的长航时惯性导航系统阻尼方法的系统框图;
图2为基于切换控制的长航时惯性导航系统阻尼方法的流程图;
图3为状态反馈框图。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
本发明提供了一种基于切换控制的长航时惯性导航系统阻尼切换方法,通过建立惯性导航系统数学模型并利用状态反馈控制器实现惯性导航系统的最优控制,减小切换过程中的超调量,有效提高了惯性导航系统的精度。
本发明的阻尼切换原理是:根据惯性导航系统阻尼与无阻尼状态的特点,建立基于切换控制的惯性导航系统阻尼与无阻尼状态的状态空间数学模型。使用小波变换判断载体运行状态进行切换,通过设计状态反馈控制器,并选择与超调量有关的性能指标,通过状态反馈使性能指标达到最优,从而达到减小超调量的目的,系统框图如图1所示。
具体切换流程如图2所示,包括以下步骤:
步骤1,根据惯性导航系统在阻尼和无阻尼状态下的误差方程,确定状态变量为其中,δvE是东向速度误差,δvN是北向速度误差,是纬度误差,φE、φN、φU分别是东、北、天向误差角;建立基于切换控制的惯性导航系统的数学模型为:
其中,σ(t)是阻尼状态与无阻尼状态的切换律,σ(t)=1代表阻尼状态,σ(t)=2代表无阻尼状态,t0是初始时间,x0是初始状态,t是时间;Aσ(t)(t)为惯性导航系统的系统矩阵,是时间的分段函数,Aσ(t)(t)={A1(t),A2(t)},A1(t)为阻尼状态系统矩阵,A2(t)为无阻尼状态系统矩阵;Bσ(t)(t)为惯性导航系统的输入矩阵,是时间的分段函数,Bσ(t)(t)={B1(t),B2(t)},B1(t)为阻尼状态系统输入矩阵,B2(t)为无阻尼状态系统输入矩阵;Cσ(t)(t)是惯性导航系统输出矩阵,Cσ(t)(t)={C1(t),C2(t)},C1(t)为阻尼状态系统输出矩阵,C2(t)为无阻尼状态系统输出矩阵;x(t)为惯性导航系统的系统状态;Dw为惯性导航系统的系统干扰矩阵;u(t)是惯性导航系统的控制输入,具体表达形式为:
其中,ωie为地球自转角速度,为纬度,r为地球半径,g为重力加速度;和分别为东向和北向加速度计误差,εE,εN和εU分别为东向、北向和天向陀螺漂移。
步骤2,确定切换律,可以采用传统的以加速度为切换规则的切换律,也可以采用本实施例提出的以加加速度为切换规则的切换律。
考虑到惯性导航系统在状态切换时刻,加速度大小无突变,但加加速度会产生突变,因此,可以以加加速度为依据,利用加加速度与设定阈值的大小判断载体的运行状态,从而可以更早的检测到载体运动状态的变化,相对于传统的以加速度为依据的方法能够实现阻尼的提前切换,增加了惯性导航系统的稳定性,提高了系统导航定位精度。
其中,可以利用小波变换对加加速度进行突变性检测,可快速准确地检测到状态的改变,确定更为精确的切换时间。具体的,对惯性导航系统的加加速度采用Daubechies小波分解,得到其小波系数。当加加速度没有显著变化时,小波系数没有明显变化;当加加速度有突变时,对应时刻的小波系数会有明显的尖峰,故可对小波系数设定阈值来检测是否存在加加速度突变,从而进行切换。
步骤3,设计状态反馈控制器,对惯性导航系统的状态进行反馈控制,减小惯性导航系统在阻尼状态与无阻尼状态切换时产生的超调量。
设计的状态反馈控制器如图3所示。
具体的,状态反馈控制器的控制输出信号即为u(t),且
u(t)=-Kσ(t)(t)x(t)
其中,Kσ(t)(t)为反馈控制矩阵,Kσ(t)(t)={K1(t),K2(t)},K2(t)为无阻尼状态下的反馈控制矩阵,K1(t)为阻尼状态下的反馈控制矩阵。
对于无阻尼状态来说,K2(t)=-1;对于阻尼状态来说,u(t)=-K1(t)x(t),K1(t)为需要设计的反馈控制矩阵。将u(t)=-K1(t)x(t)代入基于切换控制的惯性导航系统的数学模型中,可得到闭环系统的状态变量模型为
步骤4,在阻尼状态与无阻尼状态切换过程中所有状态会产生超调,因此需要设计性能指标对控制过程的超调量进行度量,对控制的稳态误差也要进行度量,选取性能指标为:
其中,上标T表示转置;Q是状态加权矩阵,R是控制加权矩阵,t1是切换初始时刻,tf是切换结束时刻;Q和R都可根据要求进行调整。
步骤5,对加入反馈控制器后的惯性导航系统进行最优控制,最优控制的哈密顿函数H为:
根据Riccati方程即可求解出最优控制u*(t),其中,Riccati方程为:
则可以得到最优控制为:其中,R-1(t)为控制加权矩阵的逆,P(t)可由Riccati方程解得。
然后结合状态反馈u*(t)=-K1(t)x*(t)即可得状态反馈矩阵为:
故按照状态反馈矩阵通过状态反馈即可使切换过程性能指标达到最小,从而达到减小超调量的目的,实现最优控制。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种基于切换控制的长航时惯性导航系统阻尼切换方法,其特征在于,包括如下步骤:
步骤1,建立考虑阻尼状态和非阻尼状态的惯性导航系统的数学模型为:
其中,σ(t)是阻尼状态与无阻尼状态的切换律,σ(t)=1代表阻尼状态,σ(t)=2代表无阻尼状态,t0是初始时间,x0是初始状态,t是时间;Aσ(t)(t)为惯性导航系统的系统矩阵,Aσ(t)(t)={A1(t),A2(t)},A1(t)为阻尼状态系统矩阵,A2(t)为无阻尼状态系统矩阵;Bσ(t)(t)为惯性导航系统的输入矩阵,Bσ(t)(t)={B1(t),B2(t)},B1(t)为阻尼状态系统输入矩阵,B2(t)为无阻尼状态系统输入矩阵;Cσ(t)(t)是惯性导航系统输出矩阵,Cσ(t)(t)={C1(t),C2(t)},C1(t)为阻尼状态系统输出矩阵,C2(t)为无阻尼状态系统输出矩阵;x(t)为惯性导航系统的系统状态;Dw为惯性导航系统的系统干扰矩阵;
u(t)是惯性导航系统的控制输入,u(t)=-Kσ(t)(t)x(t),Kσ(t)(t)为反馈控制矩阵,Kσ(t)(t)={K1(t),K2(t)},K2(t)为无阻尼状态下的反馈控制矩阵,K2(t)=-1;K1(t)为阻尼状态下的反馈控制矩阵,其中,R-1(t)为控制加权矩阵的逆,P(t)由Riccati方程解得,上标T表示转置;
步骤2,根据设置的切换律,利用步骤1建立的惯性导航系统的数学模型实现阻尼切换。
2.如权利要求1所述的基于切换控制的长航时惯性导航系统阻尼切换方法,其特征在于,所述切换律为:根据惯性导航系统的加加速度相对于设定阈值的大小来进行阻尼切换。
3.如权利要求2所述的基于切换控制的长航时惯性导航系统阻尼切换方法,其特征在于,对惯性导航系统的加加速度进行小波分解,得到小波系数,对小波系数设定一个阈值,根据小波系数相对其阈值的大小进行阻尼切换。
4.如权利要求3所述的基于切换控制的长航时惯性导航系统阻尼切换方法,其特征在于,采用Daubechies小波进行小波分解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710599147.0A CN107270899B (zh) | 2017-07-21 | 2017-07-21 | 基于切换控制的长航时惯性导航系统阻尼切换方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710599147.0A CN107270899B (zh) | 2017-07-21 | 2017-07-21 | 基于切换控制的长航时惯性导航系统阻尼切换方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107270899A CN107270899A (zh) | 2017-10-20 |
CN107270899B true CN107270899B (zh) | 2019-07-30 |
Family
ID=60078472
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710599147.0A Active CN107270899B (zh) | 2017-07-21 | 2017-07-21 | 基于切换控制的长航时惯性导航系统阻尼切换方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107270899B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111198561B (zh) * | 2019-12-05 | 2021-10-22 | 浙江大华技术股份有限公司 | 目标跟踪的运动控制方法、装置、计算机设备及存储介质 |
CN110926464B (zh) * | 2019-12-11 | 2020-10-16 | 中国人民解放军海军潜艇学院 | 一种基于双模式的惯性导航方法及系统 |
CN112925204B (zh) * | 2021-01-21 | 2022-06-24 | 深圳翱诺科技有限公司 | 基于加强学习的非仿射系统最优容错控制方法 |
CN117516518B (zh) * | 2023-11-10 | 2024-04-19 | 中国人民解放军国防科技大学 | 一种地球椭球模型下的跨极区阻尼切换方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103557863A (zh) * | 2013-10-15 | 2014-02-05 | 哈尔滨工程大学 | 水下潜器的阻尼方法 |
CN105424038A (zh) * | 2015-12-17 | 2016-03-23 | 北京理工大学 | 一种长航时惯导系统进行状态切换的方法 |
-
2017
- 2017-07-21 CN CN201710599147.0A patent/CN107270899B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103557863A (zh) * | 2013-10-15 | 2014-02-05 | 哈尔滨工程大学 | 水下潜器的阻尼方法 |
CN105424038A (zh) * | 2015-12-17 | 2016-03-23 | 北京理工大学 | 一种长航时惯导系统进行状态切换的方法 |
Non-Patent Citations (2)
Title |
---|
Absolute Velocity Damping Algorithm with Varying Damping Ratio for Inertial Navigation Systems Based on Kalman Filter;丰璐等;《Proceedings of 2016 IEEE Chinese Guidance,Navigatino and Control Conference》;20170123;第2462-2467页 |
基于小波分析的惯导超调误差抑制方法研究;李开龙等;《计算机与数字工程》;20120930;第40卷(第9期);第4-7页 |
Also Published As
Publication number | Publication date |
---|---|
CN107270899A (zh) | 2017-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107270899B (zh) | 基于切换控制的长航时惯性导航系统阻尼切换方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
Serrano et al. | Trajectory tracking of underactuated surface vessels: A linear algebra approach | |
CN106444794B (zh) | 一种无参数欠驱动uuv垂直面路径跟踪滑模控制方法 | |
CN104811588B (zh) | 一种基于陀螺仪的船载稳像控制方法 | |
CN109828570A (zh) | 一种自适应边界层水面无人艇控制导引方法 | |
Boudjedir et al. | Adaptive neural network control based on neural observer for quadrotor unmanned aerial vehicle | |
CN108036676A (zh) | 一种基于三维再入弹道解析解的全射向自主再入制导方法 | |
CN106708064B (zh) | 一种水下机器人的垂直面控制方法 | |
CN108227504B (zh) | 微陀螺分数阶自适应模糊神经反演终端滑模控制方法 | |
CN107631738B (zh) | 一种陀螺飞轮偶不平衡辨识方法 | |
CN108710296B (zh) | 微陀螺仪的分数阶自适应快速终端滑模控制方法 | |
CN103616818A (zh) | 微陀螺仪的自适应模糊神经全局快速终端滑模控制方法 | |
Swathi et al. | Modeling and analysis of model reference adaptive control by using MIT and modified MIT rule for speed control of DC motor | |
CN103955223A (zh) | 一种深空探测软着陆过程的姿轨耦合控制方法 | |
CN106338918B (zh) | 一种微陀螺自适应动态面双神经网络控制方法 | |
CN104122794A (zh) | 微陀螺仪的自适应模糊神经补偿非奇异终端滑模控制方法 | |
Fujioka et al. | Input-shaped model reference control of a nonlinear time-varying double-pendulum crane | |
CN108583938B (zh) | 一种可应用于运行于太阳同步晨昏轨道的全向天线通信卫星姿态控制系统及其方法 | |
CN109828458A (zh) | 一种波浪滑翔器路径跟踪控制方法 | |
CN110389528A (zh) | 基于扰动观测的数据驱动mems陀螺仪驱动控制方法 | |
CN110377034A (zh) | 一种基于蜻蜓算法优化的水面船轨迹跟踪全局鲁棒滑模控制方法 | |
CN109885096A (zh) | 一种基于Lyapunov-MPC技术的自主水下机器人路径跟踪闭环控制方法 | |
Zhang et al. | Sliding mode prediction control for 3d path following of an underactuated auv | |
Mandić et al. | Mobile beacon control algorithm that ensures observability in single range navigation |
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 |