一种姿态航向角的余度管理算法

标题：一种姿态航向角的余度管理算法

摘要：本发明提供了一种姿态航向角的余度管理算法，首先对信号进行处理，解决换向问题，然后对三余度信号进行比较监控和表决，通过计算两个惯导值与航姿部件差值来获取基准值，之后进行归一化处理来解决换向问题，解决了传统余度管理算法无法解决的180度附近符号跳变问题，保证了对三余度信号的正确监控和表决。

申请号：CN201510102854.5

申请日：2015/3/9

申请人：中国航空工业集团公司沈阳飞机设计研究所

首项权利要求：一种姿态航向角的余度管理算法，其特征在于，包括以下步骤：S1、获取来自惯导1、惯导2及航姿部件的三余度航向角，依次记做G1、G2和HZ；S2、计算差值，分别计算航姿角HZ和两个惯导角G1与G2的差值的绝对值△ab和△ac，若△ab＞180°，则令△ab＝360°-△ab，△ac同理；S3、计算转换基准值，取△ab与△ac中较少的值作为转换基准值JZ；S4、分别对三余度航向角G1、G2和HZ进行归一化处理，对于G1，比较abs([G1]-JZ)、abs([G1+360°]-JZ)、abs([G1-360°]-JZ)三个值的大小，将最小值对应的中扩号[]中的值赋给G1，其中abs表示绝对值，G2和HZ同理进行重新赋值；S5、采用三余度监控表决算法输出表决值，对G1、G2和HZ两两进行比较，舍去差值较大的姿态航向角；S6、表决输出处理，当步骤S5中的表决值＞180°时，最终输出表决值为前一步结果减掉360°，当第四步中的表决值＜-180°时，最终输出表决值为前一步结果加上360°。

专利类型：发明申请