回环修正语义并结合三角定位的重定位算法

针对栅格地图的回环检测导致语义物体的映射产生偏移,Cartographer匹配定位算法在单一环境下定位速度慢甚至定位错误的问题,本文提出基于回环检测修正语义物体位置并结合三角定位的重定位算法。通过YOLOV5物体识别并结合Cartographer构建语义地图,基于回环检测修正语义地图中语义物体位置,基于语义地图结合三角定位对机器人预定位,基于预定位位姿进行Cartographer精定位。最后通过多组真实环境下的实验证明了该算法在大场景下定位速率相较于原始Cartographer重定位算法提升76.23%,并提升鲁棒性。