# IMU-Aided High-Frequency Lidar Odometry for Autonomous Driving
## 3 The Proposed Approach
### Output Step: Fusion in an EKF Framework
#### 3.6.3 Measurement Model
(**a**) shows the trajectory generated by our system when the UGV drives at a speed around 20 km/h and the overall distance is about 1.3 km. (**b**) compares the trajectories generated by our system and by the disturbed GNSS/INS system. (**c**) shows the output period of our localization system during the whole process, and the average output frequency is about 39.7 Hz. * [PERSON] et al. (2015) [PERSON]; [PERSON]; [PERSON]; [PERSON]; [PERSON]; [PERSON] [PERSON]; [PERSON]; [PERSON] [PERSON] LiDAR scan matching aided inertial navigation system in GNSS-denied environments. _Sensors_**2015**, _15_, 16710-16728. [CrossRef] [PubMed]
* [PERSON] et al. (2014) [PERSON]; [PERSON]; [PERSON] [PERSON]; [PERSON]; [PERSON] An inertial-aided LiDAR scan matching algorithm for multisensor land-based navigation. In Proceedings of the 27 th International Technical Meeting of the Satellite Division of the Institute of Navigation, Tampa, FL, USA, 8-12 September 2014; pp. 2089-2096. * [PERSON] and [PERSON] (2017) [PERSON]; [PERSON] LiDAR and Inertial Fusion for Pose Estimation by Non-linear Optimization. _arXiv_**2017**, arXiv:1710.07104. * [PERSON] and [PERSON] (2018) [PERSON] [PERSON]; [PERSON] [PERSON]; [PERSON] Mapping forests using an unmanned ground vehicle with 3D LiDAR and graph-SLAM. _Comput. Electron. Agric._**2018**, _145_, 217-225. [CrossRef]
* [PERSON] (1992) [PERSON]; [PERSON] A Method for Registration of 3-D Shapes. _IEEE Trans. Pattern Anal. Mach. Intell._**1992**, _14_, 239-256. [CrossRef]
* [PERSON] et al. (2013) [PERSON]; [PERSON]; [PERSON]; [PERSON] Comparing ICP variants on real-world data sets. _Auton. Robots_**2013**, _34_, 133-148. [CrossRef]
* [PERSON] et al. (2012) [PERSON] [PERSON]; [PERSON] [PERSON]; [PERSON] [PERSON]; [PERSON] Fast and accurate scan registration through minimization of the distance between compact 3D NDT representations. _Int. J. Robot. Res._**2012**, _31_, 1377-1393. [CrossRef]
* [PERSON] et al. (2007) [PERSON]; [PERSON] [PERSON]; [PERSON] Scan registration for autonomous mining vehicles using 3D-NDT. _J. Field Robot._**2007**, _24_, 803-827. [CrossRef]
* [PERSON] et al. (2007) [PERSON]; [PERSON]; [PERSON] [PERSON]; [PERSON]; [PERSON] A comparison of line extraction algorithms using 2D range data for indoor mobile robotics. _Auton. Robots_**2007**, _23_, 97-111. [CrossRef]
* [PERSON] and [PERSON] (2007) [PERSON]; [PERSON] [PERSON] Feature-Based Laser Scan Matching for Accurate and High Speed Mobile Robot Localization. In Proceedings of the EMCR, Freiburg, Germany, 19-21 September 2007. * [PERSON] et al. (2015) [PERSON]; [PERSON]; [PERSON]; [PERSON]; [PERSON] [PERSON] Fast global scan matching for high-speed vehicle navigation. In Proceedings of the 2015 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI), San Diego, CA, USA, 14-16 September 2015; pp. 37-42. * [PERSON] and [PERSON] (2014) [PERSON]; [PERSON] [PERSON] LOAM: Lidar Odometry and Mapping in Real-time. In Proceedings of the Robotics: Science and Systems, Berkeley, CA, USA, 12-16 July 2014; pp. 109-111. * [PERSON] and [PERSON] (2017) [PERSON]; [PERSON] Low-drift and real-time lidar odometry and mapping. _Auton. Robots_**2017**, _41_, 401-416. [CrossRef]
* [PERSON] et al. (2016) [PERSON]; [PERSON]; [PERSON] Long-range GPS-denied aerial inertial navigation with LIDAR localization. In Proceedings of the 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Daejeon, Korea, 9-14 October 2016; pp. 1659-1666. * [PERSON] et al. (2018) [PERSON]; [PERSON], [PERSON]; [PERSON]; [PERSON]; [PERSON]; [PERSON]; [PERSON] Robust and Precise Vehicle Localization Based on Multi-Sensor Fusion in Diverse City Scenes. In Proceedings of the 2018 IEEE International Conference on Robotics and Automation (ICRA), Brisbane, QLD, Australia, 21-25 May 2018; pp. 4670-4677. * [PERSON] (2017) [PERSON] _State Estimation for Robotics_; Cambridge University Press: Cambridge, UK, 2017; pp. 231-234. * [PERSON] et al.