本人自己整理公开的四元数姿态更新一阶算法,代码从c#那边改过来的,大家应该能看懂的。搞四轴飞行器的,搞捷联式惯性导航的童鞋值得参考。代码不包括数据滤波及融合等东东。代码都有注释!