LiDAR-IMU Time Delay Calibration Based on Iterative Closest Point and Iterated Sigma Point Kalman Filter. Sensors 2017, 17, 539.

The IMU consists of three gyros and three accelerometers [...].

The authors wish to make the following corrections to this paper [1]:

3.2. IMU Measurement Model

The IMU consists of three gyros and three accelerometers. The gyro provides change of Euler angles, while the accelerometers give the specific force. This model is based on the inertial measurement system error modeling method presented by Jonathan Kelly [5,27] and integrates the modified Rodrigues parameters kinematic equation. We obtained the IMU measuring equations as follows: where is the IMU orientation covariance at a time , is an additive noise vector, is the modified Rodrigues parameters vector, and are the system matrix for , is the skew-symmetric cross-product matrix for , is the 3 × 3 identity matrix, is the true angular velocity of IMU, and and are the gyroscope bias vector and the noise vector, respectively.

4.1. The ICP Algorithm for Estimation the Time Delay and Relative Orientation of LiDAR-IMU

The ICP algorithm is utilized to estimation the LiDAR-IMU time delay and relative orientation. At the beginning, the transforms between the LiDAR-IMU orientation curves are computed through iteratively selecting correspondences point using the ICP algorithm. We employed the TD-ICP algorithm registration rules proposed by Jonathan Kelly [5,31] and by adjusting the search corresponding time scale and the orientation curves converge, this ICP algorithm can be described in two steps:

Step I: Registration Rules.

The ICP algorithm operates by iteratively selecting the closest point between the IMU orientation curve and the LiDAR measurement point, and the concept of ICP proximity requires a suitable distance measurement. The minimum value of distance function can be computed as where is the incremental rotation arc length taking from to in radians orientation, and is the spatial transform model on the unit sphere.

Step II: Nonlinear Iterative Registration Rules.

We can getcorrespondence relationship between IMU and LiDAR orientation measurement curves by selecting the closest IMU point for LiDAR point. The cost function used to align the IMU and LiDAR orientation curves can be calculated as where and are the associated covariance matrices, and are the stacked residuals vectors, and the and are transform parameters.

By using Lagrange multipliers and incorporating the constraints , differentiating and rearranging, Equation (32) can be minimized as where is the block-diagonal Jacobian matrix of the constraints with respect to , and is the stacked Jacobian matrix of the constraints with respect to the transform parameters and .

The authors would like to apologize for any inconvenience caused to the readers by these changes.