纯惯性解算

这是一个纯惯性解算程序，姿态主要采用四元数法，加速度计的建模误差暂时没有考虑