利索能及
我要发布
收藏
专利号: 2015108886871
申请人: 北京健德乾坤导航系统科技有限责任公司
专利类型:发明专利
专利状态:已下证
更新日期:2026-06-16
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种用于旋转弹的横滚角的计算方法,其特征在于,包括如下步骤:步骤S1,建立弹体坐标系和导航坐标系;

步骤S2,控制旋转弹的弹体根据所述弹体坐标系和导航坐标系以预设弹体姿态角转动;

步骤S3,根据所述弹体转动的弹体姿态角建立旋转矩阵,并根据所述旋转矩阵计算所述旋转弹的旋转弹姿态矩阵;

步骤S4,设置地磁在参考系中的投影,根据所述地磁在参考系中的投影、旋转矩阵和旋转弹姿态矩阵计算横滚角。

2.如权利要求1所述的用于旋转弹的横滚角的计算方法,其特征在于,所述弹体坐标系定义为:X轴表示横滚轴,Y轴表示俯仰轴,Z轴表示偏航;所述导航坐标系定义为北东地坐标系。

3.如权利要求1所述的用于旋转弹的横滚角的计算方法,其特征在于,在所述步骤S2中,所述弹体姿态角为弹体按照以下顺序转动时的角度:绕所述Z轴转动的角度ψ,绕所述Y轴转动的角度θ,绕所述X轴转动的角度Φ。

4.如权利要求1所述的用于旋转弹的横滚角的计算方法,其特征在于,在所述步骤S3中,所述旋转矩阵为(c1,c2,c3),根据绕z轴转动ψ角,计算得到

根据绕y轴转动θ角,计算得到

根据绕x轴转动Φ角,计算得到

5.如权利要求4所述的用于旋转弹的横滚角的计算方法,其特征在于,在所述步骤S3中,根据所述旋转矩阵计算所述旋转弹的旋转弹姿态矩阵,包括如下步骤:根据所述旋转矩阵将参考体系变化至载体系,cnb=c3c2c1;

然后计算所述旋转弹姿态矩阵Cbn为:

其中,

6.如权利要求5所述的用于旋转弹的横滚角的计算方法,其特征在于,在所述步骤S4中,根据所述地磁在参考系中的投影、旋转矩阵和旋转弹姿态矩阵计算横滚角Φd为:Φd=arctan(yb/zb),

其中,

其中, 为地磁在参考系中的投影。

7.如权利要求6所述的用于旋转弹的横滚角的计算方法,其特征在于,在所述步骤S4中,根据地磁计算旋转弹横滚角,包括如下步骤:Φ1=Φ_1-k×(Φg-Φd),其中,Φ1为修正后的横滚角,Φ_1为上一次计算到的横滚角Φ1,Φg为弹体绕X轴转动横滚角度,Φg=(Φ,θ,ψ),k为预设系数。

8.如权利要求7所述的用于旋转弹的横滚角的机算方法,其特征在于,k的取值范围为

0.4~0.6。