A Nonlinear Attitude Observer Based on Active Vision and Inertial Measurements

This paper presents an experimentally evaluated solution to the problem of estimating the attitude of a rigid body using rate gyros and a pan-tilt camera. A nonlinear attitude observer combines angular velocity measurements obtained from rate gyros with images of a planar scene provided by the camera. By directly exploiting the sensor information, a stabilizing feedback law is introduced, and exponential convergence to the origin of the estimation errors is shown. Additionally, an active-vision system is proposed that relies on an image-based exponentially input-to-state-stable control law for the pan and tilt angular rates of the camera to keep the features in the image plane. Using recent results in geometric numerical integration, a multirate implementation of the observer is proposed, which exploits the complementary bandwidth of the sensors. Practical considerations, such as the lens-distortion compensation and the computation of suitable observer feedback gains, are considered. Experimental results obtained with a high-accuracy motion rate table demonstrate the high level of performance attained by the proposed solution.