106 research outputs found
Rigid Body Motion Estimation based on the Lagrange-d'Alembert Principle
Stable estimation of rigid body pose and velocities from noisy measurements,
without any knowledge of the dynamics model, is treated using the
Lagrange-d'Alembert principle from variational mechanics. With body-fixed
optical and inertial sensor measurements, a Lagrangian is obtained as the
difference between a kinetic energy-like term that is quadratic in velocity
estimation error and the sum of two artificial potential functions; one
obtained from a generalization of Wahba's function for attitude estimation and
another which is quadratic in the position estimate error. An additional
dissipation term that is linear in the velocity estimation error is introduced,
and the Lagrange-d'Alembert principle is applied to the Lagrangian with this
dissipation. This estimation scheme is discretized using discrete variational
mechanics. The presented pose estimator requires optical measurements of at
least three inertially fixed landmarks or beacons in order to estimate
instantaneous pose. The discrete estimation scheme can also estimate velocities
from such optical measurements. In the presence of bounded measurement noise in
the vector measurements, numerical simulations show that the estimated states
converge to a bounded neighborhood of the actual states.Comment: My earlier submitted manuscript (arXiv:1508.07671), is an extended
version of this work, containing detailed proofs and more elaborated
numerical simulations, currently under review in Automatica. This paper will
be cited in the extended journal version (arXiv:1508.07671) upon publicatio
Deterministic Global Attitude Estimation
A deterministic attitude estimation problem for a rigid body in an attitude
dependent potential field with bounded measurement errors is studied. An
attitude estimation scheme that does not use generalized coordinate
representations of the attitude is presented here. Assuming that the initial
attitude, angular velocity and measurement noise lie within given ellipsoidal
bounds, an uncertainty ellipsoid that bounds the attitude and the angular
velocity of the rigid body is obtained. The center of the uncertainty ellipsoid
provides point estimates, and its size gives the accuracy of the estimates. The
point estimates and the uncertainty ellipsoids are propagated using a Lie group
variational integrator and its linearization, respectively. The estimation
scheme is optimal in the sense that the attitude estimation error and the size
of the uncertainty ellipsoid is minimized at each measurement instant, and it
is global since the attitude is represented by a rotation matrix.Comment: IEEE Conference on Decision and Control, 2006. 6 pages, 6 figure
- …