钻地弹引信定深爆炸控制算法

为实现定深爆破,利用惯性测量原理,合理配置钻地弹引信上加速度计空间位置。通过对加速度计输出信息的实时处理,获得了钻地弹侵彻过程中加速度和角速度信息。求解四元数微分运动方程,计算出弹体坐标系和惯性坐标系之间的变换矩阵。分解了方向余弦矩阵,将加速度计输出转换为钻地弹沿惯性坐标系的加速度分量。二次积分加速度分量,得到钻地弹瞬时轨迹信息,为定深引信提供了炸深控制参数。