详细的INS/GPS组合导航程序,卡尔曼滤波,初始化条件。