[发明专利]一种基于改造车道线的高精度车辆定位系统及方法

摘要

本发明提供一种基于改造车道线的高精度车辆定位系统及方法，车载摄像机拍摄车辆当前位置的图片，图片包含与普通车道线有区别的改造车道线；WiFi接收机接收车辆当前位置的WiFi数据，WiFi数据由沿带定位路段间隔设置AP基站发射出的WiFi信号组成；处理器和存储器，存储器中预存有待定位路段的高精度视觉地图，高精度视觉地图中包含每个间隔位置的WIFI数据和图像数据、每条改造车道线的二维位置数据及编码，每个间隔拍摄的包含改造车道线的图片及其图像特征数据；存储器中存有可被调用的计算机程序。本发明在WiFi初步定位后，增加了改造车道线检测、图像级定位和测量级定位从而实现精确定位，改造成本低，同时实现了在无法接收GPS信号的情况下的高精度车辆定位。

主权项

1.一种基于改造车道线的高精度车辆定位系统，其特征在于：它包括：/n数据采集模块，包括车载摄像机和WiFi接收机；其中车载摄像机用于拍摄车辆当前位置的图片即图像数据，图片中包含与普通车道线有区别的改造车道线，改造车道线沿待定位路段间隔设置并对每条改造车道线进行编码；其中WiFi接收机接收车辆当前位置的WiFi数据，WiFi数据由沿带定位路段间隔设置AP基站发射出的WiFi信号组成，每个AP基站发射出的WiFi信号都包括MAC地址和WiFi信号强度；/n数据传输模块，包括图像数据传输线和WiFi数据传输线；其中图像数据传输线连接车载摄像机和数据处理模块，将车载摄像机拍摄到的图像数据传输给数据处理模块；其中WiFi数据传输线连接WiFi接收机和数据处理模块，将WiFi接收机接收到的WiFi数据传输给数据处理模块；/n数据处理模块，包括处理器和存储器，存储器中预存有待定位路段的高精度视觉地图，高精度视觉地图中包含每个间隔位置接收的WiFi数据、人工测量的每条改造车道线的二维位置数据、分类器模板和每个间隔位置拍摄的图片及从图片中提取的图像局部特征数据，每张图片中至少包含一条改造车道线；/n所述的存储器中存有计算机程序，所述的计算机程序可被所述的处理器执行以下步骤：/n根据当前位置WiFi接收机接收到的WiFi数据与预存的高精度视觉地图中的每个间隔位置接收的WiFi数据匹配，得到预存的高精度视觉地图中与当前位置接收到的WiFi数据距离最近的WiFi数据，在高精度视觉地图中选取含有该WiFi数据对应编码前后最近2条改造车道线的图片作为WiFi初定位结果；/n利用分类器对当前位置车载摄像机拍摄到的图片进行改造车道线检测，如果检测到含有改造车道线，则进行下一步，否则重新采取数据；/n提取当前位置图片的局部特征数据，与WiFi初定位结果对应的存储在高精度视觉地图中的图像局部特征数据进行匹配，选取WiFi初定位结果中特征点匹配数目最多的图片作为图像级定位结果；/n结合当前位置图片的局部特征数据与图像级定位结果的局部特征数据，计算当前车辆的车载摄像机位置与拍摄图像级定位结果图片的摄像机位置之间的位姿关系，并根据图像级定位结果图片所含的改造车道线的二维位置数据和制作高精度地图车辆的车身数据与车辆距离改造车道线的横纵向距离，得到车辆当前位置即最终定位结果。/n