1: \begin{abstract}                          % Abstract of not more than 250 words.

2: Stable estimation of rigid body pose and velocities from noisy measurements, without any 

3: knowledge of the dynamics model, is treated using the Lagrange-d'Alembert principle from 

4: variational mechanics.

5: With body-fixed optical and inertial sensor measurements, a Lagrangian is obtained as the 

6: difference between a kinetic energy-like term that is quadratic in velocity estimation error and 

7: the sum of two artificial potential functions; one obtained from a generalization of Wahba's 

8: function for attitude estimation and another which is quadratic in the position estimate error. An 

9: additional dissipation term that is linear in the velocity estimation error is introduced, and the 

10: Lagrange-d'Alembert principle is applied to the Lagrangian with this dissipation. A Lyapunov 

11: analysis shows that the state estimation scheme so obtained provides stable asymptotic 

12: convergence of state estimates to actual states in the absence of measurement noise, with an 

13: almost global domain of attraction. This estimation scheme is discretized for computer 

14: implementation using discrete variational mechanics, as a first order Lie group variational 

15: integrator. The continuous and discrete pose estimation schemes require optical measurements 

16: of at least three inertially fixed landmarks or beacons in order to estimate instantaneous pose. 

17: The discrete estimation scheme can also estimate velocities from such optical measurements.

18: Moreover, all states can be estimated during time periods when measurements of only two 

19: inertial vectors, the angular velocity vector, and one feature point position vector are available 

20: in body frame. In the presence of bounded measurement noise in the vector measurements, 

21: numerical simulations show that the estimated states converge to a bounded neighborhood 

22: of the actual states.

23: \end{abstract}