一种融合反光柱及栅格地图的定位方法及装置
授权
摘要

本发明公开一种融合反光柱及栅格地图的定位方法,包括如下步骤:获取当前帧中的反光柱和对应的里程计位姿数据;检测局部概率栅格地图是否初始化,若为否,则以当前帧反光柱和对应的里程计位姿数据,更新局部概率栅格地图;若为是,则以当前帧反光柱和对应的里程计位姿数据为初值,通过局部概率栅格地图跟踪,得到更准确的约束关系,通过约束关系优化待定位对象的位姿;获取上一帧反光柱数据和当前帧反光柱数据的对应关系,通过局部概率栅格地图跟踪并利用最小二乘方法对待定位对象的位姿进行寻优;以寻优后待定位对象的位姿以及当前帧的反光柱数据,更新栅格地图。本发明能够实时连续的反馈位姿信息,保证建图和定位的稳定性。

基本信息
专利标题 :
一种融合反光柱及栅格地图的定位方法及装置
专利标题(英):
暂无
公开(公告)号 :
CN112344940A
申请号 :
CN202011230450.1
公开(公告)日 :
2021-02-09
申请日 :
2020-11-06
授权号 :
CN112344940B
授权日 :
2022-05-17
发明人 :
赵成伟胡佳琪冯艳晓靳兴来朱世强裴翔王国成
申请人 :
杭州国辰机器人科技有限公司
申请人地址 :
浙江省杭州市萧山经济开发区鸿兴路389号
代理机构 :
苏州中合知识产权代理事务所(普通合伙)
代理人 :
阮梅
优先权 :
CN202011230450.1
主分类号 :
G01C21/20
IPC分类号 :
G01C21/20  
IPC结构图谱
G
G部——物理
G01
测量;测试
G01C
测量距离、水准或者方位;勘测;导航;陀螺仪;摄影测量学或视频测量学
G01C21/00
导航;不包含在G01C1/001至G01C19/00组中的导航仪器
G01C21/20
执行导航计算的仪器
法律状态
2022-05-17 :
授权
2021-03-02 :
实质审查的生效
IPC(主分类) : G01C 21/20
申请日 : 20201106
2021-02-09 :
公开
注:本法律状态信息仅供参考,即时准确的法律状态信息须到国家知识产权局办理专利登记簿副本。
文件下载
暂无PDF文件可下载
  • 联系电话
    电话:023-6033-8768
    QQ:1493236332
  • 联系 Q Q
    电话:023-6033-8768
    QQ:1493236332
  • 关注微信
    电话:023-6033-8768
    QQ:1493236332
  • 收藏
    电话:023-6033-8768
    QQ:1493236332