发明名称 |
一种实现空间轨迹追踪的方法 |
摘要 |
本发明公开了一种实现空间轨迹追踪的方法,它包括以下步骤:S1、位移计算,在可穿戴设备上安装加速度计,利用加速度计测量可穿戴设备的线加速度、上报频率f及初始速度;S2、姿态计算,在可穿戴设备上安装陀螺仪,通过陀螺仪测量可穿戴设备的角速度为、上报频率为f及可穿戴设备的初始姿态;S3、漂移修正;S4、轨迹拟合,记录每次采样的位移、姿态及漂移修正信息,将这些信息绘图连接,即得到对设备轨迹的拟合,从而实现了对可穿戴设备的轨迹追踪。本发明的有益效果是:能够在GPS无法使用的场合有效追踪,具有一定的自我矫正能力、减小了因为漂移出现追踪不精确的问题。 |
申请公布号 |
CN105115500A |
申请公布日期 |
2015.12.02 |
申请号 |
CN201510395256.1 |
申请日期 |
2015.07.08 |
申请人 |
成都西可科技有限公司 |
发明人 |
赵霄萌 |
分类号 |
G01C21/12(2006.01)I;G05D1/10(2006.01)I |
主分类号 |
G01C21/12(2006.01)I |
代理机构 |
成都金英专利代理事务所(普通合伙) 51218 |
代理人 |
袁英 |
主权项 |
一种实现空间轨迹追踪的方法,其特征在于:它包括以下步骤:S1、位移计算,在可穿戴设备上安装加速度计,利用加速度计测量可穿戴设备的线加速度<img file="dest_path_FDA0000815510630000011.GIF" wi="61" he="61" />上报频率f及初始速度<img file="dest_path_FDA0000815510630000012.GIF" wi="94" he="70" />并通过公式(1)来计算可穿戴设备的位移<img file="dest_path_FDA0000815510630000013.GIF" wi="70" he="60" /><img file="dest_path_FDA0000815510630000014.GIF" wi="801" he="125" />S2、姿态计算,在可穿戴设备上安装陀螺仪,通过陀螺仪测量可穿戴设备的角速度为<img file="dest_path_FDA0000815510630000015.GIF" wi="70" he="61" />上报频率为f及可穿戴设备的初始姿态<img file="dest_path_FDA0000815510630000016.GIF" wi="74" he="71" />并通过公式(2)来计算可穿戴设备的当前姿态<img file="dest_path_FDA0000815510630000017.GIF" wi="54" he="62" /><img file="dest_path_FDA0000815510630000018.GIF" wi="759" he="108" />S3、漂移修正,根据步骤S1和步骤S2中得到的位移和姿态信息,拟合图像传感器采集的数据,使得相邻时间采集的图像能够良好接合,如果图像难以接合,则通过图像解出设备的位移和姿态变化,并作为增量叠加到现有数据当中,以实现对漂移的修正;S4、轨迹拟合,记录每次采样的位移、姿态及漂移修正信息,将这些信息绘图连接,即得到对设备轨迹的拟合,从而实现了对可穿戴设备的轨迹追踪。 |
地址 |
610041 四川省成都市成都高新区天华二路219号天府软件园C区12栋6层 |