通过XENS采集MARG传感器的三维加速度,三维地磁场和三维角速度,用QUEST算法和Gauss-Newton算法计算姿态,并与原始姿态进行对比,分析2种算法的优劣。最后发现Gauss-Newton迭代算法能够用来计算与体坐标系中测量的加速度和地磁场相关的最优四元数。这个最优四元数送到扩展卡尔曼滤波中作为测量值。实验结果证实了滤波器设计的有效性,证明了利用惯性/磁性传感器模型能够实现实时人体运动跟踪。