[发明专利]一种基于差分GPS和反光板的室外组合定位方法

说明书

本发明公开了一种基于差分GPS和反光板的室外组合定位方法，将RTK差分GPS信号接收模组和激光雷达反光板组合用于停车机器人的室外场地定位。本发明通过RTK差分GPS以及反光板的组合能够实现室外场地全部位置的高精度定位，并且可以实现任意点的全局初始定位，定位效果稳定。

技术领域

本发明涉及一种应用于室外停车机器人的组合定位方法，尤其涉及一种基于差分GPS和反光板的室外组合定位方法。

背景技术

随着我国汽车消费的迅速发展，车辆保有量逐年上升，使得停车变得越来越困难，消耗了普通人大量的日常时间。近年来随着自动驾驶技术的蓬勃发展，室外自动停车机器人因此应运而生。在停车机器人的自动驾驶领域里，导航和定位一直是最核心的技术问题，目前针对于露天停车场地较为空旷，且停车流程包含了室内外场地切换的特殊条件因素，单纯采用反光板、3D SLAM、RTK差分GPS导航均无法实现整个流程的定位工作。

基于3D-SLAM与差分GPS的室外组合定位方式，该技术的问题在于必须从特定点启动，无法实现建筑物附近的全局定位和重定位。此外，停车场地空旷且车辆变动频繁的实际情况也严重制约3D-SLAM的定位精度和稳定性。

使用单一传感器的室外定位方式：1)单3D-SLAM，该技术可以在建筑物附近实现高精度定位，但问题在于室外停车场面积大且空旷，缺少参照物，且地面参照物被车辆所遮挡，因此很容易出现丢失位置的情况；2)单RTK差分GPS，该技术可以在室外空旷实现较高精度定位，但在建筑物附近定位数据不准确，在室内完全丢失位置；3)单线激光雷达反光板定位，该技术可实现全局高精度定位和重定位，但需要布置反光板，因此在室外大场地下布置的反光板工作量和施工成本巨大。

发明内容

为了解决上述技术所存在的不足之处，本发明提供了一种基于差分GPS和反光板的室外组合定位方法。

为了解决以上技术问题，本发明采用的技术方案是：一种基于差分GPS和反光板的室外组合定位方法，将RTK差分GPS信号接收模组和激光雷达反光板组合用于停车机器人的室外场地定位。

进一步地，将定位过程分为四种状态：RTK定位失效且反光板定位失效、RTK定位成功但反光板定位失效、RTK定位失效但反光板定位成功、RTK定位成功且反光板定位成功。

进一步地，RTK定位失效且反光板定位失效即代表地图中有无法定位的盲区或者外界环境影响导致定位异常，因此机器人会停留原地并上报状态信息，等待后台处理；RTK定位失效但反光板定位成功时，定位即依赖于反光板定位，反之依然；RTK定位和反光板定位均成功时，融合二者的定位结果。

进一步地，在停车机器人安装上激光雷达，在室内和室外建筑物上布置反光板，然后选择一个既能够收到RTK差分GPS数据又能够检测到足够数量的反光板的地方作为起始点，并移动机器人建立反光板地图。

进一步地，机器人建立反光板地图过程为：机器人首先静止不动，不断获取激光雷达数据并识别出反光板的位置，直到每个识别到的反光板的位置都被记录了20组以上的数据，选取距离最近的5个反光板位置作为初始地图参照；

移动机器人，不断计算出新的反光板位置，将位置压入数组中，当该数组中的点所在位置0.2m范围内没有反光板，且数组中有20个点距离此点距离小于20cm，则表明此点附近有一个新的反光板，加权平均以计算该反光板的最优位置，存入反光板列表；按照这个过程直到把所有的反光板都记录到反光板列表中；

回环检测重复识别的反光板，并提取出误差；根据机器人的路径信息分配误差；重新计算所有反光板的位置，构建完成地图。

进一步地，从反光板地图中读取所有反光板的位置信息，根据扫描到的反光板及其相互之间的距离信息通过三点定位方法计算反光板位置进行全局初定位。