说明：卡尔曼滤波程序，系统为捷联惯导，维数为15的系统方程，参考书目是秦永元惯性导航

cardgja 捷联惯性 捷联导航 惯导 捷联惯导