[发明专利]一种对齐方法及对齐装置有效

专利信息
申请号: 201710273572.0 申请日: 2017-04-24
公开(公告)号: CN107102735B 公开(公告)日: 2018-06-19
发明(设计)人: 胡永涛;戴景文;贺杰 申请(专利权)人: 广东虚拟现实科技有限公司
主分类号: G06F3/01 分类号: G06F3/01;G01C21/18
代理公司: 深圳市深佳知识产权代理事务所(普通合伙) 44285 代理人: 王仲凯
地址: 518051 广东省广*** 国省代码: 广东;44
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 对齐 传感器 定位目标 对齐装置 目标向量 缓冲池 向量归一化 定位装置 工艺要求 算法计算 位置符合 旋转矩阵 向量 预设 预置 保存 退出
【权利要求书】:

1.一种对齐方法,其特征在于,包括:

确定IMU传感器进入稳定状态时定位目标的第一3D位置以及第一IMU计算3D位置,所述第一3D位置为所述IMU传感器进入稳定状态时根据定位装置采集的所述定位目标的3D位置信息确定所述定位目标的3D位置,所述第一IMU计算3D位置为所述IMU传感器进入稳定状态时根据所述IMU传感器采集的所述定位目标的IMU传感器信息计算出的所述定位目标的3D位置;

确定所述IMU传感器退出稳定状态时所述定位目标的第二3D位置以及第二IMU计算3D位置,所述第二3D位置为所述IMU传感器退出稳定状态时根据所述定位装置采集的所述定位目标的3D位置信息确定的所述定位目标的3D位置,所述第二IMU计算3D位置为所述IMU传感器退出稳定状态时根据所述IMU传感器采集的所述定位目标的IMU传感器信息计算出的所述定位目标的3D位置;

根据所述第一3D位置以及所述第二3D位置确定第一相对位置,所述第一相对位置为所述IMU传感器进入稳定状态时所述定位目标的3D位置以及所述IMU传感器退出稳定状态时的所述定位目标的3D位置间的距离;

根据所述第一IMU计算3D位置以及所述第二IMU计算3D位置信息确定第二相对位置,所述第二相对位置为所述IMU传感器进入稳定状态时计算出的所述定位目标的3D位置以及所述IMU传感器退出稳定状态时计算出的所述定位目标的3D位置间的距离;

判断所述第一相对位置以及所述第二相对位置是否符合预置的条件;

若是,则将所述第一相对位置以及所述第二相对位置进行向量归一化处理确定目标向量对;

将所述目标向量对保存至目标缓冲池中;

判断所述目标缓冲池中的向量对个数是否大于预设值;

若是,则通过刚性匹配算法对所述目标缓冲池中的所有向量对进行计算确定旋转矩阵;

根据所述旋转矩阵将所述定位装置的坐标系与所述IMU传感器的坐标系对齐。

2.根据权利要求1所述的方法,其特征在于,所述确定IMU传感器进入稳定状态时定位目标的第一3D位置以及第一IMU计算3D位置包括:

判断所述IMU传感器是否进入稳定状态;

若是,则采集的所述定位目标的第一3D位置信息以及第一IMU传感器信息,所述第一3D位置信息为所述IMU传感器进入稳定状态时所述定位装置采集的所述定位目标的3D位置信息,所述第一IMU传感器信息为所述IMU传感器进入稳定状态时所述IMU传感器采集的信息;

根据所述第一3D位置信息确定所述第一3D位置;

根据所述第一IMU传感器信息确定所述第一IMU计算3D位置。

3.根据权利要求2所述的方法,其特征在于,所述判断所述IMU传感器是否进入稳定状态包括:

获取任意两帧间的所述IMU传感器的yaw值的差值;

判断所述任意两帧间的所述IMU传感器的yaw值的差值是否小于第一预设的阈值;

若是,则确定所述IMU传感器进入稳定状态;

和/或,

获取任意两帧间的所述IMU传感器的pitch值的差值;

判断所述任意两帧间的所述IMU传感器的pitch值的差值是否小于第二预设的阈值;

若是,则确定所述IMU传感器进入稳定状态;

和/或,

获取任意两帧间的所述IMU传感器的roll值的差值;

判断所述任意两帧间的所述IMU传感器的roll值的差值是否小于第三预设的阈值;

若是,则确定所述IMU传感器进入稳定状态。

4.根据权利要求1所述的方法,其特征在于,所述确定所述IMU传感器退出稳定状态时所述定位目标的第二3D位置以及第二IMU计算3D位置包括:

判断所述IMU传感器是否退出所述稳定状态;

若是,则采集所述定位目标的第二3D位置信息以及第二IMU传感器信息,所述第二3D位置信息为所述IMU传感器退出稳定状态时所述定位装置采集的所述定位目标的3D位置信息,所述第二IMU传感器信息为所述IMU传感器退出稳定状态时所述IMU传感器采集的信息;

根据所述第二3D位置信息确定所述第二3D位置;

根据所述第二IMU传感器信息确定所述第二IMU计算3D位置。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广东虚拟现实科技有限公司,未经广东虚拟现实科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/201710273572.0/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top