一种面向封闭园区自动驾驶的单目视觉惯性定位方法
授权
摘要

本发明公开了一种面向封闭园区自动驾驶的单目视觉惯性定位方法,方法包括:S0,读入多帧连续单目图像和IMU测量信息,初始化处理;S1,跟踪上一帧的特征点,在当前帧提取特征点,处理当前帧与上一帧的IMU测量信息;S2,求取当前帧的位姿;S3,将平移向量和特征点深度与旋转向量解耦,确定当前帧的特征点中的异常点,剔除异常点;S4,在滑动窗口中选择视觉重投影误差和IMU残差为代价函数,构建最小二乘问题,求解车辆位姿;S5,根据IMU测量信息的不确定性设置优化模式;S6,在滑动窗口中,若当前帧的上一帧为非关键帧,则去掉上一帧;否则去掉滑动窗口的初始帧;去帧后转S1。本发明能够保证车辆在园区的各种工况下实现实时稳定准确的定位。

基本信息
专利标题 :
一种面向封闭园区自动驾驶的单目视觉惯性定位方法
专利标题(英):
暂无
公开(公告)号 :
CN113436261A
申请号 :
CN202110706284.6
公开(公告)日 :
2021-09-24
申请日 :
2021-06-24
授权号 :
CN113436261B
授权日 :
2022-04-29
发明人 :
秦晓辉马珅刘海涛尚敬胡云卿王晓伟边有钢徐彪谢国涛秦兆博秦洪懋胡满江丁荣军
申请人 :
湖南大学;中车株洲电力机车研究所有限公司
申请人地址 :
湖南省长沙市岳麓区麓山南路麓山门
代理机构 :
北京汇智胜知识产权代理事务所(普通合伙)
代理人 :
石辉
优先权 :
CN202110706284.6
主分类号 :
G06T7/73
IPC分类号 :
G06T7/73  G01C21/16  G01C21/28  
相关图片
IPC结构图谱
G
G部——物理
G06
计算;推算或计数
G06T
一般的图像数据处理或产生
G06T7/10
分割;边缘检测
G06T7/70
确定物体或摄像机的姿态、方向
G06T7/73
使用基于特征的方法
法律状态
2022-04-29 :
授权
2021-10-15 :
实质审查的生效
IPC(主分类) : G06T 7/73
申请日 : 20210624
2021-09-24 :
公开
注:本法律状态信息仅供参考,即时准确的法律状态信息须到国家知识产权局办理专利登记簿副本。
文件下载
1、
CN113436261A.PDF
PDF下载
  • 联系电话
    电话:023-6033-8768
    QQ:1493236332
  • 联系 Q Q
    电话:023-6033-8768
    QQ:1493236332
  • 关注微信
    电话:023-6033-8768
    QQ:1493236332
  • 收藏
    电话:023-6033-8768
    QQ:1493236332