PSINS之alignvn原理解析

注：严老师程序中量测更新时速度量测用的vn，即惯导速度减零，所以适用于静态场景，如果是动基座对准需要对量测进行修改：

kf = kfupdate(kf, vn-vgps);