Attitude Estimation and Control Using Linear-Like Complementary Filters: Theory and Experiment

This paper proposes new algorithms for attitude estimation and control based on fused inertial vector measurements using linear complementary filters principle. First, n-order direct and passive complementary filters combined with TRIAD algorithm are proposed to give attitude estimation solutions. These solutions which are efficient with respect to noise include the gyro bias estimation. Thereafter, the same principle of data fusion is used to address the problem of attitude tracking based on inertial vector measurements. Thus, instead of using noisy raw measurements in the control law a new solution of control that includes a linear-like complementary filter to deal with the noise is proposed. The stability analysis of the tracking error dynamics based on LaSalle's invariance theorem proved that almost all trajectories converge asymptotically to the desired equilibrium. Experimental results, obtained with DIY Quad equipped with the APM2.6 auto-pilot, show the effectiveness and the performance of the proposed solutions.Comment: Submitted for Journal publication on March 09, 2015. Partial results related to this work have been presented in IEEE-ROBIO-201

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

Dispersion enhancement and damping by buoyancy driven flows in 2D networks of capillaries

The influence of a small relative density difference on the displacement of two miscible liquids is studied experimentally in transparent 2D networks of micro channels. Both stable displacements in which the denser fluid enters at the bottom of the cell and displaces the lighter one and unstable displacements in which the lighter fluid is injected at the bottom and displaces the denser one are realized. Except at the lowest mean flow velocity U, the average $C(x,t)$ of the relative concentration satisfies a convection-dispersion equation. The dispersion coefficient is studied as function of the relative magnitude of fluid velocity and of the velocity of buoyancy driven fluid motion. A model is suggested and its applicability to previous results obtained in 3D media is discussed