一种基于切换式自适应控制罗经的捷联惯导动基座对准方法
【专利摘要】本发明提出了一种基于切换式自适应控制罗经的捷联惯导动基座对准方法，该方法通过引入伪参考量、伪误差量以及代价函数，可以同时计算控制器集合中的所有备选控制器的代价值，将最佳控制器切换至回路中，而无须将所有控制器都切换入控制回路中即可评估其性能，这就避免了频繁切换的风险以及时间损耗。该方法构建简单，易于工程实现。
【专利说明】一种基于切换式自适应控制罗经的捷联惯导动基座对准方 法
【技术领域】
[0001] 本发明涉及一种捷联式惯导系统技术，具体涉及一种基于切换式自适应控制罗经 的捷联惯导动基座对准方法。
【背景技术】
[0002] 在军、民领域中的各类飞行器上，惯导系统作为一种现代化导航设备已被广泛应 用。惯导系统主要分为平台式惯导系统和捷联式惯导系统两大类。捷联惯导系统（SINS) 是在平台式惯导系统基础上发展而来的，它是一种无框架系统，由三个速率陀螺、三个线加 速度计和微型计算机组成。
[0003] 捷联惯导系统和平台式惯导系统一样，能精确提供载体的姿态、地速、经纬度等导 航参数。在捷联惯导系统中，由于计算机中存储的方向余弦解析参考系取代了平台系统以 物理形式实现的参考系，因此，捷联惯导系统有以下独特优点：去掉了复杂的平台机械系 统，系统结构极为简单，减小了系统的体积和重量，同时降低了成本，简化了维修，提高了可 靠性；除能提供平台式系统所能提供的所有参数外，还可以提供沿弹体三个轴的速度和加 速度信息。
[0004] 一般性的捷联惯导系统主要包括三个部分，如图1所示：1)惯性测量单元（MU)， 即3个陀螺和3个加速度计；2)外部传感器，为卫星、里程计等，提供速度参考量；3)导航 计算机，即具有较强计算能力的计算基板；导航计算机通过采集陀螺和加速度计的原始数 据（角速度、加速度），利用捷联导航算法计算出当前的姿态、速度、位置，作为被控对象的 输出y ;导航计算机同时采集外部传感器的信息作为参考信号r。
[0005] 如图1所示，切换式自适应控制方法需要针对一个被控对象建立一个控制器集合 (Cl?Cn)，在任意时刻t，有且只有1个控制器在控制回路中，采集被控对象的输出y，参考 量r，控制量u，并依据一定的切换法则选择合适的控制器并将其切换到控制回路中。其中， rfk，k = 1，2. . . n表示利用控制量u和控制器模型Ckk G {1，2. . . n}计算得到的伪参考量。 其物理含义是：对于控制器Ck，如果参考量为rfk时，可以产生大小为u的控制信号。
[0006] 该方法的主要缺点有两个：首先，如果控制器集合中的元素数量庞大，则将全部控 制器遍历一次，耗时将会很长；其次，如果控制器集合中包含不稳定的控制器，则有是控制 回路跑飞的风险。
【发明内容】
[0007] 为了解决上述问题，本发明提出了一种基于切换式自适应控制罗经的捷联惯导动 基座对准方法。本方法在一种新型切换式自适应控制方法的基础上，将其与罗经对准方法 结合，设计了一种基于切换式自适应控制罗经的捷联惯导动基座对准方法。
[0008] 本发明请求保护一种基于切换式自适应控制罗经的捷联惯导动基座对准方法，其 特征在于，该方法包括如下步骤：
[0009] 步骤S101，计算控制器参数；
[0010] 控制器参数可通过理论最优值通过扩展得到，其计算方法如公式（1):
【权利要求】
1. 一种基于切换式自适应控制罗经的捷联惯导动基座对准方法，其特征在于，该方法 包括如下步骤： 步骤S101，计算控制器参数； 控制器参数可通过理论最优值通过扩展得到，其计算方法如公式（1):
其中O为衰减系数，为振荡周期，g为重力加速度。 步骤S102,建立控制器集合； 首先按照公式（1)，令〇 = 〇. 055,= 50,计算得到一组基础参数：K11?K41，再 以 K11 ?K41 为 4 维球体的中心扩展开来：K12 = Kn+0.01*Kn，K22 = K21+0.01*K21，K32 = K31+0. 01*K31，K42 = K42+0. 01*K42 Kjk = Klk+0. 01*k*Klk，j = I ?4, k = I ?N， (2) 其中N代表控制器集合的元素个数。 步骤103,计算伪参考量； 伪参考量的计算公式如下：
其中，R为地球曲率半径，y为输出量，L为当地纬度，Klk?K4k表示第k个待选控制器 回路中的一组参数，输入量（控制角速率。7、《通过采样得到，s为拉氏变换符号。 步骤S104,计算各个备选控制器的代价函数值； 在引入了伪参考量后，对于每个不在控制回路中的备选控制器，均能得到与之相关的 三种参考信息，即（rfk，u，y)，分别为伪参考量、控制量、输出量，通过这三种参考信息，计算 代价函数如下：
其中W1为加权函数，efk为伪误差量，rfk为伪参考量，ii为一正数小量,其作用是防止 11+如1^_ = ?时代价函数无意义； 步骤S105,选择代价函数值最小的控制器切换入控制回路中。
2. 如权利要求1所述的方法，其特征在于，加权函数W1是为了更精细地筛选所期望的 控制器特性而加入的，其计算方式如下：
其中M为峰值频率，与超调相关，为穿越频率，与相应速度相关，A为通过频率的幅 值，表示稳态速度误差。
3. 如权利要求1所述的方法，其特征在于，伪误差量efk的计算方法为：efk = y+rfk。
4.如权利要求1所述的方法，其特征在于，代价函数的物理意义为：当有相同的参考量 时，误差越小，则代价函数值越小。
【文档编号】G01C25/00GK104344835SQ201410589895
【公开日】2015年2月11日 申请日期:2014年10月28日 优先权日:2014年10月28日
【发明者】韩勇强, 田晓春, 李楠, 谢玲, 陈家斌 申请人:北京理工大学