Robot Self-Localization based on a Single Image of Identified Landmarks

Abstract

This paper introduces a novel self-localization algorithm for mobile robots, which recovers the robot position from a single image of identified landmarks taken by an onboard camera. The visual angle between two landmarks can be derived from their projections in the same image. The distances between the optical center and the landmarks can be calculated from the visual angles and the known landmark positions based on the law of cosine. The robot position can then be determined using the principle of trilateration. Extensive simulation has been carried out. A comprehensive error analysis provides the insight on how to improve the localization accuracy.