A Reliable Linearly Separable Optimization Method for SLAM Estimation based on Stereo Features

Mohamed Hamdy Merzban, Mohamed Hassan Mohamed, Mohamed Abdellatif

Abstract


SLAM (Simultaneous Localization and Mapping) based on graphical representation is used to solve optimization non-linear problems. The solutions of graph-based SLAM have n noisy measurements and re-projection errors lead to uncertainty in robot pose and landmark position. The proposed system providesa novel two-stage architecture for visual SLAM that was designed and implemented. The new two-stage architecture resulted in an exactly linear graph optimization, by using a linear optimization method for graph optimization, so the problem now becomes linear. We take benefit of all camera measurements and needn’t ignore any frames. We enhance accuracy of large scale VSLM system, minimize processing time and decrease computational cost. We show that our system can be used with a higher accuracy and processing time than well-known systems based on bundle adjustment.


Keywords


Graph based SLAM (Simultaneous Localization and Mapping); Stereo Features; Linearization; Consistent Map.

Full Text:

PDF

References


Jia-Qi Fang and Thomas S Huang. “Some experiments on estimating the 3-D motion parameters of a rigid body from two consecutive image frames”. In: Pattern Analysis and Machine Intelligence, IEEE Transactions on 5 (1984), pp. 545–554.

Andrew W Fitzgibbon and Andrew Zisserman. “Automatic camera recovery for closed or open image sequences”. In: Computer Vision—ECCV’98. Springer, 1998, pp. 311–326.

David Nist´er. “An efficient solution to the five-point relative pose problem.” In: IEEE transactions on pattern analysis and machine intelligence 26.6 (June 2004), pp. 756–77.

Bert M. Haralick, Chung-Nan Lee, Karsten Ottenberg, and Michael Nolle. “Review and analysis of solutions of the three point perspective pose estimation problem”. In: International Journal of Computer Vision 13.3 (Dec. 1994), pp. 331–356.

Martin A. Fischler and Robert C. Bolles. “Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography”. In: Communications of the ACM 24.6 (June 1981), pp. 381–395.

David Nist´er, Oleg Naroditsky, and James Bergen. “Visual odometry for ground vehicle applications”. In: Journal of Field Robotics 23.1 (2006), pp. 3–20.

David Nist´er. “Preemptive RANSAC for live structure and motion estimation”. In:

Proceedings Ninth IEEE International Conference on Computer Vision. IEEE, 2003,199–206 vol.1.

Etienne Mouragnon, Maxime Lhuillier, Michel Dhome, Fabien Dekeyser, and Patrick Sayd. “Generic and real-time structure from motion using local bundle adjustment”. In: Image and Vision Computing 27.8 (2009), pp. 1178–1193.

Andrew Howard. “Real-time stereo visual odometry for autonomous ground vehi- cles”. In: Intelligent Robots and Systems, 2008. IROS 2008. IEEE/RSJ Interna- tional Conference on. IEEE. 2008, pp. 3946–3952.

Georg Klein and David Murray. “Parallel Tracking and Mapping for Small AR Workspaces”. In: 2007 6th IEEE and ACM International Symposium on Mixed and Augmented Reality 07.3 (2007), pp. 1–10.

Zhan Wang, Shoudong Huang, and Gamini Dissanayake. “D-SLAM: Decoupled lo- calization and mapping for autonomous robots”. In: Robotics Research. Springer,2007, pp. 203–213.

Paul Newman. “On the structure and solution of the simultaneous localisation and map building problem”. In: Doctoral diss., University of Sydney (1999).

Eagle S Jones and Stefano Soatto. “Visual-inertial navigation, mapping and local- ization: A scalable real-time causal approach”. In: The International Journal of Robotics Research 30.4 (2011), pp. 407–430.

Pedro Pini´es, Todd Lupton, Salah Sukkarieh, and Juan D Tardos. “Inertial aiding of inverse depth SLAM using a monocular camera”. In: Robotics and Automation,

IEEE International Conference on. IEEE. 2007, pp. 2797–2802.

Atanas Georgiev and Peter K Allen. “Localization methods for a mobile robot in urban environments”. In: Robotics, IEEE Transactions on 20.5 (2004), pp. 851–864.

Stephan Weiss, Markus W Achtelik, Simon Lynen, Margarita Chli, and Roland Siegwart. “Real-time onboard visual-inertial state estimation and self-calibration of mavs in unknown environments”. In: Robotics and Automation (ICRA), 2012 IEEE International Conference on. IEEE. 2012, pp. 957–964.

Anthony Kim and MF Golnaraghi. “Initial calibration of an inertial measurement unit using an optical position tracking system”. In: Position Location and Navigation Symposium, 2004. IEEE. 2004, pp. 96–101.

WT Fong, SK Ong, and AYC Nee. “Methods for in-field user calibration of an inertial measurement unit without external equipment”. In: Measurement Science and Technology 19.8 (2008).

Michael Jean Philippe Tardif, Michel Laverne, Alonzo Kelly, and Anthony Stentz. “A new approach to vision-aided inertial navigation”. In: Intelligent Robots and Sys- tems (IROS), 2010 IEEE/RSJ International Conference on. IEEE. 2010, pp. 4161–4168.

Stefan Leutenegger, Paul Timothy Furgale, Vincent Rabaud, Margarita Chli, Kurt Konolige, and Roland Siegwart. “Keyframe-Based Visual-Inertial SLAM using Non- linear Optimization.” In: Robotics: Science and Systems. 2013.

Bill Triggs, Philip F McLauchlan, Richard I Hartley, and Andrew W Fitzgibbon. “Bundle adjustment—a modern synthesis”. In: Vision algorithms: theory and prac- tice. Springer, 2000, pp. 298–372.

Tim Bailey, Juan Nieto, Jose Guivant, Michael Stevens, and Eduardo Nebot. “Con- sistency of the EKF-SLAM algorithm”. In: Intelligent Robots and Systems, 2006 IEEE/RSJ International Conference on. IEEE. 2006, pp. 3562–3568.

Kurt Konolige and Motilal Agrawal . " Frame SLAM: From bundle adjustment to realtime visual mapping". In: Robotics, IEEE Transactions on 24.5 (2008), pp. 1066{

Gabe Sibley, Christopher Mei, Ian Reid, and Paul Newman. “Adaptive RelativeBundle Adjustment”. In: IEEE Transactions on Robotics 220.3 (2009), pp. 1–8.

Hauke Strasdat, JMM Montiel, and Andrew J Davison. “Real-time monocular slam: Why filter?” In: Robotics and Automation (ICRA), 2010 IEEE International Con- ference on. IEEE. 2010, pp. 2657–2664.

Christopher Mei, Gabe Sibley, Mark Cummins, Paul M Newman, and Ian D Reid. “A Constant-Time Efficient Stereo SLAM System.” In: BMVC. 2009, pp. 1–11.

Mark Cummins and Paul Newman. “FAB-MAP: Probabilistic localization and map- ping in the space of appearance”. In: The International Journal of Robotics Research

6 (2008), pp. 647–665.

Mark Cummins and Paul Newman. “Probabilistic appearance based navigation and loop closing”. In: Robotics and automation, 2007 IEEE international conference on. IEEE. 2007, pp. 2042–2048.

Kurt Konolige, James Bowman, JD Chen, Patrick Mihelich, Michael Calonder, Vin- cent Lepetit, and Pascal Fua. “View-based maps”. In: The International Journal of Robotics Research (2010).

Frank Dellaert and Michael Kaess. “Square Root SAM: Simultaneous localization and mapping via square root information smoothing”. In: The International Journal of Robotics Research 25.12 (2006), pp. 1181–1203.

William H Press. Numerical recipes 3rd edition: The art of scientific computing.Cambridge university press, 2007.

Zhengyou Zhang. “A flexible new technique for camera calibration”. In: PatternAnalysis and Machine Intelligence, IEEE Transactions on 22.11 (2000), pp. 1330–1334.

Richard Hartley and Andrew Zisserman. Multiple View Geometry in Computer Vi-sion. Cambridge University Press, 2003.

Richard I. Hartley and Peter Sturm. Triangulation". In: Computer Vision andImage Understanding 68.2 (Nov. 1997), pp. 146{157.

Tue-Cuong Dong-Si and A.I. Mourikis. “Estimator initialization in vision-aided iner- tial navigation with unknown camera-IMU calibration”. In: Intelligent Robots and Systems (IROS), 2012 IEEE/RSJ International Conference on. 2012, pp. 1064–1071.

Javier Civera, Andrew J Davison, and J Montiel. “Inverse depth parametrization for monocular SLAM”. In: Robotics, IEEE Transactions on 24.5 (2008), pp. 932–945.

Cyril Roussillon, Aurelien Gonzalez, and Joan Sol`a. “RT-SLAM: a generic and real- time visual SLAM implementation”. In: Computer Vision . . . (Jan. 2011), p. 10.

Paul Furgale, Joern Rehder, and Roland Siegwart , "Unied temporal and spatial calibration for multi-sensor systems". In: Intelligent Robots and Systems (IROS),2013 IEEE/RSJ International Conference on. IEEE. 2013, pp. 1280{1286.

Jos´e-Luis Blanco, Francisco-Angel Moreno, and Javier Gonz´alez. “A Collection of Outdoor Robotic Datasets with centimeter-accuracy Ground Truth”. In: Au- tonomous Robots 27.4 (Nov. 2009), pp. 327–351.

Mohamed H. Mahmoud, N. M. Hussein, Elsayed Hemayed, F. Endres, W. Burgard, and D. Cremers, “A FAST LINEARLY BACK-END SLAM FOR NAVIGATION BASED ON MONOCULAR CAMERA,” in International Journal of Civil Engineering and Technology (IJCIET) Volume 9, Issue 12, December 2018, pp. 627-645.

Mohamed H. Merzban, etc.. "Toward multi-stage decoupled visual SLAM system" , 2013 IEEE International Symposium on Robotic and Sensors Environments (ROSE), 2013.




DOI: http://dx.doi.org/10.52155/ijpsat.v29.1.3437

Refbacks

  • There are currently no refbacks.


Copyright (c) 2021 Mohamed Hassan M. Mahmoud, Nashaat M. Hussien Hassan, Elsayed Hemayed

Creative Commons License
This work is licensed under a Creative Commons Attribution 4.0 International License.