Position and Altitude of the Nao Camera Head from Two Points on the Soccer Field plus the Gravitational Direction

TL;DR

This paper introduces a geometric method using simplified tetrahedron models and rational trigonometry to accurately estimate the Nao robot's camera position and altitude on a soccer field, improving speed without sacrificing accuracy.

Contribution

It presents a novel geometric approach for determining robot camera position and altitude using minimal observed points and gravitational direction, optimized with rational trigonometry.

Findings

28.7% faster computations with equal accuracy

Position errors of 3-6 centimeters compared to external measurements

Effective gravitational direction estimation from goal post edges

Abstract

To be able to play soccer, a robot needs a good estimate of its current position on the field. Ideally, multiple features are visible that have known locations. By applying trigonometry we can estimate the viewpoint from where this observation was actually made. Given that the Nao robots of the Standard Platform League have quite a limited field of view, a given camera frame typically only allows for one or two points to be recognized. In this paper we propose a method for determining the (x, y) coordinates on the field and the height h of the camera from the geometry of a simplified tetrahedron. This configuration is formed by two observed points on the ground plane plus the gravitational direction. When the distance between the two points is known, and the directions to the points plus the gravitational direction are measured, all dimensions of the tetrahedron can be determined. By performing these calculations with rational trigonometry instead of classical trigonometry, the computations turn out to be 28.7% faster, with equal numerical accuracy. The position of the head of the Nao can also be externally measured with the OptiTrack system. The difference between externally measured and internally predicted position from sensor data gives us mean absolute errors in the 3-6 centimeters range, when we estimated the gravitational direction from the vanishing point of the outer edges of the goal posts.