自身位置计算装置以及自身位置计算方法
Abstract:
一种自身位置计算装置,包括:对车辆周围的路面投光图案光的投光器(11);安装在车辆上,拍摄包含被投光了图案光的区域的车辆周围的路面而获取图像的摄像单元(12);根据摄像单元(12)获取的图像中的图案光的位置,计算车辆对于路面的姿态角的姿态角计算单元(22);根据摄像单元(12)获取的图像,在被投光了图案光的区域的周围设定特征点检测区域,在该特征点检测区域中检测路面上的多个特征点的特征点检测单元(23);根据路面上的多个特征点的时间变化,计算车辆的姿态变化量的姿态变化量计算单元(24);以及通过对车辆对于路面的初始位置以及姿态角不断加上姿态变化量,计算车辆的当前位置以及姿态角的自身位置计算单元(25)。
Public/Granted literature
Patent Agency Ranking
0/0