Continuous Fusion of Motion Data Using an Axis-Angle Rotation Representation with Uniform B-Spline

The fusion of motion data is key in the fields of robotic and automated driving. Most existing approaches are filter-based or pose-graph-based. By using filter-based approaches, parameters should be set very carefully and the motion data can usually only be fused in a time forward direction. Pose-graph-based approaches can fuse data in time forward and backward directions. However, pre-integration is needed by applying measurements from inertial measurement units. Additionally, both approaches only provide discrete fusion results. In this work, we address this problem and present a uniform B-spline-based continuous fusion approach, which can fuse motion measurements from an inertial measurement unit and pose data from other localization systems robustly, accurately and efficiently. In our continuous fusion approach, an axis-angle is applied as our rotation representation method and uniform B-spline as the back-end optimization base. Evaluation results performed on the real world data show that our approach provides accurate, robust and continuous fusion results, which again supports our continuous fusion concept.

[1]  Julius Ziegler,et al.  Calibrating multiple cameras with non-overlapping views using coded checkerboard targets , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[2]  Martin Lauer,et al.  Automatic Calibration of Multiple Cameras and Depth Sensors with a Spherical Target , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[3]  Andreu Corominas Murtra,et al.  IMU and cable encoder data fusion for in-pipe mobile robot localization , 2013, 2013 IEEE Conference on Technologies for Practical Robot Applications (TePRA).

[4]  Martin Lauer,et al.  Mapping and localization using surround view , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[5]  Gerhard P. Hancke,et al.  Pose Estimation of a Mobile Robot Based on Fusion of IMU Data and Vision Data Using an Extended Kalman Filter , 2017, Sensors.

[6]  Andrew Zisserman,et al.  Multiple View Geometry in Computer Vision (2nd ed) , 2003 .

[7]  Sascha Wirges,et al.  Making Bertha Cooperate–Team AnnieWAY’s Entry to the 2016 Grand Cooperative Driving Challenge , 2018, IEEE Transactions on Intelligent Transportation Systems.

[8]  Yafei Ren,et al.  Particle Filter Data Fusion Enhancements for MEMS-IMU/GPS , 2010, Intell. Inf. Manag..

[9]  Anthony J. Yezzi,et al.  A Compact Formula for the Derivative of a 3-D Rotation in Exponential Coordinates , 2013, Journal of Mathematical Imaging and Vision.

[10]  Anweshan Das,et al.  An Experimental Study on Relative and Absolute Pose Graph Fusion for Vehicle Localization , 2018, 2018 IEEE Intelligent Vehicles Symposium (IV).

[11]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[12]  L. Schumaker,et al.  Degree raising for splines , 1986 .

[13]  Guozhao Wang,et al.  NUAT B-spline curves , 2004, Comput. Aided Geom. Des..

[14]  Hyun Myung,et al.  Robust Vehicle Localization Using Entropy-Weighted Particle Filter-based Data Fusion of Vertical and Road Intensity Information for a Large Scale Urban Area , 2017, IEEE Robotics and Automation Letters.

[15]  B. Hall Lie Groups, Lie Algebras, and Representations , 2003 .

[16]  Cyrill Stachniss,et al.  Pose fusion with chain pose graphs for automated driving , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[17]  S. Helgason Differential Geometry and Symmetric Spaces , 1964 .

[18]  F. Samadzadegan,et al.  Autonomous navigation of Unmanned Aerial Vehicles based on multi-sensor data fusion , 2012, 20th Iranian Conference on Electrical Engineering (ICEE2012).

[19]  M. Cox The Numerical Evaluation of B-Splines , 1972 .

[20]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[21]  Roland Siegwart,et al.  GOMSF: Graph-Optimization Based Multi-Sensor Fusion for robust UAV Pose estimation , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[22]  Tilman Kühner,et al.  Fast and Precise Visual Rear Axle Calibration , 2019, 2019 IEEE Intelligent Transportation Systems Conference (ITSC).

[23]  Rubén Mascaró Palliser Graph-Optimization base multi-sensor fusion for robust UAV pose estimation , 2017 .

[24]  C. D. Boor,et al.  On Calculating B-splines , 1972 .

[25]  Kiyoshi Irie A graph optimization approach for motion estimation using inertial measurement unit data , 2018 .

[26]  Sangkyung Sung,et al.  IMU/Vision/Lidar integrated navigation system in GNSS denied environments , 2013, 2013 IEEE Aerospace Conference.

[27]  Dinar Camotim,et al.  On the differentiation of the Rodrigues formula and its significance for the vector‐like parameterization of Reissner–Simo beam theory , 2002 .

[28]  Hong Yan,et al.  Vectorization of hand-drawn image using piecewise cubic Bézier curves fitting , 1998, Pattern Recognit..