[发明专利]车辆定位、车道级路径规划的方法及装置

权利要求书

1.一种车辆定位的方法，其特征在于，包括：

获取定位周期内车辆周围的点云数据以及卫星定位系统的定位信息；

根据点云数据，获取第一特征标识物的数据；

根据所述第一特征标识物的数据以及所述卫星定位系统的定位信息，在预先建立的电子地图中匹配所述第一特征标识物对应的地图数据；

根据所匹配的地图数据，对所述车辆进行定位；

所述根据所述第一特征标识物的数据以及所述卫星定位系统的定位信息，在预先建立的电子地图中匹配所述第一特征标识物对应的地图数据，包括：

在预先建立的电子地图中匹配第一特征标识物所对应的第二特征标识物；确定所述第二特征标识物与所述第一特征标识物的二维投影线段的线段重合率，确定所述第二特征标识物与所述第一特征标识物的面积重合率；根据所述线段重合率以及所述面积重合率，确定所述第一特征标识物对应的地图数据。

2.如权利要求1所述的方法，其特征在于，所述第一特征标识物的数据包括所述第一特征标识物在车辆坐标系下的坐标位置；

根据所述第一特征标识物的数据以及所述卫星定位系统的定位信息，在预先建立的电子地图中匹配所述第一特征标识物对应的地图数据，进一步包括：

根据所述车辆的卫星定位系统的定位信息，确定所述车辆所在道路的道路方向；

按照所述第一特征标识物在车辆坐标系下的坐标位置、所述车辆的卫星定位系统的定位信息以及所述车辆所在道路的道路方向，将所述第一特征标识物在所述车辆坐标系下的坐标位置转换成所述第一特征标识物在高斯坐标系中的第一坐标位置；

将所述第一特征标识物在高斯坐标系中的第一坐标位置转换成所述第一特征标识物在大地坐标中的第一坐标位置；

以所述第一特征标识物在大地坐标系中的第一坐标位置为中心，预设的匹配长度为半径，在电子地图中，确定匹配范围；

针对所述匹配范围内的每个第二特征标识物，根据该第二特征标识物在大地坐标系中的坐标位置确定该第二特征标识物的面积和二维投影线段，根据所述第一特征标识物在所述大地坐标系下的第一坐标位置确定所述第一特征标识物的面积和二维投影线段，其中，所述第二特征标识物位于电子地图中；

确定该第二特征标识物与所述第一特征标识物的二维投影线段的线段重合率，确定该第二特征标识物与所述第一特征标识物的面积重合率；

根据所述线段重合率以及所述面积重合率，确定所述第一特征标识物对应的地图数据。

3.如权利要求2所述的方法，其特征在于，根据所匹配的地图数据，对所述车辆进行定位，进一步包括：

获取第一特征标识物在大地坐标系下的第二坐标位置；

将所述第一特征标识物在大地坐标系下的第二坐标位置转换成所述第一特征标识物在高斯坐标系下的第二坐标位置；

根据车辆坐标系下的第一特征标识物的坐标位置以及所述车辆所在道路的道路方向与正北方向的夹角，确定高斯坐标系下的第一特征标识物的坐标位置与车辆的坐标位置构成的向量；

根据所述第一特征标识物在高斯坐标系下的第二坐标位置以及所确定的高斯坐标系下的第一特征标识物的坐标位置与车辆的坐标位置构成的向量，确定在高斯坐标系下所述车辆的坐标位置；

将在高斯坐标系下所述车辆的坐标位置转换成所述车辆在大地坐标系下的坐标位置。

4.如权利要求3所述的方法，其特征在于，当存在至少两个所述第一特征标识物，确定所述车辆在电子地图中的位置，进一步包括：

针对每个第一特征标识物，确定根据该第一特征标识物所确定出的所述车辆在大地坐标系下的坐标位置与该第一特征标识物的线段重合率的乘积；

确定根据该第一特征标识物所确定出的所述车辆在大地坐标系下的坐标位置与该第一特征标识物的线段重合率的乘积之和；

确定第一特征标识物的线段重合率之和；

将根据该第一特征标识物所确定出的所述车辆在大地坐标系下的坐标位置与该第一特征标识物的线段重合率的乘积之和与所述第一特征标识物的线段重合率之和的比值作为所述车辆在电子地图中的位置。