[发明专利]高过载环境下的捷联惯性导航系统陀螺信号智能滤波方法有效
申请号: | 201310080881.8 | 申请日: | 2013-03-14 |
公开(公告)号: | CN103196446A | 公开(公告)日: | 2013-07-10 |
发明(设计)人: | 徐晓苏;李佩娟;刘锡祥;张涛;王立辉 | 申请(专利权)人: | 东南大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C21/20 |
代理公司: | 南京苏高专利商标事务所(普通合伙) 32204 | 代理人: | 柏尚春 |
地址: | 210096*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 过载 环境 惯性 导航系统 陀螺 信号 智能 滤波 方法 | ||
1.一种高过载环境下的捷联惯性导航系统陀螺信号智能滤波方法,其特征为:
步骤1:建立3个BP网络结构,所述3个BP网络初始结构包括模拟高过载环境下X轴陀螺输出的BP网络、模拟高过载环境下Y轴陀螺输出的BP网络和模拟高过载环境下Z轴陀螺输出的BP网络,3个BP网络初始结构为:单输入/单输出和单个隐含层的三层网络结构形式,隐含层节点数为m,m=10;3个BP网络的输入分别为X、Y、Z轴上的陀螺输出时间相关值xθ、xγ、输出分别为X、Y、Z轴上的陀螺输出yθ、yγ、其中x、y分别表示BP网络的输入、输出,上标θ、γ、分别表示对应X、Y、Z轴的输入或输出;3个BP网络的输出与输入之间的关系分别为:
式中分别表示3个BP网络输入层到隐含层的连接权值,下标i、j分别表示输入层第i个节点与隐含层第j个节点;分别表示3个BP网络隐含层到输出层之间的连接权值,下标k表示输出层第k个节点,i=1,k=1;分别表示3个BP网络隐含层激活函数,都为Sigmoidal函数,Sigmoidal函数表达式如下:
其导数为:
其中,分别表示3个BP网络隐含层激活函数的输入,且为指数函数;分别表示3个BP网络隐含层激活函数的输出分别表示3个BP网络输出层激活函数,都为Sigmoidal函数,Sigmoidal函数表达式如下:
其导数为:
其中,u′θ、u′γ、分别表示3个BP网络输出层激活函数的输入,且
步骤2:分别接收X、Y、Z轴上的陀螺信号;
步骤3:判断是否处于进入高过载环境,所述的高过载环境判断方法为:根据捷联惯性导航系统的加速度计输出进行判断,当加速度计输出大于设定阈值5g且g为重力加速度时,则视为进入高过载环境,否则视为非高过载环境;
步骤4:当判断结果为进入高过载环境时,则3个BP网络工作在模拟输出状态,模拟陀螺信号输出,且分别以当前最新的步骤1的输出yθ、yγ、作为X、Y、Z轴上陀螺的模拟信号输出并用于导航计算;
步骤5:当判断结果为非高过载环境,则将3个陀螺输出用于导航计算并将非高过载环境下的陀螺输出作为BP网络在线训练样本,所述在线训练样本包括陀螺输出时间相关值和非高过载环境下的陀螺输出陀螺累计采样数为p,再令p=p+1,如果p小于在线训练样本数P,P=300,则返回步骤2,如果p等于300,则利用300个训练样本对BP网络进行在线训练,并以当前在线训练结果更新步骤1所述的BP网络连接权值p清零后返回步骤2,所述在线训练包括X轴在线训练、Y轴在线训练和Z轴在线训练;
所述X轴在线训练的步骤如下:
步骤5.1.1:令迭代次数nθ的初始值为1,利用随机函数Random(·)对模拟高过载环境下X轴陀螺输出的BP网络隐含层和输出层的权值进行初始化:
步骤5.1.2:计算当前迭代过程中所用300个样本总误差
式中为当前迭代过程中当输入第p个样本时模拟高过
步骤5.1.3:如果或者nθ≥10000,则采用当前更新步骤1的模拟高过载环境下X轴陀螺输出的BP网络中的否则进入步骤5.1.4;
步骤5.1.4:令nθ=nθ+1,
其中
其中
式中表示上一次迭代过程中当输入第p个样本时的BP网络输出,表示上一次迭代过程中当输入第p个样本时的BP网络输出层激活函数的输入,表示上一次迭代过程中当输入第p个样本时的BP网络隐含层激活函数的输出,表示上一次迭代过程中当输入第p个样本时的BP网络隐含层激活函数的输入,表示上一次迭代结束后隐含层到输出层的连接权值,为上一次迭代结束后输入层到隐含层的连接权值,返回步骤5.1.2;
所述Y轴在线训练的步骤如下:
步骤5.2.1:令迭代次数nγ的初始值为1,利用随机函数Random(·)对模拟高过载环境下Y轴陀螺输出的BP网络隐含层和输出层的权值进行初始化:
步骤5.2.2:计算当前迭代过程中所用300个样本总误差
式中为当前迭代过程中当输入第p个样本时模拟高过载环境下Y轴陀螺输出的BP网络的输出;
步骤5.2.3:如果或者nγ≥10000,则采用当前更新步骤1的模拟高过载环境下Y轴陀螺输出的BP网络中的否则进入步骤5.2.4;
步骤5.2.4:令nγ=nγ+1,
其中
其中
式中表示上一次迭代过程中当输入第p个样本时的BP网络输出,表示上一次迭代过程中当输入第p个样本时的BP网络输出层激活函数的输入,表示上一次迭代过程中当输入第p个样本时的BP网络隐含层激活函数的输出,表示上一次迭代过程中当输入第p个样本时的BP网络隐含层激活函数的输入,表示上一次迭代结束后隐含层到输出层的连接权值,为上一次迭代结束后输入层到隐含层的连接权值,返回步骤5.2.2;
所述Z轴在线训练的步骤如下:
步骤5.3.1:令迭代次数的初始值为1,利用随机函数Random(·)对模拟高过载环境下Z轴陀螺输出的BP网络隐含层和输出层的权值进行初始化:
步骤5.3.2:计算当前迭代过程中所用300个样本总误差
式中为当前迭代过程中当输入第p个样本时模拟高过载环境下Z轴陀螺输出的BP网络的输出;
步骤5.3.3:如果或者则采用当前更新步骤1的模拟高过载环境下Z轴陀螺输出的BP网络中的否则进入步骤5.3.4;
步骤5.3.4:令
其中
其中
式中表示上一次迭代过程中当输入第p个样本时的BP网络输出,表示上一次迭代过程中当输入第p个样本时的BP网络输出层激活函数的输入,表示上一次迭代过程中当输入第p个样本时的BP网络隐含层激活函数的输出,表示上一次迭代过程中当输入第p个样本时的BP网络隐含层激活函数的输入,表示上一次迭代结束后隐含层到输出层的连接权值,为上一次迭代结束后输入层到隐含层的连接权值,返回步骤5.3.2。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于东南大学,未经东南大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201310080881.8/1.html,转载请声明来源钻瓜专利网。