摘要

本发明公开了一种实现空间轨迹追踪的算法,它包括以下步骤:S1、位移计算,在可穿戴设备上安装加速度计,利用加速度计测量可穿戴设备的线加速度、上报频率f及初始速度;S2、姿态计算,在可穿戴设备上安装陀螺仪,通过陀螺仪测量可穿戴设备的角速度为、上报频率为f及可穿戴设备的初始姿态;S3、漂移修正;S4、轨迹拟合,记录每次采样的位移、姿态及漂移修正信息,将这些信息绘图连接,即得到对设备轨迹的拟合,从而实现了对可穿戴设备的轨迹追踪。本发明的有益效果是:能够在GPS无法使用的场合有效追踪,具有一定的自我矫正能力、减小了因为漂移出现追踪不精确的问题。