[发明专利]一种运动惯性追踪方法

说明书

技术领域

本发明涉及人机交互技术领域，具体来说是一种运动惯性追踪方法。

背景技术

微机电系统加速度传感器由于体积小、质量轻、成本低、可靠性高等优点而备受关注， 尤其在对器件的体积、质量及可靠性有很高要求的航空航天及兵器科学领域有很大的应用 前景。加速度传感器的研究近年来发展迅速，各种性能、量程的高量程加速度传感器己经 相继报道。现有技术中的惯性追踪方法繁琐，采集的信息受噪音影响大，故而不精确。

发明内容

本发明的目的是为了解决现有技术中运动追踪方法因噪音影响而导致灵敏度不好的缺 陷，提供一种运动惯性追踪方法来解决上述问题。

为了实现上述目的，本发明的技术方案如下：

一种运动惯性追踪的方法，所述方法应用于一种运动惯性追踪系统，所述系统包括加 速计模块、控制模块、陀螺仪模块；所述加速计模块包括至少两个加速计，两个加速计相 隔一定距离设置在活动物体上；陀螺仪模块设置在所述活动物体上；加速计模块和陀螺仪 模块分别与控制模块电连接；

所述方法包括以下步骤：

11)t时刻加速度信号采集及传输

至少两个加速计分别测出活动物体在t时刻的加速度信号，并将t时刻的加速度信号 传输给控制模块；

12)确定t时刻的位置

控制模块根据至少两个加速计传输来的t时刻的加速度信号确定活动物体在t时刻的 位置；

13)t-1时刻加速度信号采集级传输

至少两个加速计分别测出活动物体在t-1时刻的加速度；并将t-1时刻的加速度信号 传输给控制模块；

14)确定t-1时刻的位置

控制模块根据至少两个加速计传输来的t-1时刻的加速度信号确定活动物体在t时刻 的位置；

15)位置矫正

控制模块根据两个加速度计的相对位置校正t—1时刻的位置；

16)角速度信号采集及传输

陀螺仪模块采集活动物体的角速度信号并将角速度信号传输给控制模块；

17)计算

控制模块根据陀螺仪模块传输的角速度信号计算出活动物体t—t-1的旋转角度。

优选的，所述步骤15)中的矫正方法为最小平方法。

优选的，所述至少两个加速度计的位置在活动物体的不同平面上。

优选的，所述加速度计为三周加速度计。

本发明与现有技术相比，具有以下有益效果：

本发明提供的方法操作简单，由于减少了惯性测量系统中的磁性罗盘模块，减少了被 测物体周围电子设备及磁场干扰，极大地精确物体旋转角度的数值，提高了测量精度；同 时，由于减少了磁性罗盘，降低了测量设备的成本。

附图说明

图1为本发明提供的一种运动惯性追踪方法应用于一种运动惯性追踪系统的结构图；

图2为本发明提供的一种运动惯性追踪方法的流程图。

具体实施方式

为使对本发明的结构特征及所达成的功效有更进一步的了解与认识，用以较佳的实施 例及附图配合详细的说明，说明如下：

如图1所示，一种运动惯性追踪的方法，所述方法应用于一种运动惯性追踪系统，所 述系统包括加速计模块、控制模块、陀螺仪模块；所述加速计模块包括至少两个加速计， 两个加速计相隔一定距离设置在活动物体上；陀螺仪模块设置在所述活动物体上；加速计 模块和陀螺仪模块分别与控制模块电连接。

如图2所示，所述方法包括以下步骤：

步骤1.t时刻加速度信号采集及传输

至少两个加速计分别测出活动物体在t时刻的加速度信号，并将t时刻的加速度信号 传输给控制模块；

步骤2.确定t时刻的位置

控制模块根据至少两个加速计传输来的t时刻的加速度信号确定活动物体在t时刻的 位置；

步骤3.t-1时刻加速度信号采集级传输

至少两个加速计分别测出活动物体在t-1时刻的加速度；并将t-1时刻的加速度信号 传输给控制模块；

步骤4.确定t-1时刻的位置

控制模块根据至少两个加速计传输来的t-1时刻的加速度信号确定活动物体在t时刻 的位置；

步骤5.位置矫正