SO(3)-invariant asymptotic observers for dense depth field estimation based on visual data and known camera motion

In this paper, we use known camera motion associated to a video sequence of a static scene in order to estimate and incrementally refine the surrounding depth field. We exploit the SO(3)-invariance of brightness and depth fields dynamics to customize standard image processing techniques. Inspired by the Horn-Schunck method, we propose a SO(3)-invariant cost to estimate the depth field. At each time step, this provides a diffusion equation on the unit Riemannian sphere of R3 that is numerically solved to obtain a real time depth field estimation of the entire field of view. Two asymptotic observers are derived from the governing equations of dynamics, respectively based on optical flow and depth estimations: implemented on noisy sequences of synthetic images as well as on real data, they perform a more robust and accurate depth estimation. This approach is complementary to most methods employing state observers for range estimation, which uniquely concern single or isolated feature points.

[1]  Berthold K. P. Horn,et al.  Determining Optical Flow , 1981, Other Conferences.

[2]  Robert E. Mahony,et al.  A general optical flow based terrain-following strategy for a VTOL UAV using multiple views , 2010, 2010 IEEE International Conference on Robotics and Automation.

[3]  Sebastian Thrun,et al.  FastSLAM 2.0: An Improved Particle Filtering Algorithm for Simultaneous Localization and Mapping that Provably Converges , 2003, IJCAI.

[4]  Hauke Strasdat,et al.  Scale Drift-Aware Large Scale Monocular SLAM , 2010, Robotics: Science and Systems.

[5]  Mohan M. Trivedi,et al.  Improving stereo camera depth measurements and benefiting from intermediate results , 2010, 2010 IEEE Intelligent Vehicles Symposium.

[6]  Larry H. Matthies,et al.  Kalman filter-based algorithms for estimating depth from image sequences , 1989, International Journal of Computer Vision.

[7]  P. Rouchon,et al.  Fusion of inertial and visual: a geometrical observer‐based approach , 2009 .

[8]  Xinkai Chen,et al.  A new state observer for perspective systems , 2002, IEEE Trans. Autom. Control..

[9]  Alessandro Astolfi,et al.  A new solution to the problem of range identification in perspective vision systems , 2005, IEEE Transactions on Automatic Control.

[10]  Amar Mitiche,et al.  On convergence of the Horn and Schunck optical-flow estimation method , 2004, IEEE Transactions on Image Processing.

[11]  Giuseppe Oriolo,et al.  Feature Depth Observation for Image-based Visual Servoing: Theory and Experiments , 2008, Int. J. Robotics Res..

[12]  Javier Civera,et al.  Inverse Depth Parametrization for Monocular SLAM , 2008, IEEE Transactions on Robotics.

[13]  Anders Heyden,et al.  Observer forms for perspective systems , 2010, Autom..

[14]  Hauke Strasdat,et al.  Real-time monocular SLAM: Why filter? , 2010, 2010 IEEE International Conference on Robotics and Automation.

[15]  Richard M. Murray,et al.  A bio-plausible design for visual attitude stabilization , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[16]  Warren E. Dixon,et al.  Range identification for perspective vision systems , 2003, IEEE Trans. Autom. Control..

[17]  Antonin Chambolle,et al.  A First-Order Primal-Dual Algorithm for Convex Problems with Applications to Imaging , 2011, Journal of Mathematical Imaging and Vision.

[18]  Alessandro Astolfi,et al.  Observer design for range and orientation identification , 2010, Autom..

[19]  Anders Heyden,et al.  Provably convergent on-line structure and motion estimation for perspective systems , 2009, 2009 IEEE 12th International Conference on Computer Vision Workshops, ICCV Workshops.

[20]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[21]  Bijoy K. Ghosh,et al.  Nonlinear observers for perspective time-invariant linear systems , 2004, Autom..