适用于初学惯性导航原理,并用matlab速度姿态角位置误差进行卡尔曼滤波