移动设备及求取移动设备姿态的方法

专利主权项内容

1.一种移动设备，其特征在于，包括：加速度传感器，用以产生加速度数据；磁力计传感器，用以产生磁场强度数据；陀螺仪传感器，用以产生角速度数据；以及传感器中枢，用以：对上述加速度数据进行向量标准化处理以得到标准化的加速度向量，并根据上述标准化的加速度向量使用如下的第一公式来决定俯仰角及滚动角，
其中，[A, A, A]为标准化的加速度向量，θ为俯仰角，φ为滚动角，ψ为偏航角；xyzT根据上述磁场强度数据使用第二公式来决定上述偏航角，其中，与/>为上述磁场强度数据在水平坐标系的x轴与y轴上的分量；根据上述俯仰角、上述滚动角以及上述偏航角来决定上述俯仰角、上述滚动角以及上述偏航角所对应的四元数；根据上述四元数及上述角速度数据决定扩展卡尔曼滤波器中的状态转移矩阵；使用上述扩展卡尔曼滤波器并根据上述状态转移矩阵及上述四元数决定上述移动设备的预测姿态信息；以及决定导航坐标系与上述移动设备的载体坐标系之间的坐标变换矩阵，并根据上述坐标变换矩阵的第一元素和上述加速度数据对上述预测姿态信息中的与俯仰角及滚动角相对应的信息进行修正，以及根据上述坐标变换矩阵的不同于所述第一元素的第二元素及上述磁场强度数据对上述预测姿态信息中的与偏航角相对应的信息进行修正。