具体实施方式

下面结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

在下面的描述中阐述了很多具体细节以便于充分理解本发明，但是本发明还可以采用其他不同于在此描述的其它方式来实施，本领域技术人员可以在不违背本发明内涵的情况下做类似推广，因此本发明不受下面公开的具体实施例的限制。

如图1所示，本发明实施例公开了一种slam(同步定位与地图绘制)地图坐标系与大地坐标系转换方法，包括如下步骤：

slam过程中，采集车辆行驶轨迹上的地图坐标点集和由gps接收的大地坐标点集；

对两种点集作剔除奇异点处理和类型归一化处理，使得处理后两种点集中坐标点数至少各三个；

根据处理后的地图坐标点集和大地坐标点集，计算两者之间的变换矩阵；

利用计算的变换矩阵和类型归一化逆处理，确定地图坐标系中地图坐标对应的大地坐标。

本方法能够精准进行slam地图坐标系与大地坐标系之间的转换，为地图坐标系与大地坐标的转换提供了一种新思路。

进一步的，如图2所示，本发明实施例所述方法包括如下步骤：

将激光雷达或者摄像头和gps导航装置安装在清扫车上的固定位置处，在清扫车移动构图的过程中，采集清扫车移动轨迹上路径点的地图坐标点，同时采集在该路径点gps导航装置接收的大地坐标点。

对两种点集作剔除奇异点:剔除掉大地坐标点集中gps导航装置搜星数少于一定阀值，非正常工作模式下的大地坐标点及相应的地图坐标点，剔除掉地图坐标点集中距离值突变超过一定范围的地图坐标点及相应的大地坐标点。

剔除除奇异点处理后的两种点集中包括至少三对不重复的地图坐标点和大地坐标点。

对两种点集作类型归一化处理：将大地坐标点集的坐标点的经度值和纬度值转换为UTM投影坐标系下的距离值。

转换过程：根据大地坐标点集中每一个点的经度值和纬度值确定当前所在的时区，根据时区确定投影参数，采用WGS84坐标转UTM坐标算法确定大地坐标点集中每一个点的距离坐标值。

根据处理后的地图坐标点集和大地坐标点集，计算两者之间的变换矩阵：选取处理后的地图坐标点集和大地坐标点集中的其中一对坐标点为参考点，分别把其他点跟参考点求出多个初等变换矩阵，至少确定二个初等变换矩阵，对多个初等变换矩阵进行处理确定最后的地图坐标系到大地坐标系的变换矩阵。

利用计算的变换矩阵和类型归一化逆处理，确定地图坐标系中地图坐标对应的大地坐标：

在地图坐标系中选取任意点作为地图目标坐标点，利用以上变换矩阵对地图目标点进行处理，再将处理结果作类型同一化逆处理，处理方法为利用UTM坐标转WGS84坐标算法求出地图目标点对应的大地坐标点。

相应的，所述实施例还公开了一种与所述方法相对应的slam(同步定位与地图绘制)地图坐标系与大地坐标系转换装置，包括：

地图生成模块：用于利用激光雷达或者摄像头数据生成slam地图，获取slam运动轨迹上多个路径点的地图坐标点集和相对应的大地坐标点集。其中，大地坐标点集从gps导航装置处获取。

滤波模块：用于对采集到的地图坐标点集和大地坐标点集作剔除奇异点处理。

类型归一化处理模块：用于根据所述两种坐标点集中的大地坐标点集的经度值和纬度值做距离值的投影转换，使两种点集的数据类型归一化。

坐标转换矩阵确定模块：用于根据处理后的两种点集，确定slam地图坐标系到大地坐标系的转换矩阵。

大地坐标确定模块：用于根据确定的转换矩阵和类型归一化逆处理过程,确定地图坐标系下待转换目标点所对应的大地坐标点。

进一步的，如图4所示，本申请还公开了一种地图坐标系与大地坐标系的转换系统，包括：

至少一个激光雷达或者至少一个摄像头、gps导航装置和控制设备，控制设备与至少一个激光雷达连接或者至少一个摄像头、gps导航装置之间电连接；控制设备包括:一个或多个处理器，所述处理器内设置有所述的转换装置。

进一步的，本发明还公开了一种计算机可读存储介质，其上存储有计算机程序，该程序被一个或者多个处理器执行所述的slam地图坐标系与大地坐标的转换方法。