Rigid body motion estimation based on the Lagrange-d'Alembert principle
Authors:
- 1 December 2015
- conference paper
- Published by Institute of Electrical and Electronics Engineers (IEEE)
- p. 3699-3704
Abstract
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.Keywords
This publication has 15 references indexed in Scilit:
- Geometric Adaptive Tracking Control of a Quadrotor Unmanned Aerial Vehicle on SE(3) for Agile ManeuversJournal of Dynamic Systems, Measurement, and Control, 2015
- Comparison of an attitude estimator based on the Lagrange-d'Alembert principle with some state-of-the-art filters2015
- Observers for invariant systems on Lie groups with biased input measurements and homogeneous outputsAutomatica, 2015
- Determination of relative motion of a space object from simultaneous measurements of range and range rate2014
- Relative Navigation Approach for Vision-Based Aerial GPS-Denied NavigationJournal of Intelligent & Robotic Systems, 2013
- A nonlinear position and attitude observer on SE(3) using landmark measurementsSystems & Control Letters, 2010
- Nonlinear Complementary Filters on the Special Orthogonal GroupIEEE Transactions on Automatic Control, 2008
- Pose estimation using line-based dynamic vision and inertial sensorsIEEE Transactions on Automatic Control, 2003
- Discrete mechanics and variational integratorsActa Numerica, 2001
- Maximum-likelihood recursive nonlinear filteringJournal of Optimization Theory and Applications, 1968