提高捷联惯导系统姿态测量输出频率求姿态角的方法技术方案

本发明专利技术提出了一种通过提高捷联惯性导航系统姿态测量输出频率，利用欧拉角法求得姿态角的新方法。本发明专利技术提高了捷联惯性导航系统姿态测量输出频率，利用欧拉角法以求得姿态角。

【技术实现步骤摘要】

【技术保护点】
一种提高捷联惯性导航系统姿态测量输出频率的方法，其特征是：一种提高捷联惯性导航系统姿态测量输出频率求姿态角的方法，其特征是：?步骤1、通过外部设备确定载体的初始位置参数与初始速度值；?步骤2、光纤陀螺捷联惯性导航系统进行初始对准，确定载体坐标系相对导航坐标系在k时刻的初始姿态θ(k)，γ(k)；?步骤3、利用步骤2所确定的初始姿态θ(k)，γ(k)，建立载体坐标系相对于导航坐标系在k时刻的捷联矩阵T(k)；其中，?步骤4、根据光纤陀螺输出的载体坐标系相对于惯性坐标系在k时刻的角速度利用欧拉角微分方程求解；其中，欧拉角微分方程为?而为机体坐标系相对于平台坐标系在k时刻的角速度向量步骤5、利用一阶解欧拉算法求得在时刻的姿态?其中，一阶欧拉算法为：yi+1＝yi+τf(ωi，yi，ti)。根据此公式，可得出?步骤6、根据步骤5所求得的重复步骤2，再次建立载体坐标系相对于导航坐标系在时刻的捷联矩阵其中，?步骤7、根据光纤陀螺输出载体坐标系相对于惯性坐标系在时刻的角速度重复步骤3，利用欧拉角微分方程求解。?其中，欧拉角微分方程为：?步骤8、利用二阶龙格?库塔法，将的数值，更新为其中，二阶龙格?库塔法为：在步骤中，所用的一阶欧拉法求得点(xi，yi)的斜率K1＝f(ωi，yi，ti)的基础上，可得点ti+1处的预报值，即及ti点得斜率值K1＝f(ωi，yi，ti)，再由点ti+1的预报值求ti+1点的斜率值K2＝f(ωi+1，yi+1，ti+1)，然后求平均斜率?从而，则由二阶龙格?库塔法可得到?步骤9、再利用步骤8所更新后，所得到的数值，建立载体坐标系相对于导航坐标系在时刻的捷联矩阵重复步骤3至步骤8，以不断循环更新下一时刻的姿态和捷联矩阵，从而通过提高捷联惯性导航系统姿态测量输出频率能够求得姿态角。?dest_path_FSB0000115082430000011.tif,dest_path_FSB0000115082430000012.tif,dest_path_FSB0000115082430000013.tif,dest_path_FSB0000115082430000014.tif,dest_path_FSB0000115082430000015.tif,dest_path_FSB0000115082430000016.tif,dest_path_FSB0000115082430000017.tif,dest_path_FSB0000115082430000018.tif,dest_path_FSB0000115082430000019.tif,dest_path_FSB00001150824300000110.tif,dest_path_FSB0000115082430000021.tif,dest_path_FSB0000115082430000022.tif,dest_path_FSB0000115082430000023.tif,dest_path_FSB0000115082430000024.tif,dest_path_FSB0000115082430000025.tif,dest_path_FSB0000115082430000026.tif,dest_path_FSB0000115082430000027.tif,dest_path_FSB0000115082430000028.tif,dest_path_FSB0000115082430000029.tif,dest_path_FSB00001150824300000210.tif,dest_path_FSB00001150824300000211.tif,dest_path_FSB00001150824300000212.tif,dest_path_FSB00001150824300000213.tif,dest_path_FSB00001150824300000214.tif,dest_path_FSB00001150824300000215.tif,dest_path_FSB00001150824300000216.tif,dest_path_FSB0000115082430000031.tif,dest_path_FSB0000115082430000032.tif,dest_path_FSB0000115082430000033.tif,dest_path_FSB0000115082430000034.tif,dest_path_FSB0000115082430000035.tif,dest_path_FSB0000115082430000036.tif...

【技术特征摘要】

【专利技术属性】
技术研发人员：奔粤阳，杨娇龙，鲍桂清，高伟，李倩，于飞，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：