Extraction of preview elevation of road based on 3D sensor

Abstract With preview road elevation information, we could prepare the vehicle for preview road inputs and allow the vehicle body to remain as smooth as possible to improve ride comfort. But few people gave a detailed description of it. In this paper, we proposed an approach using 3D sensor, IMU and GPS to get accurate preview three dimensional points cloud data of the road, attitude angle and position information for extracting the elevation information of road in advance. GPS/INS loosely-coupled integrated navigation and Kalman Filter were used to get accurate attitude angle and position information, which could ensure the precision of data fusion. Then the points cloud data was processed by VoxelGrid filtering algorithm and PassThrough filtering algorithm to get the useful data, which could reduce the calculation burden. In the end, these road elevation information was interpolated and fitted by cubic spline interpolation, which is a computationally fast and accurate method.

[1]  Sven Behnke,et al.  Continuous mapping and localization for autonomous navigation in rough terrain using a 3D laser scanner , 2017, Robotics Auton. Syst..

[2]  Oliver Sawodny,et al.  Design and Vehicle Implementation of Preview Active Suspension Controllers , 2014, IEEE Transactions on Control Systems Technology.

[3]  Hikmet Kerem Cigizoglu,et al.  Short term monitoring of forest road pavement degradation using terrestrial laser scanning , 2017 .

[4]  Guisong Yang,et al.  Distributed H∞ filtering for a class of sensor networks with uncertain rates of packet losses , 2014, Signal Process..

[5]  Raquel Caballero-Águila,et al.  Fusion estimation using measured outputs with random parameter matrices subject to random delays and packet dropouts , 2016, Signal Process..

[6]  Shu-Li Sun,et al.  H∞ filtering for multiple channel systems with varying delays, consecutive packet losses and randomly occurred nonlinearities , 2014, Signal Process..

[7]  Masayoshi Tomizuka,et al.  Road disturbance estimation for the optimal preview control of an active suspension systems based on tracked vehicle model , 2017 .

[8]  Hamid Reza Karimi,et al.  Observer-based finite-time fuzzy H∞ control for discrete-time systems with stochastic jumps and time-delays , 2014, Signal Process..

[9]  Seong Yun Cho,et al.  Modified Unscented Kalman Filter for a Multirate INS/GPS Integrated Navigation System , 2013 .

[10]  Gongjian Zhou,et al.  Constant turn model for statically fused converted measurement Kalman filters , 2015, Signal Process..

[11]  D. A. Crolla,et al.  A study of a Kalman filter active vehicle suspension system using correlation of front and rear wheel road inputs , 2000 .

[12]  Zhang Jian-wu,et al.  Performance analysis of limited bandwidth active suspension with preview based on a discrete time model , 2010 .

[13]  Michael V. Basin,et al.  Mean-square H∞ filtering for stochastic systems: Application to a 2DOF helicopter , 2012, Signal Process..

[14]  Jörg Stückler,et al.  Rough Terrain 3D Mapping and Navigation Using a Continuously Rotating 2D Laser Scanner , 2014, KI - Künstliche Intelligenz.

[15]  Mingzhen Gui,et al.  INS/VNS/CNS integrated navigation method for planetary rovers , 2016 .

[16]  James Lam,et al.  Multi-objective control for active vehicle suspension with wheelbase preview , 2014 .

[17]  Zhaolong Cao,et al.  MR-SAS variable universe fuzzy control in steering situation based on wheelbase preview , 2016 .

[18]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[19]  Jianye Liu,et al.  A robust filtering algorithm for integrated navigation system of aerospace vehicle in launch inertial coordinate , 2016 .

[20]  Youngjin Park,et al.  Ride quality analysis of a tracked vehicle suspension with a preview control , 2011 .

[21]  Aboelmagd Noureldin,et al.  Performance Enhancement of MEMS-Based INS/GPS Integration for Low-Cost Navigation Applications , 2009, IEEE Transactions on Vehicular Technology.

[22]  Goodarz Ahmadi,et al.  Optimal Active Control of Vehicle Suspension System Including Time Delay and Preview for Rough Roads , 2002 .

[23]  Masayoshi Tomizuka,et al.  OPTIMAL PREVIEW CONTROL OF TRACKED VEHICLE SUSPENSION SYSTEMS , 2006 .