申请/专利权人：格兰菲智能科技有限公司

申请日：2016-11-17

公开（公告）日：2024-03-19

公开（公告）号：CN113804191B

主分类号：G01C21/16

分类号：G01C21/16

优先权：

专利状态码：有效-授权

法律状态：2024.03.19#授权;2022.01.04#实质审查的生效;2021.12.17#公开

摘要：本发明提供一种移动设备及求取移动设备姿态的方法。移动设备包括加速度传感器、磁力计传感器、陀螺仪传感器以及处理器。加速度传感器、磁力计传感器以及陀螺仪传感器在采样时刻分别产生移动设备的加速度数据、磁场强度数据以及角速度数据。处理器根据加速度数据决定对应的俯仰角及滚动角，根据磁场强度数据决定对应的偏航角，决定俯仰角、滚动角以及偏航角所对应的四元数，根据上述采样时刻的四元数及角速度数据决定当前时刻移动设备的预测的姿态信息，以及根据加速度数据及磁场强度数据对预测的姿态信息进行修正。本发明能够更精准地反应移动设备的实际姿态。

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

全文数据：

权利要求：

百度查询： 格兰菲智能科技有限公司 移动设备及求取移动设备姿态的方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD