Rigid body pose estimation based on the Lagrange-d'Alembert principle

Maziar Izadi, Amit Sanyal

Research output: Contribution to journalArticle

8 Citations (Scopus)

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 vision 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. A Lyapunov analysis shows that the state estimation scheme so obtained provides stable asymptotic convergence of state estimates to actual states in the absence of measurement noise, with an almost global domain of attraction. This estimation scheme is discretized for computer implementation using discrete variational mechanics, as a first order Lie group variational integrator. The discrete estimation scheme can also estimate velocities from such onboard sensor measurements. Moreover, all states can be estimated during time periods when measurements of only two inertial vectors, the angular velocity vector, and one feature point position vector are available in body frame. 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 true states.

Original languageEnglish (US)
Pages (from-to)78-88
Number of pages11
JournalAutomatica
Volume71
DOIs
StatePublished - Sep 1 2016

Fingerprint

Error analysis
Mechanics
Lie groups
Sensors
Angular velocity
State estimation
Kinetic energy
Dynamic models
Computer simulation

Keywords

  • Lagrange-d'Alembert principle
  • Lie group variational integrator
  • Pose estimation
  • Variational estimator

ASJC Scopus subject areas

  • Control and Systems Engineering
  • Electrical and Electronic Engineering

Cite this

Rigid body pose estimation based on the Lagrange-d'Alembert principle. / Izadi, Maziar; Sanyal, Amit.

In: Automatica, Vol. 71, 01.09.2016, p. 78-88.

Research output: Contribution to journalArticle

@article{a454c4c0b172422ca8a7afcc9a158588,
title = "Rigid body pose estimation based on the Lagrange-d'Alembert principle",
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 vision 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. A Lyapunov analysis shows that the state estimation scheme so obtained provides stable asymptotic convergence of state estimates to actual states in the absence of measurement noise, with an almost global domain of attraction. This estimation scheme is discretized for computer implementation using discrete variational mechanics, as a first order Lie group variational integrator. The discrete estimation scheme can also estimate velocities from such onboard sensor measurements. Moreover, all states can be estimated during time periods when measurements of only two inertial vectors, the angular velocity vector, and one feature point position vector are available in body frame. 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 true states.",
keywords = "Lagrange-d'Alembert principle, Lie group variational integrator, Pose estimation, Variational estimator",
author = "Maziar Izadi and Amit Sanyal",
year = "2016",
month = "9",
day = "1",
doi = "10.1016/j.automatica.2016.04.028",
language = "English (US)",
volume = "71",
pages = "78--88",
journal = "Automatica",
issn = "0005-1098",
publisher = "Elsevier",

}

TY - JOUR

T1 - Rigid body pose estimation based on the Lagrange-d'Alembert principle

AU - Izadi, Maziar

AU - Sanyal, Amit

PY - 2016/9/1

Y1 - 2016/9/1

N2 - 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 vision 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. A Lyapunov analysis shows that the state estimation scheme so obtained provides stable asymptotic convergence of state estimates to actual states in the absence of measurement noise, with an almost global domain of attraction. This estimation scheme is discretized for computer implementation using discrete variational mechanics, as a first order Lie group variational integrator. The discrete estimation scheme can also estimate velocities from such onboard sensor measurements. Moreover, all states can be estimated during time periods when measurements of only two inertial vectors, the angular velocity vector, and one feature point position vector are available in body frame. 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 true states.

AB - 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 vision 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. A Lyapunov analysis shows that the state estimation scheme so obtained provides stable asymptotic convergence of state estimates to actual states in the absence of measurement noise, with an almost global domain of attraction. This estimation scheme is discretized for computer implementation using discrete variational mechanics, as a first order Lie group variational integrator. The discrete estimation scheme can also estimate velocities from such onboard sensor measurements. Moreover, all states can be estimated during time periods when measurements of only two inertial vectors, the angular velocity vector, and one feature point position vector are available in body frame. 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 true states.

KW - Lagrange-d'Alembert principle

KW - Lie group variational integrator

KW - Pose estimation

KW - Variational estimator

UR - http://www.scopus.com/inward/record.url?scp=84974555850&partnerID=8YFLogxK

UR - http://www.scopus.com/inward/citedby.url?scp=84974555850&partnerID=8YFLogxK

U2 - 10.1016/j.automatica.2016.04.028

DO - 10.1016/j.automatica.2016.04.028

M3 - Article

AN - SCOPUS:84974555850

VL - 71

SP - 78

EP - 88

JO - Automatica

JF - Automatica

SN - 0005-1098

ER -