We address the problem of finding the current position and heading angle of an autonomous vehicle in real-time using a single camera. Compared to methods which require LiDARs and high definition (HD) 3D maps in real-time, the proposed approach is easily scalable and computationally efficient, at the price of lower precision. The new method combines and adapts existing algorithms in three different fields: image retrieval, mapping database, and particle filtering. The result is a simple, real-time localization method using an image retrieval method whose performance is comparable to other monocular camera localization methods which use a map built with LiDARs. We evaluate the proposed method using the KITTI odometry dataset and via closed-loop experiments with an indoor 1:10 autonomous vehicle. The tests demonstrate real-time capability and a 10cm level accuracy. Also, experimental results of the closed-loop indoor tests show the presence of a positive feedback loop between the localization error and the control error. Such phenomena is analysed in details at the end of the article.
翻译:我们用一台照相机实时寻找自主飞行器当前位置和方向角的问题。与需要LiDARs和高定义(HD)实时3D地图的方法相比,拟议方法以较低精度的价格容易缩放和计算效率。新方法结合并调整了三个不同领域现有的算法:图像检索、绘图数据库和粒子过滤。结果是一种简单、实时本地化方法,采用图像检索方法,其性能可与使用LiDARs制作的地图的单个相机本地化方法相比。我们用KITTI odology数据集并通过室内1:10自主飞行器的闭环实验评估拟议方法。测试显示了实时能力和10厘米的准确度。此外,闭环室内测试的实验结果显示了定位错误与控制错误之间的积极反馈循环。在文章结尾处对此类现象进行了详细分析。